blob: 01b66d4a5aad076fd7eac4d29e6c9bf4b9758ef8 [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"
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,
Sven Eckelmann7c64fd92012-02-28 10:55:36 +010075 "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,
Sven Eckelmann86ceb362012-03-07 09:07:45 +010086 "Changing route towards: %pM (now via %pM - was via %pM)\n",
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000087 orig_node->orig, neigh_node->addr,
Linus Lüssinge1a53822011-03-14 22:43:37 +000088 curr_router->addr);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000089 }
90
Linus Lüssinge1a53822011-03-14 22:43:37 +000091 if (curr_router)
92 neigh_node_free_ref(curr_router);
93
94 /* increase refcount of new best neighbor */
Marek Lindner44524fc2011-02-10 14:33:53 +000095 if (neigh_node && !atomic_inc_not_zero(&neigh_node->refcount))
96 neigh_node = NULL;
Linus Lüssinge1a53822011-03-14 22:43:37 +000097
98 spin_lock_bh(&orig_node->neigh_list_lock);
99 rcu_assign_pointer(orig_node->router, neigh_node);
100 spin_unlock_bh(&orig_node->neigh_list_lock);
101
102 /* decrease refcount of previous best neighbor */
103 if (curr_router)
104 neigh_node_free_ref(curr_router);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000105}
106
Marek Lindnerfc957272011-07-30 12:04:12 +0200107void update_route(struct bat_priv *bat_priv, struct orig_node *orig_node,
108 struct neigh_node *neigh_node)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000109{
Linus Lüssinge1a53822011-03-14 22:43:37 +0000110 struct neigh_node *router = NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000111
112 if (!orig_node)
Linus Lüssinge1a53822011-03-14 22:43:37 +0000113 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000114
Linus Lüssinge1a53822011-03-14 22:43:37 +0000115 router = orig_node_get_router(orig_node);
116
117 if (router != neigh_node)
Marek Lindnerfc957272011-07-30 12:04:12 +0200118 _update_route(bat_priv, orig_node, neigh_node);
Linus Lüssinge1a53822011-03-14 22:43:37 +0000119
120out:
121 if (router)
122 neigh_node_free_ref(router);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000123}
124
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000125/* caller must hold the neigh_list_lock */
126void bonding_candidate_del(struct orig_node *orig_node,
127 struct neigh_node *neigh_node)
128{
129 /* this neighbor is not part of our candidate list */
130 if (list_empty(&neigh_node->bonding_list))
131 goto out;
132
133 list_del_rcu(&neigh_node->bonding_list);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000134 INIT_LIST_HEAD(&neigh_node->bonding_list);
Marek Lindner44524fc2011-02-10 14:33:53 +0000135 neigh_node_free_ref(neigh_node);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000136 atomic_dec(&orig_node->bond_candidates);
137
138out:
139 return;
140}
141
Marek Lindnerfc957272011-07-30 12:04:12 +0200142void bonding_candidate_add(struct orig_node *orig_node,
143 struct neigh_node *neigh_node)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000144{
145 struct hlist_node *node;
Linus Lüssinge1a53822011-03-14 22:43:37 +0000146 struct neigh_node *tmp_neigh_node, *router = NULL;
147 uint8_t interference_candidate = 0;
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000148
149 spin_lock_bh(&orig_node->neigh_list_lock);
150
151 /* only consider if it has the same primary address ... */
Marek Lindner39901e72011-02-18 12:28:08 +0000152 if (!compare_eth(orig_node->orig,
153 neigh_node->orig_node->primary_addr))
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000154 goto candidate_del;
155
Linus Lüssinge1a53822011-03-14 22:43:37 +0000156 router = orig_node_get_router(orig_node);
157 if (!router)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000158 goto candidate_del;
159
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000160 /* ... and is good enough to be considered */
Linus Lüssinge1a53822011-03-14 22:43:37 +0000161 if (neigh_node->tq_avg < router->tq_avg - BONDING_TQ_THRESHOLD)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000162 goto candidate_del;
163
164 /**
165 * check if we have another candidate with the same mac address or
166 * interface. If we do, we won't select this candidate because of
167 * possible interference.
168 */
169 hlist_for_each_entry_rcu(tmp_neigh_node, node,
170 &orig_node->neigh_list, list) {
171
172 if (tmp_neigh_node == neigh_node)
173 continue;
174
175 /* we only care if the other candidate is even
176 * considered as candidate. */
177 if (list_empty(&tmp_neigh_node->bonding_list))
178 continue;
179
180 if ((neigh_node->if_incoming == tmp_neigh_node->if_incoming) ||
Marek Lindner39901e72011-02-18 12:28:08 +0000181 (compare_eth(neigh_node->addr, tmp_neigh_node->addr))) {
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000182 interference_candidate = 1;
183 break;
184 }
185 }
186
187 /* don't care further if it is an interference candidate */
188 if (interference_candidate)
189 goto candidate_del;
190
191 /* this neighbor already is part of our candidate list */
192 if (!list_empty(&neigh_node->bonding_list))
193 goto out;
194
Marek Lindner44524fc2011-02-10 14:33:53 +0000195 if (!atomic_inc_not_zero(&neigh_node->refcount))
196 goto out;
197
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000198 list_add_rcu(&neigh_node->bonding_list, &orig_node->bond_list);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000199 atomic_inc(&orig_node->bond_candidates);
200 goto out;
201
202candidate_del:
203 bonding_candidate_del(orig_node, neigh_node);
204
205out:
206 spin_unlock_bh(&orig_node->neigh_list_lock);
Linus Lüssinge1a53822011-03-14 22:43:37 +0000207
208 if (router)
209 neigh_node_free_ref(router);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000210}
211
212/* copy primary address for bonding */
Marek Lindnerfc957272011-07-30 12:04:12 +0200213void bonding_save_primary(const struct orig_node *orig_node,
214 struct orig_node *orig_neigh_node,
215 const struct batman_ogm_packet *batman_ogm_packet)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000216{
Marek Lindnerb6da4bf2011-07-29 17:31:50 +0200217 if (!(batman_ogm_packet->flags & PRIMARIES_FIRST_HOP))
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000218 return;
219
220 memcpy(orig_neigh_node->primary_addr, orig_node->orig, ETH_ALEN);
221}
222
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000223/* checks whether the host restarted and is in the protection time.
224 * returns:
225 * 0 if the packet is to be accepted
226 * 1 if the packet is to be ignored.
227 */
Marek Lindnerfc957272011-07-30 12:04:12 +0200228int window_protected(struct bat_priv *bat_priv, int32_t seq_num_diff,
229 unsigned long *last_reset)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000230{
Sven Eckelmann7c64fd92012-02-28 10:55:36 +0100231 if ((seq_num_diff <= -TQ_LOCAL_WINDOW_SIZE) ||
232 (seq_num_diff >= EXPECTED_SEQNO_RANGE)) {
Marek Lindner032b7962011-12-20 19:30:40 +0800233 if (has_timed_out(*last_reset, RESET_PROTECTION_MS)) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000234
235 *last_reset = jiffies;
236 bat_dbg(DBG_BATMAN, bat_priv,
237 "old packet received, start protection\n");
238
239 return 0;
240 } else
241 return 1;
242 }
243 return 0;
244}
245
Marek Lindnerfc957272011-07-30 12:04:12 +0200246int recv_bat_ogm_packet(struct sk_buff *skb, struct hard_iface *hard_iface)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000247{
Marek Lindner01c42242011-11-28 21:31:55 +0800248 struct bat_priv *bat_priv = netdev_priv(hard_iface->soft_iface);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000249 struct ethhdr *ethhdr;
250
251 /* drop packet if it has not necessary minimum size */
Marek Lindnerb6da4bf2011-07-29 17:31:50 +0200252 if (unlikely(!pskb_may_pull(skb, BATMAN_OGM_LEN)))
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000253 return NET_RX_DROP;
254
255 ethhdr = (struct ethhdr *)skb_mac_header(skb);
256
257 /* packet with broadcast indication but unicast recipient */
258 if (!is_broadcast_ether_addr(ethhdr->h_dest))
259 return NET_RX_DROP;
260
261 /* packet with broadcast sender address */
262 if (is_broadcast_ether_addr(ethhdr->h_source))
263 return NET_RX_DROP;
264
265 /* create a copy of the skb, if needed, to modify it. */
266 if (skb_cow(skb, 0) < 0)
267 return NET_RX_DROP;
268
269 /* keep skb linear */
270 if (skb_linearize(skb) < 0)
271 return NET_RX_DROP;
272
Marek Lindner01c42242011-11-28 21:31:55 +0800273 bat_priv->bat_algo_ops->bat_ogm_receive(hard_iface, skb);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000274
275 kfree_skb(skb);
276 return NET_RX_SUCCESS;
277}
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üssinge1a53822011-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üssinge1a53822011-03-14 22:43:37 +0000304 goto out;
Marek Lindner44524fc2011-02-10 14:33:53 +0000305
Linus Lüssinge1a53822011-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. */
311 if (skb_cow(skb, sizeof(struct ethhdr)) < 0)
312 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üssinge1a53822011-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üssinge1a53822011-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üssinge1a53822011-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üssinge1a53822011-03-14 22:43:37 +0000359 goto out;
Marek Lindner44524fc2011-02-10 14:33:53 +0000360
Linus Lüssinge1a53822011-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. */
366 if (skb_cow(skb, sizeof(struct ethhdr)) < 0)
367 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üssinge1a53822011-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üssinge1a53822011-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üssinge1a53822011-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üssinge1a53822011-03-14 22:43:37 +0000445 goto out;
Marek Lindner44524fc2011-02-10 14:33:53 +0000446
Linus Lüssinge1a53822011-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. */
452 if (skb_cow(skb, sizeof(struct ethhdr)) < 0)
453 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üssinge1a53822011-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üssinge1a53822011-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 Quartullia73105b2011-04-27 14:27:44 +0200620
Antonio Quartulli8b7342d2011-10-16 20:32:03 +0200621 tt_len = tt_query->tt_data * sizeof(struct tt_change);
622
623 /* Ensure we have all the claimed data */
624 if (unlikely(skb_headlen(skb) <
Antonio Quartulli69497c12011-12-02 17:38:52 +0100625 sizeof(struct tt_query_packet) + tt_len))
Antonio Quartulli8b7342d2011-10-16 20:32:03 +0200626 goto out;
627
Antonio Quartullia73105b2011-04-27 14:27:44 +0200628 handle_tt_response(bat_priv, tt_query);
Antonio Quartullidc58fe32011-10-16 20:32:02 +0200629 } else {
Antonio Quartullia73105b2011-04-27 14:27:44 +0200630 bat_dbg(DBG_TT, bat_priv,
631 "Routing TT_RESPONSE to %pM [%c]\n",
632 tt_query->dst,
633 (tt_query->flags & TT_FULL_TABLE ? 'F' : '.'));
634 tt_query->tt_data = htons(tt_query->tt_data);
635 return route_unicast_packet(skb, recv_if);
636 }
637 break;
638 }
639
640out:
641 /* returning NET_RX_DROP will make the caller function kfree the skb */
642 return NET_RX_DROP;
643}
644
Antonio Quartullicc47f662011-04-27 14:27:57 +0200645int recv_roam_adv(struct sk_buff *skb, struct hard_iface *recv_if)
646{
647 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
648 struct roam_adv_packet *roam_adv_packet;
649 struct orig_node *orig_node;
650 struct ethhdr *ethhdr;
651
652 /* drop packet if it has not necessary minimum size */
653 if (unlikely(!pskb_may_pull(skb, sizeof(struct roam_adv_packet))))
654 goto out;
655
656 ethhdr = (struct ethhdr *)skb_mac_header(skb);
657
658 /* packet with unicast indication but broadcast recipient */
659 if (is_broadcast_ether_addr(ethhdr->h_dest))
660 goto out;
661
662 /* packet with broadcast sender address */
663 if (is_broadcast_ether_addr(ethhdr->h_source))
664 goto out;
665
666 roam_adv_packet = (struct roam_adv_packet *)skb->data;
667
668 if (!is_my_mac(roam_adv_packet->dst))
669 return route_unicast_packet(skb, recv_if);
670
671 orig_node = orig_hash_find(bat_priv, roam_adv_packet->src);
672 if (!orig_node)
673 goto out;
674
Sven Eckelmann86ceb362012-03-07 09:07:45 +0100675 bat_dbg(DBG_TT, bat_priv,
676 "Received ROAMING_ADV from %pM (client %pM)\n",
677 roam_adv_packet->src, roam_adv_packet->client);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200678
679 tt_global_add(bat_priv, orig_node, roam_adv_packet->client,
Antonio Quartullibc279082011-07-07 15:35:35 +0200680 atomic_read(&orig_node->last_ttvn) + 1, true, false);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200681
682 /* Roaming phase starts: I have new information but the ttvn has not
683 * been incremented yet. This flag will make me check all the incoming
684 * packets for the correct destination. */
685 bat_priv->tt_poss_change = true;
686
687 orig_node_free_ref(orig_node);
688out:
689 /* returning NET_RX_DROP will make the caller function kfree the skb */
690 return NET_RX_DROP;
691}
692
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000693/* find a suitable router for this originator, and use
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000694 * bonding if possible. increases the found neighbors
695 * refcount.*/
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000696struct neigh_node *find_router(struct bat_priv *bat_priv,
697 struct orig_node *orig_node,
Sven Eckelmann747e4222011-05-14 23:14:50 +0200698 const struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000699{
700 struct orig_node *primary_orig_node;
701 struct orig_node *router_orig;
Linus Lüssing55158622011-03-14 22:43:27 +0000702 struct neigh_node *router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000703 static uint8_t zero_mac[ETH_ALEN] = {0, 0, 0, 0, 0, 0};
704 int bonding_enabled;
705
706 if (!orig_node)
707 return NULL;
708
Linus Lüssinge1a53822011-03-14 22:43:37 +0000709 router = orig_node_get_router(orig_node);
710 if (!router)
Marek Lindner01df2b62011-05-05 14:14:46 +0200711 goto err;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000712
713 /* without bonding, the first node should
714 * always choose the default router. */
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000715 bonding_enabled = atomic_read(&bat_priv->bonding);
716
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000717 rcu_read_lock();
718 /* select default router to output */
Linus Lüssinge1a53822011-03-14 22:43:37 +0000719 router_orig = router->orig_node;
Marek Lindner01df2b62011-05-05 14:14:46 +0200720 if (!router_orig)
721 goto err_unlock;
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000722
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000723 if ((!recv_if) && (!bonding_enabled))
724 goto return_router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000725
726 /* if we have something in the primary_addr, we can search
727 * for a potential bonding candidate. */
Marek Lindner39901e72011-02-18 12:28:08 +0000728 if (compare_eth(router_orig->primary_addr, zero_mac))
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000729 goto return_router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000730
731 /* find the orig_node which has the primary interface. might
732 * even be the same as our router_orig in many cases */
733
Marek Lindner39901e72011-02-18 12:28:08 +0000734 if (compare_eth(router_orig->primary_addr, router_orig->orig)) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000735 primary_orig_node = router_orig;
736 } else {
Marek Lindner7aadf882011-02-18 12:28:09 +0000737 primary_orig_node = orig_hash_find(bat_priv,
738 router_orig->primary_addr);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000739 if (!primary_orig_node)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000740 goto return_router;
Marek Lindner7aadf882011-02-18 12:28:09 +0000741
Marek Lindner7b36e8e2011-02-18 12:28:10 +0000742 orig_node_free_ref(primary_orig_node);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000743 }
744
745 /* with less than 2 candidates, we can't do any
746 * bonding and prefer the original router. */
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000747 if (atomic_read(&primary_orig_node->bond_candidates) < 2)
748 goto return_router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000749
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000750 /* all nodes between should choose a candidate which
751 * is is not on the interface where the packet came
752 * in. */
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000753
Marek Lindner44524fc2011-02-10 14:33:53 +0000754 neigh_node_free_ref(router);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000755
Linus Lüssing55158622011-03-14 22:43:27 +0000756 if (bonding_enabled)
757 router = find_bond_router(primary_orig_node, recv_if);
758 else
759 router = find_ifalter_router(primary_orig_node, recv_if);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000760
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000761return_router:
Antonio Quartullie2cbc112011-05-08 20:52:57 +0200762 if (router && router->if_incoming->if_status != IF_ACTIVE)
763 goto err_unlock;
764
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000765 rcu_read_unlock();
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000766 return router;
Marek Lindner01df2b62011-05-05 14:14:46 +0200767err_unlock:
768 rcu_read_unlock();
769err:
770 if (router)
771 neigh_node_free_ref(router);
772 return NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000773}
774
775static int check_unicast_packet(struct sk_buff *skb, int hdr_size)
776{
777 struct ethhdr *ethhdr;
778
779 /* drop packet if it has not necessary minimum size */
780 if (unlikely(!pskb_may_pull(skb, hdr_size)))
781 return -1;
782
783 ethhdr = (struct ethhdr *)skb_mac_header(skb);
784
785 /* packet with unicast indication but broadcast recipient */
786 if (is_broadcast_ether_addr(ethhdr->h_dest))
787 return -1;
788
789 /* packet with broadcast sender address */
790 if (is_broadcast_ether_addr(ethhdr->h_source))
791 return -1;
792
793 /* not for me */
794 if (!is_my_mac(ethhdr->h_dest))
795 return -1;
796
797 return 0;
798}
799
Linus Lüssing7cefb142011-03-02 17:39:31 +0000800int route_unicast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000801{
802 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Marek Lindner44524fc2011-02-10 14:33:53 +0000803 struct orig_node *orig_node = NULL;
804 struct neigh_node *neigh_node = NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000805 struct unicast_packet *unicast_packet;
806 struct ethhdr *ethhdr = (struct ethhdr *)skb_mac_header(skb);
Marek Lindner44524fc2011-02-10 14:33:53 +0000807 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000808 struct sk_buff *new_skb;
809
810 unicast_packet = (struct unicast_packet *)skb->data;
811
812 /* TTL exceeded */
Sven Eckelmann76543d12011-11-20 15:47:38 +0100813 if (unicast_packet->header.ttl < 2) {
Sven Eckelmann86ceb362012-03-07 09:07:45 +0100814 pr_debug("Warning - can't forward unicast packet from %pM to %pM: ttl exceeded\n",
815 ethhdr->h_source, unicast_packet->dest);
Marek Lindner44524fc2011-02-10 14:33:53 +0000816 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000817 }
818
819 /* get routing information */
Marek Lindner7aadf882011-02-18 12:28:09 +0000820 orig_node = orig_hash_find(bat_priv, unicast_packet->dest);
821
Marek Lindner44524fc2011-02-10 14:33:53 +0000822 if (!orig_node)
Antonio Quartullib5a6f692011-04-16 11:30:57 +0200823 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000824
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000825 /* find_router() increases neigh_nodes refcount if found. */
Marek Lindner44524fc2011-02-10 14:33:53 +0000826 neigh_node = find_router(bat_priv, orig_node, recv_if);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000827
Marek Lindnerd0072602011-01-19 20:01:44 +0000828 if (!neigh_node)
Marek Lindner44524fc2011-02-10 14:33:53 +0000829 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000830
831 /* create a copy of the skb, if needed, to modify it. */
832 if (skb_cow(skb, sizeof(struct ethhdr)) < 0)
Marek Lindner44524fc2011-02-10 14:33:53 +0000833 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000834
835 unicast_packet = (struct unicast_packet *)skb->data;
836
Sven Eckelmann76543d12011-11-20 15:47:38 +0100837 if (unicast_packet->header.packet_type == BAT_UNICAST &&
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000838 atomic_read(&bat_priv->fragmentation) &&
Marek Lindnerd0072602011-01-19 20:01:44 +0000839 skb->len > neigh_node->if_incoming->net_dev->mtu) {
840 ret = frag_send_skb(skb, bat_priv,
841 neigh_node->if_incoming, neigh_node->addr);
842 goto out;
843 }
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000844
Sven Eckelmann76543d12011-11-20 15:47:38 +0100845 if (unicast_packet->header.packet_type == BAT_UNICAST_FRAG &&
Marek Lindnerd0072602011-01-19 20:01:44 +0000846 frag_can_reassemble(skb, neigh_node->if_incoming->net_dev->mtu)) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000847
848 ret = frag_reassemble_skb(skb, bat_priv, &new_skb);
849
850 if (ret == NET_RX_DROP)
Marek Lindner44524fc2011-02-10 14:33:53 +0000851 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000852
853 /* packet was buffered for late merge */
Marek Lindner44524fc2011-02-10 14:33:53 +0000854 if (!new_skb) {
855 ret = NET_RX_SUCCESS;
856 goto out;
857 }
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000858
859 skb = new_skb;
860 unicast_packet = (struct unicast_packet *)skb->data;
861 }
862
863 /* decrement ttl */
Sven Eckelmann76543d12011-11-20 15:47:38 +0100864 unicast_packet->header.ttl--;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000865
866 /* route it */
Marek Lindnerd0072602011-01-19 20:01:44 +0000867 send_skb_packet(skb, neigh_node->if_incoming, neigh_node->addr);
Marek Lindner44524fc2011-02-10 14:33:53 +0000868 ret = NET_RX_SUCCESS;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000869
Marek Lindner44524fc2011-02-10 14:33:53 +0000870out:
871 if (neigh_node)
872 neigh_node_free_ref(neigh_node);
873 if (orig_node)
Marek Lindner7b36e8e2011-02-18 12:28:10 +0000874 orig_node_free_ref(orig_node);
Marek Lindner44524fc2011-02-10 14:33:53 +0000875 return ret;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000876}
877
Antonio Quartullia73105b2011-04-27 14:27:44 +0200878static int check_unicast_ttvn(struct bat_priv *bat_priv,
879 struct sk_buff *skb) {
880 uint8_t curr_ttvn;
881 struct orig_node *orig_node;
882 struct ethhdr *ethhdr;
883 struct hard_iface *primary_if;
884 struct unicast_packet *unicast_packet;
Antonio Quartullicc47f662011-04-27 14:27:57 +0200885 bool tt_poss_change;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200886
887 /* I could need to modify it */
888 if (skb_cow(skb, sizeof(struct unicast_packet)) < 0)
889 return 0;
890
891 unicast_packet = (struct unicast_packet *)skb->data;
892
Antonio Quartullicc47f662011-04-27 14:27:57 +0200893 if (is_my_mac(unicast_packet->dest)) {
894 tt_poss_change = bat_priv->tt_poss_change;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200895 curr_ttvn = (uint8_t)atomic_read(&bat_priv->ttvn);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200896 } else {
Antonio Quartullia73105b2011-04-27 14:27:44 +0200897 orig_node = orig_hash_find(bat_priv, unicast_packet->dest);
898
899 if (!orig_node)
900 return 0;
901
902 curr_ttvn = (uint8_t)atomic_read(&orig_node->last_ttvn);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200903 tt_poss_change = orig_node->tt_poss_change;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200904 orig_node_free_ref(orig_node);
905 }
906
907 /* Check whether I have to reroute the packet */
Antonio Quartullicc47f662011-04-27 14:27:57 +0200908 if (seq_before(unicast_packet->ttvn, curr_ttvn) || tt_poss_change) {
Antonio Quartullia73105b2011-04-27 14:27:44 +0200909 /* Linearize the skb before accessing it */
910 if (skb_linearize(skb) < 0)
911 return 0;
912
913 ethhdr = (struct ethhdr *)(skb->data +
914 sizeof(struct unicast_packet));
Antonio Quartulli3d393e42011-07-07 15:35:37 +0200915 orig_node = transtable_search(bat_priv, NULL, ethhdr->h_dest);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200916
917 if (!orig_node) {
918 if (!is_my_client(bat_priv, ethhdr->h_dest))
919 return 0;
920 primary_if = primary_if_get_selected(bat_priv);
921 if (!primary_if)
922 return 0;
923 memcpy(unicast_packet->dest,
924 primary_if->net_dev->dev_addr, ETH_ALEN);
925 hardif_free_ref(primary_if);
926 } else {
927 memcpy(unicast_packet->dest, orig_node->orig,
928 ETH_ALEN);
929 curr_ttvn = (uint8_t)
930 atomic_read(&orig_node->last_ttvn);
931 orig_node_free_ref(orig_node);
932 }
933
Sven Eckelmann86ceb362012-03-07 09:07:45 +0100934 bat_dbg(DBG_ROUTES, bat_priv,
935 "TTVN mismatch (old_ttvn %u new_ttvn %u)! Rerouting unicast packet (for %pM) to %pM\n",
936 unicast_packet->ttvn, curr_ttvn, ethhdr->h_dest,
937 unicast_packet->dest);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200938
939 unicast_packet->ttvn = curr_ttvn;
940 }
941 return 1;
942}
943
Marek Lindnere6c10f42011-02-18 12:33:20 +0000944int recv_unicast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000945{
Antonio Quartullia73105b2011-04-27 14:27:44 +0200946 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000947 struct unicast_packet *unicast_packet;
Sven Eckelmann704509b2011-05-14 23:14:54 +0200948 int hdr_size = sizeof(*unicast_packet);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000949
950 if (check_unicast_packet(skb, hdr_size) < 0)
951 return NET_RX_DROP;
952
Antonio Quartullia73105b2011-04-27 14:27:44 +0200953 if (!check_unicast_ttvn(bat_priv, skb))
954 return NET_RX_DROP;
955
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000956 unicast_packet = (struct unicast_packet *)skb->data;
957
958 /* packet for me */
959 if (is_my_mac(unicast_packet->dest)) {
960 interface_rx(recv_if->soft_iface, skb, recv_if, hdr_size);
961 return NET_RX_SUCCESS;
962 }
963
Linus Lüssing7cefb142011-03-02 17:39:31 +0000964 return route_unicast_packet(skb, recv_if);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000965}
966
Marek Lindnere6c10f42011-02-18 12:33:20 +0000967int recv_ucast_frag_packet(struct sk_buff *skb, struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000968{
969 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
970 struct unicast_frag_packet *unicast_packet;
Sven Eckelmann704509b2011-05-14 23:14:54 +0200971 int hdr_size = sizeof(*unicast_packet);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000972 struct sk_buff *new_skb = NULL;
973 int ret;
974
975 if (check_unicast_packet(skb, hdr_size) < 0)
976 return NET_RX_DROP;
977
Antonio Quartullia73105b2011-04-27 14:27:44 +0200978 if (!check_unicast_ttvn(bat_priv, skb))
979 return NET_RX_DROP;
980
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000981 unicast_packet = (struct unicast_frag_packet *)skb->data;
982
983 /* packet for me */
984 if (is_my_mac(unicast_packet->dest)) {
985
986 ret = frag_reassemble_skb(skb, bat_priv, &new_skb);
987
988 if (ret == NET_RX_DROP)
989 return NET_RX_DROP;
990
991 /* packet was buffered for late merge */
992 if (!new_skb)
993 return NET_RX_SUCCESS;
994
995 interface_rx(recv_if->soft_iface, new_skb, recv_if,
996 sizeof(struct unicast_packet));
997 return NET_RX_SUCCESS;
998 }
999
Linus Lüssing7cefb142011-03-02 17:39:31 +00001000 return route_unicast_packet(skb, recv_if);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001001}
1002
1003
Marek Lindnere6c10f42011-02-18 12:33:20 +00001004int recv_bcast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001005{
1006 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001007 struct orig_node *orig_node = NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001008 struct bcast_packet *bcast_packet;
1009 struct ethhdr *ethhdr;
Sven Eckelmann704509b2011-05-14 23:14:54 +02001010 int hdr_size = sizeof(*bcast_packet);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001011 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001012 int32_t seq_diff;
1013
1014 /* drop packet if it has not necessary minimum size */
1015 if (unlikely(!pskb_may_pull(skb, hdr_size)))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001016 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001017
1018 ethhdr = (struct ethhdr *)skb_mac_header(skb);
1019
1020 /* packet with broadcast indication but unicast recipient */
1021 if (!is_broadcast_ether_addr(ethhdr->h_dest))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001022 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001023
1024 /* packet with broadcast sender address */
1025 if (is_broadcast_ether_addr(ethhdr->h_source))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001026 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001027
1028 /* ignore broadcasts sent by myself */
1029 if (is_my_mac(ethhdr->h_source))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001030 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001031
1032 bcast_packet = (struct bcast_packet *)skb->data;
1033
1034 /* ignore broadcasts originated by myself */
1035 if (is_my_mac(bcast_packet->orig))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001036 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001037
Sven Eckelmann76543d12011-11-20 15:47:38 +01001038 if (bcast_packet->header.ttl < 2)
Marek Lindnerf3e00082011-01-25 21:52:11 +00001039 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001040
Marek Lindner7aadf882011-02-18 12:28:09 +00001041 orig_node = orig_hash_find(bat_priv, bcast_packet->orig);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001042
1043 if (!orig_node)
Antonio Quartullib5a6f692011-04-16 11:30:57 +02001044 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001045
Marek Lindnerf3e00082011-01-25 21:52:11 +00001046 spin_lock_bh(&orig_node->bcast_seqno_lock);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001047
1048 /* check whether the packet is a duplicate */
Marek Lindnerf3e00082011-01-25 21:52:11 +00001049 if (get_bit_status(orig_node->bcast_bits, orig_node->last_bcast_seqno,
1050 ntohl(bcast_packet->seqno)))
1051 goto spin_unlock;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001052
1053 seq_diff = ntohl(bcast_packet->seqno) - orig_node->last_bcast_seqno;
1054
1055 /* check whether the packet is old and the host just restarted. */
1056 if (window_protected(bat_priv, seq_diff,
Marek Lindnerf3e00082011-01-25 21:52:11 +00001057 &orig_node->bcast_seqno_reset))
1058 goto spin_unlock;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001059
1060 /* mark broadcast in flood history, update window position
1061 * if required. */
1062 if (bit_get_packet(bat_priv, orig_node->bcast_bits, seq_diff, 1))
1063 orig_node->last_bcast_seqno = ntohl(bcast_packet->seqno);
1064
Marek Lindnerf3e00082011-01-25 21:52:11 +00001065 spin_unlock_bh(&orig_node->bcast_seqno_lock);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001066
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001067 /* rebroadcast packet */
Antonio Quartulli86985292011-06-25 19:09:12 +02001068 add_bcast_packet_to_list(bat_priv, skb, 1);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001069
1070 /* broadcast for me */
1071 interface_rx(recv_if->soft_iface, skb, recv_if, hdr_size);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001072 ret = NET_RX_SUCCESS;
1073 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001074
Marek Lindnerf3e00082011-01-25 21:52:11 +00001075spin_unlock:
1076 spin_unlock_bh(&orig_node->bcast_seqno_lock);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001077out:
1078 if (orig_node)
Marek Lindner7b36e8e2011-02-18 12:28:10 +00001079 orig_node_free_ref(orig_node);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001080 return ret;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001081}
1082
Marek Lindnere6c10f42011-02-18 12:33:20 +00001083int recv_vis_packet(struct sk_buff *skb, struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001084{
1085 struct vis_packet *vis_packet;
1086 struct ethhdr *ethhdr;
1087 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Sven Eckelmann704509b2011-05-14 23:14:54 +02001088 int hdr_size = sizeof(*vis_packet);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001089
1090 /* keep skb linear */
1091 if (skb_linearize(skb) < 0)
1092 return NET_RX_DROP;
1093
1094 if (unlikely(!pskb_may_pull(skb, hdr_size)))
1095 return NET_RX_DROP;
1096
1097 vis_packet = (struct vis_packet *)skb->data;
1098 ethhdr = (struct ethhdr *)skb_mac_header(skb);
1099
1100 /* not for me */
1101 if (!is_my_mac(ethhdr->h_dest))
1102 return NET_RX_DROP;
1103
1104 /* ignore own packets */
1105 if (is_my_mac(vis_packet->vis_orig))
1106 return NET_RX_DROP;
1107
1108 if (is_my_mac(vis_packet->sender_orig))
1109 return NET_RX_DROP;
1110
1111 switch (vis_packet->vis_type) {
1112 case VIS_TYPE_SERVER_SYNC:
1113 receive_server_sync_packet(bat_priv, vis_packet,
1114 skb_headlen(skb));
1115 break;
1116
1117 case VIS_TYPE_CLIENT_UPDATE:
1118 receive_client_update_packet(bat_priv, vis_packet,
1119 skb_headlen(skb));
1120 break;
1121
1122 default: /* ignore unknown packet */
1123 break;
1124 }
1125
1126 /* We take a copy of the data in the packet, so we should
1127 always free the skbuf. */
1128 return NET_RX_DROP;
1129}