blob: 7ed9d8f92916b64e685faec33f88a896ae64c4b8 [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 Lindner032b7962011-12-20 19:30:40 +0800237 if (has_timed_out(*last_reset, RESET_PROTECTION_MS)) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000238
239 *last_reset = jiffies;
240 bat_dbg(DBG_BATMAN, bat_priv,
241 "old packet received, start protection\n");
242
243 return 0;
Sven Eckelmann96741ad2012-03-07 09:07:47 +0100244 } else {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000245 return 1;
Sven Eckelmann96741ad2012-03-07 09:07:47 +0100246 }
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000247 }
248 return 0;
249}
250
Marek Lindnerc3e29312012-03-04 16:56:25 +0800251bool check_management_packet(struct sk_buff *skb,
252 struct hard_iface *hard_iface,
253 int header_len)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000254{
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000255 struct ethhdr *ethhdr;
256
257 /* drop packet if it has not necessary minimum size */
Marek Lindnerc3e29312012-03-04 16:56:25 +0800258 if (unlikely(!pskb_may_pull(skb, header_len)))
259 return false;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000260
261 ethhdr = (struct ethhdr *)skb_mac_header(skb);
262
263 /* packet with broadcast indication but unicast recipient */
264 if (!is_broadcast_ether_addr(ethhdr->h_dest))
Marek Lindnerc3e29312012-03-04 16:56:25 +0800265 return false;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000266
267 /* packet with broadcast sender address */
268 if (is_broadcast_ether_addr(ethhdr->h_source))
Marek Lindnerc3e29312012-03-04 16:56:25 +0800269 return false;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000270
271 /* create a copy of the skb, if needed, to modify it. */
272 if (skb_cow(skb, 0) < 0)
Marek Lindnerc3e29312012-03-04 16:56:25 +0800273 return false;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000274
275 /* keep skb linear */
276 if (skb_linearize(skb) < 0)
Marek Lindnerc3e29312012-03-04 16:56:25 +0800277 return false;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000278
Marek Lindnerc3e29312012-03-04 16:56:25 +0800279 return true;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000280}
281
282static int recv_my_icmp_packet(struct bat_priv *bat_priv,
283 struct sk_buff *skb, size_t icmp_len)
284{
Marek Lindner32ae9b22011-04-20 15:40:58 +0200285 struct hard_iface *primary_if = NULL;
Marek Lindner44524fc2011-02-10 14:33:53 +0000286 struct orig_node *orig_node = NULL;
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000287 struct neigh_node *router = NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000288 struct icmp_packet_rr *icmp_packet;
Marek Lindner44524fc2011-02-10 14:33:53 +0000289 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000290
291 icmp_packet = (struct icmp_packet_rr *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000292
293 /* add data to device queue */
294 if (icmp_packet->msg_type != ECHO_REQUEST) {
295 bat_socket_receive_packet(icmp_packet, icmp_len);
Marek Lindner44524fc2011-02-10 14:33:53 +0000296 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000297 }
298
Marek Lindner32ae9b22011-04-20 15:40:58 +0200299 primary_if = primary_if_get_selected(bat_priv);
300 if (!primary_if)
Marek Lindner44524fc2011-02-10 14:33:53 +0000301 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000302
303 /* answer echo request (ping) */
304 /* get routing information */
Marek Lindner7aadf882011-02-18 12:28:09 +0000305 orig_node = orig_hash_find(bat_priv, icmp_packet->orig);
Marek Lindner44524fc2011-02-10 14:33:53 +0000306 if (!orig_node)
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000307 goto out;
Marek Lindner44524fc2011-02-10 14:33:53 +0000308
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000309 router = orig_node_get_router(orig_node);
310 if (!router)
311 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000312
Marek Lindner44524fc2011-02-10 14:33:53 +0000313 /* create a copy of the skb, if needed, to modify it. */
Antonio Quartulli0d125072012-02-18 11:27:34 +0100314 if (skb_cow(skb, ETH_HLEN) < 0)
Marek Lindner44524fc2011-02-10 14:33:53 +0000315 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000316
Marek Lindner44524fc2011-02-10 14:33:53 +0000317 icmp_packet = (struct icmp_packet_rr *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000318
Marek Lindner44524fc2011-02-10 14:33:53 +0000319 memcpy(icmp_packet->dst, icmp_packet->orig, ETH_ALEN);
Marek Lindner32ae9b22011-04-20 15:40:58 +0200320 memcpy(icmp_packet->orig, primary_if->net_dev->dev_addr, ETH_ALEN);
Marek Lindner44524fc2011-02-10 14:33:53 +0000321 icmp_packet->msg_type = ECHO_REPLY;
Sven Eckelmann76543d12011-11-20 15:47:38 +0100322 icmp_packet->header.ttl = TTL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000323
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000324 send_skb_packet(skb, router->if_incoming, router->addr);
Marek Lindner44524fc2011-02-10 14:33:53 +0000325 ret = NET_RX_SUCCESS;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000326
Marek Lindner44524fc2011-02-10 14:33:53 +0000327out:
Marek Lindner32ae9b22011-04-20 15:40:58 +0200328 if (primary_if)
329 hardif_free_ref(primary_if);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000330 if (router)
331 neigh_node_free_ref(router);
Marek Lindner44524fc2011-02-10 14:33:53 +0000332 if (orig_node)
Marek Lindner7b36e8e2011-02-18 12:28:10 +0000333 orig_node_free_ref(orig_node);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000334 return ret;
335}
336
337static int recv_icmp_ttl_exceeded(struct bat_priv *bat_priv,
Simon Wunderlich74ef1152010-12-29 16:15:19 +0000338 struct sk_buff *skb)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000339{
Marek Lindner32ae9b22011-04-20 15:40:58 +0200340 struct hard_iface *primary_if = NULL;
Marek Lindner44524fc2011-02-10 14:33:53 +0000341 struct orig_node *orig_node = NULL;
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000342 struct neigh_node *router = NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000343 struct icmp_packet *icmp_packet;
Marek Lindner44524fc2011-02-10 14:33:53 +0000344 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000345
346 icmp_packet = (struct icmp_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000347
348 /* send TTL exceeded if packet is an echo request (traceroute) */
349 if (icmp_packet->msg_type != ECHO_REQUEST) {
Sven Eckelmann86ceb362012-03-07 09:07:45 +0100350 pr_debug("Warning - can't forward icmp packet from %pM to %pM: ttl exceeded\n",
351 icmp_packet->orig, icmp_packet->dst);
Marek Lindner44524fc2011-02-10 14:33:53 +0000352 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000353 }
354
Marek Lindner32ae9b22011-04-20 15:40:58 +0200355 primary_if = primary_if_get_selected(bat_priv);
356 if (!primary_if)
Marek Lindner44524fc2011-02-10 14:33:53 +0000357 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000358
359 /* get routing information */
Marek Lindner7aadf882011-02-18 12:28:09 +0000360 orig_node = orig_hash_find(bat_priv, icmp_packet->orig);
Marek Lindner44524fc2011-02-10 14:33:53 +0000361 if (!orig_node)
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000362 goto out;
Marek Lindner44524fc2011-02-10 14:33:53 +0000363
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000364 router = orig_node_get_router(orig_node);
365 if (!router)
366 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000367
Marek Lindner44524fc2011-02-10 14:33:53 +0000368 /* create a copy of the skb, if needed, to modify it. */
Antonio Quartulli0d125072012-02-18 11:27:34 +0100369 if (skb_cow(skb, ETH_HLEN) < 0)
Marek Lindner44524fc2011-02-10 14:33:53 +0000370 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000371
Marek Lindner44524fc2011-02-10 14:33:53 +0000372 icmp_packet = (struct icmp_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000373
Marek Lindner44524fc2011-02-10 14:33:53 +0000374 memcpy(icmp_packet->dst, icmp_packet->orig, ETH_ALEN);
Marek Lindner32ae9b22011-04-20 15:40:58 +0200375 memcpy(icmp_packet->orig, primary_if->net_dev->dev_addr, ETH_ALEN);
Marek Lindner44524fc2011-02-10 14:33:53 +0000376 icmp_packet->msg_type = TTL_EXCEEDED;
Sven Eckelmann76543d12011-11-20 15:47:38 +0100377 icmp_packet->header.ttl = TTL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000378
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000379 send_skb_packet(skb, router->if_incoming, router->addr);
Marek Lindner44524fc2011-02-10 14:33:53 +0000380 ret = NET_RX_SUCCESS;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000381
Marek Lindner44524fc2011-02-10 14:33:53 +0000382out:
Marek Lindner32ae9b22011-04-20 15:40:58 +0200383 if (primary_if)
384 hardif_free_ref(primary_if);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000385 if (router)
386 neigh_node_free_ref(router);
Marek Lindner44524fc2011-02-10 14:33:53 +0000387 if (orig_node)
Marek Lindner7b36e8e2011-02-18 12:28:10 +0000388 orig_node_free_ref(orig_node);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000389 return ret;
390}
391
392
Marek Lindnere6c10f42011-02-18 12:33:20 +0000393int recv_icmp_packet(struct sk_buff *skb, struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000394{
395 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
396 struct icmp_packet_rr *icmp_packet;
397 struct ethhdr *ethhdr;
Marek Lindner44524fc2011-02-10 14:33:53 +0000398 struct orig_node *orig_node = NULL;
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000399 struct neigh_node *router = NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000400 int hdr_size = sizeof(struct icmp_packet);
Marek Lindner44524fc2011-02-10 14:33:53 +0000401 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000402
403 /**
404 * we truncate all incoming icmp packets if they don't match our size
405 */
406 if (skb->len >= sizeof(struct icmp_packet_rr))
407 hdr_size = sizeof(struct icmp_packet_rr);
408
409 /* drop packet if it has not necessary minimum size */
410 if (unlikely(!pskb_may_pull(skb, hdr_size)))
Marek Lindner44524fc2011-02-10 14:33:53 +0000411 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000412
413 ethhdr = (struct ethhdr *)skb_mac_header(skb);
414
415 /* packet with unicast indication but broadcast recipient */
416 if (is_broadcast_ether_addr(ethhdr->h_dest))
Marek Lindner44524fc2011-02-10 14:33:53 +0000417 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000418
419 /* packet with broadcast sender address */
420 if (is_broadcast_ether_addr(ethhdr->h_source))
Marek Lindner44524fc2011-02-10 14:33:53 +0000421 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000422
423 /* not for me */
424 if (!is_my_mac(ethhdr->h_dest))
Marek Lindner44524fc2011-02-10 14:33:53 +0000425 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000426
427 icmp_packet = (struct icmp_packet_rr *)skb->data;
428
429 /* add record route information if not full */
430 if ((hdr_size == sizeof(struct icmp_packet_rr)) &&
431 (icmp_packet->rr_cur < BAT_RR_LEN)) {
432 memcpy(&(icmp_packet->rr[icmp_packet->rr_cur]),
Sven Eckelmann7c64fd92012-02-28 10:55:36 +0100433 ethhdr->h_dest, ETH_ALEN);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000434 icmp_packet->rr_cur++;
435 }
436
437 /* packet for me */
438 if (is_my_mac(icmp_packet->dst))
439 return recv_my_icmp_packet(bat_priv, skb, hdr_size);
440
441 /* TTL exceeded */
Sven Eckelmann76543d12011-11-20 15:47:38 +0100442 if (icmp_packet->header.ttl < 2)
Simon Wunderlich74ef1152010-12-29 16:15:19 +0000443 return recv_icmp_ttl_exceeded(bat_priv, skb);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000444
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000445 /* get routing information */
Marek Lindner7aadf882011-02-18 12:28:09 +0000446 orig_node = orig_hash_find(bat_priv, icmp_packet->dst);
Marek Lindner44524fc2011-02-10 14:33:53 +0000447 if (!orig_node)
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000448 goto out;
Marek Lindner44524fc2011-02-10 14:33:53 +0000449
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000450 router = orig_node_get_router(orig_node);
451 if (!router)
452 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000453
Marek Lindner44524fc2011-02-10 14:33:53 +0000454 /* create a copy of the skb, if needed, to modify it. */
Antonio Quartulli0d125072012-02-18 11:27:34 +0100455 if (skb_cow(skb, ETH_HLEN) < 0)
Marek Lindner44524fc2011-02-10 14:33:53 +0000456 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000457
Marek Lindner44524fc2011-02-10 14:33:53 +0000458 icmp_packet = (struct icmp_packet_rr *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000459
Marek Lindner44524fc2011-02-10 14:33:53 +0000460 /* decrement ttl */
Sven Eckelmann76543d12011-11-20 15:47:38 +0100461 icmp_packet->header.ttl--;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000462
Marek Lindner44524fc2011-02-10 14:33:53 +0000463 /* route it */
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000464 send_skb_packet(skb, router->if_incoming, router->addr);
Marek Lindner44524fc2011-02-10 14:33:53 +0000465 ret = NET_RX_SUCCESS;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000466
Marek Lindner44524fc2011-02-10 14:33:53 +0000467out:
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000468 if (router)
469 neigh_node_free_ref(router);
Marek Lindner44524fc2011-02-10 14:33:53 +0000470 if (orig_node)
Marek Lindner7b36e8e2011-02-18 12:28:10 +0000471 orig_node_free_ref(orig_node);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000472 return ret;
473}
474
Linus Lüssing55158622011-03-14 22:43:27 +0000475/* In the bonding case, send the packets in a round
476 * robin fashion over the remaining interfaces.
477 *
478 * This method rotates the bonding list and increases the
479 * returned router's refcount. */
480static struct neigh_node *find_bond_router(struct orig_node *primary_orig,
Sven Eckelmann747e4222011-05-14 23:14:50 +0200481 const struct hard_iface *recv_if)
Linus Lüssing55158622011-03-14 22:43:27 +0000482{
483 struct neigh_node *tmp_neigh_node;
484 struct neigh_node *router = NULL, *first_candidate = NULL;
485
486 rcu_read_lock();
487 list_for_each_entry_rcu(tmp_neigh_node, &primary_orig->bond_list,
488 bonding_list) {
489 if (!first_candidate)
490 first_candidate = tmp_neigh_node;
491
492 /* recv_if == NULL on the first node. */
493 if (tmp_neigh_node->if_incoming == recv_if)
494 continue;
495
496 if (!atomic_inc_not_zero(&tmp_neigh_node->refcount))
497 continue;
498
499 router = tmp_neigh_node;
500 break;
501 }
502
503 /* use the first candidate if nothing was found. */
504 if (!router && first_candidate &&
505 atomic_inc_not_zero(&first_candidate->refcount))
506 router = first_candidate;
507
508 if (!router)
509 goto out;
510
511 /* selected should point to the next element
512 * after the current router */
513 spin_lock_bh(&primary_orig->neigh_list_lock);
514 /* this is a list_move(), which unfortunately
515 * does not exist as rcu version */
516 list_del_rcu(&primary_orig->bond_list);
517 list_add_rcu(&primary_orig->bond_list,
518 &router->bonding_list);
519 spin_unlock_bh(&primary_orig->neigh_list_lock);
520
521out:
522 rcu_read_unlock();
523 return router;
524}
525
526/* Interface Alternating: Use the best of the
527 * remaining candidates which are not using
528 * this interface.
529 *
530 * Increases the returned router's refcount */
531static struct neigh_node *find_ifalter_router(struct orig_node *primary_orig,
Sven Eckelmann747e4222011-05-14 23:14:50 +0200532 const struct hard_iface *recv_if)
Linus Lüssing55158622011-03-14 22:43:27 +0000533{
534 struct neigh_node *tmp_neigh_node;
535 struct neigh_node *router = NULL, *first_candidate = NULL;
536
537 rcu_read_lock();
538 list_for_each_entry_rcu(tmp_neigh_node, &primary_orig->bond_list,
539 bonding_list) {
540 if (!first_candidate)
541 first_candidate = tmp_neigh_node;
542
543 /* recv_if == NULL on the first node. */
544 if (tmp_neigh_node->if_incoming == recv_if)
545 continue;
546
547 if (!atomic_inc_not_zero(&tmp_neigh_node->refcount))
548 continue;
549
550 /* if we don't have a router yet
551 * or this one is better, choose it. */
552 if ((!router) ||
553 (tmp_neigh_node->tq_avg > router->tq_avg)) {
554 /* decrement refcount of
555 * previously selected router */
556 if (router)
557 neigh_node_free_ref(router);
558
559 router = tmp_neigh_node;
560 atomic_inc_not_zero(&router->refcount);
561 }
562
563 neigh_node_free_ref(tmp_neigh_node);
564 }
565
566 /* use the first candidate if nothing was found. */
567 if (!router && first_candidate &&
568 atomic_inc_not_zero(&first_candidate->refcount))
569 router = first_candidate;
570
571 rcu_read_unlock();
572 return router;
573}
574
Antonio Quartullia73105b2011-04-27 14:27:44 +0200575int recv_tt_query(struct sk_buff *skb, struct hard_iface *recv_if)
576{
577 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
578 struct tt_query_packet *tt_query;
Antonio Quartulli8b7342d2011-10-16 20:32:03 +0200579 uint16_t tt_len;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200580 struct ethhdr *ethhdr;
581
582 /* drop packet if it has not necessary minimum size */
583 if (unlikely(!pskb_may_pull(skb, sizeof(struct tt_query_packet))))
584 goto out;
585
586 /* I could need to modify it */
587 if (skb_cow(skb, sizeof(struct tt_query_packet)) < 0)
588 goto out;
589
590 ethhdr = (struct ethhdr *)skb_mac_header(skb);
591
592 /* packet with unicast indication but broadcast recipient */
593 if (is_broadcast_ether_addr(ethhdr->h_dest))
594 goto out;
595
596 /* packet with broadcast sender address */
597 if (is_broadcast_ether_addr(ethhdr->h_source))
598 goto out;
599
600 tt_query = (struct tt_query_packet *)skb->data;
601
602 tt_query->tt_data = ntohs(tt_query->tt_data);
603
604 switch (tt_query->flags & TT_QUERY_TYPE_MASK) {
605 case TT_REQUEST:
606 /* If we cannot provide an answer the tt_request is
607 * forwarded */
608 if (!send_tt_response(bat_priv, tt_query)) {
609 bat_dbg(DBG_TT, bat_priv,
610 "Routing TT_REQUEST to %pM [%c]\n",
611 tt_query->dst,
612 (tt_query->flags & TT_FULL_TABLE ? 'F' : '.'));
613 tt_query->tt_data = htons(tt_query->tt_data);
614 return route_unicast_packet(skb, recv_if);
615 }
616 break;
617 case TT_RESPONSE:
Antonio Quartullidc58fe32011-10-16 20:32:02 +0200618 if (is_my_mac(tt_query->dst)) {
619 /* packet needs to be linearized to access the TT
620 * changes */
621 if (skb_linearize(skb) < 0)
622 goto out;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200623
Antonio Quartulli8b7342d2011-10-16 20:32:03 +0200624 tt_len = tt_query->tt_data * sizeof(struct tt_change);
625
626 /* Ensure we have all the claimed data */
627 if (unlikely(skb_headlen(skb) <
Antonio Quartulli69497c12011-12-02 17:38:52 +0100628 sizeof(struct tt_query_packet) + tt_len))
Antonio Quartulli8b7342d2011-10-16 20:32:03 +0200629 goto out;
630
Antonio Quartullia73105b2011-04-27 14:27:44 +0200631 handle_tt_response(bat_priv, tt_query);
Antonio Quartullidc58fe32011-10-16 20:32:02 +0200632 } else {
Antonio Quartullia73105b2011-04-27 14:27:44 +0200633 bat_dbg(DBG_TT, bat_priv,
634 "Routing TT_RESPONSE to %pM [%c]\n",
635 tt_query->dst,
636 (tt_query->flags & TT_FULL_TABLE ? 'F' : '.'));
637 tt_query->tt_data = htons(tt_query->tt_data);
638 return route_unicast_packet(skb, recv_if);
639 }
640 break;
641 }
642
643out:
644 /* returning NET_RX_DROP will make the caller function kfree the skb */
645 return NET_RX_DROP;
646}
647
Antonio Quartullicc47f662011-04-27 14:27:57 +0200648int recv_roam_adv(struct sk_buff *skb, struct hard_iface *recv_if)
649{
650 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
651 struct roam_adv_packet *roam_adv_packet;
652 struct orig_node *orig_node;
653 struct ethhdr *ethhdr;
654
655 /* drop packet if it has not necessary minimum size */
656 if (unlikely(!pskb_may_pull(skb, sizeof(struct roam_adv_packet))))
657 goto out;
658
659 ethhdr = (struct ethhdr *)skb_mac_header(skb);
660
661 /* packet with unicast indication but broadcast recipient */
662 if (is_broadcast_ether_addr(ethhdr->h_dest))
663 goto out;
664
665 /* packet with broadcast sender address */
666 if (is_broadcast_ether_addr(ethhdr->h_source))
667 goto out;
668
669 roam_adv_packet = (struct roam_adv_packet *)skb->data;
670
671 if (!is_my_mac(roam_adv_packet->dst))
672 return route_unicast_packet(skb, recv_if);
673
Simon Wunderlich20ff9d52012-01-22 20:00:23 +0100674 /* check if it is a backbone gateway. we don't accept
675 * roaming advertisement from it, as it has the same
676 * entries as we have.
677 */
678 if (bla_is_backbone_gw_orig(bat_priv, roam_adv_packet->src))
679 goto out;
680
Antonio Quartullicc47f662011-04-27 14:27:57 +0200681 orig_node = orig_hash_find(bat_priv, roam_adv_packet->src);
682 if (!orig_node)
683 goto out;
684
Sven Eckelmann86ceb362012-03-07 09:07:45 +0100685 bat_dbg(DBG_TT, bat_priv,
686 "Received ROAMING_ADV from %pM (client %pM)\n",
687 roam_adv_packet->src, roam_adv_packet->client);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200688
689 tt_global_add(bat_priv, orig_node, roam_adv_packet->client,
Antonio Quartullibc279082011-07-07 15:35:35 +0200690 atomic_read(&orig_node->last_ttvn) + 1, true, false);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200691
692 /* Roaming phase starts: I have new information but the ttvn has not
693 * been incremented yet. This flag will make me check all the incoming
694 * packets for the correct destination. */
695 bat_priv->tt_poss_change = true;
696
697 orig_node_free_ref(orig_node);
698out:
699 /* returning NET_RX_DROP will make the caller function kfree the skb */
700 return NET_RX_DROP;
701}
702
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000703/* find a suitable router for this originator, and use
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000704 * bonding if possible. increases the found neighbors
705 * refcount.*/
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000706struct neigh_node *find_router(struct bat_priv *bat_priv,
707 struct orig_node *orig_node,
Sven Eckelmann747e4222011-05-14 23:14:50 +0200708 const struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000709{
710 struct orig_node *primary_orig_node;
711 struct orig_node *router_orig;
Linus Lüssing55158622011-03-14 22:43:27 +0000712 struct neigh_node *router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000713 static uint8_t zero_mac[ETH_ALEN] = {0, 0, 0, 0, 0, 0};
714 int bonding_enabled;
715
716 if (!orig_node)
717 return NULL;
718
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000719 router = orig_node_get_router(orig_node);
720 if (!router)
Marek Lindner01df2b62011-05-05 14:14:46 +0200721 goto err;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000722
723 /* without bonding, the first node should
724 * always choose the default router. */
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000725 bonding_enabled = atomic_read(&bat_priv->bonding);
726
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000727 rcu_read_lock();
728 /* select default router to output */
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000729 router_orig = router->orig_node;
Marek Lindner01df2b62011-05-05 14:14:46 +0200730 if (!router_orig)
731 goto err_unlock;
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000732
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000733 if ((!recv_if) && (!bonding_enabled))
734 goto return_router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000735
736 /* if we have something in the primary_addr, we can search
737 * for a potential bonding candidate. */
Marek Lindner39901e72011-02-18 12:28:08 +0000738 if (compare_eth(router_orig->primary_addr, zero_mac))
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000739 goto return_router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000740
741 /* find the orig_node which has the primary interface. might
742 * even be the same as our router_orig in many cases */
743
Marek Lindner39901e72011-02-18 12:28:08 +0000744 if (compare_eth(router_orig->primary_addr, router_orig->orig)) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000745 primary_orig_node = router_orig;
746 } else {
Marek Lindner7aadf882011-02-18 12:28:09 +0000747 primary_orig_node = orig_hash_find(bat_priv,
748 router_orig->primary_addr);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000749 if (!primary_orig_node)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000750 goto return_router;
Marek Lindner7aadf882011-02-18 12:28:09 +0000751
Marek Lindner7b36e8e2011-02-18 12:28:10 +0000752 orig_node_free_ref(primary_orig_node);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000753 }
754
755 /* with less than 2 candidates, we can't do any
756 * bonding and prefer the original router. */
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000757 if (atomic_read(&primary_orig_node->bond_candidates) < 2)
758 goto return_router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000759
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000760 /* all nodes between should choose a candidate which
761 * is is not on the interface where the packet came
762 * in. */
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000763
Marek Lindner44524fc2011-02-10 14:33:53 +0000764 neigh_node_free_ref(router);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000765
Linus Lüssing55158622011-03-14 22:43:27 +0000766 if (bonding_enabled)
767 router = find_bond_router(primary_orig_node, recv_if);
768 else
769 router = find_ifalter_router(primary_orig_node, recv_if);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000770
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000771return_router:
Antonio Quartullie2cbc112011-05-08 20:52:57 +0200772 if (router && router->if_incoming->if_status != IF_ACTIVE)
773 goto err_unlock;
774
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000775 rcu_read_unlock();
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000776 return router;
Marek Lindner01df2b62011-05-05 14:14:46 +0200777err_unlock:
778 rcu_read_unlock();
779err:
780 if (router)
781 neigh_node_free_ref(router);
782 return NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000783}
784
785static int check_unicast_packet(struct sk_buff *skb, int hdr_size)
786{
787 struct ethhdr *ethhdr;
788
789 /* drop packet if it has not necessary minimum size */
790 if (unlikely(!pskb_may_pull(skb, hdr_size)))
791 return -1;
792
793 ethhdr = (struct ethhdr *)skb_mac_header(skb);
794
795 /* packet with unicast indication but broadcast recipient */
796 if (is_broadcast_ether_addr(ethhdr->h_dest))
797 return -1;
798
799 /* packet with broadcast sender address */
800 if (is_broadcast_ether_addr(ethhdr->h_source))
801 return -1;
802
803 /* not for me */
804 if (!is_my_mac(ethhdr->h_dest))
805 return -1;
806
807 return 0;
808}
809
Simon Wunderlicha7f6ee92012-01-22 20:00:18 +0100810static int route_unicast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000811{
812 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Marek Lindner44524fc2011-02-10 14:33:53 +0000813 struct orig_node *orig_node = NULL;
814 struct neigh_node *neigh_node = NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000815 struct unicast_packet *unicast_packet;
816 struct ethhdr *ethhdr = (struct ethhdr *)skb_mac_header(skb);
Marek Lindner44524fc2011-02-10 14:33:53 +0000817 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000818 struct sk_buff *new_skb;
819
820 unicast_packet = (struct unicast_packet *)skb->data;
821
822 /* TTL exceeded */
Sven Eckelmann76543d12011-11-20 15:47:38 +0100823 if (unicast_packet->header.ttl < 2) {
Sven Eckelmann86ceb362012-03-07 09:07:45 +0100824 pr_debug("Warning - can't forward unicast packet from %pM to %pM: ttl exceeded\n",
825 ethhdr->h_source, unicast_packet->dest);
Marek Lindner44524fc2011-02-10 14:33:53 +0000826 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000827 }
828
829 /* get routing information */
Marek Lindner7aadf882011-02-18 12:28:09 +0000830 orig_node = orig_hash_find(bat_priv, unicast_packet->dest);
831
Marek Lindner44524fc2011-02-10 14:33:53 +0000832 if (!orig_node)
Antonio Quartullib5a6f692011-04-16 11:30:57 +0200833 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000834
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000835 /* find_router() increases neigh_nodes refcount if found. */
Marek Lindner44524fc2011-02-10 14:33:53 +0000836 neigh_node = find_router(bat_priv, orig_node, recv_if);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000837
Marek Lindnerd0072602011-01-19 20:01:44 +0000838 if (!neigh_node)
Marek Lindner44524fc2011-02-10 14:33:53 +0000839 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000840
841 /* create a copy of the skb, if needed, to modify it. */
Antonio Quartulli0d125072012-02-18 11:27:34 +0100842 if (skb_cow(skb, ETH_HLEN) < 0)
Marek Lindner44524fc2011-02-10 14:33:53 +0000843 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000844
845 unicast_packet = (struct unicast_packet *)skb->data;
846
Sven Eckelmann76543d12011-11-20 15:47:38 +0100847 if (unicast_packet->header.packet_type == BAT_UNICAST &&
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000848 atomic_read(&bat_priv->fragmentation) &&
Marek Lindnerd0072602011-01-19 20:01:44 +0000849 skb->len > neigh_node->if_incoming->net_dev->mtu) {
850 ret = frag_send_skb(skb, bat_priv,
851 neigh_node->if_incoming, neigh_node->addr);
852 goto out;
853 }
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000854
Sven Eckelmann76543d12011-11-20 15:47:38 +0100855 if (unicast_packet->header.packet_type == BAT_UNICAST_FRAG &&
Marek Lindnerd0072602011-01-19 20:01:44 +0000856 frag_can_reassemble(skb, neigh_node->if_incoming->net_dev->mtu)) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000857
858 ret = frag_reassemble_skb(skb, bat_priv, &new_skb);
859
860 if (ret == NET_RX_DROP)
Marek Lindner44524fc2011-02-10 14:33:53 +0000861 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000862
863 /* packet was buffered for late merge */
Marek Lindner44524fc2011-02-10 14:33:53 +0000864 if (!new_skb) {
865 ret = NET_RX_SUCCESS;
866 goto out;
867 }
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000868
869 skb = new_skb;
870 unicast_packet = (struct unicast_packet *)skb->data;
871 }
872
873 /* decrement ttl */
Sven Eckelmann76543d12011-11-20 15:47:38 +0100874 unicast_packet->header.ttl--;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000875
876 /* route it */
Marek Lindnerd0072602011-01-19 20:01:44 +0000877 send_skb_packet(skb, neigh_node->if_incoming, neigh_node->addr);
Marek Lindner44524fc2011-02-10 14:33:53 +0000878 ret = NET_RX_SUCCESS;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000879
Marek Lindner44524fc2011-02-10 14:33:53 +0000880out:
881 if (neigh_node)
882 neigh_node_free_ref(neigh_node);
883 if (orig_node)
Marek Lindner7b36e8e2011-02-18 12:28:10 +0000884 orig_node_free_ref(orig_node);
Marek Lindner44524fc2011-02-10 14:33:53 +0000885 return ret;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000886}
887
Antonio Quartullia73105b2011-04-27 14:27:44 +0200888static int check_unicast_ttvn(struct bat_priv *bat_priv,
889 struct sk_buff *skb) {
890 uint8_t curr_ttvn;
891 struct orig_node *orig_node;
892 struct ethhdr *ethhdr;
893 struct hard_iface *primary_if;
894 struct unicast_packet *unicast_packet;
Antonio Quartullicc47f662011-04-27 14:27:57 +0200895 bool tt_poss_change;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200896
897 /* I could need to modify it */
898 if (skb_cow(skb, sizeof(struct unicast_packet)) < 0)
899 return 0;
900
901 unicast_packet = (struct unicast_packet *)skb->data;
902
Antonio Quartullicc47f662011-04-27 14:27:57 +0200903 if (is_my_mac(unicast_packet->dest)) {
904 tt_poss_change = bat_priv->tt_poss_change;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200905 curr_ttvn = (uint8_t)atomic_read(&bat_priv->ttvn);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200906 } else {
Antonio Quartullia73105b2011-04-27 14:27:44 +0200907 orig_node = orig_hash_find(bat_priv, unicast_packet->dest);
908
909 if (!orig_node)
910 return 0;
911
912 curr_ttvn = (uint8_t)atomic_read(&orig_node->last_ttvn);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200913 tt_poss_change = orig_node->tt_poss_change;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200914 orig_node_free_ref(orig_node);
915 }
916
917 /* Check whether I have to reroute the packet */
Antonio Quartullicc47f662011-04-27 14:27:57 +0200918 if (seq_before(unicast_packet->ttvn, curr_ttvn) || tt_poss_change) {
Antonio Quartullia73105b2011-04-27 14:27:44 +0200919 /* Linearize the skb before accessing it */
920 if (skb_linearize(skb) < 0)
921 return 0;
922
923 ethhdr = (struct ethhdr *)(skb->data +
924 sizeof(struct unicast_packet));
Antonio Quartulli3d393e42011-07-07 15:35:37 +0200925 orig_node = transtable_search(bat_priv, NULL, ethhdr->h_dest);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200926
927 if (!orig_node) {
928 if (!is_my_client(bat_priv, ethhdr->h_dest))
929 return 0;
930 primary_if = primary_if_get_selected(bat_priv);
931 if (!primary_if)
932 return 0;
933 memcpy(unicast_packet->dest,
934 primary_if->net_dev->dev_addr, ETH_ALEN);
935 hardif_free_ref(primary_if);
936 } else {
937 memcpy(unicast_packet->dest, orig_node->orig,
938 ETH_ALEN);
939 curr_ttvn = (uint8_t)
940 atomic_read(&orig_node->last_ttvn);
941 orig_node_free_ref(orig_node);
942 }
943
Sven Eckelmann86ceb362012-03-07 09:07:45 +0100944 bat_dbg(DBG_ROUTES, bat_priv,
945 "TTVN mismatch (old_ttvn %u new_ttvn %u)! Rerouting unicast packet (for %pM) to %pM\n",
946 unicast_packet->ttvn, curr_ttvn, ethhdr->h_dest,
947 unicast_packet->dest);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200948
949 unicast_packet->ttvn = curr_ttvn;
950 }
951 return 1;
952}
953
Marek Lindnere6c10f42011-02-18 12:33:20 +0000954int recv_unicast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000955{
Antonio Quartullia73105b2011-04-27 14:27:44 +0200956 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000957 struct unicast_packet *unicast_packet;
Sven Eckelmann704509b2011-05-14 23:14:54 +0200958 int hdr_size = sizeof(*unicast_packet);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000959
960 if (check_unicast_packet(skb, hdr_size) < 0)
961 return NET_RX_DROP;
962
Antonio Quartullia73105b2011-04-27 14:27:44 +0200963 if (!check_unicast_ttvn(bat_priv, skb))
964 return NET_RX_DROP;
965
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000966 unicast_packet = (struct unicast_packet *)skb->data;
967
968 /* packet for me */
969 if (is_my_mac(unicast_packet->dest)) {
970 interface_rx(recv_if->soft_iface, skb, recv_if, hdr_size);
971 return NET_RX_SUCCESS;
972 }
973
Linus Lüssing7cefb142011-03-02 17:39:31 +0000974 return route_unicast_packet(skb, recv_if);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000975}
976
Marek Lindnere6c10f42011-02-18 12:33:20 +0000977int recv_ucast_frag_packet(struct sk_buff *skb, struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000978{
979 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
980 struct unicast_frag_packet *unicast_packet;
Sven Eckelmann704509b2011-05-14 23:14:54 +0200981 int hdr_size = sizeof(*unicast_packet);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000982 struct sk_buff *new_skb = NULL;
983 int ret;
984
985 if (check_unicast_packet(skb, hdr_size) < 0)
986 return NET_RX_DROP;
987
Antonio Quartullia73105b2011-04-27 14:27:44 +0200988 if (!check_unicast_ttvn(bat_priv, skb))
989 return NET_RX_DROP;
990
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000991 unicast_packet = (struct unicast_frag_packet *)skb->data;
992
993 /* packet for me */
994 if (is_my_mac(unicast_packet->dest)) {
995
996 ret = frag_reassemble_skb(skb, bat_priv, &new_skb);
997
998 if (ret == NET_RX_DROP)
999 return NET_RX_DROP;
1000
1001 /* packet was buffered for late merge */
1002 if (!new_skb)
1003 return NET_RX_SUCCESS;
1004
1005 interface_rx(recv_if->soft_iface, new_skb, recv_if,
1006 sizeof(struct unicast_packet));
1007 return NET_RX_SUCCESS;
1008 }
1009
Linus Lüssing7cefb142011-03-02 17:39:31 +00001010 return route_unicast_packet(skb, recv_if);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001011}
1012
1013
Marek Lindnere6c10f42011-02-18 12:33:20 +00001014int recv_bcast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001015{
1016 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001017 struct orig_node *orig_node = NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001018 struct bcast_packet *bcast_packet;
1019 struct ethhdr *ethhdr;
Sven Eckelmann704509b2011-05-14 23:14:54 +02001020 int hdr_size = sizeof(*bcast_packet);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001021 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001022 int32_t seq_diff;
1023
1024 /* drop packet if it has not necessary minimum size */
1025 if (unlikely(!pskb_may_pull(skb, hdr_size)))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001026 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001027
1028 ethhdr = (struct ethhdr *)skb_mac_header(skb);
1029
1030 /* packet with broadcast indication but unicast recipient */
1031 if (!is_broadcast_ether_addr(ethhdr->h_dest))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001032 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001033
1034 /* packet with broadcast sender address */
1035 if (is_broadcast_ether_addr(ethhdr->h_source))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001036 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001037
1038 /* ignore broadcasts sent by myself */
1039 if (is_my_mac(ethhdr->h_source))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001040 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001041
1042 bcast_packet = (struct bcast_packet *)skb->data;
1043
1044 /* ignore broadcasts originated by myself */
1045 if (is_my_mac(bcast_packet->orig))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001046 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001047
Sven Eckelmann76543d12011-11-20 15:47:38 +01001048 if (bcast_packet->header.ttl < 2)
Marek Lindnerf3e00082011-01-25 21:52:11 +00001049 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001050
Marek Lindner7aadf882011-02-18 12:28:09 +00001051 orig_node = orig_hash_find(bat_priv, bcast_packet->orig);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001052
1053 if (!orig_node)
Antonio Quartullib5a6f692011-04-16 11:30:57 +02001054 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001055
Marek Lindnerf3e00082011-01-25 21:52:11 +00001056 spin_lock_bh(&orig_node->bcast_seqno_lock);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001057
1058 /* check whether the packet is a duplicate */
Sven Eckelmann0079d2c2012-02-04 17:34:52 +01001059 if (bat_test_bit(orig_node->bcast_bits, orig_node->last_bcast_seqno,
1060 ntohl(bcast_packet->seqno)))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001061 goto spin_unlock;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001062
1063 seq_diff = ntohl(bcast_packet->seqno) - orig_node->last_bcast_seqno;
1064
1065 /* check whether the packet is old and the host just restarted. */
1066 if (window_protected(bat_priv, seq_diff,
Marek Lindnerf3e00082011-01-25 21:52:11 +00001067 &orig_node->bcast_seqno_reset))
1068 goto spin_unlock;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001069
1070 /* mark broadcast in flood history, update window position
1071 * if required. */
1072 if (bit_get_packet(bat_priv, orig_node->bcast_bits, seq_diff, 1))
1073 orig_node->last_bcast_seqno = ntohl(bcast_packet->seqno);
1074
Marek Lindnerf3e00082011-01-25 21:52:11 +00001075 spin_unlock_bh(&orig_node->bcast_seqno_lock);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001076
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001077 /* check whether this has been sent by another originator before */
1078 if (bla_check_bcast_duplist(bat_priv, bcast_packet, hdr_size))
1079 goto out;
1080
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001081 /* rebroadcast packet */
Antonio Quartulli86985292011-06-25 19:09:12 +02001082 add_bcast_packet_to_list(bat_priv, skb, 1);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001083
Simon Wunderlich23721382012-01-22 20:00:19 +01001084 /* don't hand the broadcast up if it is from an originator
1085 * from the same backbone.
1086 */
1087 if (bla_is_backbone_gw(skb, orig_node, hdr_size))
1088 goto out;
1089
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001090 /* broadcast for me */
1091 interface_rx(recv_if->soft_iface, skb, recv_if, hdr_size);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001092 ret = NET_RX_SUCCESS;
1093 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001094
Marek Lindnerf3e00082011-01-25 21:52:11 +00001095spin_unlock:
1096 spin_unlock_bh(&orig_node->bcast_seqno_lock);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001097out:
1098 if (orig_node)
Marek Lindner7b36e8e2011-02-18 12:28:10 +00001099 orig_node_free_ref(orig_node);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001100 return ret;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001101}
1102
Marek Lindnere6c10f42011-02-18 12:33:20 +00001103int recv_vis_packet(struct sk_buff *skb, struct hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001104{
1105 struct vis_packet *vis_packet;
1106 struct ethhdr *ethhdr;
1107 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Sven Eckelmann704509b2011-05-14 23:14:54 +02001108 int hdr_size = sizeof(*vis_packet);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001109
1110 /* keep skb linear */
1111 if (skb_linearize(skb) < 0)
1112 return NET_RX_DROP;
1113
1114 if (unlikely(!pskb_may_pull(skb, hdr_size)))
1115 return NET_RX_DROP;
1116
1117 vis_packet = (struct vis_packet *)skb->data;
1118 ethhdr = (struct ethhdr *)skb_mac_header(skb);
1119
1120 /* not for me */
1121 if (!is_my_mac(ethhdr->h_dest))
1122 return NET_RX_DROP;
1123
1124 /* ignore own packets */
1125 if (is_my_mac(vis_packet->vis_orig))
1126 return NET_RX_DROP;
1127
1128 if (is_my_mac(vis_packet->sender_orig))
1129 return NET_RX_DROP;
1130
1131 switch (vis_packet->vis_type) {
1132 case VIS_TYPE_SERVER_SYNC:
1133 receive_server_sync_packet(bat_priv, vis_packet,
1134 skb_headlen(skb));
1135 break;
1136
1137 case VIS_TYPE_CLIENT_UPDATE:
1138 receive_client_update_packet(bat_priv, vis_packet,
1139 skb_headlen(skb));
1140 break;
1141
1142 default: /* ignore unknown packet */
1143 break;
1144 }
1145
1146 /* We take a copy of the data in the packet, so we should
1147 always free the skbuf. */
1148 return NET_RX_DROP;
1149}