blob: 939fc01371dff0c209665b297b69ec6502887b1a [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
Martin Hundebøllff51fd72012-07-05 11:34:27 +0200582static int batadv_check_unicast_packet(struct sk_buff *skb, int hdr_size)
583{
584 struct ethhdr *ethhdr;
585
586 /* drop packet if it has not necessary minimum size */
587 if (unlikely(!pskb_may_pull(skb, hdr_size)))
588 return -1;
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 return -1;
595
596 /* packet with broadcast sender address */
597 if (is_broadcast_ether_addr(ethhdr->h_source))
598 return -1;
599
600 /* not for me */
601 if (!batadv_is_my_mac(ethhdr->h_dest))
602 return -1;
603
604 return 0;
605}
606
Sven Eckelmann56303d32012-06-05 22:31:31 +0200607int batadv_recv_tt_query(struct sk_buff *skb, struct batadv_hard_iface *recv_if)
Antonio Quartullia73105b2011-04-27 14:27:44 +0200608{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200609 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Sven Eckelmann96412692012-06-05 22:31:30 +0200610 struct batadv_tt_query_packet *tt_query;
Al Virof25bd582012-04-22 07:44:27 +0100611 uint16_t tt_size;
Martin Hundebøll74ee3632012-07-05 11:34:28 +0200612 int hdr_size = sizeof(*tt_query);
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200613 char tt_flag;
Sven Eckelmann96412692012-06-05 22:31:30 +0200614 size_t packet_size;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200615
Martin Hundebøll74ee3632012-07-05 11:34:28 +0200616 if (batadv_check_unicast_packet(skb, hdr_size) < 0)
617 return NET_RX_DROP;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200618
619 /* I could need to modify it */
Sven Eckelmann96412692012-06-05 22:31:30 +0200620 if (skb_cow(skb, sizeof(struct batadv_tt_query_packet)) < 0)
Antonio Quartullia73105b2011-04-27 14:27:44 +0200621 goto out;
622
Sven Eckelmann96412692012-06-05 22:31:30 +0200623 tt_query = (struct batadv_tt_query_packet *)skb->data;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200624
Sven Eckelmann7e071c72012-06-03 22:19:13 +0200625 switch (tt_query->flags & BATADV_TT_QUERY_TYPE_MASK) {
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200626 case BATADV_TT_REQUEST:
Sven Eckelmannd69909d2012-06-03 22:19:20 +0200627 batadv_inc_counter(bat_priv, BATADV_CNT_TT_REQUEST_RX);
Martin Hundebøllf8214862012-04-20 17:02:45 +0200628
Antonio Quartullia73105b2011-04-27 14:27:44 +0200629 /* If we cannot provide an answer the tt_request is
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200630 * forwarded
631 */
Sven Eckelmann08c36d32012-05-12 02:09:39 +0200632 if (!batadv_send_tt_response(bat_priv, tt_query)) {
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200633 if (tt_query->flags & BATADV_TT_FULL_TABLE)
634 tt_flag = 'F';
635 else
636 tt_flag = '.';
637
Sven Eckelmann39c75a52012-06-03 22:19:22 +0200638 batadv_dbg(BATADV_DBG_TT, bat_priv,
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200639 "Routing TT_REQUEST to %pM [%c]\n",
640 tt_query->dst,
641 tt_flag);
Sven Eckelmann63b01032012-05-16 20:23:13 +0200642 return batadv_route_unicast_packet(skb, recv_if);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200643 }
644 break;
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200645 case BATADV_TT_RESPONSE:
Sven Eckelmannd69909d2012-06-03 22:19:20 +0200646 batadv_inc_counter(bat_priv, BATADV_CNT_TT_RESPONSE_RX);
Martin Hundebøllf8214862012-04-20 17:02:45 +0200647
Sven Eckelmann3193e8f2012-05-12 02:09:42 +0200648 if (batadv_is_my_mac(tt_query->dst)) {
Antonio Quartullidc58fe32011-10-16 20:32:02 +0200649 /* packet needs to be linearized to access the TT
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200650 * changes
651 */
Antonio Quartullidc58fe32011-10-16 20:32:02 +0200652 if (skb_linearize(skb) < 0)
653 goto out;
Antonio Quartullid2b6cc82012-06-14 22:21:28 +0200654 /* skb_linearize() possibly changed skb->data */
Sven Eckelmann96412692012-06-05 22:31:30 +0200655 tt_query = (struct batadv_tt_query_packet *)skb->data;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200656
Sven Eckelmann08c36d32012-05-12 02:09:39 +0200657 tt_size = batadv_tt_len(ntohs(tt_query->tt_data));
Antonio Quartulli8b7342d2011-10-16 20:32:03 +0200658
659 /* Ensure we have all the claimed data */
Sven Eckelmann96412692012-06-05 22:31:30 +0200660 packet_size = sizeof(struct batadv_tt_query_packet);
661 packet_size += tt_size;
662 if (unlikely(skb_headlen(skb) < packet_size))
Antonio Quartulli8b7342d2011-10-16 20:32:03 +0200663 goto out;
664
Sven Eckelmann08c36d32012-05-12 02:09:39 +0200665 batadv_handle_tt_response(bat_priv, tt_query);
Antonio Quartullidc58fe32011-10-16 20:32:02 +0200666 } else {
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200667 if (tt_query->flags & BATADV_TT_FULL_TABLE)
668 tt_flag = 'F';
669 else
670 tt_flag = '.';
Sven Eckelmann39c75a52012-06-03 22:19:22 +0200671 batadv_dbg(BATADV_DBG_TT, bat_priv,
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200672 "Routing TT_RESPONSE to %pM [%c]\n",
673 tt_query->dst,
674 tt_flag);
Sven Eckelmann63b01032012-05-16 20:23:13 +0200675 return batadv_route_unicast_packet(skb, recv_if);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200676 }
677 break;
678 }
679
680out:
681 /* returning NET_RX_DROP will make the caller function kfree the skb */
682 return NET_RX_DROP;
683}
684
Sven Eckelmann56303d32012-06-05 22:31:31 +0200685int batadv_recv_roam_adv(struct sk_buff *skb, struct batadv_hard_iface *recv_if)
Antonio Quartullicc47f662011-04-27 14:27:57 +0200686{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200687 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Sven Eckelmann96412692012-06-05 22:31:30 +0200688 struct batadv_roam_adv_packet *roam_adv_packet;
Sven Eckelmann56303d32012-06-05 22:31:31 +0200689 struct batadv_orig_node *orig_node;
Antonio Quartullicc47f662011-04-27 14:27:57 +0200690 struct ethhdr *ethhdr;
691
692 /* drop packet if it has not necessary minimum size */
Sven Eckelmann96412692012-06-05 22:31:30 +0200693 if (unlikely(!pskb_may_pull(skb,
694 sizeof(struct batadv_roam_adv_packet))))
Antonio Quartullicc47f662011-04-27 14:27:57 +0200695 goto out;
696
697 ethhdr = (struct ethhdr *)skb_mac_header(skb);
698
699 /* packet with unicast indication but broadcast recipient */
700 if (is_broadcast_ether_addr(ethhdr->h_dest))
701 goto out;
702
703 /* packet with broadcast sender address */
704 if (is_broadcast_ether_addr(ethhdr->h_source))
705 goto out;
706
Sven Eckelmannd69909d2012-06-03 22:19:20 +0200707 batadv_inc_counter(bat_priv, BATADV_CNT_TT_ROAM_ADV_RX);
Martin Hundebøllf8214862012-04-20 17:02:45 +0200708
Sven Eckelmann96412692012-06-05 22:31:30 +0200709 roam_adv_packet = (struct batadv_roam_adv_packet *)skb->data;
Antonio Quartullicc47f662011-04-27 14:27:57 +0200710
Sven Eckelmann3193e8f2012-05-12 02:09:42 +0200711 if (!batadv_is_my_mac(roam_adv_packet->dst))
Sven Eckelmann63b01032012-05-16 20:23:13 +0200712 return batadv_route_unicast_packet(skb, recv_if);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200713
Simon Wunderlich20ff9d52012-01-22 20:00:23 +0100714 /* check if it is a backbone gateway. we don't accept
715 * roaming advertisement from it, as it has the same
716 * entries as we have.
717 */
Sven Eckelmann08adf152012-05-12 13:38:47 +0200718 if (batadv_bla_is_backbone_gw_orig(bat_priv, roam_adv_packet->src))
Simon Wunderlich20ff9d52012-01-22 20:00:23 +0100719 goto out;
720
Sven Eckelmannda641192012-05-12 13:48:56 +0200721 orig_node = batadv_orig_hash_find(bat_priv, roam_adv_packet->src);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200722 if (!orig_node)
723 goto out;
724
Sven Eckelmann39c75a52012-06-03 22:19:22 +0200725 batadv_dbg(BATADV_DBG_TT, bat_priv,
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200726 "Received ROAMING_ADV from %pM (client %pM)\n",
727 roam_adv_packet->src, roam_adv_packet->client);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200728
Sven Eckelmann08c36d32012-05-12 02:09:39 +0200729 batadv_tt_global_add(bat_priv, orig_node, roam_adv_packet->client,
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200730 BATADV_TT_CLIENT_ROAM,
Antonio Quartullid4f44692012-05-25 00:00:54 +0200731 atomic_read(&orig_node->last_ttvn) + 1);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200732
733 /* Roaming phase starts: I have new information but the ttvn has not
734 * been incremented yet. This flag will make me check all the incoming
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200735 * packets for the correct destination.
736 */
Sven Eckelmann807736f2012-07-15 22:26:51 +0200737 bat_priv->tt.poss_change = true;
Antonio Quartullicc47f662011-04-27 14:27:57 +0200738
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200739 batadv_orig_node_free_ref(orig_node);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200740out:
741 /* returning NET_RX_DROP will make the caller function kfree the skb */
742 return NET_RX_DROP;
743}
744
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000745/* find a suitable router for this originator, and use
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000746 * bonding if possible. increases the found neighbors
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200747 * refcount.
748 */
Sven Eckelmann56303d32012-06-05 22:31:31 +0200749struct batadv_neigh_node *
750batadv_find_router(struct batadv_priv *bat_priv,
751 struct batadv_orig_node *orig_node,
752 const struct batadv_hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000753{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200754 struct batadv_orig_node *primary_orig_node;
755 struct batadv_orig_node *router_orig;
756 struct batadv_neigh_node *router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000757 static uint8_t zero_mac[ETH_ALEN] = {0, 0, 0, 0, 0, 0};
758 int bonding_enabled;
Sven Eckelmannda641192012-05-12 13:48:56 +0200759 uint8_t *primary_addr;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000760
761 if (!orig_node)
762 return NULL;
763
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200764 router = batadv_orig_node_get_router(orig_node);
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000765 if (!router)
Marek Lindner01df2b62011-05-05 14:14:46 +0200766 goto err;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000767
768 /* without bonding, the first node should
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200769 * always choose the default router.
770 */
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000771 bonding_enabled = atomic_read(&bat_priv->bonding);
772
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000773 rcu_read_lock();
774 /* select default router to output */
Linus Lüssinge1a5382f2011-03-14 22:43:37 +0000775 router_orig = router->orig_node;
Marek Lindner01df2b62011-05-05 14:14:46 +0200776 if (!router_orig)
777 goto err_unlock;
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000778
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000779 if ((!recv_if) && (!bonding_enabled))
780 goto return_router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000781
Sven Eckelmannda641192012-05-12 13:48:56 +0200782 primary_addr = router_orig->primary_addr;
783
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000784 /* if we have something in the primary_addr, we can search
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200785 * for a potential bonding candidate.
786 */
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200787 if (batadv_compare_eth(primary_addr, zero_mac))
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000788 goto return_router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000789
790 /* find the orig_node which has the primary interface. might
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200791 * even be the same as our router_orig in many cases
792 */
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200793 if (batadv_compare_eth(primary_addr, router_orig->orig)) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000794 primary_orig_node = router_orig;
795 } else {
Sven Eckelmannda641192012-05-12 13:48:56 +0200796 primary_orig_node = batadv_orig_hash_find(bat_priv,
797 primary_addr);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000798 if (!primary_orig_node)
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000799 goto return_router;
Marek Lindner7aadf882011-02-18 12:28:09 +0000800
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200801 batadv_orig_node_free_ref(primary_orig_node);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000802 }
803
804 /* with less than 2 candidates, we can't do any
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200805 * bonding and prefer the original router.
806 */
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000807 if (atomic_read(&primary_orig_node->bond_candidates) < 2)
808 goto return_router;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000809
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000810 /* all nodes between should choose a candidate which
811 * is is not on the interface where the packet came
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +0200812 * in.
813 */
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200814 batadv_neigh_node_free_ref(router);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000815
Linus Lüssing55158622011-03-14 22:43:27 +0000816 if (bonding_enabled)
Sven Eckelmann63b01032012-05-16 20:23:13 +0200817 router = batadv_find_bond_router(primary_orig_node, recv_if);
Linus Lüssing55158622011-03-14 22:43:27 +0000818 else
Sven Eckelmann63b01032012-05-16 20:23:13 +0200819 router = batadv_find_ifalter_router(primary_orig_node, recv_if);
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000820
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000821return_router:
Sven Eckelmanne9a4f292012-06-03 22:19:19 +0200822 if (router && router->if_incoming->if_status != BATADV_IF_ACTIVE)
Antonio Quartullie2cbc112011-05-08 20:52:57 +0200823 goto err_unlock;
824
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000825 rcu_read_unlock();
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000826 return router;
Marek Lindner01df2b62011-05-05 14:14:46 +0200827err_unlock:
828 rcu_read_unlock();
829err:
830 if (router)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200831 batadv_neigh_node_free_ref(router);
Marek Lindner01df2b62011-05-05 14:14:46 +0200832 return NULL;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000833}
834
Sven Eckelmann63b01032012-05-16 20:23:13 +0200835static int batadv_route_unicast_packet(struct sk_buff *skb,
Sven Eckelmann56303d32012-06-05 22:31:31 +0200836 struct batadv_hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000837{
Sven Eckelmann56303d32012-06-05 22:31:31 +0200838 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
839 struct batadv_orig_node *orig_node = NULL;
840 struct batadv_neigh_node *neigh_node = NULL;
Sven Eckelmann96412692012-06-05 22:31:30 +0200841 struct batadv_unicast_packet *unicast_packet;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000842 struct ethhdr *ethhdr = (struct ethhdr *)skb_mac_header(skb);
Marek Lindner44524fc2011-02-10 14:33:53 +0000843 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000844 struct sk_buff *new_skb;
845
Sven Eckelmann96412692012-06-05 22:31:30 +0200846 unicast_packet = (struct batadv_unicast_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000847
848 /* TTL exceeded */
Sven Eckelmann76543d12011-11-20 15:47:38 +0100849 if (unicast_packet->header.ttl < 2) {
Sven Eckelmann86ceb362012-03-07 09:07:45 +0100850 pr_debug("Warning - can't forward unicast packet from %pM to %pM: ttl exceeded\n",
851 ethhdr->h_source, unicast_packet->dest);
Marek Lindner44524fc2011-02-10 14:33:53 +0000852 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000853 }
854
855 /* get routing information */
Sven Eckelmannda641192012-05-12 13:48:56 +0200856 orig_node = batadv_orig_hash_find(bat_priv, unicast_packet->dest);
Marek Lindner7aadf882011-02-18 12:28:09 +0000857
Marek Lindner44524fc2011-02-10 14:33:53 +0000858 if (!orig_node)
Antonio Quartullib5a6f692011-04-16 11:30:57 +0200859 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000860
Simon Wunderlicha4c135c2011-01-19 20:01:43 +0000861 /* find_router() increases neigh_nodes refcount if found. */
Sven Eckelmann30d3c512012-05-12 02:09:36 +0200862 neigh_node = batadv_find_router(bat_priv, orig_node, recv_if);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000863
Marek Lindnerd0072602011-01-19 20:01:44 +0000864 if (!neigh_node)
Marek Lindner44524fc2011-02-10 14:33:53 +0000865 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000866
867 /* create a copy of the skb, if needed, to modify it. */
Antonio Quartulli0d125072012-02-18 11:27:34 +0100868 if (skb_cow(skb, ETH_HLEN) < 0)
Marek Lindner44524fc2011-02-10 14:33:53 +0000869 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000870
Sven Eckelmann96412692012-06-05 22:31:30 +0200871 unicast_packet = (struct batadv_unicast_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000872
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200873 if (unicast_packet->header.packet_type == BATADV_UNICAST &&
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000874 atomic_read(&bat_priv->fragmentation) &&
Marek Lindnerd0072602011-01-19 20:01:44 +0000875 skb->len > neigh_node->if_incoming->net_dev->mtu) {
Sven Eckelmann88ed1e772012-05-12 02:09:40 +0200876 ret = batadv_frag_send_skb(skb, bat_priv,
877 neigh_node->if_incoming,
878 neigh_node->addr);
Marek Lindnerd0072602011-01-19 20:01:44 +0000879 goto out;
880 }
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000881
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200882 if (unicast_packet->header.packet_type == BATADV_UNICAST_FRAG &&
Sven Eckelmannf0530ee2012-05-12 13:48:57 +0200883 batadv_frag_can_reassemble(skb,
884 neigh_node->if_incoming->net_dev->mtu)) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000885
Sven Eckelmann88ed1e772012-05-12 02:09:40 +0200886 ret = batadv_frag_reassemble_skb(skb, bat_priv, &new_skb);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000887
888 if (ret == NET_RX_DROP)
Marek Lindner44524fc2011-02-10 14:33:53 +0000889 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000890
891 /* packet was buffered for late merge */
Marek Lindner44524fc2011-02-10 14:33:53 +0000892 if (!new_skb) {
893 ret = NET_RX_SUCCESS;
894 goto out;
895 }
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000896
897 skb = new_skb;
Sven Eckelmann96412692012-06-05 22:31:30 +0200898 unicast_packet = (struct batadv_unicast_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000899 }
900
901 /* decrement ttl */
Sven Eckelmann76543d12011-11-20 15:47:38 +0100902 unicast_packet->header.ttl--;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000903
Martin Hundebøllf8214862012-04-20 17:02:45 +0200904 /* Update stats counter */
Sven Eckelmannd69909d2012-06-03 22:19:20 +0200905 batadv_inc_counter(bat_priv, BATADV_CNT_FORWARD);
906 batadv_add_counter(bat_priv, BATADV_CNT_FORWARD_BYTES,
Martin Hundebøllf8214862012-04-20 17:02:45 +0200907 skb->len + ETH_HLEN);
908
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000909 /* route it */
Sven Eckelmann9455e342012-05-12 02:09:37 +0200910 batadv_send_skb_packet(skb, neigh_node->if_incoming, neigh_node->addr);
Marek Lindner44524fc2011-02-10 14:33:53 +0000911 ret = NET_RX_SUCCESS;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000912
Marek Lindner44524fc2011-02-10 14:33:53 +0000913out:
914 if (neigh_node)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200915 batadv_neigh_node_free_ref(neigh_node);
Marek Lindner44524fc2011-02-10 14:33:53 +0000916 if (orig_node)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200917 batadv_orig_node_free_ref(orig_node);
Marek Lindner44524fc2011-02-10 14:33:53 +0000918 return ret;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +0000919}
920
Sven Eckelmann56303d32012-06-05 22:31:31 +0200921static int batadv_check_unicast_ttvn(struct batadv_priv *bat_priv,
Sven Eckelmann63b01032012-05-16 20:23:13 +0200922 struct sk_buff *skb) {
Antonio Quartullia73105b2011-04-27 14:27:44 +0200923 uint8_t curr_ttvn;
Sven Eckelmann56303d32012-06-05 22:31:31 +0200924 struct batadv_orig_node *orig_node;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200925 struct ethhdr *ethhdr;
Sven Eckelmann56303d32012-06-05 22:31:31 +0200926 struct batadv_hard_iface *primary_if;
Sven Eckelmann96412692012-06-05 22:31:30 +0200927 struct batadv_unicast_packet *unicast_packet;
Antonio Quartullicc47f662011-04-27 14:27:57 +0200928 bool tt_poss_change;
Sven Eckelmann3e348192012-05-16 20:23:22 +0200929 int is_old_ttvn;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200930
931 /* I could need to modify it */
Sven Eckelmann96412692012-06-05 22:31:30 +0200932 if (skb_cow(skb, sizeof(struct batadv_unicast_packet)) < 0)
Antonio Quartullia73105b2011-04-27 14:27:44 +0200933 return 0;
934
Sven Eckelmann96412692012-06-05 22:31:30 +0200935 unicast_packet = (struct batadv_unicast_packet *)skb->data;
Antonio Quartullia73105b2011-04-27 14:27:44 +0200936
Sven Eckelmann3193e8f2012-05-12 02:09:42 +0200937 if (batadv_is_my_mac(unicast_packet->dest)) {
Sven Eckelmann807736f2012-07-15 22:26:51 +0200938 tt_poss_change = bat_priv->tt.poss_change;
939 curr_ttvn = (uint8_t)atomic_read(&bat_priv->tt.vn);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200940 } else {
Sven Eckelmannda641192012-05-12 13:48:56 +0200941 orig_node = batadv_orig_hash_find(bat_priv,
942 unicast_packet->dest);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200943
944 if (!orig_node)
945 return 0;
946
947 curr_ttvn = (uint8_t)atomic_read(&orig_node->last_ttvn);
Antonio Quartullicc47f662011-04-27 14:27:57 +0200948 tt_poss_change = orig_node->tt_poss_change;
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200949 batadv_orig_node_free_ref(orig_node);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200950 }
951
952 /* Check whether I have to reroute the packet */
Sven Eckelmann3e348192012-05-16 20:23:22 +0200953 is_old_ttvn = batadv_seq_before(unicast_packet->ttvn, curr_ttvn);
954 if (is_old_ttvn || tt_poss_change) {
Antonio Quartulli8710e262012-03-16 11:52:31 +0100955 /* check if there is enough data before accessing it */
Sven Eckelmann96412692012-06-05 22:31:30 +0200956 if (pskb_may_pull(skb, sizeof(struct batadv_unicast_packet) +
Antonio Quartulli8710e262012-03-16 11:52:31 +0100957 ETH_HLEN) < 0)
Antonio Quartullia73105b2011-04-27 14:27:44 +0200958 return 0;
959
Sven Eckelmann0aca2362012-06-19 20:26:30 +0200960 ethhdr = (struct ethhdr *)(skb->data + sizeof(*unicast_packet));
Antonio Quartulli3275e7c2012-03-16 18:03:28 +0100961
962 /* we don't have an updated route for this client, so we should
963 * not try to reroute the packet!!
964 */
Sven Eckelmann08c36d32012-05-12 02:09:39 +0200965 if (batadv_tt_global_client_is_roaming(bat_priv,
966 ethhdr->h_dest))
Antonio Quartulli3275e7c2012-03-16 18:03:28 +0100967 return 1;
968
Sven Eckelmann08c36d32012-05-12 02:09:39 +0200969 orig_node = batadv_transtable_search(bat_priv, NULL,
970 ethhdr->h_dest);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200971
972 if (!orig_node) {
Sven Eckelmann08c36d32012-05-12 02:09:39 +0200973 if (!batadv_is_my_client(bat_priv, ethhdr->h_dest))
Antonio Quartullia73105b2011-04-27 14:27:44 +0200974 return 0;
Sven Eckelmanne5d89252012-05-12 13:48:54 +0200975 primary_if = batadv_primary_if_get_selected(bat_priv);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200976 if (!primary_if)
977 return 0;
978 memcpy(unicast_packet->dest,
979 primary_if->net_dev->dev_addr, ETH_ALEN);
Sven Eckelmanne5d89252012-05-12 13:48:54 +0200980 batadv_hardif_free_ref(primary_if);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200981 } else {
982 memcpy(unicast_packet->dest, orig_node->orig,
983 ETH_ALEN);
Sven Eckelmannc67893d2012-07-08 18:33:51 +0200984 curr_ttvn = (uint8_t)atomic_read(&orig_node->last_ttvn);
Sven Eckelmann7d211ef2012-05-12 02:09:34 +0200985 batadv_orig_node_free_ref(orig_node);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200986 }
987
Sven Eckelmann39c75a52012-06-03 22:19:22 +0200988 batadv_dbg(BATADV_DBG_ROUTES, bat_priv,
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200989 "TTVN mismatch (old_ttvn %u new_ttvn %u)! Rerouting unicast packet (for %pM) to %pM\n",
990 unicast_packet->ttvn, curr_ttvn, ethhdr->h_dest,
991 unicast_packet->dest);
Antonio Quartullia73105b2011-04-27 14:27:44 +0200992
993 unicast_packet->ttvn = curr_ttvn;
994 }
995 return 1;
996}
997
Sven Eckelmann56303d32012-06-05 22:31:31 +0200998int batadv_recv_unicast_packet(struct sk_buff *skb,
999 struct batadv_hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001000{
Sven Eckelmann56303d32012-06-05 22:31:31 +02001001 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Sven Eckelmann96412692012-06-05 22:31:30 +02001002 struct batadv_unicast_packet *unicast_packet;
Sven Eckelmann704509b2011-05-14 23:14:54 +02001003 int hdr_size = sizeof(*unicast_packet);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001004
Sven Eckelmann63b01032012-05-16 20:23:13 +02001005 if (batadv_check_unicast_packet(skb, hdr_size) < 0)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001006 return NET_RX_DROP;
1007
Sven Eckelmann63b01032012-05-16 20:23:13 +02001008 if (!batadv_check_unicast_ttvn(bat_priv, skb))
Antonio Quartullia73105b2011-04-27 14:27:44 +02001009 return NET_RX_DROP;
1010
Sven Eckelmann96412692012-06-05 22:31:30 +02001011 unicast_packet = (struct batadv_unicast_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001012
1013 /* packet for me */
Sven Eckelmann3193e8f2012-05-12 02:09:42 +02001014 if (batadv_is_my_mac(unicast_packet->dest)) {
Antonio Quartulli37135172012-07-05 23:38:30 +02001015 batadv_interface_rx(recv_if->soft_iface, skb, recv_if, hdr_size,
1016 NULL);
1017
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001018 return NET_RX_SUCCESS;
1019 }
1020
Sven Eckelmann63b01032012-05-16 20:23:13 +02001021 return batadv_route_unicast_packet(skb, recv_if);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001022}
1023
Sven Eckelmann30d3c512012-05-12 02:09:36 +02001024int batadv_recv_ucast_frag_packet(struct sk_buff *skb,
Sven Eckelmann56303d32012-06-05 22:31:31 +02001025 struct batadv_hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001026{
Sven Eckelmann56303d32012-06-05 22:31:31 +02001027 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Sven Eckelmann96412692012-06-05 22:31:30 +02001028 struct batadv_unicast_frag_packet *unicast_packet;
Sven Eckelmann704509b2011-05-14 23:14:54 +02001029 int hdr_size = sizeof(*unicast_packet);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001030 struct sk_buff *new_skb = NULL;
1031 int ret;
1032
Sven Eckelmann63b01032012-05-16 20:23:13 +02001033 if (batadv_check_unicast_packet(skb, hdr_size) < 0)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001034 return NET_RX_DROP;
1035
Sven Eckelmann63b01032012-05-16 20:23:13 +02001036 if (!batadv_check_unicast_ttvn(bat_priv, skb))
Antonio Quartullia73105b2011-04-27 14:27:44 +02001037 return NET_RX_DROP;
1038
Sven Eckelmann96412692012-06-05 22:31:30 +02001039 unicast_packet = (struct batadv_unicast_frag_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001040
1041 /* packet for me */
Sven Eckelmann3193e8f2012-05-12 02:09:42 +02001042 if (batadv_is_my_mac(unicast_packet->dest)) {
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001043
Sven Eckelmann88ed1e772012-05-12 02:09:40 +02001044 ret = batadv_frag_reassemble_skb(skb, bat_priv, &new_skb);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001045
1046 if (ret == NET_RX_DROP)
1047 return NET_RX_DROP;
1048
1049 /* packet was buffered for late merge */
1050 if (!new_skb)
1051 return NET_RX_SUCCESS;
1052
Sven Eckelmann04b482a2012-05-12 02:09:38 +02001053 batadv_interface_rx(recv_if->soft_iface, new_skb, recv_if,
Antonio Quartulli37135172012-07-05 23:38:30 +02001054 sizeof(struct batadv_unicast_packet), NULL);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001055 return NET_RX_SUCCESS;
1056 }
1057
Sven Eckelmann63b01032012-05-16 20:23:13 +02001058 return batadv_route_unicast_packet(skb, recv_if);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001059}
1060
1061
Sven Eckelmann56303d32012-06-05 22:31:31 +02001062int batadv_recv_bcast_packet(struct sk_buff *skb,
1063 struct batadv_hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001064{
Sven Eckelmann56303d32012-06-05 22:31:31 +02001065 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
1066 struct batadv_orig_node *orig_node = NULL;
Sven Eckelmann96412692012-06-05 22:31:30 +02001067 struct batadv_bcast_packet *bcast_packet;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001068 struct ethhdr *ethhdr;
Sven Eckelmann704509b2011-05-14 23:14:54 +02001069 int hdr_size = sizeof(*bcast_packet);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001070 int ret = NET_RX_DROP;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001071 int32_t seq_diff;
1072
1073 /* drop packet if it has not necessary minimum size */
1074 if (unlikely(!pskb_may_pull(skb, hdr_size)))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001075 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001076
1077 ethhdr = (struct ethhdr *)skb_mac_header(skb);
1078
1079 /* packet with broadcast indication but unicast recipient */
1080 if (!is_broadcast_ether_addr(ethhdr->h_dest))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001081 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001082
1083 /* packet with broadcast sender address */
1084 if (is_broadcast_ether_addr(ethhdr->h_source))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001085 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001086
1087 /* ignore broadcasts sent by myself */
Sven Eckelmann3193e8f2012-05-12 02:09:42 +02001088 if (batadv_is_my_mac(ethhdr->h_source))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001089 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001090
Sven Eckelmann96412692012-06-05 22:31:30 +02001091 bcast_packet = (struct batadv_bcast_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001092
1093 /* ignore broadcasts originated by myself */
Sven Eckelmann3193e8f2012-05-12 02:09:42 +02001094 if (batadv_is_my_mac(bcast_packet->orig))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001095 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001096
Sven Eckelmann76543d12011-11-20 15:47:38 +01001097 if (bcast_packet->header.ttl < 2)
Marek Lindnerf3e00082011-01-25 21:52:11 +00001098 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001099
Sven Eckelmannda641192012-05-12 13:48:56 +02001100 orig_node = batadv_orig_hash_find(bat_priv, bcast_packet->orig);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001101
1102 if (!orig_node)
Antonio Quartullib5a6f692011-04-16 11:30:57 +02001103 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001104
Marek Lindnerf3e00082011-01-25 21:52:11 +00001105 spin_lock_bh(&orig_node->bcast_seqno_lock);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001106
1107 /* check whether the packet is a duplicate */
Sven Eckelmann9b4a1152012-05-12 13:48:53 +02001108 if (batadv_test_bit(orig_node->bcast_bits, orig_node->last_bcast_seqno,
1109 ntohl(bcast_packet->seqno)))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001110 goto spin_unlock;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001111
1112 seq_diff = ntohl(bcast_packet->seqno) - orig_node->last_bcast_seqno;
1113
1114 /* check whether the packet is old and the host just restarted. */
Sven Eckelmann30d3c512012-05-12 02:09:36 +02001115 if (batadv_window_protected(bat_priv, seq_diff,
1116 &orig_node->bcast_seqno_reset))
Marek Lindnerf3e00082011-01-25 21:52:11 +00001117 goto spin_unlock;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001118
1119 /* mark broadcast in flood history, update window position
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +02001120 * if required.
1121 */
Sven Eckelmann0f5f9322012-05-12 02:09:25 +02001122 if (batadv_bit_get_packet(bat_priv, orig_node->bcast_bits, seq_diff, 1))
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001123 orig_node->last_bcast_seqno = ntohl(bcast_packet->seqno);
1124
Marek Lindnerf3e00082011-01-25 21:52:11 +00001125 spin_unlock_bh(&orig_node->bcast_seqno_lock);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001126
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001127 /* check whether this has been sent by another originator before */
Sven Eckelmann08adf152012-05-12 13:38:47 +02001128 if (batadv_bla_check_bcast_duplist(bat_priv, bcast_packet, hdr_size))
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001129 goto out;
1130
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001131 /* rebroadcast packet */
Sven Eckelmann9455e342012-05-12 02:09:37 +02001132 batadv_add_bcast_packet_to_list(bat_priv, skb, 1);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001133
Simon Wunderlich23721382012-01-22 20:00:19 +01001134 /* don't hand the broadcast up if it is from an originator
1135 * from the same backbone.
1136 */
Sven Eckelmann08adf152012-05-12 13:38:47 +02001137 if (batadv_bla_is_backbone_gw(skb, orig_node, hdr_size))
Simon Wunderlich23721382012-01-22 20:00:19 +01001138 goto out;
1139
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001140 /* broadcast for me */
Antonio Quartulli37135172012-07-05 23:38:30 +02001141 batadv_interface_rx(recv_if->soft_iface, skb, recv_if, hdr_size,
1142 orig_node);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001143 ret = NET_RX_SUCCESS;
1144 goto out;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001145
Marek Lindnerf3e00082011-01-25 21:52:11 +00001146spin_unlock:
1147 spin_unlock_bh(&orig_node->bcast_seqno_lock);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001148out:
1149 if (orig_node)
Sven Eckelmann7d211ef2012-05-12 02:09:34 +02001150 batadv_orig_node_free_ref(orig_node);
Marek Lindnerf3e00082011-01-25 21:52:11 +00001151 return ret;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001152}
1153
Sven Eckelmann56303d32012-06-05 22:31:31 +02001154int batadv_recv_vis_packet(struct sk_buff *skb,
1155 struct batadv_hard_iface *recv_if)
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001156{
Sven Eckelmann96412692012-06-05 22:31:30 +02001157 struct batadv_vis_packet *vis_packet;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001158 struct ethhdr *ethhdr;
Sven Eckelmann56303d32012-06-05 22:31:31 +02001159 struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
Sven Eckelmann704509b2011-05-14 23:14:54 +02001160 int hdr_size = sizeof(*vis_packet);
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001161
1162 /* keep skb linear */
1163 if (skb_linearize(skb) < 0)
1164 return NET_RX_DROP;
1165
1166 if (unlikely(!pskb_may_pull(skb, hdr_size)))
1167 return NET_RX_DROP;
1168
Sven Eckelmann96412692012-06-05 22:31:30 +02001169 vis_packet = (struct batadv_vis_packet *)skb->data;
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001170 ethhdr = (struct ethhdr *)skb_mac_header(skb);
1171
1172 /* not for me */
Sven Eckelmann3193e8f2012-05-12 02:09:42 +02001173 if (!batadv_is_my_mac(ethhdr->h_dest))
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001174 return NET_RX_DROP;
1175
1176 /* ignore own packets */
Sven Eckelmann3193e8f2012-05-12 02:09:42 +02001177 if (batadv_is_my_mac(vis_packet->vis_orig))
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001178 return NET_RX_DROP;
1179
Sven Eckelmann3193e8f2012-05-12 02:09:42 +02001180 if (batadv_is_my_mac(vis_packet->sender_orig))
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001181 return NET_RX_DROP;
1182
1183 switch (vis_packet->vis_type) {
Sven Eckelmannacd34af2012-06-03 22:19:21 +02001184 case BATADV_VIS_TYPE_SERVER_SYNC:
Sven Eckelmannd0f714f2012-05-12 02:09:41 +02001185 batadv_receive_server_sync_packet(bat_priv, vis_packet,
1186 skb_headlen(skb));
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001187 break;
1188
Sven Eckelmannacd34af2012-06-03 22:19:21 +02001189 case BATADV_VIS_TYPE_CLIENT_UPDATE:
Sven Eckelmannd0f714f2012-05-12 02:09:41 +02001190 batadv_receive_client_update_packet(bat_priv, vis_packet,
1191 skb_headlen(skb));
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001192 break;
1193
1194 default: /* ignore unknown packet */
1195 break;
1196 }
1197
1198 /* We take a copy of the data in the packet, so we should
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +02001199 * always free the skbuf.
1200 */
Sven Eckelmannc6c8fea2010-12-13 11:19:28 +00001201 return NET_RX_DROP;
1202}