blob: b72d7f3b3c6aaafa7a47e558cbfcc4a0092fb945 [file] [log] [blame]
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001/*
Sven Eckelmann64afe352011-01-27 10:38:15 +01002 * Copyright (C) 2007-2011 B.A.T.M.A.N. contributors:
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00003 *
4 * Marek Lindner, Simon Wunderlich
5 *
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of version 2 of the GNU General Public
8 * License as published by the Free Software Foundation.
9 *
10 * This program is distributed in the hope that it will be useful, but
11 * WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
13 * General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License
16 * along with this program; if not, write to the Free Software
17 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
18 * 02110-1301, USA
19 *
20 */
21
22#include "main.h"
23#include "routing.h"
24#include "send.h"
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000025#include "soft-interface.h"
26#include "hard-interface.h"
27#include "icmp_socket.h"
28#include "translation-table.h"
29#include "originator.h"
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000030#include "vis.h"
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000031#include "unicast.h"
32
Marek Lindnere6c10f42011-02-18 12:33:20 +000033void slide_own_bcast_window(struct hard_iface *hard_iface)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000034{
Marek Lindnere6c10f42011-02-18 12:33:20 +000035 struct bat_priv *bat_priv = netdev_priv(hard_iface->soft_iface);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000036 struct hashtable_t *hash = bat_priv->orig_hash;
Marek Lindner7aadf882011-02-18 12:28:09 +000037 struct hlist_node *node;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000038 struct hlist_head *head;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000039 struct orig_node *orig_node;
40 unsigned long *word;
Antonio Quartullic90681b2011-10-05 17:05:25 +020041 uint32_t i;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000042 size_t word_index;
43
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000044 for (i = 0; i < hash->size; i++) {
45 head = &hash->table[i];
46
Marek Lindnerfb778ea2011-01-19 20:01:40 +000047 rcu_read_lock();
Marek Lindner7aadf882011-02-18 12:28:09 +000048 hlist_for_each_entry_rcu(orig_node, node, head, hash_entry) {
Marek Lindner2ae2daf2011-01-19 20:01:42 +000049 spin_lock_bh(&orig_node->ogm_cnt_lock);
Marek Lindnere6c10f42011-02-18 12:33:20 +000050 word_index = hard_iface->if_num * NUM_WORDS;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000051 word = &(orig_node->bcast_own[word_index]);
52
53 bit_get_packet(bat_priv, word, 1, 0);
Marek Lindnere6c10f42011-02-18 12:33:20 +000054 orig_node->bcast_own_sum[hard_iface->if_num] =
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000055 bit_packet_count(word);
Marek Lindner2ae2daf2011-01-19 20:01:42 +000056 spin_unlock_bh(&orig_node->ogm_cnt_lock);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000057 }
Marek Lindnerfb778ea2011-01-19 20:01:40 +000058 rcu_read_unlock();
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000059 }
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000060}
61
Marek Lindnerfc957272011-07-30 12:04:12 +020062static void _update_route(struct bat_priv *bat_priv,
63 struct orig_node *orig_node,
64 struct neigh_node *neigh_node)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000065{
Linus Lüssinge1a53822011-03-14 22:43:37 +000066 struct neigh_node *curr_router;
67
68 curr_router = orig_node_get_router(orig_node);
Marek Lindnera8e7f4b2010-12-12 21:57:10 +000069
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000070 /* route deleted */
Linus Lüssinge1a53822011-03-14 22:43:37 +000071 if ((curr_router) && (!neigh_node)) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000072 bat_dbg(DBG_ROUTES, bat_priv, "Deleting route towards: %pM\n",
73 orig_node->orig);
Antonio Quartulli2dafb492011-05-05 08:42:45 +020074 tt_global_del_orig(bat_priv, orig_node,
Antonio Quartullia73105b2011-04-27 14:27:44 +020075 "Deleted route towards originator");
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000076
Linus Lüssinge1a53822011-03-14 22:43:37 +000077 /* route added */
78 } else if ((!curr_router) && (neigh_node)) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000079
80 bat_dbg(DBG_ROUTES, bat_priv,
81 "Adding route towards: %pM (via %pM)\n",
82 orig_node->orig, neigh_node->addr);
Linus Lüssinge1a53822011-03-14 22:43:37 +000083 /* route changed */
Sven Eckelmannbb899b82011-05-10 11:22:37 +020084 } else if (neigh_node && curr_router) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000085 bat_dbg(DBG_ROUTES, bat_priv,
86 "Changing route towards: %pM "
87 "(now via %pM - was via %pM)\n",
88 orig_node->orig, neigh_node->addr,
Linus Lüssinge1a53822011-03-14 22:43:37 +000089 curr_router->addr);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000090 }
91
Linus Lüssinge1a53822011-03-14 22:43:37 +000092 if (curr_router)
93 neigh_node_free_ref(curr_router);
94
95 /* increase refcount of new best neighbor */
Marek Lindner44524fc2011-02-10 14:33:53 +000096 if (neigh_node && !atomic_inc_not_zero(&neigh_node->refcount))
97 neigh_node = NULL;
Linus Lüssinge1a53822011-03-14 22:43:37 +000098
99 spin_lock_bh(&orig_node->neigh_list_lock);
100 rcu_assign_pointer(orig_node->router, neigh_node);
101 spin_unlock_bh(&orig_node->neigh_list_lock);
102
103 /* decrease refcount of previous best neighbor */
104 if (curr_router)
105 neigh_node_free_ref(curr_router);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000106}
107
Marek Lindnerfc957272011-07-30 12:04:12 +0200108void update_route(struct bat_priv *bat_priv, struct orig_node *orig_node,
109 struct neigh_node *neigh_node)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000110{
Linus Lüssinge1a53822011-03-14 22:43:37 +0000111 struct neigh_node *router = NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000112
113 if (!orig_node)
Linus Lüssinge1a53822011-03-14 22:43:37 +0000114 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000115
Linus Lüssinge1a53822011-03-14 22:43:37 +0000116 router = orig_node_get_router(orig_node);
117
118 if (router != neigh_node)
Marek Lindnerfc957272011-07-30 12:04:12 +0200119 _update_route(bat_priv, orig_node, neigh_node);
Linus Lüssinge1a53822011-03-14 22:43:37 +0000120
121out:
122 if (router)
123 neigh_node_free_ref(router);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000124}
125
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000126/* caller must hold the neigh_list_lock */
127void bonding_candidate_del(struct orig_node *orig_node,
128 struct neigh_node *neigh_node)
129{
130 /* this neighbor is not part of our candidate list */
131 if (list_empty(&neigh_node->bonding_list))
132 goto out;
133
134 list_del_rcu(&neigh_node->bonding_list);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000135 INIT_LIST_HEAD(&neigh_node->bonding_list);
Marek Lindner44524fc2011-02-10 14:33:53 +0000136 neigh_node_free_ref(neigh_node);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000137 atomic_dec(&orig_node->bond_candidates);
138
139out:
140 return;
141}
142
Marek Lindnerfc957272011-07-30 12:04:12 +0200143void bonding_candidate_add(struct orig_node *orig_node,
144 struct neigh_node *neigh_node)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000145{
146 struct hlist_node *node;
Linus Lüssinge1a53822011-03-14 22:43:37 +0000147 struct neigh_node *tmp_neigh_node, *router = NULL;
148 uint8_t interference_candidate = 0;
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000149
150 spin_lock_bh(&orig_node->neigh_list_lock);
151
152 /* only consider if it has the same primary address ... */
Marek Lindner39901e72011-02-18 12:28:08 +0000153 if (!compare_eth(orig_node->orig,
154 neigh_node->orig_node->primary_addr))
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000155 goto candidate_del;
156
Linus Lüssinge1a53822011-03-14 22:43:37 +0000157 router = orig_node_get_router(orig_node);
158 if (!router)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000159 goto candidate_del;
160
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000161 /* ... and is good enough to be considered */
Linus Lüssinge1a53822011-03-14 22:43:37 +0000162 if (neigh_node->tq_avg < router->tq_avg - BONDING_TQ_THRESHOLD)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000163 goto candidate_del;
164
165 /**
166 * check if we have another candidate with the same mac address or
167 * interface. If we do, we won't select this candidate because of
168 * possible interference.
169 */
170 hlist_for_each_entry_rcu(tmp_neigh_node, node,
171 &orig_node->neigh_list, list) {
172
173 if (tmp_neigh_node == neigh_node)
174 continue;
175
176 /* we only care if the other candidate is even
177 * considered as candidate. */
178 if (list_empty(&tmp_neigh_node->bonding_list))
179 continue;
180
181 if ((neigh_node->if_incoming == tmp_neigh_node->if_incoming) ||
Marek Lindner39901e72011-02-18 12:28:08 +0000182 (compare_eth(neigh_node->addr, tmp_neigh_node->addr))) {
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000183 interference_candidate = 1;
184 break;
185 }
186 }
187
188 /* don't care further if it is an interference candidate */
189 if (interference_candidate)
190 goto candidate_del;
191
192 /* this neighbor already is part of our candidate list */
193 if (!list_empty(&neigh_node->bonding_list))
194 goto out;
195
Marek Lindner44524fc2011-02-10 14:33:53 +0000196 if (!atomic_inc_not_zero(&neigh_node->refcount))
197 goto out;
198
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000199 list_add_rcu(&neigh_node->bonding_list, &orig_node->bond_list);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000200 atomic_inc(&orig_node->bond_candidates);
201 goto out;
202
203candidate_del:
204 bonding_candidate_del(orig_node, neigh_node);
205
206out:
207 spin_unlock_bh(&orig_node->neigh_list_lock);
Linus Lüssinge1a53822011-03-14 22:43:37 +0000208
209 if (router)
210 neigh_node_free_ref(router);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000211}
212
213/* copy primary address for bonding */
Marek Lindnerfc957272011-07-30 12:04:12 +0200214void bonding_save_primary(const struct orig_node *orig_node,
215 struct orig_node *orig_neigh_node,
216 const struct batman_ogm_packet *batman_ogm_packet)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000217{
Marek Lindnerb6da4bf2011-07-29 17:31:50 +0200218 if (!(batman_ogm_packet->flags & PRIMARIES_FIRST_HOP))
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000219 return;
220
221 memcpy(orig_neigh_node->primary_addr, orig_node->orig, ETH_ALEN);
222}
223
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000224/* checks whether the host restarted and is in the protection time.
225 * returns:
226 * 0 if the packet is to be accepted
227 * 1 if the packet is to be ignored.
228 */
Marek Lindnerfc957272011-07-30 12:04:12 +0200229int window_protected(struct bat_priv *bat_priv, int32_t seq_num_diff,
230 unsigned long *last_reset)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000231{
232 if ((seq_num_diff <= -TQ_LOCAL_WINDOW_SIZE)
233 || (seq_num_diff >= EXPECTED_SEQNO_RANGE)) {
234 if (time_after(jiffies, *last_reset +
235 msecs_to_jiffies(RESET_PROTECTION_MS))) {
236
237 *last_reset = jiffies;
238 bat_dbg(DBG_BATMAN, bat_priv,
239 "old packet received, start protection\n");
240
241 return 0;
242 } else
243 return 1;
244 }
245 return 0;
246}
247
Marek Lindnerfc957272011-07-30 12:04:12 +0200248int recv_bat_ogm_packet(struct sk_buff *skb, struct hard_iface *hard_iface)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000249{
Marek Lindner01c42242011-11-28 21:31:55 +0800250 struct bat_priv *bat_priv = netdev_priv(hard_iface->soft_iface);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000251 struct ethhdr *ethhdr;
252
253 /* drop packet if it has not necessary minimum size */
Marek Lindnerb6da4bf2011-07-29 17:31:50 +0200254 if (unlikely(!pskb_may_pull(skb, BATMAN_OGM_LEN)))
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000255 return NET_RX_DROP;
256
257 ethhdr = (struct ethhdr *)skb_mac_header(skb);
258
259 /* packet with broadcast indication but unicast recipient */
260 if (!is_broadcast_ether_addr(ethhdr->h_dest))
261 return NET_RX_DROP;
262
263 /* packet with broadcast sender address */
264 if (is_broadcast_ether_addr(ethhdr->h_source))
265 return NET_RX_DROP;
266
267 /* create a copy of the skb, if needed, to modify it. */
268 if (skb_cow(skb, 0) < 0)
269 return NET_RX_DROP;
270
271 /* keep skb linear */
272 if (skb_linearize(skb) < 0)
273 return NET_RX_DROP;
274
Marek Lindner01c42242011-11-28 21:31:55 +0800275 bat_priv->bat_algo_ops->bat_ogm_receive(hard_iface, skb);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000276
277 kfree_skb(skb);
278 return NET_RX_SUCCESS;
279}
280
281static int recv_my_icmp_packet(struct bat_priv *bat_priv,
282 struct sk_buff *skb, size_t icmp_len)
283{
Marek Lindner32ae9b22011-04-20 15:40:58 +0200284 struct hard_iface *primary_if = NULL;
Marek Lindner44524fc2011-02-10 14:33:53 +0000285 struct orig_node *orig_node = NULL;
Linus Lüssinge1a53822011-03-14 22:43:37 +0000286 struct neigh_node *router = NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000287 struct icmp_packet_rr *icmp_packet;
Marek Lindner44524fc2011-02-10 14:33:53 +0000288 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000289
290 icmp_packet = (struct icmp_packet_rr *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000291
292 /* add data to device queue */
293 if (icmp_packet->msg_type != ECHO_REQUEST) {
294 bat_socket_receive_packet(icmp_packet, icmp_len);
Marek Lindner44524fc2011-02-10 14:33:53 +0000295 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000296 }
297
Marek Lindner32ae9b22011-04-20 15:40:58 +0200298 primary_if = primary_if_get_selected(bat_priv);
299 if (!primary_if)
Marek Lindner44524fc2011-02-10 14:33:53 +0000300 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000301
302 /* answer echo request (ping) */
303 /* get routing information */
Marek Lindner7aadf882011-02-18 12:28:09 +0000304 orig_node = orig_hash_find(bat_priv, icmp_packet->orig);
Marek Lindner44524fc2011-02-10 14:33:53 +0000305 if (!orig_node)
Linus Lüssinge1a53822011-03-14 22:43:37 +0000306 goto out;
Marek Lindner44524fc2011-02-10 14:33:53 +0000307
Linus Lüssinge1a53822011-03-14 22:43:37 +0000308 router = orig_node_get_router(orig_node);
309 if (!router)
310 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000311
Marek Lindner44524fc2011-02-10 14:33:53 +0000312 /* create a copy of the skb, if needed, to modify it. */
313 if (skb_cow(skb, sizeof(struct ethhdr)) < 0)
314 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000315
Marek Lindner44524fc2011-02-10 14:33:53 +0000316 icmp_packet = (struct icmp_packet_rr *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000317
Marek Lindner44524fc2011-02-10 14:33:53 +0000318 memcpy(icmp_packet->dst, icmp_packet->orig, ETH_ALEN);
Marek Lindner32ae9b22011-04-20 15:40:58 +0200319 memcpy(icmp_packet->orig, primary_if->net_dev->dev_addr, ETH_ALEN);
Marek Lindner44524fc2011-02-10 14:33:53 +0000320 icmp_packet->msg_type = ECHO_REPLY;
Sven Eckelmann76543d12011-11-20 15:47:38 +0100321 icmp_packet->header.ttl = TTL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000322
Linus Lüssinge1a53822011-03-14 22:43:37 +0000323 send_skb_packet(skb, router->if_incoming, router->addr);
Marek Lindner44524fc2011-02-10 14:33:53 +0000324 ret = NET_RX_SUCCESS;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000325
Marek Lindner44524fc2011-02-10 14:33:53 +0000326out:
Marek Lindner32ae9b22011-04-20 15:40:58 +0200327 if (primary_if)
328 hardif_free_ref(primary_if);
Linus Lüssinge1a53822011-03-14 22:43:37 +0000329 if (router)
330 neigh_node_free_ref(router);
Marek Lindner44524fc2011-02-10 14:33:53 +0000331 if (orig_node)
Marek Lindner7b36e8e2011-02-18 12:28:10 +0000332 orig_node_free_ref(orig_node);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000333 return ret;
334}
335
336static int recv_icmp_ttl_exceeded(struct bat_priv *bat_priv,
Simon Wunderlich74ef1152010-12-29 16:15:19 +0000337 struct sk_buff *skb)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000338{
Marek Lindner32ae9b22011-04-20 15:40:58 +0200339 struct hard_iface *primary_if = NULL;
Marek Lindner44524fc2011-02-10 14:33:53 +0000340 struct orig_node *orig_node = NULL;
Linus Lüssinge1a53822011-03-14 22:43:37 +0000341 struct neigh_node *router = NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000342 struct icmp_packet *icmp_packet;
Marek Lindner44524fc2011-02-10 14:33:53 +0000343 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000344
345 icmp_packet = (struct icmp_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000346
347 /* send TTL exceeded if packet is an echo request (traceroute) */
348 if (icmp_packet->msg_type != ECHO_REQUEST) {
349 pr_debug("Warning - can't forward icmp packet from %pM to "
350 "%pM: ttl exceeded\n", icmp_packet->orig,
351 icmp_packet->dst);
Marek Lindner44524fc2011-02-10 14:33:53 +0000352 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000353 }
354
Marek Lindner32ae9b22011-04-20 15:40:58 +0200355 primary_if = primary_if_get_selected(bat_priv);
356 if (!primary_if)
Marek Lindner44524fc2011-02-10 14:33:53 +0000357 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000358
359 /* get routing information */
Marek Lindner7aadf882011-02-18 12:28:09 +0000360 orig_node = orig_hash_find(bat_priv, icmp_packet->orig);
Marek Lindner44524fc2011-02-10 14:33:53 +0000361 if (!orig_node)
Linus Lüssinge1a53822011-03-14 22:43:37 +0000362 goto out;
Marek Lindner44524fc2011-02-10 14:33:53 +0000363
Linus Lüssinge1a53822011-03-14 22:43:37 +0000364 router = orig_node_get_router(orig_node);
365 if (!router)
366 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000367
Marek Lindner44524fc2011-02-10 14:33:53 +0000368 /* create a copy of the skb, if needed, to modify it. */
369 if (skb_cow(skb, sizeof(struct ethhdr)) < 0)
370 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000371
Marek Lindner44524fc2011-02-10 14:33:53 +0000372 icmp_packet = (struct icmp_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000373
Marek Lindner44524fc2011-02-10 14:33:53 +0000374 memcpy(icmp_packet->dst, icmp_packet->orig, ETH_ALEN);
Marek Lindner32ae9b22011-04-20 15:40:58 +0200375 memcpy(icmp_packet->orig, primary_if->net_dev->dev_addr, ETH_ALEN);
Marek Lindner44524fc2011-02-10 14:33:53 +0000376 icmp_packet->msg_type = TTL_EXCEEDED;
Sven Eckelmann76543d12011-11-20 15:47:38 +0100377 icmp_packet->header.ttl = TTL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000378
Linus Lüssinge1a53822011-03-14 22:43:37 +0000379 send_skb_packet(skb, router->if_incoming, router->addr);
Marek Lindner44524fc2011-02-10 14:33:53 +0000380 ret = NET_RX_SUCCESS;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000381
Marek Lindner44524fc2011-02-10 14:33:53 +0000382out:
Marek Lindner32ae9b22011-04-20 15:40:58 +0200383 if (primary_if)
384 hardif_free_ref(primary_if);
Linus Lüssinge1a53822011-03-14 22:43:37 +0000385 if (router)
386 neigh_node_free_ref(router);
Marek Lindner44524fc2011-02-10 14:33:53 +0000387 if (orig_node)
Marek Lindner7b36e8e2011-02-18 12:28:10 +0000388 orig_node_free_ref(orig_node);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000389 return ret;
390}
391
392
Marek Lindnere6c10f42011-02-18 12:33:20 +0000393int recv_icmp_packet(struct sk_buff *skb, struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000394{
395 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
396 struct icmp_packet_rr *icmp_packet;
397 struct ethhdr *ethhdr;
Marek Lindner44524fc2011-02-10 14:33:53 +0000398 struct orig_node *orig_node = NULL;
Linus Lüssinge1a53822011-03-14 22:43:37 +0000399 struct neigh_node *router = NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000400 int hdr_size = sizeof(struct icmp_packet);
Marek Lindner44524fc2011-02-10 14:33:53 +0000401 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000402
403 /**
404 * we truncate all incoming icmp packets if they don't match our size
405 */
406 if (skb->len >= sizeof(struct icmp_packet_rr))
407 hdr_size = sizeof(struct icmp_packet_rr);
408
409 /* drop packet if it has not necessary minimum size */
410 if (unlikely(!pskb_may_pull(skb, hdr_size)))
Marek Lindner44524fc2011-02-10 14:33:53 +0000411 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000412
413 ethhdr = (struct ethhdr *)skb_mac_header(skb);
414
415 /* packet with unicast indication but broadcast recipient */
416 if (is_broadcast_ether_addr(ethhdr->h_dest))
Marek Lindner44524fc2011-02-10 14:33:53 +0000417 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000418
419 /* packet with broadcast sender address */
420 if (is_broadcast_ether_addr(ethhdr->h_source))
Marek Lindner44524fc2011-02-10 14:33:53 +0000421 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000422
423 /* not for me */
424 if (!is_my_mac(ethhdr->h_dest))
Marek Lindner44524fc2011-02-10 14:33:53 +0000425 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000426
427 icmp_packet = (struct icmp_packet_rr *)skb->data;
428
429 /* add record route information if not full */
430 if ((hdr_size == sizeof(struct icmp_packet_rr)) &&
431 (icmp_packet->rr_cur < BAT_RR_LEN)) {
432 memcpy(&(icmp_packet->rr[icmp_packet->rr_cur]),
433 ethhdr->h_dest, ETH_ALEN);
434 icmp_packet->rr_cur++;
435 }
436
437 /* packet for me */
438 if (is_my_mac(icmp_packet->dst))
439 return recv_my_icmp_packet(bat_priv, skb, hdr_size);
440
441 /* TTL exceeded */
Sven Eckelmann76543d12011-11-20 15:47:38 +0100442 if (icmp_packet->header.ttl < 2)
Simon Wunderlich74ef1152010-12-29 16:15:19 +0000443 return recv_icmp_ttl_exceeded(bat_priv, skb);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000444
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000445 /* get routing information */
Marek Lindner7aadf882011-02-18 12:28:09 +0000446 orig_node = orig_hash_find(bat_priv, icmp_packet->dst);
Marek Lindner44524fc2011-02-10 14:33:53 +0000447 if (!orig_node)
Linus Lüssinge1a53822011-03-14 22:43:37 +0000448 goto out;
Marek Lindner44524fc2011-02-10 14:33:53 +0000449
Linus Lüssinge1a53822011-03-14 22:43:37 +0000450 router = orig_node_get_router(orig_node);
451 if (!router)
452 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000453
Marek Lindner44524fc2011-02-10 14:33:53 +0000454 /* create a copy of the skb, if needed, to modify it. */
455 if (skb_cow(skb, sizeof(struct ethhdr)) < 0)
456 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000457
Marek Lindner44524fc2011-02-10 14:33:53 +0000458 icmp_packet = (struct icmp_packet_rr *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000459
Marek Lindner44524fc2011-02-10 14:33:53 +0000460 /* decrement ttl */
Sven Eckelmann76543d12011-11-20 15:47:38 +0100461 icmp_packet->header.ttl--;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000462
Marek Lindner44524fc2011-02-10 14:33:53 +0000463 /* route it */
Linus Lüssinge1a53822011-03-14 22:43:37 +0000464 send_skb_packet(skb, router->if_incoming, router->addr);
Marek Lindner44524fc2011-02-10 14:33:53 +0000465 ret = NET_RX_SUCCESS;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000466
Marek Lindner44524fc2011-02-10 14:33:53 +0000467out:
Linus Lüssinge1a53822011-03-14 22:43:37 +0000468 if (router)
469 neigh_node_free_ref(router);
Marek Lindner44524fc2011-02-10 14:33:53 +0000470 if (orig_node)
Marek Lindner7b36e8e2011-02-18 12:28:10 +0000471 orig_node_free_ref(orig_node);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000472 return ret;
473}
474
Linus Lüssing55158622011-03-14 22:43:27 +0000475/* In the bonding case, send the packets in a round
476 * robin fashion over the remaining interfaces.
477 *
478 * This method rotates the bonding list and increases the
479 * returned router's refcount. */
480static struct neigh_node *find_bond_router(struct orig_node *primary_orig,
Sven Eckelmann747e4222011-05-14 23:14:50 +0200481 const struct hard_iface *recv_if)
Linus Lüssing55158622011-03-14 22:43:27 +0000482{
483 struct neigh_node *tmp_neigh_node;
484 struct neigh_node *router = NULL, *first_candidate = NULL;
485
486 rcu_read_lock();
487 list_for_each_entry_rcu(tmp_neigh_node, &primary_orig->bond_list,
488 bonding_list) {
489 if (!first_candidate)
490 first_candidate = tmp_neigh_node;
491
492 /* recv_if == NULL on the first node. */
493 if (tmp_neigh_node->if_incoming == recv_if)
494 continue;
495
496 if (!atomic_inc_not_zero(&tmp_neigh_node->refcount))
497 continue;
498
499 router = tmp_neigh_node;
500 break;
501 }
502
503 /* use the first candidate if nothing was found. */
504 if (!router && first_candidate &&
505 atomic_inc_not_zero(&first_candidate->refcount))
506 router = first_candidate;
507
508 if (!router)
509 goto out;
510
511 /* selected should point to the next element
512 * after the current router */
513 spin_lock_bh(&primary_orig->neigh_list_lock);
514 /* this is a list_move(), which unfortunately
515 * does not exist as rcu version */
516 list_del_rcu(&primary_orig->bond_list);
517 list_add_rcu(&primary_orig->bond_list,
518 &router->bonding_list);
519 spin_unlock_bh(&primary_orig->neigh_list_lock);
520
521out:
522 rcu_read_unlock();
523 return router;
524}
525
526/* Interface Alternating: Use the best of the
527 * remaining candidates which are not using
528 * this interface.
529 *
530 * Increases the returned router's refcount */
531static struct neigh_node *find_ifalter_router(struct orig_node *primary_orig,
Sven Eckelmann747e4222011-05-14 23:14:50 +0200532 const struct hard_iface *recv_if)
Linus Lüssing55158622011-03-14 22:43:27 +0000533{
534 struct neigh_node *tmp_neigh_node;
535 struct neigh_node *router = NULL, *first_candidate = NULL;
536
537 rcu_read_lock();
538 list_for_each_entry_rcu(tmp_neigh_node, &primary_orig->bond_list,
539 bonding_list) {
540 if (!first_candidate)
541 first_candidate = tmp_neigh_node;
542
543 /* recv_if == NULL on the first node. */
544 if (tmp_neigh_node->if_incoming == recv_if)
545 continue;
546
547 if (!atomic_inc_not_zero(&tmp_neigh_node->refcount))
548 continue;
549
550 /* if we don't have a router yet
551 * or this one is better, choose it. */
552 if ((!router) ||
553 (tmp_neigh_node->tq_avg > router->tq_avg)) {
554 /* decrement refcount of
555 * previously selected router */
556 if (router)
557 neigh_node_free_ref(router);
558
559 router = tmp_neigh_node;
560 atomic_inc_not_zero(&router->refcount);
561 }
562
563 neigh_node_free_ref(tmp_neigh_node);
564 }
565
566 /* use the first candidate if nothing was found. */
567 if (!router && first_candidate &&
568 atomic_inc_not_zero(&first_candidate->refcount))
569 router = first_candidate;
570
571 rcu_read_unlock();
572 return router;
573}
574
Antonio Quartullia73105b2011-04-27 14:27:44 +0200575int recv_tt_query(struct sk_buff *skb, struct hard_iface *recv_if)
576{
577 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
578 struct tt_query_packet *tt_query;
Antonio Quartulli8b7342d2011-10-16 20:32:03 +0200579 uint16_t tt_len;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200580 struct ethhdr *ethhdr;
581
582 /* drop packet if it has not necessary minimum size */
583 if (unlikely(!pskb_may_pull(skb, sizeof(struct tt_query_packet))))
584 goto out;
585
586 /* I could need to modify it */
587 if (skb_cow(skb, sizeof(struct tt_query_packet)) < 0)
588 goto out;
589
590 ethhdr = (struct ethhdr *)skb_mac_header(skb);
591
592 /* packet with unicast indication but broadcast recipient */
593 if (is_broadcast_ether_addr(ethhdr->h_dest))
594 goto out;
595
596 /* packet with broadcast sender address */
597 if (is_broadcast_ether_addr(ethhdr->h_source))
598 goto out;
599
600 tt_query = (struct tt_query_packet *)skb->data;
601
602 tt_query->tt_data = ntohs(tt_query->tt_data);
603
604 switch (tt_query->flags & TT_QUERY_TYPE_MASK) {
605 case TT_REQUEST:
606 /* If we cannot provide an answer the tt_request is
607 * forwarded */
608 if (!send_tt_response(bat_priv, tt_query)) {
609 bat_dbg(DBG_TT, bat_priv,
610 "Routing TT_REQUEST to %pM [%c]\n",
611 tt_query->dst,
612 (tt_query->flags & TT_FULL_TABLE ? 'F' : '.'));
613 tt_query->tt_data = htons(tt_query->tt_data);
614 return route_unicast_packet(skb, recv_if);
615 }
616 break;
617 case TT_RESPONSE:
Antonio Quartullidc58fe32011-10-16 20:32:02 +0200618 if (is_my_mac(tt_query->dst)) {
619 /* packet needs to be linearized to access the TT
620 * changes */
621 if (skb_linearize(skb) < 0)
622 goto out;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200623
Antonio Quartulli8b7342d2011-10-16 20:32:03 +0200624 tt_len = tt_query->tt_data * sizeof(struct tt_change);
625
626 /* Ensure we have all the claimed data */
627 if (unlikely(skb_headlen(skb) <
Antonio Quartulli69497c12011-12-02 17:38:52 +0100628 sizeof(struct tt_query_packet) + tt_len))
Antonio Quartulli8b7342d2011-10-16 20:32:03 +0200629 goto out;
630
Antonio Quartullia73105b2011-04-27 14:27:44 +0200631 handle_tt_response(bat_priv, tt_query);
Antonio Quartullidc58fe32011-10-16 20:32:02 +0200632 } else {
Antonio Quartullia73105b2011-04-27 14:27:44 +0200633 bat_dbg(DBG_TT, bat_priv,
634 "Routing TT_RESPONSE to %pM [%c]\n",
635 tt_query->dst,
636 (tt_query->flags & TT_FULL_TABLE ? 'F' : '.'));
637 tt_query->tt_data = htons(tt_query->tt_data);
638 return route_unicast_packet(skb, recv_if);
639 }
640 break;
641 }
642
643out:
644 /* returning NET_RX_DROP will make the caller function kfree the skb */
645 return NET_RX_DROP;
646}
647
Antonio Quartullicc47f662011-04-27 14:27:57 +0200648int recv_roam_adv(struct sk_buff *skb, struct hard_iface *recv_if)
649{
650 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
651 struct roam_adv_packet *roam_adv_packet;
652 struct orig_node *orig_node;
653 struct ethhdr *ethhdr;
654
655 /* drop packet if it has not necessary minimum size */
656 if (unlikely(!pskb_may_pull(skb, sizeof(struct roam_adv_packet))))
657 goto out;
658
659 ethhdr = (struct ethhdr *)skb_mac_header(skb);
660
661 /* packet with unicast indication but broadcast recipient */
662 if (is_broadcast_ether_addr(ethhdr->h_dest))
663 goto out;
664
665 /* packet with broadcast sender address */
666 if (is_broadcast_ether_addr(ethhdr->h_source))
667 goto out;
668
669 roam_adv_packet = (struct roam_adv_packet *)skb->data;
670
671 if (!is_my_mac(roam_adv_packet->dst))
672 return route_unicast_packet(skb, recv_if);
673
674 orig_node = orig_hash_find(bat_priv, roam_adv_packet->src);
675 if (!orig_node)
676 goto out;
677
678 bat_dbg(DBG_TT, bat_priv, "Received ROAMING_ADV from %pM "
679 "(client %pM)\n", roam_adv_packet->src,
680 roam_adv_packet->client);
681
682 tt_global_add(bat_priv, orig_node, roam_adv_packet->client,
Antonio Quartullibc279082011-07-07 15:35:35 +0200683 atomic_read(&orig_node->last_ttvn) + 1, true, false);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200684
685 /* Roaming phase starts: I have new information but the ttvn has not
686 * been incremented yet. This flag will make me check all the incoming
687 * packets for the correct destination. */
688 bat_priv->tt_poss_change = true;
689
690 orig_node_free_ref(orig_node);
691out:
692 /* returning NET_RX_DROP will make the caller function kfree the skb */
693 return NET_RX_DROP;
694}
695
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000696/* find a suitable router for this originator, and use
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000697 * bonding if possible. increases the found neighbors
698 * refcount.*/
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000699struct neigh_node *find_router(struct bat_priv *bat_priv,
700 struct orig_node *orig_node,
Sven Eckelmann747e4222011-05-14 23:14:50 +0200701 const struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000702{
703 struct orig_node *primary_orig_node;
704 struct orig_node *router_orig;
Linus Lüssing55158622011-03-14 22:43:27 +0000705 struct neigh_node *router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000706 static uint8_t zero_mac[ETH_ALEN] = {0, 0, 0, 0, 0, 0};
707 int bonding_enabled;
708
709 if (!orig_node)
710 return NULL;
711
Linus Lüssinge1a53822011-03-14 22:43:37 +0000712 router = orig_node_get_router(orig_node);
713 if (!router)
Marek Lindner01df2b62011-05-05 14:14:46 +0200714 goto err;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000715
716 /* without bonding, the first node should
717 * always choose the default router. */
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000718 bonding_enabled = atomic_read(&bat_priv->bonding);
719
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000720 rcu_read_lock();
721 /* select default router to output */
Linus Lüssinge1a53822011-03-14 22:43:37 +0000722 router_orig = router->orig_node;
Marek Lindner01df2b62011-05-05 14:14:46 +0200723 if (!router_orig)
724 goto err_unlock;
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000725
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000726 if ((!recv_if) && (!bonding_enabled))
727 goto return_router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000728
729 /* if we have something in the primary_addr, we can search
730 * for a potential bonding candidate. */
Marek Lindner39901e72011-02-18 12:28:08 +0000731 if (compare_eth(router_orig->primary_addr, zero_mac))
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000732 goto return_router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000733
734 /* find the orig_node which has the primary interface. might
735 * even be the same as our router_orig in many cases */
736
Marek Lindner39901e72011-02-18 12:28:08 +0000737 if (compare_eth(router_orig->primary_addr, router_orig->orig)) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000738 primary_orig_node = router_orig;
739 } else {
Marek Lindner7aadf882011-02-18 12:28:09 +0000740 primary_orig_node = orig_hash_find(bat_priv,
741 router_orig->primary_addr);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000742 if (!primary_orig_node)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000743 goto return_router;
Marek Lindner7aadf882011-02-18 12:28:09 +0000744
Marek Lindner7b36e8e2011-02-18 12:28:10 +0000745 orig_node_free_ref(primary_orig_node);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000746 }
747
748 /* with less than 2 candidates, we can't do any
749 * bonding and prefer the original router. */
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000750 if (atomic_read(&primary_orig_node->bond_candidates) < 2)
751 goto return_router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000752
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000753 /* all nodes between should choose a candidate which
754 * is is not on the interface where the packet came
755 * in. */
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000756
Marek Lindner44524fc2011-02-10 14:33:53 +0000757 neigh_node_free_ref(router);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000758
Linus Lüssing55158622011-03-14 22:43:27 +0000759 if (bonding_enabled)
760 router = find_bond_router(primary_orig_node, recv_if);
761 else
762 router = find_ifalter_router(primary_orig_node, recv_if);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000763
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000764return_router:
Antonio Quartullie2cbc112011-05-08 20:52:57 +0200765 if (router && router->if_incoming->if_status != IF_ACTIVE)
766 goto err_unlock;
767
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000768 rcu_read_unlock();
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000769 return router;
Marek Lindner01df2b62011-05-05 14:14:46 +0200770err_unlock:
771 rcu_read_unlock();
772err:
773 if (router)
774 neigh_node_free_ref(router);
775 return NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000776}
777
778static int check_unicast_packet(struct sk_buff *skb, int hdr_size)
779{
780 struct ethhdr *ethhdr;
781
782 /* drop packet if it has not necessary minimum size */
783 if (unlikely(!pskb_may_pull(skb, hdr_size)))
784 return -1;
785
786 ethhdr = (struct ethhdr *)skb_mac_header(skb);
787
788 /* packet with unicast indication but broadcast recipient */
789 if (is_broadcast_ether_addr(ethhdr->h_dest))
790 return -1;
791
792 /* packet with broadcast sender address */
793 if (is_broadcast_ether_addr(ethhdr->h_source))
794 return -1;
795
796 /* not for me */
797 if (!is_my_mac(ethhdr->h_dest))
798 return -1;
799
800 return 0;
801}
802
Linus Lüssing7cefb142011-03-02 17:39:31 +0000803int route_unicast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000804{
805 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Marek Lindner44524fc2011-02-10 14:33:53 +0000806 struct orig_node *orig_node = NULL;
807 struct neigh_node *neigh_node = NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000808 struct unicast_packet *unicast_packet;
809 struct ethhdr *ethhdr = (struct ethhdr *)skb_mac_header(skb);
Marek Lindner44524fc2011-02-10 14:33:53 +0000810 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000811 struct sk_buff *new_skb;
812
813 unicast_packet = (struct unicast_packet *)skb->data;
814
815 /* TTL exceeded */
Sven Eckelmann76543d12011-11-20 15:47:38 +0100816 if (unicast_packet->header.ttl < 2) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000817 pr_debug("Warning - can't forward unicast packet from %pM to "
818 "%pM: ttl exceeded\n", ethhdr->h_source,
819 unicast_packet->dest);
Marek Lindner44524fc2011-02-10 14:33:53 +0000820 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000821 }
822
823 /* get routing information */
Marek Lindner7aadf882011-02-18 12:28:09 +0000824 orig_node = orig_hash_find(bat_priv, unicast_packet->dest);
825
Marek Lindner44524fc2011-02-10 14:33:53 +0000826 if (!orig_node)
Antonio Quartullib5a6f692011-04-16 11:30:57 +0200827 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000828
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000829 /* find_router() increases neigh_nodes refcount if found. */
Marek Lindner44524fc2011-02-10 14:33:53 +0000830 neigh_node = find_router(bat_priv, orig_node, recv_if);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000831
Marek Lindnerd0072602011-01-19 20:01:44 +0000832 if (!neigh_node)
Marek Lindner44524fc2011-02-10 14:33:53 +0000833 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000834
835 /* create a copy of the skb, if needed, to modify it. */
836 if (skb_cow(skb, sizeof(struct ethhdr)) < 0)
Marek Lindner44524fc2011-02-10 14:33:53 +0000837 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000838
839 unicast_packet = (struct unicast_packet *)skb->data;
840
Sven Eckelmann76543d12011-11-20 15:47:38 +0100841 if (unicast_packet->header.packet_type == BAT_UNICAST &&
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000842 atomic_read(&bat_priv->fragmentation) &&
Marek Lindnerd0072602011-01-19 20:01:44 +0000843 skb->len > neigh_node->if_incoming->net_dev->mtu) {
844 ret = frag_send_skb(skb, bat_priv,
845 neigh_node->if_incoming, neigh_node->addr);
846 goto out;
847 }
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000848
Sven Eckelmann76543d12011-11-20 15:47:38 +0100849 if (unicast_packet->header.packet_type == BAT_UNICAST_FRAG &&
Marek Lindnerd0072602011-01-19 20:01:44 +0000850 frag_can_reassemble(skb, neigh_node->if_incoming->net_dev->mtu)) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000851
852 ret = frag_reassemble_skb(skb, bat_priv, &new_skb);
853
854 if (ret == NET_RX_DROP)
Marek Lindner44524fc2011-02-10 14:33:53 +0000855 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000856
857 /* packet was buffered for late merge */
Marek Lindner44524fc2011-02-10 14:33:53 +0000858 if (!new_skb) {
859 ret = NET_RX_SUCCESS;
860 goto out;
861 }
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000862
863 skb = new_skb;
864 unicast_packet = (struct unicast_packet *)skb->data;
865 }
866
867 /* decrement ttl */
Sven Eckelmann76543d12011-11-20 15:47:38 +0100868 unicast_packet->header.ttl--;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000869
870 /* route it */
Marek Lindnerd0072602011-01-19 20:01:44 +0000871 send_skb_packet(skb, neigh_node->if_incoming, neigh_node->addr);
Marek Lindner44524fc2011-02-10 14:33:53 +0000872 ret = NET_RX_SUCCESS;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000873
Marek Lindner44524fc2011-02-10 14:33:53 +0000874out:
875 if (neigh_node)
876 neigh_node_free_ref(neigh_node);
877 if (orig_node)
Marek Lindner7b36e8e2011-02-18 12:28:10 +0000878 orig_node_free_ref(orig_node);
Marek Lindner44524fc2011-02-10 14:33:53 +0000879 return ret;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000880}
881
Antonio Quartullia73105b2011-04-27 14:27:44 +0200882static int check_unicast_ttvn(struct bat_priv *bat_priv,
883 struct sk_buff *skb) {
884 uint8_t curr_ttvn;
885 struct orig_node *orig_node;
886 struct ethhdr *ethhdr;
887 struct hard_iface *primary_if;
888 struct unicast_packet *unicast_packet;
Antonio Quartullicc47f662011-04-27 14:27:57 +0200889 bool tt_poss_change;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200890
891 /* I could need to modify it */
892 if (skb_cow(skb, sizeof(struct unicast_packet)) < 0)
893 return 0;
894
895 unicast_packet = (struct unicast_packet *)skb->data;
896
Antonio Quartullicc47f662011-04-27 14:27:57 +0200897 if (is_my_mac(unicast_packet->dest)) {
898 tt_poss_change = bat_priv->tt_poss_change;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200899 curr_ttvn = (uint8_t)atomic_read(&bat_priv->ttvn);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200900 } else {
Antonio Quartullia73105b2011-04-27 14:27:44 +0200901 orig_node = orig_hash_find(bat_priv, unicast_packet->dest);
902
903 if (!orig_node)
904 return 0;
905
906 curr_ttvn = (uint8_t)atomic_read(&orig_node->last_ttvn);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200907 tt_poss_change = orig_node->tt_poss_change;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200908 orig_node_free_ref(orig_node);
909 }
910
911 /* Check whether I have to reroute the packet */
Antonio Quartullicc47f662011-04-27 14:27:57 +0200912 if (seq_before(unicast_packet->ttvn, curr_ttvn) || tt_poss_change) {
Antonio Quartullia73105b2011-04-27 14:27:44 +0200913 /* Linearize the skb before accessing it */
914 if (skb_linearize(skb) < 0)
915 return 0;
916
917 ethhdr = (struct ethhdr *)(skb->data +
918 sizeof(struct unicast_packet));
Antonio Quartulli3d393e42011-07-07 15:35:37 +0200919 orig_node = transtable_search(bat_priv, NULL, ethhdr->h_dest);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200920
921 if (!orig_node) {
922 if (!is_my_client(bat_priv, ethhdr->h_dest))
923 return 0;
924 primary_if = primary_if_get_selected(bat_priv);
925 if (!primary_if)
926 return 0;
927 memcpy(unicast_packet->dest,
928 primary_if->net_dev->dev_addr, ETH_ALEN);
929 hardif_free_ref(primary_if);
930 } else {
931 memcpy(unicast_packet->dest, orig_node->orig,
932 ETH_ALEN);
933 curr_ttvn = (uint8_t)
934 atomic_read(&orig_node->last_ttvn);
935 orig_node_free_ref(orig_node);
936 }
937
938 bat_dbg(DBG_ROUTES, bat_priv, "TTVN mismatch (old_ttvn %u "
939 "new_ttvn %u)! Rerouting unicast packet (for %pM) to "
940 "%pM\n", unicast_packet->ttvn, curr_ttvn,
941 ethhdr->h_dest, unicast_packet->dest);
942
943 unicast_packet->ttvn = curr_ttvn;
944 }
945 return 1;
946}
947
Marek Lindnere6c10f42011-02-18 12:33:20 +0000948int recv_unicast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000949{
Antonio Quartullia73105b2011-04-27 14:27:44 +0200950 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000951 struct unicast_packet *unicast_packet;
Sven Eckelmann704509b2011-05-14 23:14:54 +0200952 int hdr_size = sizeof(*unicast_packet);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000953
954 if (check_unicast_packet(skb, hdr_size) < 0)
955 return NET_RX_DROP;
956
Antonio Quartullia73105b2011-04-27 14:27:44 +0200957 if (!check_unicast_ttvn(bat_priv, skb))
958 return NET_RX_DROP;
959
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000960 unicast_packet = (struct unicast_packet *)skb->data;
961
962 /* packet for me */
963 if (is_my_mac(unicast_packet->dest)) {
964 interface_rx(recv_if->soft_iface, skb, recv_if, hdr_size);
965 return NET_RX_SUCCESS;
966 }
967
Linus Lüssing7cefb142011-03-02 17:39:31 +0000968 return route_unicast_packet(skb, recv_if);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000969}
970
Marek Lindnere6c10f42011-02-18 12:33:20 +0000971int recv_ucast_frag_packet(struct sk_buff *skb, struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000972{
973 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
974 struct unicast_frag_packet *unicast_packet;
Sven Eckelmann704509b2011-05-14 23:14:54 +0200975 int hdr_size = sizeof(*unicast_packet);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000976 struct sk_buff *new_skb = NULL;
977 int ret;
978
979 if (check_unicast_packet(skb, hdr_size) < 0)
980 return NET_RX_DROP;
981
Antonio Quartullia73105b2011-04-27 14:27:44 +0200982 if (!check_unicast_ttvn(bat_priv, skb))
983 return NET_RX_DROP;
984
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000985 unicast_packet = (struct unicast_frag_packet *)skb->data;
986
987 /* packet for me */
988 if (is_my_mac(unicast_packet->dest)) {
989
990 ret = frag_reassemble_skb(skb, bat_priv, &new_skb);
991
992 if (ret == NET_RX_DROP)
993 return NET_RX_DROP;
994
995 /* packet was buffered for late merge */
996 if (!new_skb)
997 return NET_RX_SUCCESS;
998
999 interface_rx(recv_if->soft_iface, new_skb, recv_if,
1000 sizeof(struct unicast_packet));
1001 return NET_RX_SUCCESS;
1002 }
1003
Linus Lüssing7cefb142011-03-02 17:39:31 +00001004 return route_unicast_packet(skb, recv_if);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001005}
1006
1007
Marek Lindnere6c10f42011-02-18 12:33:20 +00001008int recv_bcast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001009{
1010 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001011 struct orig_node *orig_node = NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001012 struct bcast_packet *bcast_packet;
1013 struct ethhdr *ethhdr;
Sven Eckelmann704509b2011-05-14 23:14:54 +02001014 int hdr_size = sizeof(*bcast_packet);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001015 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001016 int32_t seq_diff;
1017
1018 /* drop packet if it has not necessary minimum size */
1019 if (unlikely(!pskb_may_pull(skb, hdr_size)))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001020 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001021
1022 ethhdr = (struct ethhdr *)skb_mac_header(skb);
1023
1024 /* packet with broadcast indication but unicast recipient */
1025 if (!is_broadcast_ether_addr(ethhdr->h_dest))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001026 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001027
1028 /* packet with broadcast sender address */
1029 if (is_broadcast_ether_addr(ethhdr->h_source))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001030 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001031
1032 /* ignore broadcasts sent by myself */
1033 if (is_my_mac(ethhdr->h_source))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001034 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001035
1036 bcast_packet = (struct bcast_packet *)skb->data;
1037
1038 /* ignore broadcasts originated by myself */
1039 if (is_my_mac(bcast_packet->orig))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001040 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001041
Sven Eckelmann76543d12011-11-20 15:47:38 +01001042 if (bcast_packet->header.ttl < 2)
Marek Lindnerf3e00082011-01-25 21:52:11 +00001043 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001044
Marek Lindner7aadf882011-02-18 12:28:09 +00001045 orig_node = orig_hash_find(bat_priv, bcast_packet->orig);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001046
1047 if (!orig_node)
Antonio Quartullib5a6f692011-04-16 11:30:57 +02001048 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001049
Marek Lindnerf3e00082011-01-25 21:52:11 +00001050 spin_lock_bh(&orig_node->bcast_seqno_lock);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001051
1052 /* check whether the packet is a duplicate */
Marek Lindnerf3e00082011-01-25 21:52:11 +00001053 if (get_bit_status(orig_node->bcast_bits, orig_node->last_bcast_seqno,
1054 ntohl(bcast_packet->seqno)))
1055 goto spin_unlock;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001056
1057 seq_diff = ntohl(bcast_packet->seqno) - orig_node->last_bcast_seqno;
1058
1059 /* check whether the packet is old and the host just restarted. */
1060 if (window_protected(bat_priv, seq_diff,
Marek Lindnerf3e00082011-01-25 21:52:11 +00001061 &orig_node->bcast_seqno_reset))
1062 goto spin_unlock;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001063
1064 /* mark broadcast in flood history, update window position
1065 * if required. */
1066 if (bit_get_packet(bat_priv, orig_node->bcast_bits, seq_diff, 1))
1067 orig_node->last_bcast_seqno = ntohl(bcast_packet->seqno);
1068
Marek Lindnerf3e00082011-01-25 21:52:11 +00001069 spin_unlock_bh(&orig_node->bcast_seqno_lock);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001070
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001071 /* rebroadcast packet */
Antonio Quartulli86985292011-06-25 19:09:12 +02001072 add_bcast_packet_to_list(bat_priv, skb, 1);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001073
1074 /* broadcast for me */
1075 interface_rx(recv_if->soft_iface, skb, recv_if, hdr_size);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001076 ret = NET_RX_SUCCESS;
1077 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001078
Marek Lindnerf3e00082011-01-25 21:52:11 +00001079spin_unlock:
1080 spin_unlock_bh(&orig_node->bcast_seqno_lock);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001081out:
1082 if (orig_node)
Marek Lindner7b36e8e2011-02-18 12:28:10 +00001083 orig_node_free_ref(orig_node);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001084 return ret;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001085}
1086
Marek Lindnere6c10f42011-02-18 12:33:20 +00001087int recv_vis_packet(struct sk_buff *skb, struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001088{
1089 struct vis_packet *vis_packet;
1090 struct ethhdr *ethhdr;
1091 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Sven Eckelmann704509b2011-05-14 23:14:54 +02001092 int hdr_size = sizeof(*vis_packet);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001093
1094 /* keep skb linear */
1095 if (skb_linearize(skb) < 0)
1096 return NET_RX_DROP;
1097
1098 if (unlikely(!pskb_may_pull(skb, hdr_size)))
1099 return NET_RX_DROP;
1100
1101 vis_packet = (struct vis_packet *)skb->data;
1102 ethhdr = (struct ethhdr *)skb_mac_header(skb);
1103
1104 /* not for me */
1105 if (!is_my_mac(ethhdr->h_dest))
1106 return NET_RX_DROP;
1107
1108 /* ignore own packets */
1109 if (is_my_mac(vis_packet->vis_orig))
1110 return NET_RX_DROP;
1111
1112 if (is_my_mac(vis_packet->sender_orig))
1113 return NET_RX_DROP;
1114
1115 switch (vis_packet->vis_type) {
1116 case VIS_TYPE_SERVER_SYNC:
1117 receive_server_sync_packet(bat_priv, vis_packet,
1118 skb_headlen(skb));
1119 break;
1120
1121 case VIS_TYPE_CLIENT_UPDATE:
1122 receive_client_update_packet(bat_priv, vis_packet,
1123 skb_headlen(skb));
1124 break;
1125
1126 default: /* ignore unknown packet */
1127 break;
1128 }
1129
1130 /* We take a copy of the data in the packet, so we should
1131 always free the skbuf. */
1132 return NET_RX_DROP;
1133}