blob: 457dfef9c5fcac4d7fc92d74e22c77054579c8bc [file] [log] [blame]
Antonio Quartulli0b873932013-01-04 03:05:31 +01001/* Copyright (C) 2007-2013 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
15 * along with this program; if not, write to the Free Software
16 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
17 * 02110-1301, USA
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000018 */
19
20#include "main.h"
21#include "routing.h"
22#include "send.h"
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000023#include "soft-interface.h"
24#include "hard-interface.h"
25#include "icmp_socket.h"
26#include "translation-table.h"
27#include "originator.h"
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000028#include "unicast.h"
Simon Wunderlich23721382012-01-22 20:00:19 +010029#include "bridge_loop_avoidance.h"
Antonio Quartullic384ea32011-06-26 03:37:18 +020030#include "distributed-arp-table.h"
Martin Hundebøll95332472013-01-25 11:12:40 +010031#include "network-coding.h"
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000032
Sven Eckelmann63b01032012-05-16 20:23:13 +020033static int batadv_route_unicast_packet(struct sk_buff *skb,
Sven Eckelmann56303d32012-06-05 22:31:31 +020034 struct batadv_hard_iface *recv_if);
Simon Wunderlicha7f6ee92012-01-22 20:00:18 +010035
Sven Eckelmann56303d32012-06-05 22:31:31 +020036static void _batadv_update_route(struct batadv_priv *bat_priv,
37 struct batadv_orig_node *orig_node,
38 struct batadv_neigh_node *neigh_node)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000039{
Sven Eckelmann56303d32012-06-05 22:31:31 +020040 struct batadv_neigh_node *curr_router;
Linus Lüssinge1a5382f2011-03-14 22:43:37 +000041
Sven Eckelmann7d211ef2012-05-12 02:09:34 +020042 curr_router = batadv_orig_node_get_router(orig_node);
Marek Lindnera8e7f4b2010-12-12 21:57:10 +000043
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000044 /* route deleted */
Linus Lüssinge1a5382f2011-03-14 22:43:37 +000045 if ((curr_router) && (!neigh_node)) {
Sven Eckelmann39c75a52012-06-03 22:19:22 +020046 batadv_dbg(BATADV_DBG_ROUTES, bat_priv,
47 "Deleting route towards: %pM\n", orig_node->orig);
Sven Eckelmann08c36d32012-05-12 02:09:39 +020048 batadv_tt_global_del_orig(bat_priv, orig_node,
49 "Deleted route towards originator");
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000050
Linus Lüssinge1a5382f2011-03-14 22:43:37 +000051 /* route added */
52 } else if ((!curr_router) && (neigh_node)) {
Sven Eckelmann39c75a52012-06-03 22:19:22 +020053 batadv_dbg(BATADV_DBG_ROUTES, bat_priv,
Sven Eckelmann1eda58b2012-05-12 13:48:58 +020054 "Adding route towards: %pM (via %pM)\n",
55 orig_node->orig, neigh_node->addr);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +000056 /* route changed */
Sven Eckelmannbb899b82011-05-10 11:22:37 +020057 } else if (neigh_node && curr_router) {
Sven Eckelmann39c75a52012-06-03 22:19:22 +020058 batadv_dbg(BATADV_DBG_ROUTES, bat_priv,
Sven Eckelmann1eda58b2012-05-12 13:48:58 +020059 "Changing route towards: %pM (now via %pM - was via %pM)\n",
60 orig_node->orig, neigh_node->addr,
61 curr_router->addr);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000062 }
63
Linus Lüssinge1a5382f2011-03-14 22:43:37 +000064 if (curr_router)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +020065 batadv_neigh_node_free_ref(curr_router);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +000066
67 /* increase refcount of new best neighbor */
Marek Lindner44524fc2011-02-10 14:33:53 +000068 if (neigh_node && !atomic_inc_not_zero(&neigh_node->refcount))
69 neigh_node = NULL;
Linus Lüssinge1a5382f2011-03-14 22:43:37 +000070
71 spin_lock_bh(&orig_node->neigh_list_lock);
72 rcu_assign_pointer(orig_node->router, neigh_node);
73 spin_unlock_bh(&orig_node->neigh_list_lock);
74
75 /* decrease refcount of previous best neighbor */
76 if (curr_router)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +020077 batadv_neigh_node_free_ref(curr_router);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000078}
79
Sven Eckelmann56303d32012-06-05 22:31:31 +020080void batadv_update_route(struct batadv_priv *bat_priv,
81 struct batadv_orig_node *orig_node,
82 struct batadv_neigh_node *neigh_node)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000083{
Sven Eckelmann56303d32012-06-05 22:31:31 +020084 struct batadv_neigh_node *router = NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000085
86 if (!orig_node)
Linus Lüssinge1a5382f2011-03-14 22:43:37 +000087 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000088
Sven Eckelmann7d211ef2012-05-12 02:09:34 +020089 router = batadv_orig_node_get_router(orig_node);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +000090
91 if (router != neigh_node)
Sven Eckelmann63b01032012-05-16 20:23:13 +020092 _batadv_update_route(bat_priv, orig_node, neigh_node);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +000093
94out:
95 if (router)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +020096 batadv_neigh_node_free_ref(router);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000097}
98
Simon Wunderlicha4c135c2011-01-19 20:01:43 +000099/* caller must hold the neigh_list_lock */
Sven Eckelmann56303d32012-06-05 22:31:31 +0200100void batadv_bonding_candidate_del(struct batadv_orig_node *orig_node,
101 struct batadv_neigh_node *neigh_node)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000102{
103 /* this neighbor is not part of our candidate list */
104 if (list_empty(&neigh_node->bonding_list))
105 goto out;
106
107 list_del_rcu(&neigh_node->bonding_list);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000108 INIT_LIST_HEAD(&neigh_node->bonding_list);
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200109 batadv_neigh_node_free_ref(neigh_node);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000110 atomic_dec(&orig_node->bond_candidates);
111
112out:
113 return;
114}
115
Sven Eckelmann56303d32012-06-05 22:31:31 +0200116void batadv_bonding_candidate_add(struct batadv_orig_node *orig_node,
117 struct batadv_neigh_node *neigh_node)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000118{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200119 struct batadv_neigh_node *tmp_neigh_node, *router = NULL;
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000120 uint8_t interference_candidate = 0;
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000121
122 spin_lock_bh(&orig_node->neigh_list_lock);
123
124 /* only consider if it has the same primary address ... */
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200125 if (!batadv_compare_eth(orig_node->orig,
126 neigh_node->orig_node->primary_addr))
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000127 goto candidate_del;
128
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200129 router = batadv_orig_node_get_router(orig_node);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000130 if (!router)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000131 goto candidate_del;
132
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000133 /* ... and is good enough to be considered */
Sven Eckelmann42d0b042012-06-03 22:19:17 +0200134 if (neigh_node->tq_avg < router->tq_avg - BATADV_BONDING_TQ_THRESHOLD)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000135 goto candidate_del;
136
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200137 /* check if we have another candidate with the same mac address or
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000138 * interface. If we do, we won't select this candidate because of
139 * possible interference.
140 */
Sasha Levinb67bfe02013-02-27 17:06:00 -0800141 hlist_for_each_entry_rcu(tmp_neigh_node,
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000142 &orig_node->neigh_list, list) {
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000143 if (tmp_neigh_node == neigh_node)
144 continue;
145
146 /* we only care if the other candidate is even
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200147 * considered as candidate.
148 */
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000149 if (list_empty(&tmp_neigh_node->bonding_list))
150 continue;
151
152 if ((neigh_node->if_incoming == tmp_neigh_node->if_incoming) ||
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200153 (batadv_compare_eth(neigh_node->addr,
154 tmp_neigh_node->addr))) {
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000155 interference_candidate = 1;
156 break;
157 }
158 }
159
160 /* don't care further if it is an interference candidate */
161 if (interference_candidate)
162 goto candidate_del;
163
164 /* this neighbor already is part of our candidate list */
165 if (!list_empty(&neigh_node->bonding_list))
166 goto out;
167
Marek Lindner44524fc2011-02-10 14:33:53 +0000168 if (!atomic_inc_not_zero(&neigh_node->refcount))
169 goto out;
170
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000171 list_add_rcu(&neigh_node->bonding_list, &orig_node->bond_list);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000172 atomic_inc(&orig_node->bond_candidates);
173 goto out;
174
175candidate_del:
Sven Eckelmann30d3c512012-05-12 02:09:36 +0200176 batadv_bonding_candidate_del(orig_node, neigh_node);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000177
178out:
179 spin_unlock_bh(&orig_node->neigh_list_lock);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000180
181 if (router)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200182 batadv_neigh_node_free_ref(router);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000183}
184
185/* copy primary address for bonding */
Sven Eckelmann30d3c512012-05-12 02:09:36 +0200186void
Sven Eckelmann56303d32012-06-05 22:31:31 +0200187batadv_bonding_save_primary(const struct batadv_orig_node *orig_node,
188 struct batadv_orig_node *orig_neigh_node,
Sven Eckelmann96412692012-06-05 22:31:30 +0200189 const struct batadv_ogm_packet *batman_ogm_packet)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000190{
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200191 if (!(batman_ogm_packet->flags & BATADV_PRIMARIES_FIRST_HOP))
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000192 return;
193
194 memcpy(orig_neigh_node->primary_addr, orig_node->orig, ETH_ALEN);
195}
196
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000197/* checks whether the host restarted and is in the protection time.
198 * returns:
199 * 0 if the packet is to be accepted
200 * 1 if the packet is to be ignored.
201 */
Sven Eckelmann56303d32012-06-05 22:31:31 +0200202int batadv_window_protected(struct batadv_priv *bat_priv, int32_t seq_num_diff,
Sven Eckelmann30d3c512012-05-12 02:09:36 +0200203 unsigned long *last_reset)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000204{
Sven Eckelmann42d0b042012-06-03 22:19:17 +0200205 if (seq_num_diff <= -BATADV_TQ_LOCAL_WINDOW_SIZE ||
206 seq_num_diff >= BATADV_EXPECTED_SEQNO_RANGE) {
207 if (!batadv_has_timed_out(*last_reset,
208 BATADV_RESET_PROTECTION_MS))
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000209 return 1;
Marek Lindner8c7bf242012-03-17 15:28:33 +0800210
211 *last_reset = jiffies;
Sven Eckelmann39c75a52012-06-03 22:19:22 +0200212 batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200213 "old packet received, start protection\n");
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000214 }
Marek Lindner8c7bf242012-03-17 15:28:33 +0800215
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000216 return 0;
217}
218
Sven Eckelmann30d3c512012-05-12 02:09:36 +0200219bool batadv_check_management_packet(struct sk_buff *skb,
Sven Eckelmann56303d32012-06-05 22:31:31 +0200220 struct batadv_hard_iface *hard_iface,
Sven Eckelmann30d3c512012-05-12 02:09:36 +0200221 int header_len)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000222{
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000223 struct ethhdr *ethhdr;
224
225 /* drop packet if it has not necessary minimum size */
Marek Lindnerc3e29312012-03-04 16:56:25 +0800226 if (unlikely(!pskb_may_pull(skb, header_len)))
227 return false;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000228
Antonio Quartulli7ed4be92013-04-08 15:08:18 +0200229 ethhdr = eth_hdr(skb);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000230
231 /* packet with broadcast indication but unicast recipient */
232 if (!is_broadcast_ether_addr(ethhdr->h_dest))
Marek Lindnerc3e29312012-03-04 16:56:25 +0800233 return false;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000234
235 /* packet with broadcast sender address */
236 if (is_broadcast_ether_addr(ethhdr->h_source))
Marek Lindnerc3e29312012-03-04 16:56:25 +0800237 return false;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000238
239 /* create a copy of the skb, if needed, to modify it. */
240 if (skb_cow(skb, 0) < 0)
Marek Lindnerc3e29312012-03-04 16:56:25 +0800241 return false;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000242
243 /* keep skb linear */
244 if (skb_linearize(skb) < 0)
Marek Lindnerc3e29312012-03-04 16:56:25 +0800245 return false;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000246
Marek Lindnerc3e29312012-03-04 16:56:25 +0800247 return true;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000248}
249
Sven Eckelmann56303d32012-06-05 22:31:31 +0200250static int batadv_recv_my_icmp_packet(struct batadv_priv *bat_priv,
Sven Eckelmann63b01032012-05-16 20:23:13 +0200251 struct sk_buff *skb, size_t icmp_len)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000252{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200253 struct batadv_hard_iface *primary_if = NULL;
254 struct batadv_orig_node *orig_node = NULL;
Sven Eckelmann96412692012-06-05 22:31:30 +0200255 struct batadv_icmp_packet_rr *icmp_packet;
Marek Lindner44524fc2011-02-10 14:33:53 +0000256 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000257
Sven Eckelmann96412692012-06-05 22:31:30 +0200258 icmp_packet = (struct batadv_icmp_packet_rr *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000259
260 /* add data to device queue */
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200261 if (icmp_packet->msg_type != BATADV_ECHO_REQUEST) {
Sven Eckelmann9039dc72012-05-12 02:09:33 +0200262 batadv_socket_receive_packet(icmp_packet, icmp_len);
Marek Lindner44524fc2011-02-10 14:33:53 +0000263 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000264 }
265
Sven Eckelmanne5d89252012-05-12 13:48:54 +0200266 primary_if = batadv_primary_if_get_selected(bat_priv);
Marek Lindner32ae9b22011-04-20 15:40:58 +0200267 if (!primary_if)
Marek Lindner44524fc2011-02-10 14:33:53 +0000268 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000269
270 /* answer echo request (ping) */
271 /* get routing information */
Sven Eckelmannda641192012-05-12 13:48:56 +0200272 orig_node = batadv_orig_hash_find(bat_priv, icmp_packet->orig);
Marek Lindner44524fc2011-02-10 14:33:53 +0000273 if (!orig_node)
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000274 goto out;
Marek Lindner44524fc2011-02-10 14:33:53 +0000275
Marek Lindner44524fc2011-02-10 14:33:53 +0000276 /* create a copy of the skb, if needed, to modify it. */
Antonio Quartulli0d125072012-02-18 11:27:34 +0100277 if (skb_cow(skb, ETH_HLEN) < 0)
Marek Lindner44524fc2011-02-10 14:33:53 +0000278 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000279
Sven Eckelmann96412692012-06-05 22:31:30 +0200280 icmp_packet = (struct batadv_icmp_packet_rr *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000281
Marek Lindner44524fc2011-02-10 14:33:53 +0000282 memcpy(icmp_packet->dst, icmp_packet->orig, ETH_ALEN);
Marek Lindner32ae9b22011-04-20 15:40:58 +0200283 memcpy(icmp_packet->orig, primary_if->net_dev->dev_addr, ETH_ALEN);
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200284 icmp_packet->msg_type = BATADV_ECHO_REPLY;
Sven Eckelmann42d0b042012-06-03 22:19:17 +0200285 icmp_packet->header.ttl = BATADV_TTL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000286
Martin Hundebølle91ecfc2013-04-20 13:54:39 +0200287 if (batadv_send_skb_to_orig(skb, orig_node, NULL) != NET_XMIT_DROP)
Martin Hundebøllbb351ba2012-10-16 16:13:48 +0200288 ret = NET_RX_SUCCESS;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000289
Marek Lindner44524fc2011-02-10 14:33:53 +0000290out:
Marek Lindner32ae9b22011-04-20 15:40:58 +0200291 if (primary_if)
Sven Eckelmanne5d89252012-05-12 13:48:54 +0200292 batadv_hardif_free_ref(primary_if);
Marek Lindner44524fc2011-02-10 14:33:53 +0000293 if (orig_node)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200294 batadv_orig_node_free_ref(orig_node);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000295 return ret;
296}
297
Sven Eckelmann56303d32012-06-05 22:31:31 +0200298static int batadv_recv_icmp_ttl_exceeded(struct batadv_priv *bat_priv,
Sven Eckelmann63b01032012-05-16 20:23:13 +0200299 struct sk_buff *skb)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000300{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200301 struct batadv_hard_iface *primary_if = NULL;
302 struct batadv_orig_node *orig_node = NULL;
Sven Eckelmann96412692012-06-05 22:31:30 +0200303 struct batadv_icmp_packet *icmp_packet;
Marek Lindner44524fc2011-02-10 14:33:53 +0000304 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000305
Sven Eckelmann96412692012-06-05 22:31:30 +0200306 icmp_packet = (struct batadv_icmp_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000307
308 /* send TTL exceeded if packet is an echo request (traceroute) */
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200309 if (icmp_packet->msg_type != BATADV_ECHO_REQUEST) {
Sven Eckelmann86ceb362012-03-07 09:07:45 +0100310 pr_debug("Warning - can't forward icmp packet from %pM to %pM: ttl exceeded\n",
311 icmp_packet->orig, icmp_packet->dst);
Marek Lindner44524fc2011-02-10 14:33:53 +0000312 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000313 }
314
Sven Eckelmanne5d89252012-05-12 13:48:54 +0200315 primary_if = batadv_primary_if_get_selected(bat_priv);
Marek Lindner32ae9b22011-04-20 15:40:58 +0200316 if (!primary_if)
Marek Lindner44524fc2011-02-10 14:33:53 +0000317 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000318
319 /* get routing information */
Sven Eckelmannda641192012-05-12 13:48:56 +0200320 orig_node = batadv_orig_hash_find(bat_priv, icmp_packet->orig);
Marek Lindner44524fc2011-02-10 14:33:53 +0000321 if (!orig_node)
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000322 goto out;
Marek Lindner44524fc2011-02-10 14:33:53 +0000323
Marek Lindner44524fc2011-02-10 14:33:53 +0000324 /* create a copy of the skb, if needed, to modify it. */
Antonio Quartulli0d125072012-02-18 11:27:34 +0100325 if (skb_cow(skb, ETH_HLEN) < 0)
Marek Lindner44524fc2011-02-10 14:33:53 +0000326 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000327
Sven Eckelmann96412692012-06-05 22:31:30 +0200328 icmp_packet = (struct batadv_icmp_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000329
Marek Lindner44524fc2011-02-10 14:33:53 +0000330 memcpy(icmp_packet->dst, icmp_packet->orig, ETH_ALEN);
Marek Lindner32ae9b22011-04-20 15:40:58 +0200331 memcpy(icmp_packet->orig, primary_if->net_dev->dev_addr, ETH_ALEN);
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200332 icmp_packet->msg_type = BATADV_TTL_EXCEEDED;
Sven Eckelmann42d0b042012-06-03 22:19:17 +0200333 icmp_packet->header.ttl = BATADV_TTL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000334
Martin Hundebølle91ecfc2013-04-20 13:54:39 +0200335 if (batadv_send_skb_to_orig(skb, orig_node, NULL) != NET_XMIT_DROP)
Martin Hundebøllbb351ba2012-10-16 16:13:48 +0200336 ret = NET_RX_SUCCESS;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000337
Marek Lindner44524fc2011-02-10 14:33:53 +0000338out:
Marek Lindner32ae9b22011-04-20 15:40:58 +0200339 if (primary_if)
Sven Eckelmanne5d89252012-05-12 13:48:54 +0200340 batadv_hardif_free_ref(primary_if);
Marek Lindner44524fc2011-02-10 14:33:53 +0000341 if (orig_node)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200342 batadv_orig_node_free_ref(orig_node);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000343 return ret;
344}
345
346
Sven Eckelmann56303d32012-06-05 22:31:31 +0200347int batadv_recv_icmp_packet(struct sk_buff *skb,
348 struct batadv_hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000349{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200350 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Sven Eckelmann96412692012-06-05 22:31:30 +0200351 struct batadv_icmp_packet_rr *icmp_packet;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000352 struct ethhdr *ethhdr;
Sven Eckelmann56303d32012-06-05 22:31:31 +0200353 struct batadv_orig_node *orig_node = NULL;
Sven Eckelmann96412692012-06-05 22:31:30 +0200354 int hdr_size = sizeof(struct batadv_icmp_packet);
Marek Lindner44524fc2011-02-10 14:33:53 +0000355 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000356
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200357 /* we truncate all incoming icmp packets if they don't match our size */
Sven Eckelmann96412692012-06-05 22:31:30 +0200358 if (skb->len >= sizeof(struct batadv_icmp_packet_rr))
359 hdr_size = sizeof(struct batadv_icmp_packet_rr);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000360
361 /* drop packet if it has not necessary minimum size */
362 if (unlikely(!pskb_may_pull(skb, hdr_size)))
Marek Lindner44524fc2011-02-10 14:33:53 +0000363 goto out;
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
367 /* packet with unicast indication but broadcast recipient */
368 if (is_broadcast_ether_addr(ethhdr->h_dest))
Marek Lindner44524fc2011-02-10 14:33:53 +0000369 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000370
371 /* packet with broadcast sender address */
372 if (is_broadcast_ether_addr(ethhdr->h_source))
Marek Lindner44524fc2011-02-10 14:33:53 +0000373 goto out;
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))
Marek Lindner44524fc2011-02-10 14:33:53 +0000377 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000378
Sven Eckelmann96412692012-06-05 22:31:30 +0200379 icmp_packet = (struct batadv_icmp_packet_rr *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000380
381 /* add record route information if not full */
Sven Eckelmann96412692012-06-05 22:31:30 +0200382 if ((hdr_size == sizeof(struct batadv_icmp_packet_rr)) &&
Sven Eckelmann7e071c72012-06-03 22:19:13 +0200383 (icmp_packet->rr_cur < BATADV_RR_LEN)) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000384 memcpy(&(icmp_packet->rr[icmp_packet->rr_cur]),
Sven Eckelmann7c64fd92012-02-28 10:55:36 +0100385 ethhdr->h_dest, ETH_ALEN);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000386 icmp_packet->rr_cur++;
387 }
388
389 /* packet for me */
Antonio Quartullife8a93b2013-04-03 19:10:26 +0200390 if (batadv_is_my_mac(bat_priv, icmp_packet->dst))
Sven Eckelmann63b01032012-05-16 20:23:13 +0200391 return batadv_recv_my_icmp_packet(bat_priv, skb, hdr_size);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000392
393 /* TTL exceeded */
Sven Eckelmann76543d12011-11-20 15:47:38 +0100394 if (icmp_packet->header.ttl < 2)
Sven Eckelmann63b01032012-05-16 20:23:13 +0200395 return batadv_recv_icmp_ttl_exceeded(bat_priv, skb);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000396
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000397 /* get routing information */
Sven Eckelmannda641192012-05-12 13:48:56 +0200398 orig_node = batadv_orig_hash_find(bat_priv, icmp_packet->dst);
Marek Lindner44524fc2011-02-10 14:33:53 +0000399 if (!orig_node)
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000400 goto out;
Marek Lindner44524fc2011-02-10 14:33:53 +0000401
Marek Lindner44524fc2011-02-10 14:33:53 +0000402 /* create a copy of the skb, if needed, to modify it. */
Antonio Quartulli0d125072012-02-18 11:27:34 +0100403 if (skb_cow(skb, ETH_HLEN) < 0)
Marek Lindner44524fc2011-02-10 14:33:53 +0000404 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000405
Sven Eckelmann96412692012-06-05 22:31:30 +0200406 icmp_packet = (struct batadv_icmp_packet_rr *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000407
Marek Lindner44524fc2011-02-10 14:33:53 +0000408 /* decrement ttl */
Sven Eckelmann76543d12011-11-20 15:47:38 +0100409 icmp_packet->header.ttl--;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000410
Marek Lindner44524fc2011-02-10 14:33:53 +0000411 /* route it */
Martin Hundebølle91ecfc2013-04-20 13:54:39 +0200412 if (batadv_send_skb_to_orig(skb, orig_node, recv_if) != NET_XMIT_DROP)
Martin Hundebøllbb351ba2012-10-16 16:13:48 +0200413 ret = NET_RX_SUCCESS;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000414
Marek Lindner44524fc2011-02-10 14:33:53 +0000415out:
Marek Lindner44524fc2011-02-10 14:33:53 +0000416 if (orig_node)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200417 batadv_orig_node_free_ref(orig_node);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000418 return ret;
419}
420
Linus Lüssing55158622011-03-14 22:43:27 +0000421/* In the bonding case, send the packets in a round
422 * robin fashion over the remaining interfaces.
423 *
424 * This method rotates the bonding list and increases the
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200425 * returned router's refcount.
426 */
Sven Eckelmann56303d32012-06-05 22:31:31 +0200427static struct batadv_neigh_node *
428batadv_find_bond_router(struct batadv_orig_node *primary_orig,
429 const struct batadv_hard_iface *recv_if)
Linus Lüssing55158622011-03-14 22:43:27 +0000430{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200431 struct batadv_neigh_node *tmp_neigh_node;
432 struct batadv_neigh_node *router = NULL, *first_candidate = NULL;
Linus Lüssing55158622011-03-14 22:43:27 +0000433
434 rcu_read_lock();
435 list_for_each_entry_rcu(tmp_neigh_node, &primary_orig->bond_list,
436 bonding_list) {
437 if (!first_candidate)
438 first_candidate = tmp_neigh_node;
439
440 /* recv_if == NULL on the first node. */
441 if (tmp_neigh_node->if_incoming == recv_if)
442 continue;
443
444 if (!atomic_inc_not_zero(&tmp_neigh_node->refcount))
445 continue;
446
447 router = tmp_neigh_node;
448 break;
449 }
450
451 /* use the first candidate if nothing was found. */
452 if (!router && first_candidate &&
453 atomic_inc_not_zero(&first_candidate->refcount))
454 router = first_candidate;
455
456 if (!router)
457 goto out;
458
459 /* selected should point to the next element
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200460 * after the current router
461 */
Linus Lüssing55158622011-03-14 22:43:27 +0000462 spin_lock_bh(&primary_orig->neigh_list_lock);
463 /* this is a list_move(), which unfortunately
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200464 * does not exist as rcu version
465 */
Linus Lüssing55158622011-03-14 22:43:27 +0000466 list_del_rcu(&primary_orig->bond_list);
467 list_add_rcu(&primary_orig->bond_list,
468 &router->bonding_list);
469 spin_unlock_bh(&primary_orig->neigh_list_lock);
470
471out:
472 rcu_read_unlock();
473 return router;
474}
475
476/* Interface Alternating: Use the best of the
477 * remaining candidates which are not using
478 * this interface.
479 *
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200480 * Increases the returned router's refcount
481 */
Sven Eckelmann56303d32012-06-05 22:31:31 +0200482static struct batadv_neigh_node *
483batadv_find_ifalter_router(struct batadv_orig_node *primary_orig,
484 const struct batadv_hard_iface *recv_if)
Linus Lüssing55158622011-03-14 22:43:27 +0000485{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200486 struct batadv_neigh_node *tmp_neigh_node;
487 struct batadv_neigh_node *router = NULL, *first_candidate = NULL;
Linus Lüssing55158622011-03-14 22:43:27 +0000488
489 rcu_read_lock();
490 list_for_each_entry_rcu(tmp_neigh_node, &primary_orig->bond_list,
491 bonding_list) {
492 if (!first_candidate)
493 first_candidate = tmp_neigh_node;
494
495 /* recv_if == NULL on the first node. */
496 if (tmp_neigh_node->if_incoming == recv_if)
497 continue;
498
Sven Eckelmannfe3f4cf2012-08-20 10:26:49 +0200499 if (router && tmp_neigh_node->tq_avg <= router->tq_avg)
500 continue;
501
Linus Lüssing55158622011-03-14 22:43:27 +0000502 if (!atomic_inc_not_zero(&tmp_neigh_node->refcount))
503 continue;
504
Sven Eckelmannfe3f4cf2012-08-20 10:26:49 +0200505 /* decrement refcount of previously selected router */
506 if (router)
507 batadv_neigh_node_free_ref(router);
Linus Lüssing55158622011-03-14 22:43:27 +0000508
Sven Eckelmannfe3f4cf2012-08-20 10:26:49 +0200509 /* we found a better router (or at least one valid router) */
510 router = tmp_neigh_node;
Linus Lüssing55158622011-03-14 22:43:27 +0000511 }
512
513 /* use the first candidate if nothing was found. */
514 if (!router && first_candidate &&
515 atomic_inc_not_zero(&first_candidate->refcount))
516 router = first_candidate;
517
518 rcu_read_unlock();
519 return router;
520}
521
Martin Hundebøllf86ce0a2013-01-14 00:20:32 +0100522/**
523 * batadv_check_unicast_packet - Check for malformed unicast packets
David S. Miller6e0895c2013-04-22 20:32:51 -0400524 * @bat_priv: the bat priv with all the soft interface information
Martin Hundebøllf86ce0a2013-01-14 00:20:32 +0100525 * @skb: packet to check
526 * @hdr_size: size of header to pull
527 *
528 * Check for short header and bad addresses in given packet. Returns negative
529 * value when check fails and 0 otherwise. The negative value depends on the
530 * reason: -ENODATA for bad header, -EBADR for broadcast destination or source,
531 * and -EREMOTE for non-local (other host) destination.
532 */
Antonio Quartullife8a93b2013-04-03 19:10:26 +0200533static int batadv_check_unicast_packet(struct batadv_priv *bat_priv,
534 struct sk_buff *skb, int hdr_size)
Martin Hundebøllff51fd72012-07-05 11:34:27 +0200535{
536 struct ethhdr *ethhdr;
537
538 /* drop packet if it has not necessary minimum size */
539 if (unlikely(!pskb_may_pull(skb, hdr_size)))
Martin Hundebøllf86ce0a2013-01-14 00:20:32 +0100540 return -ENODATA;
Martin Hundebøllff51fd72012-07-05 11:34:27 +0200541
Antonio Quartulli7ed4be92013-04-08 15:08:18 +0200542 ethhdr = eth_hdr(skb);
Martin Hundebøllff51fd72012-07-05 11:34:27 +0200543
544 /* packet with unicast indication but broadcast recipient */
545 if (is_broadcast_ether_addr(ethhdr->h_dest))
Martin Hundebøllf86ce0a2013-01-14 00:20:32 +0100546 return -EBADR;
Martin Hundebøllff51fd72012-07-05 11:34:27 +0200547
548 /* packet with broadcast sender address */
549 if (is_broadcast_ether_addr(ethhdr->h_source))
Martin Hundebøllf86ce0a2013-01-14 00:20:32 +0100550 return -EBADR;
Martin Hundebøllff51fd72012-07-05 11:34:27 +0200551
552 /* not for me */
Antonio Quartullife8a93b2013-04-03 19:10:26 +0200553 if (!batadv_is_my_mac(bat_priv, ethhdr->h_dest))
Martin Hundebøllf86ce0a2013-01-14 00:20:32 +0100554 return -EREMOTE;
Martin Hundebøllff51fd72012-07-05 11:34:27 +0200555
556 return 0;
557}
558
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000559/* find a suitable router for this originator, and use
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000560 * bonding if possible. increases the found neighbors
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200561 * refcount.
562 */
Sven Eckelmann56303d32012-06-05 22:31:31 +0200563struct batadv_neigh_node *
564batadv_find_router(struct batadv_priv *bat_priv,
565 struct batadv_orig_node *orig_node,
566 const struct batadv_hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000567{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200568 struct batadv_orig_node *primary_orig_node;
569 struct batadv_orig_node *router_orig;
570 struct batadv_neigh_node *router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000571 static uint8_t zero_mac[ETH_ALEN] = {0, 0, 0, 0, 0, 0};
572 int bonding_enabled;
Sven Eckelmannda641192012-05-12 13:48:56 +0200573 uint8_t *primary_addr;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000574
575 if (!orig_node)
576 return NULL;
577
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200578 router = batadv_orig_node_get_router(orig_node);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000579 if (!router)
Marek Lindner01df2b62011-05-05 14:14:46 +0200580 goto err;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000581
582 /* without bonding, the first node should
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200583 * always choose the default router.
584 */
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000585 bonding_enabled = atomic_read(&bat_priv->bonding);
586
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000587 rcu_read_lock();
588 /* select default router to output */
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000589 router_orig = router->orig_node;
Marek Lindner01df2b62011-05-05 14:14:46 +0200590 if (!router_orig)
591 goto err_unlock;
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000592
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000593 if ((!recv_if) && (!bonding_enabled))
594 goto return_router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000595
Sven Eckelmannda641192012-05-12 13:48:56 +0200596 primary_addr = router_orig->primary_addr;
597
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000598 /* if we have something in the primary_addr, we can search
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200599 * for a potential bonding candidate.
600 */
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200601 if (batadv_compare_eth(primary_addr, zero_mac))
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000602 goto return_router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000603
604 /* find the orig_node which has the primary interface. might
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200605 * even be the same as our router_orig in many cases
606 */
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200607 if (batadv_compare_eth(primary_addr, router_orig->orig)) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000608 primary_orig_node = router_orig;
609 } else {
Sven Eckelmannda641192012-05-12 13:48:56 +0200610 primary_orig_node = batadv_orig_hash_find(bat_priv,
611 primary_addr);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000612 if (!primary_orig_node)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000613 goto return_router;
Marek Lindner7aadf882011-02-18 12:28:09 +0000614
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200615 batadv_orig_node_free_ref(primary_orig_node);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000616 }
617
618 /* with less than 2 candidates, we can't do any
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200619 * bonding and prefer the original router.
620 */
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000621 if (atomic_read(&primary_orig_node->bond_candidates) < 2)
622 goto return_router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000623
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000624 /* all nodes between should choose a candidate which
625 * is is not on the interface where the packet came
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200626 * in.
627 */
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200628 batadv_neigh_node_free_ref(router);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000629
Linus Lüssing55158622011-03-14 22:43:27 +0000630 if (bonding_enabled)
Sven Eckelmann63b01032012-05-16 20:23:13 +0200631 router = batadv_find_bond_router(primary_orig_node, recv_if);
Linus Lüssing55158622011-03-14 22:43:27 +0000632 else
Sven Eckelmann63b01032012-05-16 20:23:13 +0200633 router = batadv_find_ifalter_router(primary_orig_node, recv_if);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000634
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000635return_router:
Sven Eckelmanne9a4f292012-06-03 22:19:19 +0200636 if (router && router->if_incoming->if_status != BATADV_IF_ACTIVE)
Antonio Quartullie2cbc112011-05-08 20:52:57 +0200637 goto err_unlock;
638
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000639 rcu_read_unlock();
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000640 return router;
Marek Lindner01df2b62011-05-05 14:14:46 +0200641err_unlock:
642 rcu_read_unlock();
643err:
644 if (router)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200645 batadv_neigh_node_free_ref(router);
Marek Lindner01df2b62011-05-05 14:14:46 +0200646 return NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000647}
648
Sven Eckelmann63b01032012-05-16 20:23:13 +0200649static int batadv_route_unicast_packet(struct sk_buff *skb,
Sven Eckelmann56303d32012-06-05 22:31:31 +0200650 struct batadv_hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000651{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200652 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
653 struct batadv_orig_node *orig_node = NULL;
654 struct batadv_neigh_node *neigh_node = NULL;
Sven Eckelmann96412692012-06-05 22:31:30 +0200655 struct batadv_unicast_packet *unicast_packet;
Antonio Quartulli7ed4be92013-04-08 15:08:18 +0200656 struct ethhdr *ethhdr = eth_hdr(skb);
Simon Wunderlichc54f38c2013-07-29 17:56:44 +0200657 int res, hdr_len, ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000658 struct sk_buff *new_skb;
659
Sven Eckelmann96412692012-06-05 22:31:30 +0200660 unicast_packet = (struct batadv_unicast_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000661
662 /* TTL exceeded */
Sven Eckelmann76543d12011-11-20 15:47:38 +0100663 if (unicast_packet->header.ttl < 2) {
Sven Eckelmann86ceb362012-03-07 09:07:45 +0100664 pr_debug("Warning - can't forward unicast packet from %pM to %pM: ttl exceeded\n",
665 ethhdr->h_source, unicast_packet->dest);
Marek Lindner44524fc2011-02-10 14:33:53 +0000666 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000667 }
668
669 /* get routing information */
Sven Eckelmannda641192012-05-12 13:48:56 +0200670 orig_node = batadv_orig_hash_find(bat_priv, unicast_packet->dest);
Marek Lindner7aadf882011-02-18 12:28:09 +0000671
Marek Lindner44524fc2011-02-10 14:33:53 +0000672 if (!orig_node)
Antonio Quartullib5a6f692011-04-16 11:30:57 +0200673 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000674
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000675 /* find_router() increases neigh_nodes refcount if found. */
Sven Eckelmann30d3c512012-05-12 02:09:36 +0200676 neigh_node = batadv_find_router(bat_priv, orig_node, recv_if);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000677
Marek Lindnerd0072602011-01-19 20:01:44 +0000678 if (!neigh_node)
Marek Lindner44524fc2011-02-10 14:33:53 +0000679 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000680
681 /* create a copy of the skb, if needed, to modify it. */
Antonio Quartulli0d125072012-02-18 11:27:34 +0100682 if (skb_cow(skb, ETH_HLEN) < 0)
Marek Lindner44524fc2011-02-10 14:33:53 +0000683 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000684
Sven Eckelmann96412692012-06-05 22:31:30 +0200685 unicast_packet = (struct batadv_unicast_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000686
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200687 if (unicast_packet->header.packet_type == BATADV_UNICAST &&
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000688 atomic_read(&bat_priv->fragmentation) &&
Marek Lindnerd0072602011-01-19 20:01:44 +0000689 skb->len > neigh_node->if_incoming->net_dev->mtu) {
Sven Eckelmann88ed1e772012-05-12 02:09:40 +0200690 ret = batadv_frag_send_skb(skb, bat_priv,
691 neigh_node->if_incoming,
692 neigh_node->addr);
Marek Lindnerd0072602011-01-19 20:01:44 +0000693 goto out;
694 }
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000695
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200696 if (unicast_packet->header.packet_type == BATADV_UNICAST_FRAG &&
Sven Eckelmannf0530ee2012-05-12 13:48:57 +0200697 batadv_frag_can_reassemble(skb,
698 neigh_node->if_incoming->net_dev->mtu)) {
Sven Eckelmann88ed1e772012-05-12 02:09:40 +0200699 ret = batadv_frag_reassemble_skb(skb, bat_priv, &new_skb);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000700
701 if (ret == NET_RX_DROP)
Marek Lindner44524fc2011-02-10 14:33:53 +0000702 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000703
704 /* packet was buffered for late merge */
Marek Lindner44524fc2011-02-10 14:33:53 +0000705 if (!new_skb) {
706 ret = NET_RX_SUCCESS;
707 goto out;
708 }
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000709
710 skb = new_skb;
Sven Eckelmann96412692012-06-05 22:31:30 +0200711 unicast_packet = (struct batadv_unicast_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000712 }
713
714 /* decrement ttl */
Sven Eckelmann76543d12011-11-20 15:47:38 +0100715 unicast_packet->header.ttl--;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000716
Simon Wunderlichc54f38c2013-07-29 17:56:44 +0200717 switch (unicast_packet->header.packet_type) {
718 case BATADV_UNICAST_4ADDR:
719 hdr_len = sizeof(struct batadv_unicast_4addr_packet);
720 break;
721 case BATADV_UNICAST:
722 hdr_len = sizeof(struct batadv_unicast_packet);
723 break;
724 default:
725 /* other packet types not supported - yet */
726 hdr_len = -1;
727 break;
728 }
729
730 if (hdr_len > 0)
731 batadv_skb_set_priority(skb, hdr_len);
732
Martin Hundebølle91ecfc2013-04-20 13:54:39 +0200733 res = batadv_send_skb_to_orig(skb, orig_node, recv_if);
Martin Hundebøll95332472013-01-25 11:12:40 +0100734
Martin Hundebølle91ecfc2013-04-20 13:54:39 +0200735 /* translate transmit result into receive result */
736 if (res == NET_XMIT_SUCCESS) {
737 /* skb was transmitted and consumed */
Martin Hundebøll95332472013-01-25 11:12:40 +0100738 batadv_inc_counter(bat_priv, BATADV_CNT_FORWARD);
739 batadv_add_counter(bat_priv, BATADV_CNT_FORWARD_BYTES,
740 skb->len + ETH_HLEN);
Martin Hundebølle91ecfc2013-04-20 13:54:39 +0200741
742 ret = NET_RX_SUCCESS;
743 } else if (res == NET_XMIT_POLICED) {
744 /* skb was buffered and consumed */
745 ret = NET_RX_SUCCESS;
Martin Hundebøll95332472013-01-25 11:12:40 +0100746 }
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000747
Marek Lindner44524fc2011-02-10 14:33:53 +0000748out:
749 if (neigh_node)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200750 batadv_neigh_node_free_ref(neigh_node);
Marek Lindner44524fc2011-02-10 14:33:53 +0000751 if (orig_node)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200752 batadv_orig_node_free_ref(orig_node);
Marek Lindner44524fc2011-02-10 14:33:53 +0000753 return ret;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000754}
755
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200756/**
757 * batadv_reroute_unicast_packet - update the unicast header for re-routing
758 * @bat_priv: the bat priv with all the soft interface information
759 * @unicast_packet: the unicast header to be updated
760 * @dst_addr: the payload destination
761 *
762 * Search the translation table for dst_addr and update the unicast header with
763 * the new corresponding information (originator address where the destination
764 * client currently is and its known TTVN)
765 *
766 * Returns true if the packet header has been updated, false otherwise
767 */
768static bool
769batadv_reroute_unicast_packet(struct batadv_priv *bat_priv,
770 struct batadv_unicast_packet *unicast_packet,
771 uint8_t *dst_addr)
772{
773 struct batadv_orig_node *orig_node = NULL;
774 struct batadv_hard_iface *primary_if = NULL;
775 bool ret = false;
776 uint8_t *orig_addr, orig_ttvn;
777
778 if (batadv_is_my_client(bat_priv, dst_addr)) {
779 primary_if = batadv_primary_if_get_selected(bat_priv);
780 if (!primary_if)
781 goto out;
782 orig_addr = primary_if->net_dev->dev_addr;
783 orig_ttvn = (uint8_t)atomic_read(&bat_priv->tt.vn);
784 } else {
785 orig_node = batadv_transtable_search(bat_priv, NULL, dst_addr);
786 if (!orig_node)
787 goto out;
788
789 if (batadv_compare_eth(orig_node->orig, unicast_packet->dest))
790 goto out;
791
792 orig_addr = orig_node->orig;
793 orig_ttvn = (uint8_t)atomic_read(&orig_node->last_ttvn);
794 }
795
796 /* update the packet header */
797 memcpy(unicast_packet->dest, orig_addr, ETH_ALEN);
798 unicast_packet->ttvn = orig_ttvn;
799
800 ret = true;
801out:
802 if (primary_if)
803 batadv_hardif_free_ref(primary_if);
804 if (orig_node)
805 batadv_orig_node_free_ref(orig_node);
806
807 return ret;
808}
809
Sven Eckelmann56303d32012-06-05 22:31:31 +0200810static int batadv_check_unicast_ttvn(struct batadv_priv *bat_priv,
Antonio Quartullidd981ab2013-04-03 10:14:20 +0200811 struct sk_buff *skb, int hdr_len) {
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200812 uint8_t curr_ttvn, old_ttvn;
Sven Eckelmann56303d32012-06-05 22:31:31 +0200813 struct batadv_orig_node *orig_node;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200814 struct ethhdr *ethhdr;
Sven Eckelmann56303d32012-06-05 22:31:31 +0200815 struct batadv_hard_iface *primary_if;
Sven Eckelmann96412692012-06-05 22:31:30 +0200816 struct batadv_unicast_packet *unicast_packet;
Sven Eckelmann3e348192012-05-16 20:23:22 +0200817 int is_old_ttvn;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200818
Antonio Quartullib8fcfa42012-08-26 23:25:59 +0200819 /* check if there is enough data before accessing it */
Antonio Quartullidd981ab2013-04-03 10:14:20 +0200820 if (pskb_may_pull(skb, hdr_len + ETH_HLEN) < 0)
Antonio Quartullib8fcfa42012-08-26 23:25:59 +0200821 return 0;
822
823 /* create a copy of the skb (in case of for re-routing) to modify it. */
824 if (skb_cow(skb, sizeof(*unicast_packet)) < 0)
Antonio Quartullia73105b2011-04-27 14:27:44 +0200825 return 0;
826
Sven Eckelmann96412692012-06-05 22:31:30 +0200827 unicast_packet = (struct batadv_unicast_packet *)skb->data;
Antonio Quartullidd981ab2013-04-03 10:14:20 +0200828 ethhdr = (struct ethhdr *)(skb->data + hdr_len);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200829
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200830 /* check if the destination client was served by this node and it is now
831 * roaming. In this case, it means that the node has got a ROAM_ADV
832 * message and that it knows the new destination in the mesh to re-route
833 * the packet to
834 */
835 if (batadv_tt_local_client_is_roaming(bat_priv, ethhdr->h_dest)) {
836 if (batadv_reroute_unicast_packet(bat_priv, unicast_packet,
837 ethhdr->h_dest))
838 net_ratelimited_function(batadv_dbg, BATADV_DBG_TT,
839 bat_priv,
840 "Rerouting unicast packet to %pM (dst=%pM): Local Roaming\n",
841 unicast_packet->dest,
842 ethhdr->h_dest);
843 /* at this point the mesh destination should have been
844 * substituted with the originator address found in the global
845 * table. If not, let the packet go untouched anyway because
846 * there is nothing the node can do
847 */
848 return 1;
849 }
850
851 /* retrieve the TTVN known by this node for the packet destination. This
852 * value is used later to check if the node which sent (or re-routed
853 * last time) the packet had an updated information or not
854 */
855 curr_ttvn = (uint8_t)atomic_read(&bat_priv->tt.vn);
Antonio Quartullife8a93b2013-04-03 19:10:26 +0200856 if (!batadv_is_my_mac(bat_priv, unicast_packet->dest)) {
Sven Eckelmannda641192012-05-12 13:48:56 +0200857 orig_node = batadv_orig_hash_find(bat_priv,
858 unicast_packet->dest);
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200859 /* if it is not possible to find the orig_node representing the
860 * destination, the packet can immediately be dropped as it will
861 * not be possible to deliver it
862 */
Antonio Quartullia73105b2011-04-27 14:27:44 +0200863 if (!orig_node)
864 return 0;
865
866 curr_ttvn = (uint8_t)atomic_read(&orig_node->last_ttvn);
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200867 batadv_orig_node_free_ref(orig_node);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200868 }
869
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200870 /* check if the TTVN contained in the packet is fresher than what the
871 * node knows
872 */
Sven Eckelmann3e348192012-05-16 20:23:22 +0200873 is_old_ttvn = batadv_seq_before(unicast_packet->ttvn, curr_ttvn);
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200874 if (!is_old_ttvn)
875 return 1;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200876
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200877 old_ttvn = unicast_packet->ttvn;
878 /* the packet was forged based on outdated network information. Its
879 * destination can possibly be updated and forwarded towards the new
880 * target host
881 */
882 if (batadv_reroute_unicast_packet(bat_priv, unicast_packet,
883 ethhdr->h_dest)) {
Antonio Quartulli60c39c72012-08-26 01:05:56 +0200884 net_ratelimited_function(batadv_dbg, BATADV_DBG_TT, bat_priv,
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200885 "Rerouting unicast packet to %pM (dst=%pM): TTVN mismatch old_ttvn=%u new_ttvn=%u\n",
886 unicast_packet->dest, ethhdr->h_dest,
887 old_ttvn, curr_ttvn);
888 return 1;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200889 }
Antonio Quartulli7c1fd912012-09-23 22:38:34 +0200890
891 /* the packet has not been re-routed: either the destination is
892 * currently served by this node or there is no destination at all and
893 * it is possible to drop the packet
894 */
895 if (!batadv_is_my_client(bat_priv, ethhdr->h_dest))
896 return 0;
897
898 /* update the header in order to let the packet be delivered to this
899 * node's soft interface
900 */
901 primary_if = batadv_primary_if_get_selected(bat_priv);
902 if (!primary_if)
903 return 0;
904
905 memcpy(unicast_packet->dest, primary_if->net_dev->dev_addr, ETH_ALEN);
906
907 batadv_hardif_free_ref(primary_if);
908
909 unicast_packet->ttvn = curr_ttvn;
910
Antonio Quartullia73105b2011-04-27 14:27:44 +0200911 return 1;
912}
913
Simon Wunderlicha1f1ac52013-04-25 10:37:23 +0200914/**
915 * batadv_recv_unhandled_unicast_packet - receive and process packets which
916 * are in the unicast number space but not yet known to the implementation
917 * @skb: unicast tvlv packet to process
918 * @recv_if: pointer to interface this packet was received on
919 *
920 * Returns NET_RX_SUCCESS if the packet has been consumed or NET_RX_DROP
921 * otherwise.
922 */
923int batadv_recv_unhandled_unicast_packet(struct sk_buff *skb,
924 struct batadv_hard_iface *recv_if)
925{
926 struct batadv_unicast_packet *unicast_packet;
927 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
928 int check, hdr_size = sizeof(*unicast_packet);
929
930 check = batadv_check_unicast_packet(bat_priv, skb, hdr_size);
931 if (check < 0)
932 return NET_RX_DROP;
933
934 /* we don't know about this type, drop it. */
935 unicast_packet = (struct batadv_unicast_packet *)skb->data;
936 if (batadv_is_my_mac(bat_priv, unicast_packet->dest))
937 return NET_RX_DROP;
938
939 return batadv_route_unicast_packet(skb, recv_if);
940}
941
Sven Eckelmann56303d32012-06-05 22:31:31 +0200942int batadv_recv_unicast_packet(struct sk_buff *skb,
943 struct batadv_hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000944{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200945 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Sven Eckelmann96412692012-06-05 22:31:30 +0200946 struct batadv_unicast_packet *unicast_packet;
Martin Hundebøll4046b242012-04-20 17:02:45 +0200947 struct batadv_unicast_4addr_packet *unicast_4addr_packet;
Antonio Quartulli9affec62012-10-14 17:19:19 +0200948 uint8_t *orig_addr;
949 struct batadv_orig_node *orig_node = NULL;
Martin Hundebøll612d2b42013-01-25 11:12:42 +0100950 int check, hdr_size = sizeof(*unicast_packet);
Antonio Quartullic384ea32011-06-26 03:37:18 +0200951 bool is4addr;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000952
Antonio Quartulli7cdcf6d2012-10-01 09:57:35 +0200953 unicast_packet = (struct batadv_unicast_packet *)skb->data;
Martin Hundebøll4046b242012-04-20 17:02:45 +0200954 unicast_4addr_packet = (struct batadv_unicast_4addr_packet *)skb->data;
Antonio Quartulli7cdcf6d2012-10-01 09:57:35 +0200955
Antonio Quartullic384ea32011-06-26 03:37:18 +0200956 is4addr = unicast_packet->header.packet_type == BATADV_UNICAST_4ADDR;
Antonio Quartulli7cdcf6d2012-10-01 09:57:35 +0200957 /* the caller function should have already pulled 2 bytes */
Antonio Quartullic384ea32011-06-26 03:37:18 +0200958 if (is4addr)
Martin Hundebøll4046b242012-04-20 17:02:45 +0200959 hdr_size = sizeof(*unicast_4addr_packet);
Antonio Quartulli7cdcf6d2012-10-01 09:57:35 +0200960
Martin Hundebøll612d2b42013-01-25 11:12:42 +0100961 /* function returns -EREMOTE for promiscuous packets */
David S. Miller6e0895c2013-04-22 20:32:51 -0400962 check = batadv_check_unicast_packet(bat_priv, skb, hdr_size);
Martin Hundebøll612d2b42013-01-25 11:12:42 +0100963
964 /* Even though the packet is not for us, we might save it to use for
965 * decoding a later received coded packet
966 */
967 if (check == -EREMOTE)
968 batadv_nc_skb_store_sniffed_unicast(bat_priv, skb);
969
970 if (check < 0)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000971 return NET_RX_DROP;
Antonio Quartullidd981ab2013-04-03 10:14:20 +0200972 if (!batadv_check_unicast_ttvn(bat_priv, skb, hdr_size))
Antonio Quartullia73105b2011-04-27 14:27:44 +0200973 return NET_RX_DROP;
974
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000975 /* packet for me */
Antonio Quartullife8a93b2013-04-03 19:10:26 +0200976 if (batadv_is_my_mac(bat_priv, unicast_packet->dest)) {
Antonio Quartulli9affec62012-10-14 17:19:19 +0200977 if (is4addr) {
Martin Hundebøll4046b242012-04-20 17:02:45 +0200978 batadv_dat_inc_counter(bat_priv,
979 unicast_4addr_packet->subtype);
Antonio Quartulli9affec62012-10-14 17:19:19 +0200980 orig_addr = unicast_4addr_packet->src;
981 orig_node = batadv_orig_hash_find(bat_priv, orig_addr);
982 }
Martin Hundebøll4046b242012-04-20 17:02:45 +0200983
Antonio Quartullic384ea32011-06-26 03:37:18 +0200984 if (batadv_dat_snoop_incoming_arp_request(bat_priv, skb,
985 hdr_size))
986 goto rx_success;
987 if (batadv_dat_snoop_incoming_arp_reply(bat_priv, skb,
988 hdr_size))
989 goto rx_success;
990
Antonio Quartulli37135172012-07-05 23:38:30 +0200991 batadv_interface_rx(recv_if->soft_iface, skb, recv_if, hdr_size,
Antonio Quartulli9affec62012-10-14 17:19:19 +0200992 orig_node);
Antonio Quartulli37135172012-07-05 23:38:30 +0200993
Antonio Quartullic384ea32011-06-26 03:37:18 +0200994rx_success:
Antonio Quartulli9affec62012-10-14 17:19:19 +0200995 if (orig_node)
996 batadv_orig_node_free_ref(orig_node);
997
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000998 return NET_RX_SUCCESS;
999 }
1000
Sven Eckelmann63b01032012-05-16 20:23:13 +02001001 return batadv_route_unicast_packet(skb, recv_if);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001002}
1003
Sven Eckelmann30d3c512012-05-12 02:09:36 +02001004int batadv_recv_ucast_frag_packet(struct sk_buff *skb,
Sven Eckelmann56303d32012-06-05 22:31:31 +02001005 struct batadv_hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001006{
Sven Eckelmann56303d32012-06-05 22:31:31 +02001007 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Sven Eckelmann96412692012-06-05 22:31:30 +02001008 struct batadv_unicast_frag_packet *unicast_packet;
Sven Eckelmann704509b2011-05-14 23:14:54 +02001009 int hdr_size = sizeof(*unicast_packet);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001010 struct sk_buff *new_skb = NULL;
1011 int ret;
1012
Antonio Quartullife8a93b2013-04-03 19:10:26 +02001013 if (batadv_check_unicast_packet(bat_priv, skb, hdr_size) < 0)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001014 return NET_RX_DROP;
1015
Antonio Quartullidd981ab2013-04-03 10:14:20 +02001016 if (!batadv_check_unicast_ttvn(bat_priv, skb, hdr_size))
Antonio Quartullia73105b2011-04-27 14:27:44 +02001017 return NET_RX_DROP;
1018
Sven Eckelmann96412692012-06-05 22:31:30 +02001019 unicast_packet = (struct batadv_unicast_frag_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001020
1021 /* packet for me */
Antonio Quartullife8a93b2013-04-03 19:10:26 +02001022 if (batadv_is_my_mac(bat_priv, unicast_packet->dest)) {
Sven Eckelmann88ed1e772012-05-12 02:09:40 +02001023 ret = batadv_frag_reassemble_skb(skb, bat_priv, &new_skb);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001024
1025 if (ret == NET_RX_DROP)
1026 return NET_RX_DROP;
1027
1028 /* packet was buffered for late merge */
1029 if (!new_skb)
1030 return NET_RX_SUCCESS;
1031
Antonio Quartullic384ea32011-06-26 03:37:18 +02001032 if (batadv_dat_snoop_incoming_arp_request(bat_priv, new_skb,
1033 hdr_size))
1034 goto rx_success;
1035 if (batadv_dat_snoop_incoming_arp_reply(bat_priv, new_skb,
1036 hdr_size))
1037 goto rx_success;
1038
Sven Eckelmann04b482a2012-05-12 02:09:38 +02001039 batadv_interface_rx(recv_if->soft_iface, new_skb, recv_if,
Antonio Quartulli37135172012-07-05 23:38:30 +02001040 sizeof(struct batadv_unicast_packet), NULL);
Antonio Quartullic384ea32011-06-26 03:37:18 +02001041
1042rx_success:
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001043 return NET_RX_SUCCESS;
1044 }
1045
Sven Eckelmann63b01032012-05-16 20:23:13 +02001046 return batadv_route_unicast_packet(skb, recv_if);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001047}
1048
Marek Lindneref261572013-04-23 21:39:57 +08001049/**
1050 * batadv_recv_unicast_tvlv - receive and process unicast tvlv packets
1051 * @skb: unicast tvlv packet to process
1052 * @recv_if: pointer to interface this packet was received on
1053 * @dst_addr: the payload destination
1054 *
1055 * Returns NET_RX_SUCCESS if the packet has been consumed or NET_RX_DROP
1056 * otherwise.
1057 */
1058int batadv_recv_unicast_tvlv(struct sk_buff *skb,
1059 struct batadv_hard_iface *recv_if)
1060{
1061 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
1062 struct batadv_unicast_tvlv_packet *unicast_tvlv_packet;
1063 unsigned char *tvlv_buff;
1064 uint16_t tvlv_buff_len;
1065 int hdr_size = sizeof(*unicast_tvlv_packet);
1066 int ret = NET_RX_DROP;
1067
1068 if (batadv_check_unicast_packet(bat_priv, skb, hdr_size) < 0)
1069 return NET_RX_DROP;
1070
1071 /* the header is likely to be modified while forwarding */
1072 if (skb_cow(skb, hdr_size) < 0)
1073 return NET_RX_DROP;
1074
1075 /* packet needs to be linearized to access the tvlv content */
1076 if (skb_linearize(skb) < 0)
1077 return NET_RX_DROP;
1078
1079 unicast_tvlv_packet = (struct batadv_unicast_tvlv_packet *)skb->data;
1080
1081 tvlv_buff = (unsigned char *)(skb->data + hdr_size);
1082 tvlv_buff_len = ntohs(unicast_tvlv_packet->tvlv_len);
1083
1084 if (tvlv_buff_len > skb->len - hdr_size)
1085 return NET_RX_DROP;
1086
1087 ret = batadv_tvlv_containers_process(bat_priv, false, NULL,
1088 unicast_tvlv_packet->src,
1089 unicast_tvlv_packet->dst,
1090 tvlv_buff, tvlv_buff_len);
1091
1092 if (ret != NET_RX_SUCCESS)
1093 ret = batadv_route_unicast_packet(skb, recv_if);
1094
1095 return ret;
1096}
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001097
Sven Eckelmann56303d32012-06-05 22:31:31 +02001098int batadv_recv_bcast_packet(struct sk_buff *skb,
1099 struct batadv_hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001100{
Sven Eckelmann56303d32012-06-05 22:31:31 +02001101 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
1102 struct batadv_orig_node *orig_node = NULL;
Sven Eckelmann96412692012-06-05 22:31:30 +02001103 struct batadv_bcast_packet *bcast_packet;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001104 struct ethhdr *ethhdr;
Sven Eckelmann704509b2011-05-14 23:14:54 +02001105 int hdr_size = sizeof(*bcast_packet);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001106 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001107 int32_t seq_diff;
1108
1109 /* drop packet if it has not necessary minimum size */
1110 if (unlikely(!pskb_may_pull(skb, hdr_size)))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001111 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001112
Antonio Quartulli7ed4be92013-04-08 15:08:18 +02001113 ethhdr = eth_hdr(skb);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001114
1115 /* packet with broadcast indication but unicast recipient */
1116 if (!is_broadcast_ether_addr(ethhdr->h_dest))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001117 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001118
1119 /* packet with broadcast sender address */
1120 if (is_broadcast_ether_addr(ethhdr->h_source))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001121 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001122
1123 /* ignore broadcasts sent by myself */
Antonio Quartullife8a93b2013-04-03 19:10:26 +02001124 if (batadv_is_my_mac(bat_priv, ethhdr->h_source))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001125 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001126
Sven Eckelmann96412692012-06-05 22:31:30 +02001127 bcast_packet = (struct batadv_bcast_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001128
1129 /* ignore broadcasts originated by myself */
Antonio Quartullife8a93b2013-04-03 19:10:26 +02001130 if (batadv_is_my_mac(bat_priv, bcast_packet->orig))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001131 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001132
Sven Eckelmann76543d12011-11-20 15:47:38 +01001133 if (bcast_packet->header.ttl < 2)
Marek Lindnerf3e00082011-01-25 21:52:11 +00001134 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001135
Sven Eckelmannda641192012-05-12 13:48:56 +02001136 orig_node = batadv_orig_hash_find(bat_priv, bcast_packet->orig);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001137
1138 if (!orig_node)
Antonio Quartullib5a6f692011-04-16 11:30:57 +02001139 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001140
Marek Lindnerf3e00082011-01-25 21:52:11 +00001141 spin_lock_bh(&orig_node->bcast_seqno_lock);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001142
1143 /* check whether the packet is a duplicate */
Sven Eckelmann9b4a1152012-05-12 13:48:53 +02001144 if (batadv_test_bit(orig_node->bcast_bits, orig_node->last_bcast_seqno,
1145 ntohl(bcast_packet->seqno)))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001146 goto spin_unlock;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001147
1148 seq_diff = ntohl(bcast_packet->seqno) - orig_node->last_bcast_seqno;
1149
1150 /* check whether the packet is old and the host just restarted. */
Sven Eckelmann30d3c512012-05-12 02:09:36 +02001151 if (batadv_window_protected(bat_priv, seq_diff,
1152 &orig_node->bcast_seqno_reset))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001153 goto spin_unlock;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001154
1155 /* mark broadcast in flood history, update window position
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +02001156 * if required.
1157 */
Sven Eckelmann0f5f9322012-05-12 02:09:25 +02001158 if (batadv_bit_get_packet(bat_priv, orig_node->bcast_bits, seq_diff, 1))
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001159 orig_node->last_bcast_seqno = ntohl(bcast_packet->seqno);
1160
Marek Lindnerf3e00082011-01-25 21:52:11 +00001161 spin_unlock_bh(&orig_node->bcast_seqno_lock);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001162
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001163 /* check whether this has been sent by another originator before */
Simon Wunderlich004e86f2012-10-18 13:47:42 +02001164 if (batadv_bla_check_bcast_duplist(bat_priv, skb))
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001165 goto out;
1166
Simon Wunderlichc54f38c2013-07-29 17:56:44 +02001167 batadv_skb_set_priority(skb, sizeof(struct batadv_bcast_packet));
1168
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001169 /* rebroadcast packet */
Sven Eckelmann9455e342012-05-12 02:09:37 +02001170 batadv_add_bcast_packet_to_list(bat_priv, skb, 1);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001171
Simon Wunderlich23721382012-01-22 20:00:19 +01001172 /* don't hand the broadcast up if it is from an originator
1173 * from the same backbone.
1174 */
Sven Eckelmann08adf152012-05-12 13:38:47 +02001175 if (batadv_bla_is_backbone_gw(skb, orig_node, hdr_size))
Simon Wunderlich23721382012-01-22 20:00:19 +01001176 goto out;
1177
Antonio Quartullic384ea32011-06-26 03:37:18 +02001178 if (batadv_dat_snoop_incoming_arp_request(bat_priv, skb, hdr_size))
1179 goto rx_success;
1180 if (batadv_dat_snoop_incoming_arp_reply(bat_priv, skb, hdr_size))
1181 goto rx_success;
1182
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001183 /* broadcast for me */
Antonio Quartulli37135172012-07-05 23:38:30 +02001184 batadv_interface_rx(recv_if->soft_iface, skb, recv_if, hdr_size,
1185 orig_node);
Antonio Quartullic384ea32011-06-26 03:37:18 +02001186
1187rx_success:
Marek Lindnerf3e00082011-01-25 21:52:11 +00001188 ret = NET_RX_SUCCESS;
1189 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001190
Marek Lindnerf3e00082011-01-25 21:52:11 +00001191spin_unlock:
1192 spin_unlock_bh(&orig_node->bcast_seqno_lock);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001193out:
1194 if (orig_node)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +02001195 batadv_orig_node_free_ref(orig_node);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001196 return ret;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001197}