blob: bc2b88bbea1fb5561a9ac2c199eb6926f3af2347 [file] [log] [blame]
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +02001/* Copyright (C) 2007-2012 B.A.T.M.A.N. contributors:
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00002 *
3 * Marek Lindner, Simon Wunderlich
4 *
5 * This program is free software; you can redistribute it and/or
6 * modify it under the terms of version 2 of the GNU General Public
7 * License as published by the Free Software Foundation.
8 *
9 * This program is distributed in the hope that it will be useful, but
10 * WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
12 * General Public License for more details.
13 *
14 * You should have received a copy of the GNU General Public License
15 * along with this program; if not, write to the Free Software
16 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
17 * 02110-1301, USA
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000018 */
19
20#include "main.h"
21#include "routing.h"
22#include "send.h"
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000023#include "soft-interface.h"
24#include "hard-interface.h"
25#include "icmp_socket.h"
26#include "translation-table.h"
27#include "originator.h"
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000028#include "vis.h"
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000029#include "unicast.h"
Simon Wunderlich23721382012-01-22 20:00:19 +010030#include "bridge_loop_avoidance.h"
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000031
Sven Eckelmann63b01032012-05-16 20:23:13 +020032static int batadv_route_unicast_packet(struct sk_buff *skb,
Sven Eckelmann56303d32012-06-05 22:31:31 +020033 struct batadv_hard_iface *recv_if);
Simon Wunderlicha7f6ee92012-01-22 20:00:18 +010034
Sven Eckelmann56303d32012-06-05 22:31:31 +020035void batadv_slide_own_bcast_window(struct batadv_hard_iface *hard_iface)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000036{
Sven Eckelmann56303d32012-06-05 22:31:31 +020037 struct batadv_priv *bat_priv = netdev_priv(hard_iface->soft_iface);
Sven Eckelmann5bf74e92012-06-05 22:31:28 +020038 struct batadv_hashtable *hash = bat_priv->orig_hash;
Marek Lindner7aadf882011-02-18 12:28:09 +000039 struct hlist_node *node;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000040 struct hlist_head *head;
Sven Eckelmann56303d32012-06-05 22:31:31 +020041 struct batadv_orig_node *orig_node;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000042 unsigned long *word;
Antonio Quartullic90681b2011-10-05 17:05:25 +020043 uint32_t i;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000044 size_t word_index;
Sven Eckelmann42d0b042012-06-03 22:19:17 +020045 uint8_t *w;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000046
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000047 for (i = 0; i < hash->size; i++) {
48 head = &hash->table[i];
49
Marek Lindnerfb778ea2011-01-19 20:01:40 +000050 rcu_read_lock();
Marek Lindner7aadf882011-02-18 12:28:09 +000051 hlist_for_each_entry_rcu(orig_node, node, head, hash_entry) {
Marek Lindner2ae2daf2011-01-19 20:01:42 +000052 spin_lock_bh(&orig_node->ogm_cnt_lock);
Sven Eckelmann42d0b042012-06-03 22:19:17 +020053 word_index = hard_iface->if_num * BATADV_NUM_WORDS;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000054 word = &(orig_node->bcast_own[word_index]);
55
Sven Eckelmann0f5f9322012-05-12 02:09:25 +020056 batadv_bit_get_packet(bat_priv, word, 1, 0);
Sven Eckelmann42d0b042012-06-03 22:19:17 +020057 w = &orig_node->bcast_own_sum[hard_iface->if_num];
58 *w = bitmap_weight(word, BATADV_TQ_LOCAL_WINDOW_SIZE);
Marek Lindner2ae2daf2011-01-19 20:01:42 +000059 spin_unlock_bh(&orig_node->ogm_cnt_lock);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000060 }
Marek Lindnerfb778ea2011-01-19 20:01:40 +000061 rcu_read_unlock();
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000062 }
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000063}
64
Sven Eckelmann56303d32012-06-05 22:31:31 +020065static void _batadv_update_route(struct batadv_priv *bat_priv,
66 struct batadv_orig_node *orig_node,
67 struct batadv_neigh_node *neigh_node)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000068{
Sven Eckelmann56303d32012-06-05 22:31:31 +020069 struct batadv_neigh_node *curr_router;
Linus Lüssinge1a5382f2011-03-14 22:43:37 +000070
Sven Eckelmann7d211ef2012-05-12 02:09:34 +020071 curr_router = batadv_orig_node_get_router(orig_node);
Marek Lindnera8e7f4b2010-12-12 21:57:10 +000072
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000073 /* route deleted */
Linus Lüssinge1a5382f2011-03-14 22:43:37 +000074 if ((curr_router) && (!neigh_node)) {
Sven Eckelmann39c75a52012-06-03 22:19:22 +020075 batadv_dbg(BATADV_DBG_ROUTES, bat_priv,
76 "Deleting route towards: %pM\n", orig_node->orig);
Sven Eckelmann08c36d32012-05-12 02:09:39 +020077 batadv_tt_global_del_orig(bat_priv, orig_node,
78 "Deleted route towards originator");
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000079
Linus Lüssinge1a5382f2011-03-14 22:43:37 +000080 /* route added */
81 } else if ((!curr_router) && (neigh_node)) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000082
Sven Eckelmann39c75a52012-06-03 22:19:22 +020083 batadv_dbg(BATADV_DBG_ROUTES, bat_priv,
Sven Eckelmann1eda58b2012-05-12 13:48:58 +020084 "Adding route towards: %pM (via %pM)\n",
85 orig_node->orig, neigh_node->addr);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +000086 /* route changed */
Sven Eckelmannbb899b82011-05-10 11:22:37 +020087 } else if (neigh_node && curr_router) {
Sven Eckelmann39c75a52012-06-03 22:19:22 +020088 batadv_dbg(BATADV_DBG_ROUTES, bat_priv,
Sven Eckelmann1eda58b2012-05-12 13:48:58 +020089 "Changing route towards: %pM (now via %pM - was via %pM)\n",
90 orig_node->orig, neigh_node->addr,
91 curr_router->addr);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +000092 }
93
Linus Lüssinge1a5382f2011-03-14 22:43:37 +000094 if (curr_router)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +020095 batadv_neigh_node_free_ref(curr_router);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +000096
97 /* increase refcount of new best neighbor */
Marek Lindner44524fc2011-02-10 14:33:53 +000098 if (neigh_node && !atomic_inc_not_zero(&neigh_node->refcount))
99 neigh_node = NULL;
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000100
101 spin_lock_bh(&orig_node->neigh_list_lock);
102 rcu_assign_pointer(orig_node->router, neigh_node);
103 spin_unlock_bh(&orig_node->neigh_list_lock);
104
105 /* decrease refcount of previous best neighbor */
106 if (curr_router)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200107 batadv_neigh_node_free_ref(curr_router);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000108}
109
Sven Eckelmann56303d32012-06-05 22:31:31 +0200110void batadv_update_route(struct batadv_priv *bat_priv,
111 struct batadv_orig_node *orig_node,
112 struct batadv_neigh_node *neigh_node)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000113{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200114 struct batadv_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
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200119 router = batadv_orig_node_get_router(orig_node);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000120
121 if (router != neigh_node)
Sven Eckelmann63b01032012-05-16 20:23:13 +0200122 _batadv_update_route(bat_priv, orig_node, neigh_node);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000123
124out:
125 if (router)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200126 batadv_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 */
Sven Eckelmann56303d32012-06-05 22:31:31 +0200130void batadv_bonding_candidate_del(struct batadv_orig_node *orig_node,
131 struct batadv_neigh_node *neigh_node)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000132{
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);
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200139 batadv_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
Sven Eckelmann56303d32012-06-05 22:31:31 +0200146void batadv_bonding_candidate_add(struct batadv_orig_node *orig_node,
147 struct batadv_neigh_node *neigh_node)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000148{
149 struct hlist_node *node;
Sven Eckelmann56303d32012-06-05 22:31:31 +0200150 struct batadv_neigh_node *tmp_neigh_node, *router = NULL;
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000151 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 ... */
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200156 if (!batadv_compare_eth(orig_node->orig,
157 neigh_node->orig_node->primary_addr))
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000158 goto candidate_del;
159
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200160 router = batadv_orig_node_get_router(orig_node);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000161 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 */
Sven Eckelmann42d0b042012-06-03 22:19:17 +0200165 if (neigh_node->tq_avg < router->tq_avg - BATADV_BONDING_TQ_THRESHOLD)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000166 goto candidate_del;
167
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200168 /* check if we have another candidate with the same mac address or
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000169 * interface. If we do, we won't select this candidate because of
170 * possible interference.
171 */
172 hlist_for_each_entry_rcu(tmp_neigh_node, node,
173 &orig_node->neigh_list, list) {
174
175 if (tmp_neigh_node == neigh_node)
176 continue;
177
178 /* we only care if the other candidate is even
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200179 * considered as candidate.
180 */
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000181 if (list_empty(&tmp_neigh_node->bonding_list))
182 continue;
183
184 if ((neigh_node->if_incoming == tmp_neigh_node->if_incoming) ||
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200185 (batadv_compare_eth(neigh_node->addr,
186 tmp_neigh_node->addr))) {
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000187 interference_candidate = 1;
188 break;
189 }
190 }
191
192 /* don't care further if it is an interference candidate */
193 if (interference_candidate)
194 goto candidate_del;
195
196 /* this neighbor already is part of our candidate list */
197 if (!list_empty(&neigh_node->bonding_list))
198 goto out;
199
Marek Lindner44524fc2011-02-10 14:33:53 +0000200 if (!atomic_inc_not_zero(&neigh_node->refcount))
201 goto out;
202
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000203 list_add_rcu(&neigh_node->bonding_list, &orig_node->bond_list);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000204 atomic_inc(&orig_node->bond_candidates);
205 goto out;
206
207candidate_del:
Sven Eckelmann30d3c512012-05-12 02:09:36 +0200208 batadv_bonding_candidate_del(orig_node, neigh_node);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000209
210out:
211 spin_unlock_bh(&orig_node->neigh_list_lock);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000212
213 if (router)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200214 batadv_neigh_node_free_ref(router);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000215}
216
217/* copy primary address for bonding */
Sven Eckelmann30d3c512012-05-12 02:09:36 +0200218void
Sven Eckelmann56303d32012-06-05 22:31:31 +0200219batadv_bonding_save_primary(const struct batadv_orig_node *orig_node,
220 struct batadv_orig_node *orig_neigh_node,
Sven Eckelmann96412692012-06-05 22:31:30 +0200221 const struct batadv_ogm_packet *batman_ogm_packet)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000222{
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200223 if (!(batman_ogm_packet->flags & BATADV_PRIMARIES_FIRST_HOP))
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000224 return;
225
226 memcpy(orig_neigh_node->primary_addr, orig_node->orig, ETH_ALEN);
227}
228
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000229/* checks whether the host restarted and is in the protection time.
230 * returns:
231 * 0 if the packet is to be accepted
232 * 1 if the packet is to be ignored.
233 */
Sven Eckelmann56303d32012-06-05 22:31:31 +0200234int batadv_window_protected(struct batadv_priv *bat_priv, int32_t seq_num_diff,
Sven Eckelmann30d3c512012-05-12 02:09:36 +0200235 unsigned long *last_reset)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000236{
Sven Eckelmann42d0b042012-06-03 22:19:17 +0200237 if (seq_num_diff <= -BATADV_TQ_LOCAL_WINDOW_SIZE ||
238 seq_num_diff >= BATADV_EXPECTED_SEQNO_RANGE) {
239 if (!batadv_has_timed_out(*last_reset,
240 BATADV_RESET_PROTECTION_MS))
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000241 return 1;
Marek Lindner8c7bf242012-03-17 15:28:33 +0800242
243 *last_reset = jiffies;
Sven Eckelmann39c75a52012-06-03 22:19:22 +0200244 batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200245 "old packet received, start protection\n");
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000246 }
Marek Lindner8c7bf242012-03-17 15:28:33 +0800247
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000248 return 0;
249}
250
Sven Eckelmann30d3c512012-05-12 02:09:36 +0200251bool batadv_check_management_packet(struct sk_buff *skb,
Sven Eckelmann56303d32012-06-05 22:31:31 +0200252 struct batadv_hard_iface *hard_iface,
Sven Eckelmann30d3c512012-05-12 02:09:36 +0200253 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
Sven Eckelmann56303d32012-06-05 22:31:31 +0200282static int batadv_recv_my_icmp_packet(struct batadv_priv *bat_priv,
Sven Eckelmann63b01032012-05-16 20:23:13 +0200283 struct sk_buff *skb, size_t icmp_len)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000284{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200285 struct batadv_hard_iface *primary_if = NULL;
286 struct batadv_orig_node *orig_node = NULL;
287 struct batadv_neigh_node *router = NULL;
Sven Eckelmann96412692012-06-05 22:31:30 +0200288 struct batadv_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
Sven Eckelmann96412692012-06-05 22:31:30 +0200291 icmp_packet = (struct batadv_icmp_packet_rr *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000292
293 /* add data to device queue */
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200294 if (icmp_packet->msg_type != BATADV_ECHO_REQUEST) {
Sven Eckelmann9039dc72012-05-12 02:09:33 +0200295 batadv_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
Sven Eckelmanne5d89252012-05-12 13:48:54 +0200299 primary_if = batadv_primary_if_get_selected(bat_priv);
Marek Lindner32ae9b22011-04-20 15:40:58 +0200300 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 */
Sven Eckelmannda641192012-05-12 13:48:56 +0200305 orig_node = batadv_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
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200309 router = batadv_orig_node_get_router(orig_node);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000310 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
Sven Eckelmann96412692012-06-05 22:31:30 +0200317 icmp_packet = (struct batadv_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);
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200321 icmp_packet->msg_type = BATADV_ECHO_REPLY;
Sven Eckelmann42d0b042012-06-03 22:19:17 +0200322 icmp_packet->header.ttl = BATADV_TTL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000323
Sven Eckelmann9455e342012-05-12 02:09:37 +0200324 batadv_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)
Sven Eckelmanne5d89252012-05-12 13:48:54 +0200329 batadv_hardif_free_ref(primary_if);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000330 if (router)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200331 batadv_neigh_node_free_ref(router);
Marek Lindner44524fc2011-02-10 14:33:53 +0000332 if (orig_node)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200333 batadv_orig_node_free_ref(orig_node);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000334 return ret;
335}
336
Sven Eckelmann56303d32012-06-05 22:31:31 +0200337static int batadv_recv_icmp_ttl_exceeded(struct batadv_priv *bat_priv,
Sven Eckelmann63b01032012-05-16 20:23:13 +0200338 struct sk_buff *skb)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000339{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200340 struct batadv_hard_iface *primary_if = NULL;
341 struct batadv_orig_node *orig_node = NULL;
342 struct batadv_neigh_node *router = NULL;
Sven Eckelmann96412692012-06-05 22:31:30 +0200343 struct batadv_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
Sven Eckelmann96412692012-06-05 22:31:30 +0200346 icmp_packet = (struct batadv_icmp_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000347
348 /* send TTL exceeded if packet is an echo request (traceroute) */
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200349 if (icmp_packet->msg_type != BATADV_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
Sven Eckelmanne5d89252012-05-12 13:48:54 +0200355 primary_if = batadv_primary_if_get_selected(bat_priv);
Marek Lindner32ae9b22011-04-20 15:40:58 +0200356 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 */
Sven Eckelmannda641192012-05-12 13:48:56 +0200360 orig_node = batadv_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
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200364 router = batadv_orig_node_get_router(orig_node);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000365 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
Sven Eckelmann96412692012-06-05 22:31:30 +0200372 icmp_packet = (struct batadv_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);
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200376 icmp_packet->msg_type = BATADV_TTL_EXCEEDED;
Sven Eckelmann42d0b042012-06-03 22:19:17 +0200377 icmp_packet->header.ttl = BATADV_TTL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000378
Sven Eckelmann9455e342012-05-12 02:09:37 +0200379 batadv_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)
Sven Eckelmanne5d89252012-05-12 13:48:54 +0200384 batadv_hardif_free_ref(primary_if);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000385 if (router)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200386 batadv_neigh_node_free_ref(router);
Marek Lindner44524fc2011-02-10 14:33:53 +0000387 if (orig_node)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200388 batadv_orig_node_free_ref(orig_node);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000389 return ret;
390}
391
392
Sven Eckelmann56303d32012-06-05 22:31:31 +0200393int batadv_recv_icmp_packet(struct sk_buff *skb,
394 struct batadv_hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000395{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200396 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Sven Eckelmann96412692012-06-05 22:31:30 +0200397 struct batadv_icmp_packet_rr *icmp_packet;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000398 struct ethhdr *ethhdr;
Sven Eckelmann56303d32012-06-05 22:31:31 +0200399 struct batadv_orig_node *orig_node = NULL;
400 struct batadv_neigh_node *router = NULL;
Sven Eckelmann96412692012-06-05 22:31:30 +0200401 int hdr_size = sizeof(struct batadv_icmp_packet);
Marek Lindner44524fc2011-02-10 14:33:53 +0000402 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000403
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200404 /* we truncate all incoming icmp packets if they don't match our size */
Sven Eckelmann96412692012-06-05 22:31:30 +0200405 if (skb->len >= sizeof(struct batadv_icmp_packet_rr))
406 hdr_size = sizeof(struct batadv_icmp_packet_rr);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000407
408 /* drop packet if it has not necessary minimum size */
409 if (unlikely(!pskb_may_pull(skb, hdr_size)))
Marek Lindner44524fc2011-02-10 14:33:53 +0000410 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000411
412 ethhdr = (struct ethhdr *)skb_mac_header(skb);
413
414 /* packet with unicast indication but broadcast recipient */
415 if (is_broadcast_ether_addr(ethhdr->h_dest))
Marek Lindner44524fc2011-02-10 14:33:53 +0000416 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000417
418 /* packet with broadcast sender address */
419 if (is_broadcast_ether_addr(ethhdr->h_source))
Marek Lindner44524fc2011-02-10 14:33:53 +0000420 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000421
422 /* not for me */
Sven Eckelmann3193e8f2012-05-12 02:09:42 +0200423 if (!batadv_is_my_mac(ethhdr->h_dest))
Marek Lindner44524fc2011-02-10 14:33:53 +0000424 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000425
Sven Eckelmann96412692012-06-05 22:31:30 +0200426 icmp_packet = (struct batadv_icmp_packet_rr *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000427
428 /* add record route information if not full */
Sven Eckelmann96412692012-06-05 22:31:30 +0200429 if ((hdr_size == sizeof(struct batadv_icmp_packet_rr)) &&
Sven Eckelmann7e071c72012-06-03 22:19:13 +0200430 (icmp_packet->rr_cur < BATADV_RR_LEN)) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000431 memcpy(&(icmp_packet->rr[icmp_packet->rr_cur]),
Sven Eckelmann7c64fd92012-02-28 10:55:36 +0100432 ethhdr->h_dest, ETH_ALEN);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000433 icmp_packet->rr_cur++;
434 }
435
436 /* packet for me */
Sven Eckelmann3193e8f2012-05-12 02:09:42 +0200437 if (batadv_is_my_mac(icmp_packet->dst))
Sven Eckelmann63b01032012-05-16 20:23:13 +0200438 return batadv_recv_my_icmp_packet(bat_priv, skb, hdr_size);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000439
440 /* TTL exceeded */
Sven Eckelmann76543d12011-11-20 15:47:38 +0100441 if (icmp_packet->header.ttl < 2)
Sven Eckelmann63b01032012-05-16 20:23:13 +0200442 return batadv_recv_icmp_ttl_exceeded(bat_priv, skb);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000443
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000444 /* get routing information */
Sven Eckelmannda641192012-05-12 13:48:56 +0200445 orig_node = batadv_orig_hash_find(bat_priv, icmp_packet->dst);
Marek Lindner44524fc2011-02-10 14:33:53 +0000446 if (!orig_node)
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000447 goto out;
Marek Lindner44524fc2011-02-10 14:33:53 +0000448
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200449 router = batadv_orig_node_get_router(orig_node);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000450 if (!router)
451 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000452
Marek Lindner44524fc2011-02-10 14:33:53 +0000453 /* create a copy of the skb, if needed, to modify it. */
Antonio Quartulli0d125072012-02-18 11:27:34 +0100454 if (skb_cow(skb, ETH_HLEN) < 0)
Marek Lindner44524fc2011-02-10 14:33:53 +0000455 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000456
Sven Eckelmann96412692012-06-05 22:31:30 +0200457 icmp_packet = (struct batadv_icmp_packet_rr *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000458
Marek Lindner44524fc2011-02-10 14:33:53 +0000459 /* decrement ttl */
Sven Eckelmann76543d12011-11-20 15:47:38 +0100460 icmp_packet->header.ttl--;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000461
Marek Lindner44524fc2011-02-10 14:33:53 +0000462 /* route it */
Sven Eckelmann9455e342012-05-12 02:09:37 +0200463 batadv_send_skb_packet(skb, router->if_incoming, router->addr);
Marek Lindner44524fc2011-02-10 14:33:53 +0000464 ret = NET_RX_SUCCESS;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000465
Marek Lindner44524fc2011-02-10 14:33:53 +0000466out:
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000467 if (router)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200468 batadv_neigh_node_free_ref(router);
Marek Lindner44524fc2011-02-10 14:33:53 +0000469 if (orig_node)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200470 batadv_orig_node_free_ref(orig_node);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000471 return ret;
472}
473
Linus Lüssing55158622011-03-14 22:43:27 +0000474/* In the bonding case, send the packets in a round
475 * robin fashion over the remaining interfaces.
476 *
477 * This method rotates the bonding list and increases the
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200478 * returned router's refcount.
479 */
Sven Eckelmann56303d32012-06-05 22:31:31 +0200480static struct batadv_neigh_node *
481batadv_find_bond_router(struct batadv_orig_node *primary_orig,
482 const struct batadv_hard_iface *recv_if)
Linus Lüssing55158622011-03-14 22:43:27 +0000483{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200484 struct batadv_neigh_node *tmp_neigh_node;
485 struct batadv_neigh_node *router = NULL, *first_candidate = NULL;
Linus Lüssing55158622011-03-14 22:43:27 +0000486
487 rcu_read_lock();
488 list_for_each_entry_rcu(tmp_neigh_node, &primary_orig->bond_list,
489 bonding_list) {
490 if (!first_candidate)
491 first_candidate = tmp_neigh_node;
492
493 /* recv_if == NULL on the first node. */
494 if (tmp_neigh_node->if_incoming == recv_if)
495 continue;
496
497 if (!atomic_inc_not_zero(&tmp_neigh_node->refcount))
498 continue;
499
500 router = tmp_neigh_node;
501 break;
502 }
503
504 /* use the first candidate if nothing was found. */
505 if (!router && first_candidate &&
506 atomic_inc_not_zero(&first_candidate->refcount))
507 router = first_candidate;
508
509 if (!router)
510 goto out;
511
512 /* selected should point to the next element
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200513 * after the current router
514 */
Linus Lüssing55158622011-03-14 22:43:27 +0000515 spin_lock_bh(&primary_orig->neigh_list_lock);
516 /* this is a list_move(), which unfortunately
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200517 * does not exist as rcu version
518 */
Linus Lüssing55158622011-03-14 22:43:27 +0000519 list_del_rcu(&primary_orig->bond_list);
520 list_add_rcu(&primary_orig->bond_list,
521 &router->bonding_list);
522 spin_unlock_bh(&primary_orig->neigh_list_lock);
523
524out:
525 rcu_read_unlock();
526 return router;
527}
528
529/* Interface Alternating: Use the best of the
530 * remaining candidates which are not using
531 * this interface.
532 *
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200533 * Increases the returned router's refcount
534 */
Sven Eckelmann56303d32012-06-05 22:31:31 +0200535static struct batadv_neigh_node *
536batadv_find_ifalter_router(struct batadv_orig_node *primary_orig,
537 const struct batadv_hard_iface *recv_if)
Linus Lüssing55158622011-03-14 22:43:27 +0000538{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200539 struct batadv_neigh_node *tmp_neigh_node;
540 struct batadv_neigh_node *router = NULL, *first_candidate = NULL;
Linus Lüssing55158622011-03-14 22:43:27 +0000541
542 rcu_read_lock();
543 list_for_each_entry_rcu(tmp_neigh_node, &primary_orig->bond_list,
544 bonding_list) {
545 if (!first_candidate)
546 first_candidate = tmp_neigh_node;
547
548 /* recv_if == NULL on the first node. */
549 if (tmp_neigh_node->if_incoming == recv_if)
550 continue;
551
552 if (!atomic_inc_not_zero(&tmp_neigh_node->refcount))
553 continue;
554
555 /* if we don't have a router yet
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200556 * or this one is better, choose it.
557 */
Linus Lüssing55158622011-03-14 22:43:27 +0000558 if ((!router) ||
559 (tmp_neigh_node->tq_avg > router->tq_avg)) {
560 /* decrement refcount of
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200561 * previously selected router
562 */
Linus Lüssing55158622011-03-14 22:43:27 +0000563 if (router)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200564 batadv_neigh_node_free_ref(router);
Linus Lüssing55158622011-03-14 22:43:27 +0000565
566 router = tmp_neigh_node;
567 atomic_inc_not_zero(&router->refcount);
568 }
569
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200570 batadv_neigh_node_free_ref(tmp_neigh_node);
Linus Lüssing55158622011-03-14 22:43:27 +0000571 }
572
573 /* use the first candidate if nothing was found. */
574 if (!router && first_candidate &&
575 atomic_inc_not_zero(&first_candidate->refcount))
576 router = first_candidate;
577
578 rcu_read_unlock();
579 return router;
580}
581
Sven Eckelmann56303d32012-06-05 22:31:31 +0200582int batadv_recv_tt_query(struct sk_buff *skb, struct batadv_hard_iface *recv_if)
Antonio Quartullia73105b2011-04-27 14:27:44 +0200583{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200584 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Sven Eckelmann96412692012-06-05 22:31:30 +0200585 struct batadv_tt_query_packet *tt_query;
Al Virof25bd582012-04-22 07:44:27 +0100586 uint16_t tt_size;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200587 struct ethhdr *ethhdr;
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200588 char tt_flag;
Sven Eckelmann96412692012-06-05 22:31:30 +0200589 size_t packet_size;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200590
591 /* drop packet if it has not necessary minimum size */
Sven Eckelmann96412692012-06-05 22:31:30 +0200592 if (unlikely(!pskb_may_pull(skb,
593 sizeof(struct batadv_tt_query_packet))))
Antonio Quartullia73105b2011-04-27 14:27:44 +0200594 goto out;
595
596 /* I could need to modify it */
Sven Eckelmann96412692012-06-05 22:31:30 +0200597 if (skb_cow(skb, sizeof(struct batadv_tt_query_packet)) < 0)
Antonio Quartullia73105b2011-04-27 14:27:44 +0200598 goto out;
599
600 ethhdr = (struct ethhdr *)skb_mac_header(skb);
601
602 /* packet with unicast indication but broadcast recipient */
603 if (is_broadcast_ether_addr(ethhdr->h_dest))
604 goto out;
605
606 /* packet with broadcast sender address */
607 if (is_broadcast_ether_addr(ethhdr->h_source))
608 goto out;
609
Sven Eckelmann96412692012-06-05 22:31:30 +0200610 tt_query = (struct batadv_tt_query_packet *)skb->data;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200611
Sven Eckelmann7e071c72012-06-03 22:19:13 +0200612 switch (tt_query->flags & BATADV_TT_QUERY_TYPE_MASK) {
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200613 case BATADV_TT_REQUEST:
Sven Eckelmannd69909d2012-06-03 22:19:20 +0200614 batadv_inc_counter(bat_priv, BATADV_CNT_TT_REQUEST_RX);
Martin Hundebøllf8214862012-04-20 17:02:45 +0200615
Antonio Quartullia73105b2011-04-27 14:27:44 +0200616 /* If we cannot provide an answer the tt_request is
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200617 * forwarded
618 */
Sven Eckelmann08c36d32012-05-12 02:09:39 +0200619 if (!batadv_send_tt_response(bat_priv, tt_query)) {
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200620 if (tt_query->flags & BATADV_TT_FULL_TABLE)
621 tt_flag = 'F';
622 else
623 tt_flag = '.';
624
Sven Eckelmann39c75a52012-06-03 22:19:22 +0200625 batadv_dbg(BATADV_DBG_TT, bat_priv,
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200626 "Routing TT_REQUEST to %pM [%c]\n",
627 tt_query->dst,
628 tt_flag);
Sven Eckelmann63b01032012-05-16 20:23:13 +0200629 return batadv_route_unicast_packet(skb, recv_if);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200630 }
631 break;
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200632 case BATADV_TT_RESPONSE:
Sven Eckelmannd69909d2012-06-03 22:19:20 +0200633 batadv_inc_counter(bat_priv, BATADV_CNT_TT_RESPONSE_RX);
Martin Hundebøllf8214862012-04-20 17:02:45 +0200634
Sven Eckelmann3193e8f2012-05-12 02:09:42 +0200635 if (batadv_is_my_mac(tt_query->dst)) {
Antonio Quartullidc58fe32011-10-16 20:32:02 +0200636 /* packet needs to be linearized to access the TT
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200637 * changes
638 */
Antonio Quartullidc58fe32011-10-16 20:32:02 +0200639 if (skb_linearize(skb) < 0)
640 goto out;
Antonio Quartullid2b6cc82012-06-14 22:21:28 +0200641 /* skb_linearize() possibly changed skb->data */
Sven Eckelmann96412692012-06-05 22:31:30 +0200642 tt_query = (struct batadv_tt_query_packet *)skb->data;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200643
Sven Eckelmann08c36d32012-05-12 02:09:39 +0200644 tt_size = batadv_tt_len(ntohs(tt_query->tt_data));
Antonio Quartulli8b7342d2011-10-16 20:32:03 +0200645
646 /* Ensure we have all the claimed data */
Sven Eckelmann96412692012-06-05 22:31:30 +0200647 packet_size = sizeof(struct batadv_tt_query_packet);
648 packet_size += tt_size;
649 if (unlikely(skb_headlen(skb) < packet_size))
Antonio Quartulli8b7342d2011-10-16 20:32:03 +0200650 goto out;
651
Sven Eckelmann08c36d32012-05-12 02:09:39 +0200652 batadv_handle_tt_response(bat_priv, tt_query);
Antonio Quartullidc58fe32011-10-16 20:32:02 +0200653 } else {
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200654 if (tt_query->flags & BATADV_TT_FULL_TABLE)
655 tt_flag = 'F';
656 else
657 tt_flag = '.';
Sven Eckelmann39c75a52012-06-03 22:19:22 +0200658 batadv_dbg(BATADV_DBG_TT, bat_priv,
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200659 "Routing TT_RESPONSE to %pM [%c]\n",
660 tt_query->dst,
661 tt_flag);
Sven Eckelmann63b01032012-05-16 20:23:13 +0200662 return batadv_route_unicast_packet(skb, recv_if);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200663 }
664 break;
665 }
666
667out:
668 /* returning NET_RX_DROP will make the caller function kfree the skb */
669 return NET_RX_DROP;
670}
671
Sven Eckelmann56303d32012-06-05 22:31:31 +0200672int batadv_recv_roam_adv(struct sk_buff *skb, struct batadv_hard_iface *recv_if)
Antonio Quartullicc47f662011-04-27 14:27:57 +0200673{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200674 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Sven Eckelmann96412692012-06-05 22:31:30 +0200675 struct batadv_roam_adv_packet *roam_adv_packet;
Sven Eckelmann56303d32012-06-05 22:31:31 +0200676 struct batadv_orig_node *orig_node;
Antonio Quartullicc47f662011-04-27 14:27:57 +0200677 struct ethhdr *ethhdr;
678
679 /* drop packet if it has not necessary minimum size */
Sven Eckelmann96412692012-06-05 22:31:30 +0200680 if (unlikely(!pskb_may_pull(skb,
681 sizeof(struct batadv_roam_adv_packet))))
Antonio Quartullicc47f662011-04-27 14:27:57 +0200682 goto out;
683
684 ethhdr = (struct ethhdr *)skb_mac_header(skb);
685
686 /* packet with unicast indication but broadcast recipient */
687 if (is_broadcast_ether_addr(ethhdr->h_dest))
688 goto out;
689
690 /* packet with broadcast sender address */
691 if (is_broadcast_ether_addr(ethhdr->h_source))
692 goto out;
693
Sven Eckelmannd69909d2012-06-03 22:19:20 +0200694 batadv_inc_counter(bat_priv, BATADV_CNT_TT_ROAM_ADV_RX);
Martin Hundebøllf8214862012-04-20 17:02:45 +0200695
Sven Eckelmann96412692012-06-05 22:31:30 +0200696 roam_adv_packet = (struct batadv_roam_adv_packet *)skb->data;
Antonio Quartullicc47f662011-04-27 14:27:57 +0200697
Sven Eckelmann3193e8f2012-05-12 02:09:42 +0200698 if (!batadv_is_my_mac(roam_adv_packet->dst))
Sven Eckelmann63b01032012-05-16 20:23:13 +0200699 return batadv_route_unicast_packet(skb, recv_if);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200700
Simon Wunderlich20ff9d52012-01-22 20:00:23 +0100701 /* check if it is a backbone gateway. we don't accept
702 * roaming advertisement from it, as it has the same
703 * entries as we have.
704 */
Sven Eckelmann08adf152012-05-12 13:38:47 +0200705 if (batadv_bla_is_backbone_gw_orig(bat_priv, roam_adv_packet->src))
Simon Wunderlich20ff9d52012-01-22 20:00:23 +0100706 goto out;
707
Sven Eckelmannda641192012-05-12 13:48:56 +0200708 orig_node = batadv_orig_hash_find(bat_priv, roam_adv_packet->src);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200709 if (!orig_node)
710 goto out;
711
Sven Eckelmann39c75a52012-06-03 22:19:22 +0200712 batadv_dbg(BATADV_DBG_TT, bat_priv,
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200713 "Received ROAMING_ADV from %pM (client %pM)\n",
714 roam_adv_packet->src, roam_adv_packet->client);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200715
Sven Eckelmann08c36d32012-05-12 02:09:39 +0200716 batadv_tt_global_add(bat_priv, orig_node, roam_adv_packet->client,
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200717 BATADV_TT_CLIENT_ROAM,
Antonio Quartullid4f44692012-05-25 00:00:54 +0200718 atomic_read(&orig_node->last_ttvn) + 1);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200719
720 /* Roaming phase starts: I have new information but the ttvn has not
721 * been incremented yet. This flag will make me check all the incoming
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200722 * packets for the correct destination.
723 */
Antonio Quartullicc47f662011-04-27 14:27:57 +0200724 bat_priv->tt_poss_change = true;
725
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200726 batadv_orig_node_free_ref(orig_node);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200727out:
728 /* returning NET_RX_DROP will make the caller function kfree the skb */
729 return NET_RX_DROP;
730}
731
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000732/* find a suitable router for this originator, and use
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000733 * bonding if possible. increases the found neighbors
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200734 * refcount.
735 */
Sven Eckelmann56303d32012-06-05 22:31:31 +0200736struct batadv_neigh_node *
737batadv_find_router(struct batadv_priv *bat_priv,
738 struct batadv_orig_node *orig_node,
739 const struct batadv_hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000740{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200741 struct batadv_orig_node *primary_orig_node;
742 struct batadv_orig_node *router_orig;
743 struct batadv_neigh_node *router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000744 static uint8_t zero_mac[ETH_ALEN] = {0, 0, 0, 0, 0, 0};
745 int bonding_enabled;
Sven Eckelmannda641192012-05-12 13:48:56 +0200746 uint8_t *primary_addr;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000747
748 if (!orig_node)
749 return NULL;
750
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200751 router = batadv_orig_node_get_router(orig_node);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000752 if (!router)
Marek Lindner01df2b62011-05-05 14:14:46 +0200753 goto err;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000754
755 /* without bonding, the first node should
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200756 * always choose the default router.
757 */
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000758 bonding_enabled = atomic_read(&bat_priv->bonding);
759
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000760 rcu_read_lock();
761 /* select default router to output */
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000762 router_orig = router->orig_node;
Marek Lindner01df2b62011-05-05 14:14:46 +0200763 if (!router_orig)
764 goto err_unlock;
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000765
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000766 if ((!recv_if) && (!bonding_enabled))
767 goto return_router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000768
Sven Eckelmannda641192012-05-12 13:48:56 +0200769 primary_addr = router_orig->primary_addr;
770
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000771 /* if we have something in the primary_addr, we can search
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200772 * for a potential bonding candidate.
773 */
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200774 if (batadv_compare_eth(primary_addr, zero_mac))
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000775 goto return_router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000776
777 /* find the orig_node which has the primary interface. might
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200778 * even be the same as our router_orig in many cases
779 */
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200780 if (batadv_compare_eth(primary_addr, router_orig->orig)) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000781 primary_orig_node = router_orig;
782 } else {
Sven Eckelmannda641192012-05-12 13:48:56 +0200783 primary_orig_node = batadv_orig_hash_find(bat_priv,
784 primary_addr);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000785 if (!primary_orig_node)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000786 goto return_router;
Marek Lindner7aadf882011-02-18 12:28:09 +0000787
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200788 batadv_orig_node_free_ref(primary_orig_node);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000789 }
790
791 /* with less than 2 candidates, we can't do any
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200792 * bonding and prefer the original router.
793 */
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000794 if (atomic_read(&primary_orig_node->bond_candidates) < 2)
795 goto return_router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000796
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000797 /* all nodes between should choose a candidate which
798 * is is not on the interface where the packet came
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200799 * in.
800 */
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200801 batadv_neigh_node_free_ref(router);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000802
Linus Lüssing55158622011-03-14 22:43:27 +0000803 if (bonding_enabled)
Sven Eckelmann63b01032012-05-16 20:23:13 +0200804 router = batadv_find_bond_router(primary_orig_node, recv_if);
Linus Lüssing55158622011-03-14 22:43:27 +0000805 else
Sven Eckelmann63b01032012-05-16 20:23:13 +0200806 router = batadv_find_ifalter_router(primary_orig_node, recv_if);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000807
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000808return_router:
Sven Eckelmanne9a4f292012-06-03 22:19:19 +0200809 if (router && router->if_incoming->if_status != BATADV_IF_ACTIVE)
Antonio Quartullie2cbc112011-05-08 20:52:57 +0200810 goto err_unlock;
811
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000812 rcu_read_unlock();
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000813 return router;
Marek Lindner01df2b62011-05-05 14:14:46 +0200814err_unlock:
815 rcu_read_unlock();
816err:
817 if (router)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200818 batadv_neigh_node_free_ref(router);
Marek Lindner01df2b62011-05-05 14:14:46 +0200819 return NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000820}
821
Sven Eckelmann63b01032012-05-16 20:23:13 +0200822static int batadv_check_unicast_packet(struct sk_buff *skb, int hdr_size)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000823{
824 struct ethhdr *ethhdr;
825
826 /* drop packet if it has not necessary minimum size */
827 if (unlikely(!pskb_may_pull(skb, hdr_size)))
828 return -1;
829
830 ethhdr = (struct ethhdr *)skb_mac_header(skb);
831
832 /* packet with unicast indication but broadcast recipient */
833 if (is_broadcast_ether_addr(ethhdr->h_dest))
834 return -1;
835
836 /* packet with broadcast sender address */
837 if (is_broadcast_ether_addr(ethhdr->h_source))
838 return -1;
839
840 /* not for me */
Sven Eckelmann3193e8f2012-05-12 02:09:42 +0200841 if (!batadv_is_my_mac(ethhdr->h_dest))
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000842 return -1;
843
844 return 0;
845}
846
Sven Eckelmann63b01032012-05-16 20:23:13 +0200847static int batadv_route_unicast_packet(struct sk_buff *skb,
Sven Eckelmann56303d32012-06-05 22:31:31 +0200848 struct batadv_hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000849{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200850 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
851 struct batadv_orig_node *orig_node = NULL;
852 struct batadv_neigh_node *neigh_node = NULL;
Sven Eckelmann96412692012-06-05 22:31:30 +0200853 struct batadv_unicast_packet *unicast_packet;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000854 struct ethhdr *ethhdr = (struct ethhdr *)skb_mac_header(skb);
Marek Lindner44524fc2011-02-10 14:33:53 +0000855 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000856 struct sk_buff *new_skb;
857
Sven Eckelmann96412692012-06-05 22:31:30 +0200858 unicast_packet = (struct batadv_unicast_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000859
860 /* TTL exceeded */
Sven Eckelmann76543d12011-11-20 15:47:38 +0100861 if (unicast_packet->header.ttl < 2) {
Sven Eckelmann86ceb362012-03-07 09:07:45 +0100862 pr_debug("Warning - can't forward unicast packet from %pM to %pM: ttl exceeded\n",
863 ethhdr->h_source, unicast_packet->dest);
Marek Lindner44524fc2011-02-10 14:33:53 +0000864 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000865 }
866
867 /* get routing information */
Sven Eckelmannda641192012-05-12 13:48:56 +0200868 orig_node = batadv_orig_hash_find(bat_priv, unicast_packet->dest);
Marek Lindner7aadf882011-02-18 12:28:09 +0000869
Marek Lindner44524fc2011-02-10 14:33:53 +0000870 if (!orig_node)
Antonio Quartullib5a6f692011-04-16 11:30:57 +0200871 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000872
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000873 /* find_router() increases neigh_nodes refcount if found. */
Sven Eckelmann30d3c512012-05-12 02:09:36 +0200874 neigh_node = batadv_find_router(bat_priv, orig_node, recv_if);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000875
Marek Lindnerd0072602011-01-19 20:01:44 +0000876 if (!neigh_node)
Marek Lindner44524fc2011-02-10 14:33:53 +0000877 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000878
879 /* create a copy of the skb, if needed, to modify it. */
Antonio Quartulli0d125072012-02-18 11:27:34 +0100880 if (skb_cow(skb, ETH_HLEN) < 0)
Marek Lindner44524fc2011-02-10 14:33:53 +0000881 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000882
Sven Eckelmann96412692012-06-05 22:31:30 +0200883 unicast_packet = (struct batadv_unicast_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000884
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200885 if (unicast_packet->header.packet_type == BATADV_UNICAST &&
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000886 atomic_read(&bat_priv->fragmentation) &&
Marek Lindnerd0072602011-01-19 20:01:44 +0000887 skb->len > neigh_node->if_incoming->net_dev->mtu) {
Sven Eckelmann88ed1e772012-05-12 02:09:40 +0200888 ret = batadv_frag_send_skb(skb, bat_priv,
889 neigh_node->if_incoming,
890 neigh_node->addr);
Marek Lindnerd0072602011-01-19 20:01:44 +0000891 goto out;
892 }
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000893
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200894 if (unicast_packet->header.packet_type == BATADV_UNICAST_FRAG &&
Sven Eckelmannf0530ee2012-05-12 13:48:57 +0200895 batadv_frag_can_reassemble(skb,
896 neigh_node->if_incoming->net_dev->mtu)) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000897
Sven Eckelmann88ed1e772012-05-12 02:09:40 +0200898 ret = batadv_frag_reassemble_skb(skb, bat_priv, &new_skb);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000899
900 if (ret == NET_RX_DROP)
Marek Lindner44524fc2011-02-10 14:33:53 +0000901 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000902
903 /* packet was buffered for late merge */
Marek Lindner44524fc2011-02-10 14:33:53 +0000904 if (!new_skb) {
905 ret = NET_RX_SUCCESS;
906 goto out;
907 }
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000908
909 skb = new_skb;
Sven Eckelmann96412692012-06-05 22:31:30 +0200910 unicast_packet = (struct batadv_unicast_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000911 }
912
913 /* decrement ttl */
Sven Eckelmann76543d12011-11-20 15:47:38 +0100914 unicast_packet->header.ttl--;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000915
Martin Hundebøllf8214862012-04-20 17:02:45 +0200916 /* Update stats counter */
Sven Eckelmannd69909d2012-06-03 22:19:20 +0200917 batadv_inc_counter(bat_priv, BATADV_CNT_FORWARD);
918 batadv_add_counter(bat_priv, BATADV_CNT_FORWARD_BYTES,
Martin Hundebøllf8214862012-04-20 17:02:45 +0200919 skb->len + ETH_HLEN);
920
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000921 /* route it */
Sven Eckelmann9455e342012-05-12 02:09:37 +0200922 batadv_send_skb_packet(skb, neigh_node->if_incoming, neigh_node->addr);
Marek Lindner44524fc2011-02-10 14:33:53 +0000923 ret = NET_RX_SUCCESS;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000924
Marek Lindner44524fc2011-02-10 14:33:53 +0000925out:
926 if (neigh_node)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200927 batadv_neigh_node_free_ref(neigh_node);
Marek Lindner44524fc2011-02-10 14:33:53 +0000928 if (orig_node)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200929 batadv_orig_node_free_ref(orig_node);
Marek Lindner44524fc2011-02-10 14:33:53 +0000930 return ret;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000931}
932
Sven Eckelmann56303d32012-06-05 22:31:31 +0200933static int batadv_check_unicast_ttvn(struct batadv_priv *bat_priv,
Sven Eckelmann63b01032012-05-16 20:23:13 +0200934 struct sk_buff *skb) {
Antonio Quartullia73105b2011-04-27 14:27:44 +0200935 uint8_t curr_ttvn;
Sven Eckelmann56303d32012-06-05 22:31:31 +0200936 struct batadv_orig_node *orig_node;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200937 struct ethhdr *ethhdr;
Sven Eckelmann56303d32012-06-05 22:31:31 +0200938 struct batadv_hard_iface *primary_if;
Sven Eckelmann96412692012-06-05 22:31:30 +0200939 struct batadv_unicast_packet *unicast_packet;
Antonio Quartullicc47f662011-04-27 14:27:57 +0200940 bool tt_poss_change;
Sven Eckelmann3e348192012-05-16 20:23:22 +0200941 int is_old_ttvn;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200942
943 /* I could need to modify it */
Sven Eckelmann96412692012-06-05 22:31:30 +0200944 if (skb_cow(skb, sizeof(struct batadv_unicast_packet)) < 0)
Antonio Quartullia73105b2011-04-27 14:27:44 +0200945 return 0;
946
Sven Eckelmann96412692012-06-05 22:31:30 +0200947 unicast_packet = (struct batadv_unicast_packet *)skb->data;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200948
Sven Eckelmann3193e8f2012-05-12 02:09:42 +0200949 if (batadv_is_my_mac(unicast_packet->dest)) {
Antonio Quartullicc47f662011-04-27 14:27:57 +0200950 tt_poss_change = bat_priv->tt_poss_change;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200951 curr_ttvn = (uint8_t)atomic_read(&bat_priv->ttvn);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200952 } else {
Sven Eckelmannda641192012-05-12 13:48:56 +0200953 orig_node = batadv_orig_hash_find(bat_priv,
954 unicast_packet->dest);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200955
956 if (!orig_node)
957 return 0;
958
959 curr_ttvn = (uint8_t)atomic_read(&orig_node->last_ttvn);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200960 tt_poss_change = orig_node->tt_poss_change;
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200961 batadv_orig_node_free_ref(orig_node);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200962 }
963
964 /* Check whether I have to reroute the packet */
Sven Eckelmann3e348192012-05-16 20:23:22 +0200965 is_old_ttvn = batadv_seq_before(unicast_packet->ttvn, curr_ttvn);
966 if (is_old_ttvn || tt_poss_change) {
Antonio Quartulli8710e262012-03-16 11:52:31 +0100967 /* check if there is enough data before accessing it */
Sven Eckelmann96412692012-06-05 22:31:30 +0200968 if (pskb_may_pull(skb, sizeof(struct batadv_unicast_packet) +
Antonio Quartulli8710e262012-03-16 11:52:31 +0100969 ETH_HLEN) < 0)
Antonio Quartullia73105b2011-04-27 14:27:44 +0200970 return 0;
971
Sven Eckelmann0aca2362012-06-19 20:26:30 +0200972 ethhdr = (struct ethhdr *)(skb->data + sizeof(*unicast_packet));
Antonio Quartulli3275e7c2012-03-16 18:03:28 +0100973
974 /* we don't have an updated route for this client, so we should
975 * not try to reroute the packet!!
976 */
Sven Eckelmann08c36d32012-05-12 02:09:39 +0200977 if (batadv_tt_global_client_is_roaming(bat_priv,
978 ethhdr->h_dest))
Antonio Quartulli3275e7c2012-03-16 18:03:28 +0100979 return 1;
980
Sven Eckelmann08c36d32012-05-12 02:09:39 +0200981 orig_node = batadv_transtable_search(bat_priv, NULL,
982 ethhdr->h_dest);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200983
984 if (!orig_node) {
Sven Eckelmann08c36d32012-05-12 02:09:39 +0200985 if (!batadv_is_my_client(bat_priv, ethhdr->h_dest))
Antonio Quartullia73105b2011-04-27 14:27:44 +0200986 return 0;
Sven Eckelmanne5d89252012-05-12 13:48:54 +0200987 primary_if = batadv_primary_if_get_selected(bat_priv);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200988 if (!primary_if)
989 return 0;
990 memcpy(unicast_packet->dest,
991 primary_if->net_dev->dev_addr, ETH_ALEN);
Sven Eckelmanne5d89252012-05-12 13:48:54 +0200992 batadv_hardif_free_ref(primary_if);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200993 } else {
994 memcpy(unicast_packet->dest, orig_node->orig,
995 ETH_ALEN);
996 curr_ttvn = (uint8_t)
997 atomic_read(&orig_node->last_ttvn);
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200998 batadv_orig_node_free_ref(orig_node);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200999 }
1000
Sven Eckelmann39c75a52012-06-03 22:19:22 +02001001 batadv_dbg(BATADV_DBG_ROUTES, bat_priv,
Sven Eckelmann1eda58b2012-05-12 13:48:58 +02001002 "TTVN mismatch (old_ttvn %u new_ttvn %u)! Rerouting unicast packet (for %pM) to %pM\n",
1003 unicast_packet->ttvn, curr_ttvn, ethhdr->h_dest,
1004 unicast_packet->dest);
Antonio Quartullia73105b2011-04-27 14:27:44 +02001005
1006 unicast_packet->ttvn = curr_ttvn;
1007 }
1008 return 1;
1009}
1010
Sven Eckelmann56303d32012-06-05 22:31:31 +02001011int batadv_recv_unicast_packet(struct sk_buff *skb,
1012 struct batadv_hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001013{
Sven Eckelmann56303d32012-06-05 22:31:31 +02001014 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Sven Eckelmann96412692012-06-05 22:31:30 +02001015 struct batadv_unicast_packet *unicast_packet;
Sven Eckelmann704509b2011-05-14 23:14:54 +02001016 int hdr_size = sizeof(*unicast_packet);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001017
Sven Eckelmann63b01032012-05-16 20:23:13 +02001018 if (batadv_check_unicast_packet(skb, hdr_size) < 0)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001019 return NET_RX_DROP;
1020
Sven Eckelmann63b01032012-05-16 20:23:13 +02001021 if (!batadv_check_unicast_ttvn(bat_priv, skb))
Antonio Quartullia73105b2011-04-27 14:27:44 +02001022 return NET_RX_DROP;
1023
Sven Eckelmann96412692012-06-05 22:31:30 +02001024 unicast_packet = (struct batadv_unicast_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001025
1026 /* packet for me */
Sven Eckelmann3193e8f2012-05-12 02:09:42 +02001027 if (batadv_is_my_mac(unicast_packet->dest)) {
Sven Eckelmann04b482a2012-05-12 02:09:38 +02001028 batadv_interface_rx(recv_if->soft_iface, skb, recv_if,
1029 hdr_size);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001030 return NET_RX_SUCCESS;
1031 }
1032
Sven Eckelmann63b01032012-05-16 20:23:13 +02001033 return batadv_route_unicast_packet(skb, recv_if);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001034}
1035
Sven Eckelmann30d3c512012-05-12 02:09:36 +02001036int batadv_recv_ucast_frag_packet(struct sk_buff *skb,
Sven Eckelmann56303d32012-06-05 22:31:31 +02001037 struct batadv_hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001038{
Sven Eckelmann56303d32012-06-05 22:31:31 +02001039 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Sven Eckelmann96412692012-06-05 22:31:30 +02001040 struct batadv_unicast_frag_packet *unicast_packet;
Sven Eckelmann704509b2011-05-14 23:14:54 +02001041 int hdr_size = sizeof(*unicast_packet);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001042 struct sk_buff *new_skb = NULL;
1043 int ret;
1044
Sven Eckelmann63b01032012-05-16 20:23:13 +02001045 if (batadv_check_unicast_packet(skb, hdr_size) < 0)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001046 return NET_RX_DROP;
1047
Sven Eckelmann63b01032012-05-16 20:23:13 +02001048 if (!batadv_check_unicast_ttvn(bat_priv, skb))
Antonio Quartullia73105b2011-04-27 14:27:44 +02001049 return NET_RX_DROP;
1050
Sven Eckelmann96412692012-06-05 22:31:30 +02001051 unicast_packet = (struct batadv_unicast_frag_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001052
1053 /* packet for me */
Sven Eckelmann3193e8f2012-05-12 02:09:42 +02001054 if (batadv_is_my_mac(unicast_packet->dest)) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001055
Sven Eckelmann88ed1e772012-05-12 02:09:40 +02001056 ret = batadv_frag_reassemble_skb(skb, bat_priv, &new_skb);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001057
1058 if (ret == NET_RX_DROP)
1059 return NET_RX_DROP;
1060
1061 /* packet was buffered for late merge */
1062 if (!new_skb)
1063 return NET_RX_SUCCESS;
1064
Sven Eckelmann04b482a2012-05-12 02:09:38 +02001065 batadv_interface_rx(recv_if->soft_iface, new_skb, recv_if,
Sven Eckelmann96412692012-06-05 22:31:30 +02001066 sizeof(struct batadv_unicast_packet));
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001067 return NET_RX_SUCCESS;
1068 }
1069
Sven Eckelmann63b01032012-05-16 20:23:13 +02001070 return batadv_route_unicast_packet(skb, recv_if);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001071}
1072
1073
Sven Eckelmann56303d32012-06-05 22:31:31 +02001074int batadv_recv_bcast_packet(struct sk_buff *skb,
1075 struct batadv_hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001076{
Sven Eckelmann56303d32012-06-05 22:31:31 +02001077 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
1078 struct batadv_orig_node *orig_node = NULL;
Sven Eckelmann96412692012-06-05 22:31:30 +02001079 struct batadv_bcast_packet *bcast_packet;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001080 struct ethhdr *ethhdr;
Sven Eckelmann704509b2011-05-14 23:14:54 +02001081 int hdr_size = sizeof(*bcast_packet);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001082 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001083 int32_t seq_diff;
1084
1085 /* drop packet if it has not necessary minimum size */
1086 if (unlikely(!pskb_may_pull(skb, hdr_size)))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001087 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001088
1089 ethhdr = (struct ethhdr *)skb_mac_header(skb);
1090
1091 /* packet with broadcast indication but unicast recipient */
1092 if (!is_broadcast_ether_addr(ethhdr->h_dest))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001093 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001094
1095 /* packet with broadcast sender address */
1096 if (is_broadcast_ether_addr(ethhdr->h_source))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001097 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001098
1099 /* ignore broadcasts sent by myself */
Sven Eckelmann3193e8f2012-05-12 02:09:42 +02001100 if (batadv_is_my_mac(ethhdr->h_source))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001101 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001102
Sven Eckelmann96412692012-06-05 22:31:30 +02001103 bcast_packet = (struct batadv_bcast_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001104
1105 /* ignore broadcasts originated by myself */
Sven Eckelmann3193e8f2012-05-12 02:09:42 +02001106 if (batadv_is_my_mac(bcast_packet->orig))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001107 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001108
Sven Eckelmann76543d12011-11-20 15:47:38 +01001109 if (bcast_packet->header.ttl < 2)
Marek Lindnerf3e00082011-01-25 21:52:11 +00001110 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001111
Sven Eckelmannda641192012-05-12 13:48:56 +02001112 orig_node = batadv_orig_hash_find(bat_priv, bcast_packet->orig);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001113
1114 if (!orig_node)
Antonio Quartullib5a6f692011-04-16 11:30:57 +02001115 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001116
Marek Lindnerf3e00082011-01-25 21:52:11 +00001117 spin_lock_bh(&orig_node->bcast_seqno_lock);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001118
1119 /* check whether the packet is a duplicate */
Sven Eckelmann9b4a1152012-05-12 13:48:53 +02001120 if (batadv_test_bit(orig_node->bcast_bits, orig_node->last_bcast_seqno,
1121 ntohl(bcast_packet->seqno)))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001122 goto spin_unlock;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001123
1124 seq_diff = ntohl(bcast_packet->seqno) - orig_node->last_bcast_seqno;
1125
1126 /* check whether the packet is old and the host just restarted. */
Sven Eckelmann30d3c512012-05-12 02:09:36 +02001127 if (batadv_window_protected(bat_priv, seq_diff,
1128 &orig_node->bcast_seqno_reset))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001129 goto spin_unlock;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001130
1131 /* mark broadcast in flood history, update window position
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +02001132 * if required.
1133 */
Sven Eckelmann0f5f9322012-05-12 02:09:25 +02001134 if (batadv_bit_get_packet(bat_priv, orig_node->bcast_bits, seq_diff, 1))
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001135 orig_node->last_bcast_seqno = ntohl(bcast_packet->seqno);
1136
Marek Lindnerf3e00082011-01-25 21:52:11 +00001137 spin_unlock_bh(&orig_node->bcast_seqno_lock);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001138
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001139 /* check whether this has been sent by another originator before */
Sven Eckelmann08adf152012-05-12 13:38:47 +02001140 if (batadv_bla_check_bcast_duplist(bat_priv, bcast_packet, hdr_size))
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001141 goto out;
1142
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001143 /* rebroadcast packet */
Sven Eckelmann9455e342012-05-12 02:09:37 +02001144 batadv_add_bcast_packet_to_list(bat_priv, skb, 1);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001145
Simon Wunderlich23721382012-01-22 20:00:19 +01001146 /* don't hand the broadcast up if it is from an originator
1147 * from the same backbone.
1148 */
Sven Eckelmann08adf152012-05-12 13:38:47 +02001149 if (batadv_bla_is_backbone_gw(skb, orig_node, hdr_size))
Simon Wunderlich23721382012-01-22 20:00:19 +01001150 goto out;
1151
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001152 /* broadcast for me */
Sven Eckelmann04b482a2012-05-12 02:09:38 +02001153 batadv_interface_rx(recv_if->soft_iface, skb, recv_if, hdr_size);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001154 ret = NET_RX_SUCCESS;
1155 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001156
Marek Lindnerf3e00082011-01-25 21:52:11 +00001157spin_unlock:
1158 spin_unlock_bh(&orig_node->bcast_seqno_lock);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001159out:
1160 if (orig_node)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +02001161 batadv_orig_node_free_ref(orig_node);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001162 return ret;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001163}
1164
Sven Eckelmann56303d32012-06-05 22:31:31 +02001165int batadv_recv_vis_packet(struct sk_buff *skb,
1166 struct batadv_hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001167{
Sven Eckelmann96412692012-06-05 22:31:30 +02001168 struct batadv_vis_packet *vis_packet;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001169 struct ethhdr *ethhdr;
Sven Eckelmann56303d32012-06-05 22:31:31 +02001170 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Sven Eckelmann704509b2011-05-14 23:14:54 +02001171 int hdr_size = sizeof(*vis_packet);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001172
1173 /* keep skb linear */
1174 if (skb_linearize(skb) < 0)
1175 return NET_RX_DROP;
1176
1177 if (unlikely(!pskb_may_pull(skb, hdr_size)))
1178 return NET_RX_DROP;
1179
Sven Eckelmann96412692012-06-05 22:31:30 +02001180 vis_packet = (struct batadv_vis_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001181 ethhdr = (struct ethhdr *)skb_mac_header(skb);
1182
1183 /* not for me */
Sven Eckelmann3193e8f2012-05-12 02:09:42 +02001184 if (!batadv_is_my_mac(ethhdr->h_dest))
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001185 return NET_RX_DROP;
1186
1187 /* ignore own packets */
Sven Eckelmann3193e8f2012-05-12 02:09:42 +02001188 if (batadv_is_my_mac(vis_packet->vis_orig))
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001189 return NET_RX_DROP;
1190
Sven Eckelmann3193e8f2012-05-12 02:09:42 +02001191 if (batadv_is_my_mac(vis_packet->sender_orig))
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001192 return NET_RX_DROP;
1193
1194 switch (vis_packet->vis_type) {
Sven Eckelmannacd34af2012-06-03 22:19:21 +02001195 case BATADV_VIS_TYPE_SERVER_SYNC:
Sven Eckelmannd0f714f2012-05-12 02:09:41 +02001196 batadv_receive_server_sync_packet(bat_priv, vis_packet,
1197 skb_headlen(skb));
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001198 break;
1199
Sven Eckelmannacd34af2012-06-03 22:19:21 +02001200 case BATADV_VIS_TYPE_CLIENT_UPDATE:
Sven Eckelmannd0f714f2012-05-12 02:09:41 +02001201 batadv_receive_client_update_packet(bat_priv, vis_packet,
1202 skb_headlen(skb));
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001203 break;
1204
1205 default: /* ignore unknown packet */
1206 break;
1207 }
1208
1209 /* We take a copy of the data in the packet, so we should
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +02001210 * always free the skbuf.
1211 */
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001212 return NET_RX_DROP;
1213}