blob: 015471d801b42eceb554c0ed86d6a49971389774 [file] [log] [blame]
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001/*
Sven Eckelmann567db7b2012-01-01 00:41:38 +01002 * Copyright (C) 2007-2012 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"
Simon Wunderlich23721382012-01-22 20:00:19 +010032#include "bridge_loop_avoidance.h"
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000033
Simon Wunderlicha7f6ee92012-01-22 20:00:18 +010034static int route_unicast_packet(struct sk_buff *skb,
35 struct hard_iface *recv_if);
36
Marek Lindnere6c10f42011-02-18 12:33:20 +000037void slide_own_bcast_window(struct hard_iface *hard_iface)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000038{
Marek Lindnere6c10f42011-02-18 12:33:20 +000039 struct bat_priv *bat_priv = netdev_priv(hard_iface->soft_iface);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000040 struct hashtable_t *hash = bat_priv->orig_hash;
Marek Lindner7aadf882011-02-18 12:28:09 +000041 struct hlist_node *node;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000042 struct hlist_head *head;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000043 struct orig_node *orig_node;
44 unsigned long *word;
Antonio Quartullic90681b2011-10-05 17:05:25 +020045 uint32_t i;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000046 size_t word_index;
47
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000048 for (i = 0; i < hash->size; i++) {
49 head = &hash->table[i];
50
Marek Lindnerfb778ea2011-01-19 20:01:40 +000051 rcu_read_lock();
Marek Lindner7aadf882011-02-18 12:28:09 +000052 hlist_for_each_entry_rcu(orig_node, node, head, hash_entry) {
Marek Lindner2ae2daf2011-01-19 20:01:42 +000053 spin_lock_bh(&orig_node->ogm_cnt_lock);
Marek Lindnere6c10f42011-02-18 12:33:20 +000054 word_index = hard_iface->if_num * NUM_WORDS;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000055 word = &(orig_node->bcast_own[word_index]);
56
57 bit_get_packet(bat_priv, word, 1, 0);
Marek Lindnere6c10f42011-02-18 12:33:20 +000058 orig_node->bcast_own_sum[hard_iface->if_num] =
Sven Eckelmann0079d2c2012-02-04 17:34:52 +010059 bitmap_weight(word, TQ_LOCAL_WINDOW_SIZE);
Marek Lindner2ae2daf2011-01-19 20:01:42 +000060 spin_unlock_bh(&orig_node->ogm_cnt_lock);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000061 }
Marek Lindnerfb778ea2011-01-19 20:01:40 +000062 rcu_read_unlock();
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000063 }
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000064}
65
Marek Lindnerfc957272011-07-30 12:04:12 +020066static void _update_route(struct bat_priv *bat_priv,
67 struct orig_node *orig_node,
68 struct neigh_node *neigh_node)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000069{
Linus Lüssinge1a5382f2011-03-14 22:43:37 +000070 struct neigh_node *curr_router;
71
72 curr_router = orig_node_get_router(orig_node);
Marek Lindnera8e7f4b2010-12-12 21:57:10 +000073
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000074 /* route deleted */
Linus Lüssinge1a5382f2011-03-14 22:43:37 +000075 if ((curr_router) && (!neigh_node)) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000076 bat_dbg(DBG_ROUTES, bat_priv, "Deleting route towards: %pM\n",
77 orig_node->orig);
Antonio Quartulli2dafb492011-05-05 08:42:45 +020078 tt_global_del_orig(bat_priv, orig_node,
Sven Eckelmann7c64fd92012-02-28 10:55:36 +010079 "Deleted route towards originator");
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000080
Linus Lüssinge1a5382f2011-03-14 22:43:37 +000081 /* route added */
82 } else if ((!curr_router) && (neigh_node)) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000083
84 bat_dbg(DBG_ROUTES, bat_priv,
85 "Adding route towards: %pM (via %pM)\n",
86 orig_node->orig, neigh_node->addr);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +000087 /* route changed */
Sven Eckelmannbb899b82011-05-10 11:22:37 +020088 } else if (neigh_node && curr_router) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000089 bat_dbg(DBG_ROUTES, bat_priv,
Sven Eckelmann86ceb362012-03-07 09:07:45 +010090 "Changing route towards: %pM (now via %pM - was via %pM)\n",
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000091 orig_node->orig, neigh_node->addr,
Linus Lüssinge1a5382f2011-03-14 22:43:37 +000092 curr_router->addr);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000093 }
94
Linus Lüssinge1a5382f2011-03-14 22:43:37 +000095 if (curr_router)
96 neigh_node_free_ref(curr_router);
97
98 /* increase refcount of new best neighbor */
Marek Lindner44524fc2011-02-10 14:33:53 +000099 if (neigh_node && !atomic_inc_not_zero(&neigh_node->refcount))
100 neigh_node = NULL;
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000101
102 spin_lock_bh(&orig_node->neigh_list_lock);
103 rcu_assign_pointer(orig_node->router, neigh_node);
104 spin_unlock_bh(&orig_node->neigh_list_lock);
105
106 /* decrease refcount of previous best neighbor */
107 if (curr_router)
108 neigh_node_free_ref(curr_router);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000109}
110
Marek Lindnerfc957272011-07-30 12:04:12 +0200111void update_route(struct bat_priv *bat_priv, struct orig_node *orig_node,
112 struct neigh_node *neigh_node)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000113{
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000114 struct neigh_node *router = NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000115
116 if (!orig_node)
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000117 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000118
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000119 router = orig_node_get_router(orig_node);
120
121 if (router != neigh_node)
Marek Lindnerfc957272011-07-30 12:04:12 +0200122 _update_route(bat_priv, orig_node, neigh_node);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000123
124out:
125 if (router)
126 neigh_node_free_ref(router);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000127}
128
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000129/* caller must hold the neigh_list_lock */
130void bonding_candidate_del(struct orig_node *orig_node,
131 struct neigh_node *neigh_node)
132{
133 /* this neighbor is not part of our candidate list */
134 if (list_empty(&neigh_node->bonding_list))
135 goto out;
136
137 list_del_rcu(&neigh_node->bonding_list);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000138 INIT_LIST_HEAD(&neigh_node->bonding_list);
Marek Lindner44524fc2011-02-10 14:33:53 +0000139 neigh_node_free_ref(neigh_node);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000140 atomic_dec(&orig_node->bond_candidates);
141
142out:
143 return;
144}
145
Marek Lindnerfc957272011-07-30 12:04:12 +0200146void bonding_candidate_add(struct orig_node *orig_node,
147 struct neigh_node *neigh_node)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000148{
149 struct hlist_node *node;
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000150 struct neigh_node *tmp_neigh_node, *router = NULL;
151 uint8_t interference_candidate = 0;
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000152
153 spin_lock_bh(&orig_node->neigh_list_lock);
154
155 /* only consider if it has the same primary address ... */
Marek Lindner39901e72011-02-18 12:28:08 +0000156 if (!compare_eth(orig_node->orig,
157 neigh_node->orig_node->primary_addr))
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000158 goto candidate_del;
159
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000160 router = orig_node_get_router(orig_node);
161 if (!router)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000162 goto candidate_del;
163
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000164 /* ... and is good enough to be considered */
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000165 if (neigh_node->tq_avg < router->tq_avg - BONDING_TQ_THRESHOLD)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000166 goto candidate_del;
167
168 /**
169 * check if we have another candidate with the same mac address or
170 * interface. If we do, we won't select this candidate because of
171 * possible interference.
172 */
173 hlist_for_each_entry_rcu(tmp_neigh_node, node,
174 &orig_node->neigh_list, list) {
175
176 if (tmp_neigh_node == neigh_node)
177 continue;
178
179 /* we only care if the other candidate is even
180 * considered as candidate. */
181 if (list_empty(&tmp_neigh_node->bonding_list))
182 continue;
183
184 if ((neigh_node->if_incoming == tmp_neigh_node->if_incoming) ||
Marek Lindner39901e72011-02-18 12:28:08 +0000185 (compare_eth(neigh_node->addr, tmp_neigh_node->addr))) {
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000186 interference_candidate = 1;
187 break;
188 }
189 }
190
191 /* don't care further if it is an interference candidate */
192 if (interference_candidate)
193 goto candidate_del;
194
195 /* this neighbor already is part of our candidate list */
196 if (!list_empty(&neigh_node->bonding_list))
197 goto out;
198
Marek Lindner44524fc2011-02-10 14:33:53 +0000199 if (!atomic_inc_not_zero(&neigh_node->refcount))
200 goto out;
201
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000202 list_add_rcu(&neigh_node->bonding_list, &orig_node->bond_list);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000203 atomic_inc(&orig_node->bond_candidates);
204 goto out;
205
206candidate_del:
207 bonding_candidate_del(orig_node, neigh_node);
208
209out:
210 spin_unlock_bh(&orig_node->neigh_list_lock);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000211
212 if (router)
213 neigh_node_free_ref(router);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000214}
215
216/* copy primary address for bonding */
Marek Lindnerfc957272011-07-30 12:04:12 +0200217void bonding_save_primary(const struct orig_node *orig_node,
218 struct orig_node *orig_neigh_node,
219 const struct batman_ogm_packet *batman_ogm_packet)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000220{
Marek Lindnerb6da4bf2011-07-29 17:31:50 +0200221 if (!(batman_ogm_packet->flags & PRIMARIES_FIRST_HOP))
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000222 return;
223
224 memcpy(orig_neigh_node->primary_addr, orig_node->orig, ETH_ALEN);
225}
226
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000227/* checks whether the host restarted and is in the protection time.
228 * returns:
229 * 0 if the packet is to be accepted
230 * 1 if the packet is to be ignored.
231 */
Marek Lindnerfc957272011-07-30 12:04:12 +0200232int window_protected(struct bat_priv *bat_priv, int32_t seq_num_diff,
233 unsigned long *last_reset)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000234{
Sven Eckelmann7c64fd92012-02-28 10:55:36 +0100235 if ((seq_num_diff <= -TQ_LOCAL_WINDOW_SIZE) ||
236 (seq_num_diff >= EXPECTED_SEQNO_RANGE)) {
Marek Lindner8c7bf242012-03-17 15:28:33 +0800237 if (!has_timed_out(*last_reset, RESET_PROTECTION_MS))
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000238 return 1;
Marek Lindner8c7bf242012-03-17 15:28:33 +0800239
240 *last_reset = jiffies;
241 bat_dbg(DBG_BATMAN, bat_priv,
242 "old packet received, start protection\n");
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000243 }
Marek Lindner8c7bf242012-03-17 15:28:33 +0800244
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000245 return 0;
246}
247
Marek Lindnerc3e29312012-03-04 16:56:25 +0800248bool check_management_packet(struct sk_buff *skb,
249 struct hard_iface *hard_iface,
250 int header_len)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000251{
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000252 struct ethhdr *ethhdr;
253
254 /* drop packet if it has not necessary minimum size */
Marek Lindnerc3e29312012-03-04 16:56:25 +0800255 if (unlikely(!pskb_may_pull(skb, header_len)))
256 return false;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000257
258 ethhdr = (struct ethhdr *)skb_mac_header(skb);
259
260 /* packet with broadcast indication but unicast recipient */
261 if (!is_broadcast_ether_addr(ethhdr->h_dest))
Marek Lindnerc3e29312012-03-04 16:56:25 +0800262 return false;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000263
264 /* packet with broadcast sender address */
265 if (is_broadcast_ether_addr(ethhdr->h_source))
Marek Lindnerc3e29312012-03-04 16:56:25 +0800266 return false;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000267
268 /* create a copy of the skb, if needed, to modify it. */
269 if (skb_cow(skb, 0) < 0)
Marek Lindnerc3e29312012-03-04 16:56:25 +0800270 return false;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000271
272 /* keep skb linear */
273 if (skb_linearize(skb) < 0)
Marek Lindnerc3e29312012-03-04 16:56:25 +0800274 return false;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000275
Marek Lindnerc3e29312012-03-04 16:56:25 +0800276 return true;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000277}
278
279static int recv_my_icmp_packet(struct bat_priv *bat_priv,
280 struct sk_buff *skb, size_t icmp_len)
281{
Marek Lindner32ae9b22011-04-20 15:40:58 +0200282 struct hard_iface *primary_if = NULL;
Marek Lindner44524fc2011-02-10 14:33:53 +0000283 struct orig_node *orig_node = NULL;
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000284 struct neigh_node *router = NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000285 struct icmp_packet_rr *icmp_packet;
Marek Lindner44524fc2011-02-10 14:33:53 +0000286 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000287
288 icmp_packet = (struct icmp_packet_rr *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000289
290 /* add data to device queue */
291 if (icmp_packet->msg_type != ECHO_REQUEST) {
292 bat_socket_receive_packet(icmp_packet, icmp_len);
Marek Lindner44524fc2011-02-10 14:33:53 +0000293 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000294 }
295
Marek Lindner32ae9b22011-04-20 15:40:58 +0200296 primary_if = primary_if_get_selected(bat_priv);
297 if (!primary_if)
Marek Lindner44524fc2011-02-10 14:33:53 +0000298 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000299
300 /* answer echo request (ping) */
301 /* get routing information */
Marek Lindner7aadf882011-02-18 12:28:09 +0000302 orig_node = orig_hash_find(bat_priv, icmp_packet->orig);
Marek Lindner44524fc2011-02-10 14:33:53 +0000303 if (!orig_node)
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000304 goto out;
Marek Lindner44524fc2011-02-10 14:33:53 +0000305
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000306 router = orig_node_get_router(orig_node);
307 if (!router)
308 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000309
Marek Lindner44524fc2011-02-10 14:33:53 +0000310 /* create a copy of the skb, if needed, to modify it. */
Antonio Quartulli0d125072012-02-18 11:27:34 +0100311 if (skb_cow(skb, ETH_HLEN) < 0)
Marek Lindner44524fc2011-02-10 14:33:53 +0000312 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000313
Marek Lindner44524fc2011-02-10 14:33:53 +0000314 icmp_packet = (struct icmp_packet_rr *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000315
Marek Lindner44524fc2011-02-10 14:33:53 +0000316 memcpy(icmp_packet->dst, icmp_packet->orig, ETH_ALEN);
Marek Lindner32ae9b22011-04-20 15:40:58 +0200317 memcpy(icmp_packet->orig, primary_if->net_dev->dev_addr, ETH_ALEN);
Marek Lindner44524fc2011-02-10 14:33:53 +0000318 icmp_packet->msg_type = ECHO_REPLY;
Sven Eckelmann76543d12011-11-20 15:47:38 +0100319 icmp_packet->header.ttl = TTL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000320
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000321 send_skb_packet(skb, router->if_incoming, router->addr);
Marek Lindner44524fc2011-02-10 14:33:53 +0000322 ret = NET_RX_SUCCESS;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000323
Marek Lindner44524fc2011-02-10 14:33:53 +0000324out:
Marek Lindner32ae9b22011-04-20 15:40:58 +0200325 if (primary_if)
326 hardif_free_ref(primary_if);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000327 if (router)
328 neigh_node_free_ref(router);
Marek Lindner44524fc2011-02-10 14:33:53 +0000329 if (orig_node)
Marek Lindner7b36e8e2011-02-18 12:28:10 +0000330 orig_node_free_ref(orig_node);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000331 return ret;
332}
333
334static int recv_icmp_ttl_exceeded(struct bat_priv *bat_priv,
Simon Wunderlich74ef1152010-12-29 16:15:19 +0000335 struct sk_buff *skb)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000336{
Marek Lindner32ae9b22011-04-20 15:40:58 +0200337 struct hard_iface *primary_if = NULL;
Marek Lindner44524fc2011-02-10 14:33:53 +0000338 struct orig_node *orig_node = NULL;
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000339 struct neigh_node *router = NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000340 struct icmp_packet *icmp_packet;
Marek Lindner44524fc2011-02-10 14:33:53 +0000341 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000342
343 icmp_packet = (struct icmp_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000344
345 /* send TTL exceeded if packet is an echo request (traceroute) */
346 if (icmp_packet->msg_type != ECHO_REQUEST) {
Sven Eckelmann86ceb362012-03-07 09:07:45 +0100347 pr_debug("Warning - can't forward icmp packet from %pM to %pM: ttl exceeded\n",
348 icmp_packet->orig, icmp_packet->dst);
Marek Lindner44524fc2011-02-10 14:33:53 +0000349 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000350 }
351
Marek Lindner32ae9b22011-04-20 15:40:58 +0200352 primary_if = primary_if_get_selected(bat_priv);
353 if (!primary_if)
Marek Lindner44524fc2011-02-10 14:33:53 +0000354 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000355
356 /* get routing information */
Marek Lindner7aadf882011-02-18 12:28:09 +0000357 orig_node = orig_hash_find(bat_priv, icmp_packet->orig);
Marek Lindner44524fc2011-02-10 14:33:53 +0000358 if (!orig_node)
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000359 goto out;
Marek Lindner44524fc2011-02-10 14:33:53 +0000360
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000361 router = orig_node_get_router(orig_node);
362 if (!router)
363 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000364
Marek Lindner44524fc2011-02-10 14:33:53 +0000365 /* create a copy of the skb, if needed, to modify it. */
Antonio Quartulli0d125072012-02-18 11:27:34 +0100366 if (skb_cow(skb, ETH_HLEN) < 0)
Marek Lindner44524fc2011-02-10 14:33:53 +0000367 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000368
Marek Lindner44524fc2011-02-10 14:33:53 +0000369 icmp_packet = (struct icmp_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000370
Marek Lindner44524fc2011-02-10 14:33:53 +0000371 memcpy(icmp_packet->dst, icmp_packet->orig, ETH_ALEN);
Marek Lindner32ae9b22011-04-20 15:40:58 +0200372 memcpy(icmp_packet->orig, primary_if->net_dev->dev_addr, ETH_ALEN);
Marek Lindner44524fc2011-02-10 14:33:53 +0000373 icmp_packet->msg_type = TTL_EXCEEDED;
Sven Eckelmann76543d12011-11-20 15:47:38 +0100374 icmp_packet->header.ttl = TTL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000375
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000376 send_skb_packet(skb, router->if_incoming, router->addr);
Marek Lindner44524fc2011-02-10 14:33:53 +0000377 ret = NET_RX_SUCCESS;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000378
Marek Lindner44524fc2011-02-10 14:33:53 +0000379out:
Marek Lindner32ae9b22011-04-20 15:40:58 +0200380 if (primary_if)
381 hardif_free_ref(primary_if);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000382 if (router)
383 neigh_node_free_ref(router);
Marek Lindner44524fc2011-02-10 14:33:53 +0000384 if (orig_node)
Marek Lindner7b36e8e2011-02-18 12:28:10 +0000385 orig_node_free_ref(orig_node);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000386 return ret;
387}
388
389
Marek Lindnere6c10f42011-02-18 12:33:20 +0000390int recv_icmp_packet(struct sk_buff *skb, struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000391{
392 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
393 struct icmp_packet_rr *icmp_packet;
394 struct ethhdr *ethhdr;
Marek Lindner44524fc2011-02-10 14:33:53 +0000395 struct orig_node *orig_node = NULL;
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000396 struct neigh_node *router = NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000397 int hdr_size = sizeof(struct icmp_packet);
Marek Lindner44524fc2011-02-10 14:33:53 +0000398 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000399
400 /**
401 * we truncate all incoming icmp packets if they don't match our size
402 */
403 if (skb->len >= sizeof(struct icmp_packet_rr))
404 hdr_size = sizeof(struct icmp_packet_rr);
405
406 /* drop packet if it has not necessary minimum size */
407 if (unlikely(!pskb_may_pull(skb, hdr_size)))
Marek Lindner44524fc2011-02-10 14:33:53 +0000408 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000409
410 ethhdr = (struct ethhdr *)skb_mac_header(skb);
411
412 /* packet with unicast indication but broadcast recipient */
413 if (is_broadcast_ether_addr(ethhdr->h_dest))
Marek Lindner44524fc2011-02-10 14:33:53 +0000414 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000415
416 /* packet with broadcast sender address */
417 if (is_broadcast_ether_addr(ethhdr->h_source))
Marek Lindner44524fc2011-02-10 14:33:53 +0000418 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000419
420 /* not for me */
421 if (!is_my_mac(ethhdr->h_dest))
Marek Lindner44524fc2011-02-10 14:33:53 +0000422 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000423
424 icmp_packet = (struct icmp_packet_rr *)skb->data;
425
426 /* add record route information if not full */
427 if ((hdr_size == sizeof(struct icmp_packet_rr)) &&
428 (icmp_packet->rr_cur < BAT_RR_LEN)) {
429 memcpy(&(icmp_packet->rr[icmp_packet->rr_cur]),
Sven Eckelmann7c64fd92012-02-28 10:55:36 +0100430 ethhdr->h_dest, ETH_ALEN);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000431 icmp_packet->rr_cur++;
432 }
433
434 /* packet for me */
435 if (is_my_mac(icmp_packet->dst))
436 return recv_my_icmp_packet(bat_priv, skb, hdr_size);
437
438 /* TTL exceeded */
Sven Eckelmann76543d12011-11-20 15:47:38 +0100439 if (icmp_packet->header.ttl < 2)
Simon Wunderlich74ef1152010-12-29 16:15:19 +0000440 return recv_icmp_ttl_exceeded(bat_priv, skb);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000441
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000442 /* get routing information */
Marek Lindner7aadf882011-02-18 12:28:09 +0000443 orig_node = orig_hash_find(bat_priv, icmp_packet->dst);
Marek Lindner44524fc2011-02-10 14:33:53 +0000444 if (!orig_node)
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000445 goto out;
Marek Lindner44524fc2011-02-10 14:33:53 +0000446
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000447 router = orig_node_get_router(orig_node);
448 if (!router)
449 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000450
Marek Lindner44524fc2011-02-10 14:33:53 +0000451 /* create a copy of the skb, if needed, to modify it. */
Antonio Quartulli0d125072012-02-18 11:27:34 +0100452 if (skb_cow(skb, ETH_HLEN) < 0)
Marek Lindner44524fc2011-02-10 14:33:53 +0000453 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000454
Marek Lindner44524fc2011-02-10 14:33:53 +0000455 icmp_packet = (struct icmp_packet_rr *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000456
Marek Lindner44524fc2011-02-10 14:33:53 +0000457 /* decrement ttl */
Sven Eckelmann76543d12011-11-20 15:47:38 +0100458 icmp_packet->header.ttl--;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000459
Marek Lindner44524fc2011-02-10 14:33:53 +0000460 /* route it */
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000461 send_skb_packet(skb, router->if_incoming, router->addr);
Marek Lindner44524fc2011-02-10 14:33:53 +0000462 ret = NET_RX_SUCCESS;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000463
Marek Lindner44524fc2011-02-10 14:33:53 +0000464out:
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000465 if (router)
466 neigh_node_free_ref(router);
Marek Lindner44524fc2011-02-10 14:33:53 +0000467 if (orig_node)
Marek Lindner7b36e8e2011-02-18 12:28:10 +0000468 orig_node_free_ref(orig_node);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000469 return ret;
470}
471
Linus Lüssing55158622011-03-14 22:43:27 +0000472/* In the bonding case, send the packets in a round
473 * robin fashion over the remaining interfaces.
474 *
475 * This method rotates the bonding list and increases the
476 * returned router's refcount. */
477static struct neigh_node *find_bond_router(struct orig_node *primary_orig,
Sven Eckelmann747e4222011-05-14 23:14:50 +0200478 const struct hard_iface *recv_if)
Linus Lüssing55158622011-03-14 22:43:27 +0000479{
480 struct neigh_node *tmp_neigh_node;
481 struct neigh_node *router = NULL, *first_candidate = NULL;
482
483 rcu_read_lock();
484 list_for_each_entry_rcu(tmp_neigh_node, &primary_orig->bond_list,
485 bonding_list) {
486 if (!first_candidate)
487 first_candidate = tmp_neigh_node;
488
489 /* recv_if == NULL on the first node. */
490 if (tmp_neigh_node->if_incoming == recv_if)
491 continue;
492
493 if (!atomic_inc_not_zero(&tmp_neigh_node->refcount))
494 continue;
495
496 router = tmp_neigh_node;
497 break;
498 }
499
500 /* use the first candidate if nothing was found. */
501 if (!router && first_candidate &&
502 atomic_inc_not_zero(&first_candidate->refcount))
503 router = first_candidate;
504
505 if (!router)
506 goto out;
507
508 /* selected should point to the next element
509 * after the current router */
510 spin_lock_bh(&primary_orig->neigh_list_lock);
511 /* this is a list_move(), which unfortunately
512 * does not exist as rcu version */
513 list_del_rcu(&primary_orig->bond_list);
514 list_add_rcu(&primary_orig->bond_list,
515 &router->bonding_list);
516 spin_unlock_bh(&primary_orig->neigh_list_lock);
517
518out:
519 rcu_read_unlock();
520 return router;
521}
522
523/* Interface Alternating: Use the best of the
524 * remaining candidates which are not using
525 * this interface.
526 *
527 * Increases the returned router's refcount */
528static struct neigh_node *find_ifalter_router(struct orig_node *primary_orig,
Sven Eckelmann747e4222011-05-14 23:14:50 +0200529 const struct hard_iface *recv_if)
Linus Lüssing55158622011-03-14 22:43:27 +0000530{
531 struct neigh_node *tmp_neigh_node;
532 struct neigh_node *router = NULL, *first_candidate = NULL;
533
534 rcu_read_lock();
535 list_for_each_entry_rcu(tmp_neigh_node, &primary_orig->bond_list,
536 bonding_list) {
537 if (!first_candidate)
538 first_candidate = tmp_neigh_node;
539
540 /* recv_if == NULL on the first node. */
541 if (tmp_neigh_node->if_incoming == recv_if)
542 continue;
543
544 if (!atomic_inc_not_zero(&tmp_neigh_node->refcount))
545 continue;
546
547 /* if we don't have a router yet
548 * or this one is better, choose it. */
549 if ((!router) ||
550 (tmp_neigh_node->tq_avg > router->tq_avg)) {
551 /* decrement refcount of
552 * previously selected router */
553 if (router)
554 neigh_node_free_ref(router);
555
556 router = tmp_neigh_node;
557 atomic_inc_not_zero(&router->refcount);
558 }
559
560 neigh_node_free_ref(tmp_neigh_node);
561 }
562
563 /* use the first candidate if nothing was found. */
564 if (!router && first_candidate &&
565 atomic_inc_not_zero(&first_candidate->refcount))
566 router = first_candidate;
567
568 rcu_read_unlock();
569 return router;
570}
571
Antonio Quartullia73105b2011-04-27 14:27:44 +0200572int recv_tt_query(struct sk_buff *skb, struct hard_iface *recv_if)
573{
574 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
575 struct tt_query_packet *tt_query;
Antonio Quartulli8b7342d2011-10-16 20:32:03 +0200576 uint16_t tt_len;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200577 struct ethhdr *ethhdr;
578
579 /* drop packet if it has not necessary minimum size */
580 if (unlikely(!pskb_may_pull(skb, sizeof(struct tt_query_packet))))
581 goto out;
582
583 /* I could need to modify it */
584 if (skb_cow(skb, sizeof(struct tt_query_packet)) < 0)
585 goto out;
586
587 ethhdr = (struct ethhdr *)skb_mac_header(skb);
588
589 /* packet with unicast indication but broadcast recipient */
590 if (is_broadcast_ether_addr(ethhdr->h_dest))
591 goto out;
592
593 /* packet with broadcast sender address */
594 if (is_broadcast_ether_addr(ethhdr->h_source))
595 goto out;
596
597 tt_query = (struct tt_query_packet *)skb->data;
598
599 tt_query->tt_data = ntohs(tt_query->tt_data);
600
601 switch (tt_query->flags & TT_QUERY_TYPE_MASK) {
602 case TT_REQUEST:
603 /* If we cannot provide an answer the tt_request is
604 * forwarded */
605 if (!send_tt_response(bat_priv, tt_query)) {
606 bat_dbg(DBG_TT, bat_priv,
607 "Routing TT_REQUEST to %pM [%c]\n",
608 tt_query->dst,
609 (tt_query->flags & TT_FULL_TABLE ? 'F' : '.'));
610 tt_query->tt_data = htons(tt_query->tt_data);
611 return route_unicast_packet(skb, recv_if);
612 }
613 break;
614 case TT_RESPONSE:
Antonio Quartullidc58fe32011-10-16 20:32:02 +0200615 if (is_my_mac(tt_query->dst)) {
616 /* packet needs to be linearized to access the TT
617 * changes */
618 if (skb_linearize(skb) < 0)
619 goto out;
Antonio Quartulli2c995ff2012-06-19 09:26:39 +0000620 /* skb_linearize() possibly changed skb->data */
621 tt_query = (struct tt_query_packet *)skb->data;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200622
Antonio Quartulli8b7342d2011-10-16 20:32:03 +0200623 tt_len = tt_query->tt_data * sizeof(struct tt_change);
624
625 /* Ensure we have all the claimed data */
626 if (unlikely(skb_headlen(skb) <
Antonio Quartulli69497c12011-12-02 17:38:52 +0100627 sizeof(struct tt_query_packet) + tt_len))
Antonio Quartulli8b7342d2011-10-16 20:32:03 +0200628 goto out;
629
Antonio Quartullia73105b2011-04-27 14:27:44 +0200630 handle_tt_response(bat_priv, tt_query);
Antonio Quartullidc58fe32011-10-16 20:32:02 +0200631 } else {
Antonio Quartullia73105b2011-04-27 14:27:44 +0200632 bat_dbg(DBG_TT, bat_priv,
633 "Routing TT_RESPONSE to %pM [%c]\n",
634 tt_query->dst,
635 (tt_query->flags & TT_FULL_TABLE ? 'F' : '.'));
636 tt_query->tt_data = htons(tt_query->tt_data);
637 return route_unicast_packet(skb, recv_if);
638 }
639 break;
640 }
641
642out:
643 /* returning NET_RX_DROP will make the caller function kfree the skb */
644 return NET_RX_DROP;
645}
646
Antonio Quartullicc47f662011-04-27 14:27:57 +0200647int recv_roam_adv(struct sk_buff *skb, struct hard_iface *recv_if)
648{
649 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
650 struct roam_adv_packet *roam_adv_packet;
651 struct orig_node *orig_node;
652 struct ethhdr *ethhdr;
653
654 /* drop packet if it has not necessary minimum size */
655 if (unlikely(!pskb_may_pull(skb, sizeof(struct roam_adv_packet))))
656 goto out;
657
658 ethhdr = (struct ethhdr *)skb_mac_header(skb);
659
660 /* packet with unicast indication but broadcast recipient */
661 if (is_broadcast_ether_addr(ethhdr->h_dest))
662 goto out;
663
664 /* packet with broadcast sender address */
665 if (is_broadcast_ether_addr(ethhdr->h_source))
666 goto out;
667
668 roam_adv_packet = (struct roam_adv_packet *)skb->data;
669
670 if (!is_my_mac(roam_adv_packet->dst))
671 return route_unicast_packet(skb, recv_if);
672
Simon Wunderlich20ff9d52012-01-22 20:00:23 +0100673 /* check if it is a backbone gateway. we don't accept
674 * roaming advertisement from it, as it has the same
675 * entries as we have.
676 */
677 if (bla_is_backbone_gw_orig(bat_priv, roam_adv_packet->src))
678 goto out;
679
Antonio Quartullicc47f662011-04-27 14:27:57 +0200680 orig_node = orig_hash_find(bat_priv, roam_adv_packet->src);
681 if (!orig_node)
682 goto out;
683
Sven Eckelmann86ceb362012-03-07 09:07:45 +0100684 bat_dbg(DBG_TT, bat_priv,
685 "Received ROAMING_ADV from %pM (client %pM)\n",
686 roam_adv_packet->src, roam_adv_packet->client);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200687
688 tt_global_add(bat_priv, orig_node, roam_adv_packet->client,
Antonio Quartullibc279082011-07-07 15:35:35 +0200689 atomic_read(&orig_node->last_ttvn) + 1, true, false);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200690
691 /* Roaming phase starts: I have new information but the ttvn has not
692 * been incremented yet. This flag will make me check all the incoming
693 * packets for the correct destination. */
694 bat_priv->tt_poss_change = true;
695
696 orig_node_free_ref(orig_node);
697out:
698 /* returning NET_RX_DROP will make the caller function kfree the skb */
699 return NET_RX_DROP;
700}
701
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000702/* find a suitable router for this originator, and use
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000703 * bonding if possible. increases the found neighbors
704 * refcount.*/
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000705struct neigh_node *find_router(struct bat_priv *bat_priv,
706 struct orig_node *orig_node,
Sven Eckelmann747e4222011-05-14 23:14:50 +0200707 const struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000708{
709 struct orig_node *primary_orig_node;
710 struct orig_node *router_orig;
Linus Lüssing55158622011-03-14 22:43:27 +0000711 struct neigh_node *router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000712 static uint8_t zero_mac[ETH_ALEN] = {0, 0, 0, 0, 0, 0};
713 int bonding_enabled;
714
715 if (!orig_node)
716 return NULL;
717
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000718 router = orig_node_get_router(orig_node);
719 if (!router)
Marek Lindner01df2b62011-05-05 14:14:46 +0200720 goto err;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000721
722 /* without bonding, the first node should
723 * always choose the default router. */
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000724 bonding_enabled = atomic_read(&bat_priv->bonding);
725
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000726 rcu_read_lock();
727 /* select default router to output */
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000728 router_orig = router->orig_node;
Marek Lindner01df2b62011-05-05 14:14:46 +0200729 if (!router_orig)
730 goto err_unlock;
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000731
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000732 if ((!recv_if) && (!bonding_enabled))
733 goto return_router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000734
735 /* if we have something in the primary_addr, we can search
736 * for a potential bonding candidate. */
Marek Lindner39901e72011-02-18 12:28:08 +0000737 if (compare_eth(router_orig->primary_addr, zero_mac))
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000738 goto return_router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000739
740 /* find the orig_node which has the primary interface. might
741 * even be the same as our router_orig in many cases */
742
Marek Lindner39901e72011-02-18 12:28:08 +0000743 if (compare_eth(router_orig->primary_addr, router_orig->orig)) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000744 primary_orig_node = router_orig;
745 } else {
Marek Lindner7aadf882011-02-18 12:28:09 +0000746 primary_orig_node = orig_hash_find(bat_priv,
747 router_orig->primary_addr);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000748 if (!primary_orig_node)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000749 goto return_router;
Marek Lindner7aadf882011-02-18 12:28:09 +0000750
Marek Lindner7b36e8e2011-02-18 12:28:10 +0000751 orig_node_free_ref(primary_orig_node);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000752 }
753
754 /* with less than 2 candidates, we can't do any
755 * bonding and prefer the original router. */
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000756 if (atomic_read(&primary_orig_node->bond_candidates) < 2)
757 goto return_router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000758
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000759 /* all nodes between should choose a candidate which
760 * is is not on the interface where the packet came
761 * in. */
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000762
Marek Lindner44524fc2011-02-10 14:33:53 +0000763 neigh_node_free_ref(router);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000764
Linus Lüssing55158622011-03-14 22:43:27 +0000765 if (bonding_enabled)
766 router = find_bond_router(primary_orig_node, recv_if);
767 else
768 router = find_ifalter_router(primary_orig_node, recv_if);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000769
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000770return_router:
Antonio Quartullie2cbc112011-05-08 20:52:57 +0200771 if (router && router->if_incoming->if_status != IF_ACTIVE)
772 goto err_unlock;
773
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000774 rcu_read_unlock();
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000775 return router;
Marek Lindner01df2b62011-05-05 14:14:46 +0200776err_unlock:
777 rcu_read_unlock();
778err:
779 if (router)
780 neigh_node_free_ref(router);
781 return NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000782}
783
784static int check_unicast_packet(struct sk_buff *skb, int hdr_size)
785{
786 struct ethhdr *ethhdr;
787
788 /* drop packet if it has not necessary minimum size */
789 if (unlikely(!pskb_may_pull(skb, hdr_size)))
790 return -1;
791
792 ethhdr = (struct ethhdr *)skb_mac_header(skb);
793
794 /* packet with unicast indication but broadcast recipient */
795 if (is_broadcast_ether_addr(ethhdr->h_dest))
796 return -1;
797
798 /* packet with broadcast sender address */
799 if (is_broadcast_ether_addr(ethhdr->h_source))
800 return -1;
801
802 /* not for me */
803 if (!is_my_mac(ethhdr->h_dest))
804 return -1;
805
806 return 0;
807}
808
Simon Wunderlicha7f6ee92012-01-22 20:00:18 +0100809static int route_unicast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000810{
811 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Marek Lindner44524fc2011-02-10 14:33:53 +0000812 struct orig_node *orig_node = NULL;
813 struct neigh_node *neigh_node = NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000814 struct unicast_packet *unicast_packet;
815 struct ethhdr *ethhdr = (struct ethhdr *)skb_mac_header(skb);
Marek Lindner44524fc2011-02-10 14:33:53 +0000816 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000817 struct sk_buff *new_skb;
818
819 unicast_packet = (struct unicast_packet *)skb->data;
820
821 /* TTL exceeded */
Sven Eckelmann76543d12011-11-20 15:47:38 +0100822 if (unicast_packet->header.ttl < 2) {
Sven Eckelmann86ceb362012-03-07 09:07:45 +0100823 pr_debug("Warning - can't forward unicast packet from %pM to %pM: ttl exceeded\n",
824 ethhdr->h_source, unicast_packet->dest);
Marek Lindner44524fc2011-02-10 14:33:53 +0000825 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000826 }
827
828 /* get routing information */
Marek Lindner7aadf882011-02-18 12:28:09 +0000829 orig_node = orig_hash_find(bat_priv, unicast_packet->dest);
830
Marek Lindner44524fc2011-02-10 14:33:53 +0000831 if (!orig_node)
Antonio Quartullib5a6f692011-04-16 11:30:57 +0200832 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000833
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000834 /* find_router() increases neigh_nodes refcount if found. */
Marek Lindner44524fc2011-02-10 14:33:53 +0000835 neigh_node = find_router(bat_priv, orig_node, recv_if);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000836
Marek Lindnerd0072602011-01-19 20:01:44 +0000837 if (!neigh_node)
Marek Lindner44524fc2011-02-10 14:33:53 +0000838 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000839
840 /* create a copy of the skb, if needed, to modify it. */
Antonio Quartulli0d125072012-02-18 11:27:34 +0100841 if (skb_cow(skb, ETH_HLEN) < 0)
Marek Lindner44524fc2011-02-10 14:33:53 +0000842 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000843
844 unicast_packet = (struct unicast_packet *)skb->data;
845
Sven Eckelmann76543d12011-11-20 15:47:38 +0100846 if (unicast_packet->header.packet_type == BAT_UNICAST &&
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000847 atomic_read(&bat_priv->fragmentation) &&
Marek Lindnerd0072602011-01-19 20:01:44 +0000848 skb->len > neigh_node->if_incoming->net_dev->mtu) {
849 ret = frag_send_skb(skb, bat_priv,
850 neigh_node->if_incoming, neigh_node->addr);
851 goto out;
852 }
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000853
Sven Eckelmann76543d12011-11-20 15:47:38 +0100854 if (unicast_packet->header.packet_type == BAT_UNICAST_FRAG &&
Marek Lindnerd0072602011-01-19 20:01:44 +0000855 frag_can_reassemble(skb, neigh_node->if_incoming->net_dev->mtu)) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000856
857 ret = frag_reassemble_skb(skb, bat_priv, &new_skb);
858
859 if (ret == NET_RX_DROP)
Marek Lindner44524fc2011-02-10 14:33:53 +0000860 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000861
862 /* packet was buffered for late merge */
Marek Lindner44524fc2011-02-10 14:33:53 +0000863 if (!new_skb) {
864 ret = NET_RX_SUCCESS;
865 goto out;
866 }
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000867
868 skb = new_skb;
869 unicast_packet = (struct unicast_packet *)skb->data;
870 }
871
872 /* decrement ttl */
Sven Eckelmann76543d12011-11-20 15:47:38 +0100873 unicast_packet->header.ttl--;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000874
875 /* route it */
Marek Lindnerd0072602011-01-19 20:01:44 +0000876 send_skb_packet(skb, neigh_node->if_incoming, neigh_node->addr);
Marek Lindner44524fc2011-02-10 14:33:53 +0000877 ret = NET_RX_SUCCESS;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000878
Marek Lindner44524fc2011-02-10 14:33:53 +0000879out:
880 if (neigh_node)
881 neigh_node_free_ref(neigh_node);
882 if (orig_node)
Marek Lindner7b36e8e2011-02-18 12:28:10 +0000883 orig_node_free_ref(orig_node);
Marek Lindner44524fc2011-02-10 14:33:53 +0000884 return ret;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000885}
886
Antonio Quartullia73105b2011-04-27 14:27:44 +0200887static int check_unicast_ttvn(struct bat_priv *bat_priv,
888 struct sk_buff *skb) {
889 uint8_t curr_ttvn;
890 struct orig_node *orig_node;
891 struct ethhdr *ethhdr;
892 struct hard_iface *primary_if;
893 struct unicast_packet *unicast_packet;
Antonio Quartullicc47f662011-04-27 14:27:57 +0200894 bool tt_poss_change;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200895
896 /* I could need to modify it */
897 if (skb_cow(skb, sizeof(struct unicast_packet)) < 0)
898 return 0;
899
900 unicast_packet = (struct unicast_packet *)skb->data;
901
Antonio Quartullicc47f662011-04-27 14:27:57 +0200902 if (is_my_mac(unicast_packet->dest)) {
903 tt_poss_change = bat_priv->tt_poss_change;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200904 curr_ttvn = (uint8_t)atomic_read(&bat_priv->ttvn);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200905 } else {
Antonio Quartullia73105b2011-04-27 14:27:44 +0200906 orig_node = orig_hash_find(bat_priv, unicast_packet->dest);
907
908 if (!orig_node)
909 return 0;
910
911 curr_ttvn = (uint8_t)atomic_read(&orig_node->last_ttvn);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200912 tt_poss_change = orig_node->tt_poss_change;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200913 orig_node_free_ref(orig_node);
914 }
915
916 /* Check whether I have to reroute the packet */
Antonio Quartullicc47f662011-04-27 14:27:57 +0200917 if (seq_before(unicast_packet->ttvn, curr_ttvn) || tt_poss_change) {
Antonio Quartulli8710e262012-03-16 11:52:31 +0100918 /* check if there is enough data before accessing it */
919 if (pskb_may_pull(skb, sizeof(struct unicast_packet) +
920 ETH_HLEN) < 0)
Antonio Quartullia73105b2011-04-27 14:27:44 +0200921 return 0;
922
923 ethhdr = (struct ethhdr *)(skb->data +
924 sizeof(struct unicast_packet));
Antonio Quartulli3275e7c2012-03-16 18:03:28 +0100925
926 /* we don't have an updated route for this client, so we should
927 * not try to reroute the packet!!
928 */
929 if (tt_global_client_is_roaming(bat_priv, ethhdr->h_dest))
930 return 1;
931
Antonio Quartulli3d393e42011-07-07 15:35:37 +0200932 orig_node = transtable_search(bat_priv, NULL, ethhdr->h_dest);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200933
934 if (!orig_node) {
935 if (!is_my_client(bat_priv, ethhdr->h_dest))
936 return 0;
937 primary_if = primary_if_get_selected(bat_priv);
938 if (!primary_if)
939 return 0;
940 memcpy(unicast_packet->dest,
941 primary_if->net_dev->dev_addr, ETH_ALEN);
942 hardif_free_ref(primary_if);
943 } else {
944 memcpy(unicast_packet->dest, orig_node->orig,
945 ETH_ALEN);
946 curr_ttvn = (uint8_t)
947 atomic_read(&orig_node->last_ttvn);
948 orig_node_free_ref(orig_node);
949 }
950
Sven Eckelmann86ceb362012-03-07 09:07:45 +0100951 bat_dbg(DBG_ROUTES, bat_priv,
952 "TTVN mismatch (old_ttvn %u new_ttvn %u)! Rerouting unicast packet (for %pM) to %pM\n",
953 unicast_packet->ttvn, curr_ttvn, ethhdr->h_dest,
954 unicast_packet->dest);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200955
956 unicast_packet->ttvn = curr_ttvn;
957 }
958 return 1;
959}
960
Marek Lindnere6c10f42011-02-18 12:33:20 +0000961int recv_unicast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000962{
Antonio Quartullia73105b2011-04-27 14:27:44 +0200963 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000964 struct unicast_packet *unicast_packet;
Sven Eckelmann704509b2011-05-14 23:14:54 +0200965 int hdr_size = sizeof(*unicast_packet);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000966
967 if (check_unicast_packet(skb, hdr_size) < 0)
968 return NET_RX_DROP;
969
Antonio Quartullia73105b2011-04-27 14:27:44 +0200970 if (!check_unicast_ttvn(bat_priv, skb))
971 return NET_RX_DROP;
972
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000973 unicast_packet = (struct unicast_packet *)skb->data;
974
975 /* packet for me */
976 if (is_my_mac(unicast_packet->dest)) {
977 interface_rx(recv_if->soft_iface, skb, recv_if, hdr_size);
978 return NET_RX_SUCCESS;
979 }
980
Linus Lüssing7cefb142011-03-02 17:39:31 +0000981 return route_unicast_packet(skb, recv_if);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000982}
983
Marek Lindnere6c10f42011-02-18 12:33:20 +0000984int recv_ucast_frag_packet(struct sk_buff *skb, struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000985{
986 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
987 struct unicast_frag_packet *unicast_packet;
Sven Eckelmann704509b2011-05-14 23:14:54 +0200988 int hdr_size = sizeof(*unicast_packet);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000989 struct sk_buff *new_skb = NULL;
990 int ret;
991
992 if (check_unicast_packet(skb, hdr_size) < 0)
993 return NET_RX_DROP;
994
Antonio Quartullia73105b2011-04-27 14:27:44 +0200995 if (!check_unicast_ttvn(bat_priv, skb))
996 return NET_RX_DROP;
997
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000998 unicast_packet = (struct unicast_frag_packet *)skb->data;
999
1000 /* packet for me */
1001 if (is_my_mac(unicast_packet->dest)) {
1002
1003 ret = frag_reassemble_skb(skb, bat_priv, &new_skb);
1004
1005 if (ret == NET_RX_DROP)
1006 return NET_RX_DROP;
1007
1008 /* packet was buffered for late merge */
1009 if (!new_skb)
1010 return NET_RX_SUCCESS;
1011
1012 interface_rx(recv_if->soft_iface, new_skb, recv_if,
1013 sizeof(struct unicast_packet));
1014 return NET_RX_SUCCESS;
1015 }
1016
Linus Lüssing7cefb142011-03-02 17:39:31 +00001017 return route_unicast_packet(skb, recv_if);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001018}
1019
1020
Marek Lindnere6c10f42011-02-18 12:33:20 +00001021int recv_bcast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001022{
1023 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001024 struct orig_node *orig_node = NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001025 struct bcast_packet *bcast_packet;
1026 struct ethhdr *ethhdr;
Sven Eckelmann704509b2011-05-14 23:14:54 +02001027 int hdr_size = sizeof(*bcast_packet);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001028 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001029 int32_t seq_diff;
1030
1031 /* drop packet if it has not necessary minimum size */
1032 if (unlikely(!pskb_may_pull(skb, hdr_size)))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001033 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001034
1035 ethhdr = (struct ethhdr *)skb_mac_header(skb);
1036
1037 /* packet with broadcast indication but unicast recipient */
1038 if (!is_broadcast_ether_addr(ethhdr->h_dest))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001039 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001040
1041 /* packet with broadcast sender address */
1042 if (is_broadcast_ether_addr(ethhdr->h_source))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001043 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001044
1045 /* ignore broadcasts sent by myself */
1046 if (is_my_mac(ethhdr->h_source))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001047 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001048
1049 bcast_packet = (struct bcast_packet *)skb->data;
1050
1051 /* ignore broadcasts originated by myself */
1052 if (is_my_mac(bcast_packet->orig))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001053 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001054
Sven Eckelmann76543d12011-11-20 15:47:38 +01001055 if (bcast_packet->header.ttl < 2)
Marek Lindnerf3e00082011-01-25 21:52:11 +00001056 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001057
Marek Lindner7aadf882011-02-18 12:28:09 +00001058 orig_node = orig_hash_find(bat_priv, bcast_packet->orig);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001059
1060 if (!orig_node)
Antonio Quartullib5a6f692011-04-16 11:30:57 +02001061 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001062
Marek Lindnerf3e00082011-01-25 21:52:11 +00001063 spin_lock_bh(&orig_node->bcast_seqno_lock);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001064
1065 /* check whether the packet is a duplicate */
Sven Eckelmann0079d2c2012-02-04 17:34:52 +01001066 if (bat_test_bit(orig_node->bcast_bits, orig_node->last_bcast_seqno,
1067 ntohl(bcast_packet->seqno)))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001068 goto spin_unlock;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001069
1070 seq_diff = ntohl(bcast_packet->seqno) - orig_node->last_bcast_seqno;
1071
1072 /* check whether the packet is old and the host just restarted. */
1073 if (window_protected(bat_priv, seq_diff,
Marek Lindnerf3e00082011-01-25 21:52:11 +00001074 &orig_node->bcast_seqno_reset))
1075 goto spin_unlock;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001076
1077 /* mark broadcast in flood history, update window position
1078 * if required. */
1079 if (bit_get_packet(bat_priv, orig_node->bcast_bits, seq_diff, 1))
1080 orig_node->last_bcast_seqno = ntohl(bcast_packet->seqno);
1081
Marek Lindnerf3e00082011-01-25 21:52:11 +00001082 spin_unlock_bh(&orig_node->bcast_seqno_lock);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001083
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001084 /* check whether this has been sent by another originator before */
1085 if (bla_check_bcast_duplist(bat_priv, bcast_packet, hdr_size))
1086 goto out;
1087
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001088 /* rebroadcast packet */
Antonio Quartulli86985292011-06-25 19:09:12 +02001089 add_bcast_packet_to_list(bat_priv, skb, 1);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001090
Simon Wunderlich23721382012-01-22 20:00:19 +01001091 /* don't hand the broadcast up if it is from an originator
1092 * from the same backbone.
1093 */
1094 if (bla_is_backbone_gw(skb, orig_node, hdr_size))
1095 goto out;
1096
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001097 /* broadcast for me */
1098 interface_rx(recv_if->soft_iface, skb, recv_if, hdr_size);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001099 ret = NET_RX_SUCCESS;
1100 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001101
Marek Lindnerf3e00082011-01-25 21:52:11 +00001102spin_unlock:
1103 spin_unlock_bh(&orig_node->bcast_seqno_lock);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001104out:
1105 if (orig_node)
Marek Lindner7b36e8e2011-02-18 12:28:10 +00001106 orig_node_free_ref(orig_node);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001107 return ret;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001108}
1109
Marek Lindnere6c10f42011-02-18 12:33:20 +00001110int recv_vis_packet(struct sk_buff *skb, struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001111{
1112 struct vis_packet *vis_packet;
1113 struct ethhdr *ethhdr;
1114 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Sven Eckelmann704509b2011-05-14 23:14:54 +02001115 int hdr_size = sizeof(*vis_packet);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001116
1117 /* keep skb linear */
1118 if (skb_linearize(skb) < 0)
1119 return NET_RX_DROP;
1120
1121 if (unlikely(!pskb_may_pull(skb, hdr_size)))
1122 return NET_RX_DROP;
1123
1124 vis_packet = (struct vis_packet *)skb->data;
1125 ethhdr = (struct ethhdr *)skb_mac_header(skb);
1126
1127 /* not for me */
1128 if (!is_my_mac(ethhdr->h_dest))
1129 return NET_RX_DROP;
1130
1131 /* ignore own packets */
1132 if (is_my_mac(vis_packet->vis_orig))
1133 return NET_RX_DROP;
1134
1135 if (is_my_mac(vis_packet->sender_orig))
1136 return NET_RX_DROP;
1137
1138 switch (vis_packet->vis_type) {
1139 case VIS_TYPE_SERVER_SYNC:
1140 receive_server_sync_packet(bat_priv, vis_packet,
1141 skb_headlen(skb));
1142 break;
1143
1144 case VIS_TYPE_CLIENT_UPDATE:
1145 receive_client_update_packet(bat_priv, vis_packet,
1146 skb_headlen(skb));
1147 break;
1148
1149 default: /* ignore unknown packet */
1150 break;
1151 }
1152
1153 /* We take a copy of the data in the packet, so we should
1154 always free the skbuf. */
1155 return NET_RX_DROP;
1156}