1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /* Copyright (C) 2012-2020 B.A.T.M.A.N. contributors:
3*4882a593Smuzhiyun *
4*4882a593Smuzhiyun * Martin Hundebøll, Jeppe Ledet-Pedersen
5*4882a593Smuzhiyun */
6*4882a593Smuzhiyun
7*4882a593Smuzhiyun #include "network-coding.h"
8*4882a593Smuzhiyun #include "main.h"
9*4882a593Smuzhiyun
10*4882a593Smuzhiyun #include <linux/atomic.h>
11*4882a593Smuzhiyun #include <linux/bitops.h>
12*4882a593Smuzhiyun #include <linux/byteorder/generic.h>
13*4882a593Smuzhiyun #include <linux/compiler.h>
14*4882a593Smuzhiyun #include <linux/debugfs.h>
15*4882a593Smuzhiyun #include <linux/errno.h>
16*4882a593Smuzhiyun #include <linux/etherdevice.h>
17*4882a593Smuzhiyun #include <linux/gfp.h>
18*4882a593Smuzhiyun #include <linux/if_ether.h>
19*4882a593Smuzhiyun #include <linux/if_packet.h>
20*4882a593Smuzhiyun #include <linux/init.h>
21*4882a593Smuzhiyun #include <linux/jhash.h>
22*4882a593Smuzhiyun #include <linux/jiffies.h>
23*4882a593Smuzhiyun #include <linux/kernel.h>
24*4882a593Smuzhiyun #include <linux/kref.h>
25*4882a593Smuzhiyun #include <linux/list.h>
26*4882a593Smuzhiyun #include <linux/lockdep.h>
27*4882a593Smuzhiyun #include <linux/net.h>
28*4882a593Smuzhiyun #include <linux/netdevice.h>
29*4882a593Smuzhiyun #include <linux/prandom.h>
30*4882a593Smuzhiyun #include <linux/printk.h>
31*4882a593Smuzhiyun #include <linux/rculist.h>
32*4882a593Smuzhiyun #include <linux/rcupdate.h>
33*4882a593Smuzhiyun #include <linux/seq_file.h>
34*4882a593Smuzhiyun #include <linux/skbuff.h>
35*4882a593Smuzhiyun #include <linux/slab.h>
36*4882a593Smuzhiyun #include <linux/spinlock.h>
37*4882a593Smuzhiyun #include <linux/stddef.h>
38*4882a593Smuzhiyun #include <linux/string.h>
39*4882a593Smuzhiyun #include <linux/workqueue.h>
40*4882a593Smuzhiyun #include <uapi/linux/batadv_packet.h>
41*4882a593Smuzhiyun
42*4882a593Smuzhiyun #include "hard-interface.h"
43*4882a593Smuzhiyun #include "hash.h"
44*4882a593Smuzhiyun #include "log.h"
45*4882a593Smuzhiyun #include "originator.h"
46*4882a593Smuzhiyun #include "routing.h"
47*4882a593Smuzhiyun #include "send.h"
48*4882a593Smuzhiyun #include "tvlv.h"
49*4882a593Smuzhiyun
50*4882a593Smuzhiyun static struct lock_class_key batadv_nc_coding_hash_lock_class_key;
51*4882a593Smuzhiyun static struct lock_class_key batadv_nc_decoding_hash_lock_class_key;
52*4882a593Smuzhiyun
53*4882a593Smuzhiyun static void batadv_nc_worker(struct work_struct *work);
54*4882a593Smuzhiyun static int batadv_nc_recv_coded_packet(struct sk_buff *skb,
55*4882a593Smuzhiyun struct batadv_hard_iface *recv_if);
56*4882a593Smuzhiyun
57*4882a593Smuzhiyun /**
58*4882a593Smuzhiyun * batadv_nc_init() - one-time initialization for network coding
59*4882a593Smuzhiyun *
60*4882a593Smuzhiyun * Return: 0 on success or negative error number in case of failure
61*4882a593Smuzhiyun */
batadv_nc_init(void)62*4882a593Smuzhiyun int __init batadv_nc_init(void)
63*4882a593Smuzhiyun {
64*4882a593Smuzhiyun int ret;
65*4882a593Smuzhiyun
66*4882a593Smuzhiyun /* Register our packet type */
67*4882a593Smuzhiyun ret = batadv_recv_handler_register(BATADV_CODED,
68*4882a593Smuzhiyun batadv_nc_recv_coded_packet);
69*4882a593Smuzhiyun
70*4882a593Smuzhiyun return ret;
71*4882a593Smuzhiyun }
72*4882a593Smuzhiyun
73*4882a593Smuzhiyun /**
74*4882a593Smuzhiyun * batadv_nc_start_timer() - initialise the nc periodic worker
75*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
76*4882a593Smuzhiyun */
batadv_nc_start_timer(struct batadv_priv * bat_priv)77*4882a593Smuzhiyun static void batadv_nc_start_timer(struct batadv_priv *bat_priv)
78*4882a593Smuzhiyun {
79*4882a593Smuzhiyun queue_delayed_work(batadv_event_workqueue, &bat_priv->nc.work,
80*4882a593Smuzhiyun msecs_to_jiffies(10));
81*4882a593Smuzhiyun }
82*4882a593Smuzhiyun
83*4882a593Smuzhiyun /**
84*4882a593Smuzhiyun * batadv_nc_tvlv_container_update() - update the network coding tvlv container
85*4882a593Smuzhiyun * after network coding setting change
86*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
87*4882a593Smuzhiyun */
batadv_nc_tvlv_container_update(struct batadv_priv * bat_priv)88*4882a593Smuzhiyun static void batadv_nc_tvlv_container_update(struct batadv_priv *bat_priv)
89*4882a593Smuzhiyun {
90*4882a593Smuzhiyun char nc_mode;
91*4882a593Smuzhiyun
92*4882a593Smuzhiyun nc_mode = atomic_read(&bat_priv->network_coding);
93*4882a593Smuzhiyun
94*4882a593Smuzhiyun switch (nc_mode) {
95*4882a593Smuzhiyun case 0:
96*4882a593Smuzhiyun batadv_tvlv_container_unregister(bat_priv, BATADV_TVLV_NC, 1);
97*4882a593Smuzhiyun break;
98*4882a593Smuzhiyun case 1:
99*4882a593Smuzhiyun batadv_tvlv_container_register(bat_priv, BATADV_TVLV_NC, 1,
100*4882a593Smuzhiyun NULL, 0);
101*4882a593Smuzhiyun break;
102*4882a593Smuzhiyun }
103*4882a593Smuzhiyun }
104*4882a593Smuzhiyun
105*4882a593Smuzhiyun /**
106*4882a593Smuzhiyun * batadv_nc_status_update() - update the network coding tvlv container after
107*4882a593Smuzhiyun * network coding setting change
108*4882a593Smuzhiyun * @net_dev: the soft interface net device
109*4882a593Smuzhiyun */
batadv_nc_status_update(struct net_device * net_dev)110*4882a593Smuzhiyun void batadv_nc_status_update(struct net_device *net_dev)
111*4882a593Smuzhiyun {
112*4882a593Smuzhiyun struct batadv_priv *bat_priv = netdev_priv(net_dev);
113*4882a593Smuzhiyun
114*4882a593Smuzhiyun batadv_nc_tvlv_container_update(bat_priv);
115*4882a593Smuzhiyun }
116*4882a593Smuzhiyun
117*4882a593Smuzhiyun /**
118*4882a593Smuzhiyun * batadv_nc_tvlv_ogm_handler_v1() - process incoming nc tvlv container
119*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
120*4882a593Smuzhiyun * @orig: the orig_node of the ogm
121*4882a593Smuzhiyun * @flags: flags indicating the tvlv state (see batadv_tvlv_handler_flags)
122*4882a593Smuzhiyun * @tvlv_value: tvlv buffer containing the gateway data
123*4882a593Smuzhiyun * @tvlv_value_len: tvlv buffer length
124*4882a593Smuzhiyun */
batadv_nc_tvlv_ogm_handler_v1(struct batadv_priv * bat_priv,struct batadv_orig_node * orig,u8 flags,void * tvlv_value,u16 tvlv_value_len)125*4882a593Smuzhiyun static void batadv_nc_tvlv_ogm_handler_v1(struct batadv_priv *bat_priv,
126*4882a593Smuzhiyun struct batadv_orig_node *orig,
127*4882a593Smuzhiyun u8 flags,
128*4882a593Smuzhiyun void *tvlv_value, u16 tvlv_value_len)
129*4882a593Smuzhiyun {
130*4882a593Smuzhiyun if (flags & BATADV_TVLV_HANDLER_OGM_CIFNOTFND)
131*4882a593Smuzhiyun clear_bit(BATADV_ORIG_CAPA_HAS_NC, &orig->capabilities);
132*4882a593Smuzhiyun else
133*4882a593Smuzhiyun set_bit(BATADV_ORIG_CAPA_HAS_NC, &orig->capabilities);
134*4882a593Smuzhiyun }
135*4882a593Smuzhiyun
136*4882a593Smuzhiyun /**
137*4882a593Smuzhiyun * batadv_nc_mesh_init() - initialise coding hash table and start housekeeping
138*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
139*4882a593Smuzhiyun *
140*4882a593Smuzhiyun * Return: 0 on success or negative error number in case of failure
141*4882a593Smuzhiyun */
batadv_nc_mesh_init(struct batadv_priv * bat_priv)142*4882a593Smuzhiyun int batadv_nc_mesh_init(struct batadv_priv *bat_priv)
143*4882a593Smuzhiyun {
144*4882a593Smuzhiyun bat_priv->nc.timestamp_fwd_flush = jiffies;
145*4882a593Smuzhiyun bat_priv->nc.timestamp_sniffed_purge = jiffies;
146*4882a593Smuzhiyun
147*4882a593Smuzhiyun if (bat_priv->nc.coding_hash || bat_priv->nc.decoding_hash)
148*4882a593Smuzhiyun return 0;
149*4882a593Smuzhiyun
150*4882a593Smuzhiyun bat_priv->nc.coding_hash = batadv_hash_new(128);
151*4882a593Smuzhiyun if (!bat_priv->nc.coding_hash)
152*4882a593Smuzhiyun goto err;
153*4882a593Smuzhiyun
154*4882a593Smuzhiyun batadv_hash_set_lock_class(bat_priv->nc.coding_hash,
155*4882a593Smuzhiyun &batadv_nc_coding_hash_lock_class_key);
156*4882a593Smuzhiyun
157*4882a593Smuzhiyun bat_priv->nc.decoding_hash = batadv_hash_new(128);
158*4882a593Smuzhiyun if (!bat_priv->nc.decoding_hash) {
159*4882a593Smuzhiyun batadv_hash_destroy(bat_priv->nc.coding_hash);
160*4882a593Smuzhiyun goto err;
161*4882a593Smuzhiyun }
162*4882a593Smuzhiyun
163*4882a593Smuzhiyun batadv_hash_set_lock_class(bat_priv->nc.decoding_hash,
164*4882a593Smuzhiyun &batadv_nc_decoding_hash_lock_class_key);
165*4882a593Smuzhiyun
166*4882a593Smuzhiyun INIT_DELAYED_WORK(&bat_priv->nc.work, batadv_nc_worker);
167*4882a593Smuzhiyun batadv_nc_start_timer(bat_priv);
168*4882a593Smuzhiyun
169*4882a593Smuzhiyun batadv_tvlv_handler_register(bat_priv, batadv_nc_tvlv_ogm_handler_v1,
170*4882a593Smuzhiyun NULL, BATADV_TVLV_NC, 1,
171*4882a593Smuzhiyun BATADV_TVLV_HANDLER_OGM_CIFNOTFND);
172*4882a593Smuzhiyun batadv_nc_tvlv_container_update(bat_priv);
173*4882a593Smuzhiyun return 0;
174*4882a593Smuzhiyun
175*4882a593Smuzhiyun err:
176*4882a593Smuzhiyun return -ENOMEM;
177*4882a593Smuzhiyun }
178*4882a593Smuzhiyun
179*4882a593Smuzhiyun /**
180*4882a593Smuzhiyun * batadv_nc_init_bat_priv() - initialise the nc specific bat_priv variables
181*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
182*4882a593Smuzhiyun */
batadv_nc_init_bat_priv(struct batadv_priv * bat_priv)183*4882a593Smuzhiyun void batadv_nc_init_bat_priv(struct batadv_priv *bat_priv)
184*4882a593Smuzhiyun {
185*4882a593Smuzhiyun atomic_set(&bat_priv->network_coding, 0);
186*4882a593Smuzhiyun bat_priv->nc.min_tq = 200;
187*4882a593Smuzhiyun bat_priv->nc.max_fwd_delay = 10;
188*4882a593Smuzhiyun bat_priv->nc.max_buffer_time = 200;
189*4882a593Smuzhiyun }
190*4882a593Smuzhiyun
191*4882a593Smuzhiyun /**
192*4882a593Smuzhiyun * batadv_nc_init_orig() - initialise the nc fields of an orig_node
193*4882a593Smuzhiyun * @orig_node: the orig_node which is going to be initialised
194*4882a593Smuzhiyun */
batadv_nc_init_orig(struct batadv_orig_node * orig_node)195*4882a593Smuzhiyun void batadv_nc_init_orig(struct batadv_orig_node *orig_node)
196*4882a593Smuzhiyun {
197*4882a593Smuzhiyun INIT_LIST_HEAD(&orig_node->in_coding_list);
198*4882a593Smuzhiyun INIT_LIST_HEAD(&orig_node->out_coding_list);
199*4882a593Smuzhiyun spin_lock_init(&orig_node->in_coding_list_lock);
200*4882a593Smuzhiyun spin_lock_init(&orig_node->out_coding_list_lock);
201*4882a593Smuzhiyun }
202*4882a593Smuzhiyun
203*4882a593Smuzhiyun /**
204*4882a593Smuzhiyun * batadv_nc_node_release() - release nc_node from lists and queue for free
205*4882a593Smuzhiyun * after rcu grace period
206*4882a593Smuzhiyun * @ref: kref pointer of the nc_node
207*4882a593Smuzhiyun */
batadv_nc_node_release(struct kref * ref)208*4882a593Smuzhiyun static void batadv_nc_node_release(struct kref *ref)
209*4882a593Smuzhiyun {
210*4882a593Smuzhiyun struct batadv_nc_node *nc_node;
211*4882a593Smuzhiyun
212*4882a593Smuzhiyun nc_node = container_of(ref, struct batadv_nc_node, refcount);
213*4882a593Smuzhiyun
214*4882a593Smuzhiyun batadv_orig_node_put(nc_node->orig_node);
215*4882a593Smuzhiyun kfree_rcu(nc_node, rcu);
216*4882a593Smuzhiyun }
217*4882a593Smuzhiyun
218*4882a593Smuzhiyun /**
219*4882a593Smuzhiyun * batadv_nc_node_put() - decrement the nc_node refcounter and possibly
220*4882a593Smuzhiyun * release it
221*4882a593Smuzhiyun * @nc_node: nc_node to be free'd
222*4882a593Smuzhiyun */
batadv_nc_node_put(struct batadv_nc_node * nc_node)223*4882a593Smuzhiyun static void batadv_nc_node_put(struct batadv_nc_node *nc_node)
224*4882a593Smuzhiyun {
225*4882a593Smuzhiyun if (!nc_node)
226*4882a593Smuzhiyun return;
227*4882a593Smuzhiyun
228*4882a593Smuzhiyun kref_put(&nc_node->refcount, batadv_nc_node_release);
229*4882a593Smuzhiyun }
230*4882a593Smuzhiyun
231*4882a593Smuzhiyun /**
232*4882a593Smuzhiyun * batadv_nc_path_release() - release nc_path from lists and queue for free
233*4882a593Smuzhiyun * after rcu grace period
234*4882a593Smuzhiyun * @ref: kref pointer of the nc_path
235*4882a593Smuzhiyun */
batadv_nc_path_release(struct kref * ref)236*4882a593Smuzhiyun static void batadv_nc_path_release(struct kref *ref)
237*4882a593Smuzhiyun {
238*4882a593Smuzhiyun struct batadv_nc_path *nc_path;
239*4882a593Smuzhiyun
240*4882a593Smuzhiyun nc_path = container_of(ref, struct batadv_nc_path, refcount);
241*4882a593Smuzhiyun
242*4882a593Smuzhiyun kfree_rcu(nc_path, rcu);
243*4882a593Smuzhiyun }
244*4882a593Smuzhiyun
245*4882a593Smuzhiyun /**
246*4882a593Smuzhiyun * batadv_nc_path_put() - decrement the nc_path refcounter and possibly
247*4882a593Smuzhiyun * release it
248*4882a593Smuzhiyun * @nc_path: nc_path to be free'd
249*4882a593Smuzhiyun */
batadv_nc_path_put(struct batadv_nc_path * nc_path)250*4882a593Smuzhiyun static void batadv_nc_path_put(struct batadv_nc_path *nc_path)
251*4882a593Smuzhiyun {
252*4882a593Smuzhiyun if (!nc_path)
253*4882a593Smuzhiyun return;
254*4882a593Smuzhiyun
255*4882a593Smuzhiyun kref_put(&nc_path->refcount, batadv_nc_path_release);
256*4882a593Smuzhiyun }
257*4882a593Smuzhiyun
258*4882a593Smuzhiyun /**
259*4882a593Smuzhiyun * batadv_nc_packet_free() - frees nc packet
260*4882a593Smuzhiyun * @nc_packet: the nc packet to free
261*4882a593Smuzhiyun * @dropped: whether the packet is freed because is dropped
262*4882a593Smuzhiyun */
batadv_nc_packet_free(struct batadv_nc_packet * nc_packet,bool dropped)263*4882a593Smuzhiyun static void batadv_nc_packet_free(struct batadv_nc_packet *nc_packet,
264*4882a593Smuzhiyun bool dropped)
265*4882a593Smuzhiyun {
266*4882a593Smuzhiyun if (dropped)
267*4882a593Smuzhiyun kfree_skb(nc_packet->skb);
268*4882a593Smuzhiyun else
269*4882a593Smuzhiyun consume_skb(nc_packet->skb);
270*4882a593Smuzhiyun
271*4882a593Smuzhiyun batadv_nc_path_put(nc_packet->nc_path);
272*4882a593Smuzhiyun kfree(nc_packet);
273*4882a593Smuzhiyun }
274*4882a593Smuzhiyun
275*4882a593Smuzhiyun /**
276*4882a593Smuzhiyun * batadv_nc_to_purge_nc_node() - checks whether an nc node has to be purged
277*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
278*4882a593Smuzhiyun * @nc_node: the nc node to check
279*4882a593Smuzhiyun *
280*4882a593Smuzhiyun * Return: true if the entry has to be purged now, false otherwise
281*4882a593Smuzhiyun */
batadv_nc_to_purge_nc_node(struct batadv_priv * bat_priv,struct batadv_nc_node * nc_node)282*4882a593Smuzhiyun static bool batadv_nc_to_purge_nc_node(struct batadv_priv *bat_priv,
283*4882a593Smuzhiyun struct batadv_nc_node *nc_node)
284*4882a593Smuzhiyun {
285*4882a593Smuzhiyun if (atomic_read(&bat_priv->mesh_state) != BATADV_MESH_ACTIVE)
286*4882a593Smuzhiyun return true;
287*4882a593Smuzhiyun
288*4882a593Smuzhiyun return batadv_has_timed_out(nc_node->last_seen, BATADV_NC_NODE_TIMEOUT);
289*4882a593Smuzhiyun }
290*4882a593Smuzhiyun
291*4882a593Smuzhiyun /**
292*4882a593Smuzhiyun * batadv_nc_to_purge_nc_path_coding() - checks whether an nc path has timed out
293*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
294*4882a593Smuzhiyun * @nc_path: the nc path to check
295*4882a593Smuzhiyun *
296*4882a593Smuzhiyun * Return: true if the entry has to be purged now, false otherwise
297*4882a593Smuzhiyun */
batadv_nc_to_purge_nc_path_coding(struct batadv_priv * bat_priv,struct batadv_nc_path * nc_path)298*4882a593Smuzhiyun static bool batadv_nc_to_purge_nc_path_coding(struct batadv_priv *bat_priv,
299*4882a593Smuzhiyun struct batadv_nc_path *nc_path)
300*4882a593Smuzhiyun {
301*4882a593Smuzhiyun if (atomic_read(&bat_priv->mesh_state) != BATADV_MESH_ACTIVE)
302*4882a593Smuzhiyun return true;
303*4882a593Smuzhiyun
304*4882a593Smuzhiyun /* purge the path when no packets has been added for 10 times the
305*4882a593Smuzhiyun * max_fwd_delay time
306*4882a593Smuzhiyun */
307*4882a593Smuzhiyun return batadv_has_timed_out(nc_path->last_valid,
308*4882a593Smuzhiyun bat_priv->nc.max_fwd_delay * 10);
309*4882a593Smuzhiyun }
310*4882a593Smuzhiyun
311*4882a593Smuzhiyun /**
312*4882a593Smuzhiyun * batadv_nc_to_purge_nc_path_decoding() - checks whether an nc path has timed
313*4882a593Smuzhiyun * out
314*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
315*4882a593Smuzhiyun * @nc_path: the nc path to check
316*4882a593Smuzhiyun *
317*4882a593Smuzhiyun * Return: true if the entry has to be purged now, false otherwise
318*4882a593Smuzhiyun */
batadv_nc_to_purge_nc_path_decoding(struct batadv_priv * bat_priv,struct batadv_nc_path * nc_path)319*4882a593Smuzhiyun static bool batadv_nc_to_purge_nc_path_decoding(struct batadv_priv *bat_priv,
320*4882a593Smuzhiyun struct batadv_nc_path *nc_path)
321*4882a593Smuzhiyun {
322*4882a593Smuzhiyun if (atomic_read(&bat_priv->mesh_state) != BATADV_MESH_ACTIVE)
323*4882a593Smuzhiyun return true;
324*4882a593Smuzhiyun
325*4882a593Smuzhiyun /* purge the path when no packets has been added for 10 times the
326*4882a593Smuzhiyun * max_buffer time
327*4882a593Smuzhiyun */
328*4882a593Smuzhiyun return batadv_has_timed_out(nc_path->last_valid,
329*4882a593Smuzhiyun bat_priv->nc.max_buffer_time * 10);
330*4882a593Smuzhiyun }
331*4882a593Smuzhiyun
332*4882a593Smuzhiyun /**
333*4882a593Smuzhiyun * batadv_nc_purge_orig_nc_nodes() - go through list of nc nodes and purge stale
334*4882a593Smuzhiyun * entries
335*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
336*4882a593Smuzhiyun * @list: list of nc nodes
337*4882a593Smuzhiyun * @lock: nc node list lock
338*4882a593Smuzhiyun * @to_purge: function in charge to decide whether an entry has to be purged or
339*4882a593Smuzhiyun * not. This function takes the nc node as argument and has to return
340*4882a593Smuzhiyun * a boolean value: true if the entry has to be deleted, false
341*4882a593Smuzhiyun * otherwise
342*4882a593Smuzhiyun */
343*4882a593Smuzhiyun static void
batadv_nc_purge_orig_nc_nodes(struct batadv_priv * bat_priv,struct list_head * list,spinlock_t * lock,bool (* to_purge)(struct batadv_priv *,struct batadv_nc_node *))344*4882a593Smuzhiyun batadv_nc_purge_orig_nc_nodes(struct batadv_priv *bat_priv,
345*4882a593Smuzhiyun struct list_head *list,
346*4882a593Smuzhiyun spinlock_t *lock,
347*4882a593Smuzhiyun bool (*to_purge)(struct batadv_priv *,
348*4882a593Smuzhiyun struct batadv_nc_node *))
349*4882a593Smuzhiyun {
350*4882a593Smuzhiyun struct batadv_nc_node *nc_node, *nc_node_tmp;
351*4882a593Smuzhiyun
352*4882a593Smuzhiyun /* For each nc_node in list */
353*4882a593Smuzhiyun spin_lock_bh(lock);
354*4882a593Smuzhiyun list_for_each_entry_safe(nc_node, nc_node_tmp, list, list) {
355*4882a593Smuzhiyun /* if an helper function has been passed as parameter,
356*4882a593Smuzhiyun * ask it if the entry has to be purged or not
357*4882a593Smuzhiyun */
358*4882a593Smuzhiyun if (to_purge && !to_purge(bat_priv, nc_node))
359*4882a593Smuzhiyun continue;
360*4882a593Smuzhiyun
361*4882a593Smuzhiyun batadv_dbg(BATADV_DBG_NC, bat_priv,
362*4882a593Smuzhiyun "Removing nc_node %pM -> %pM\n",
363*4882a593Smuzhiyun nc_node->addr, nc_node->orig_node->orig);
364*4882a593Smuzhiyun list_del_rcu(&nc_node->list);
365*4882a593Smuzhiyun batadv_nc_node_put(nc_node);
366*4882a593Smuzhiyun }
367*4882a593Smuzhiyun spin_unlock_bh(lock);
368*4882a593Smuzhiyun }
369*4882a593Smuzhiyun
370*4882a593Smuzhiyun /**
371*4882a593Smuzhiyun * batadv_nc_purge_orig() - purges all nc node data attached of the given
372*4882a593Smuzhiyun * originator
373*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
374*4882a593Smuzhiyun * @orig_node: orig_node with the nc node entries to be purged
375*4882a593Smuzhiyun * @to_purge: function in charge to decide whether an entry has to be purged or
376*4882a593Smuzhiyun * not. This function takes the nc node as argument and has to return
377*4882a593Smuzhiyun * a boolean value: true is the entry has to be deleted, false
378*4882a593Smuzhiyun * otherwise
379*4882a593Smuzhiyun */
batadv_nc_purge_orig(struct batadv_priv * bat_priv,struct batadv_orig_node * orig_node,bool (* to_purge)(struct batadv_priv *,struct batadv_nc_node *))380*4882a593Smuzhiyun void batadv_nc_purge_orig(struct batadv_priv *bat_priv,
381*4882a593Smuzhiyun struct batadv_orig_node *orig_node,
382*4882a593Smuzhiyun bool (*to_purge)(struct batadv_priv *,
383*4882a593Smuzhiyun struct batadv_nc_node *))
384*4882a593Smuzhiyun {
385*4882a593Smuzhiyun /* Check ingoing nc_node's of this orig_node */
386*4882a593Smuzhiyun batadv_nc_purge_orig_nc_nodes(bat_priv, &orig_node->in_coding_list,
387*4882a593Smuzhiyun &orig_node->in_coding_list_lock,
388*4882a593Smuzhiyun to_purge);
389*4882a593Smuzhiyun
390*4882a593Smuzhiyun /* Check outgoing nc_node's of this orig_node */
391*4882a593Smuzhiyun batadv_nc_purge_orig_nc_nodes(bat_priv, &orig_node->out_coding_list,
392*4882a593Smuzhiyun &orig_node->out_coding_list_lock,
393*4882a593Smuzhiyun to_purge);
394*4882a593Smuzhiyun }
395*4882a593Smuzhiyun
396*4882a593Smuzhiyun /**
397*4882a593Smuzhiyun * batadv_nc_purge_orig_hash() - traverse entire originator hash to check if
398*4882a593Smuzhiyun * they have timed out nc nodes
399*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
400*4882a593Smuzhiyun */
batadv_nc_purge_orig_hash(struct batadv_priv * bat_priv)401*4882a593Smuzhiyun static void batadv_nc_purge_orig_hash(struct batadv_priv *bat_priv)
402*4882a593Smuzhiyun {
403*4882a593Smuzhiyun struct batadv_hashtable *hash = bat_priv->orig_hash;
404*4882a593Smuzhiyun struct hlist_head *head;
405*4882a593Smuzhiyun struct batadv_orig_node *orig_node;
406*4882a593Smuzhiyun u32 i;
407*4882a593Smuzhiyun
408*4882a593Smuzhiyun if (!hash)
409*4882a593Smuzhiyun return;
410*4882a593Smuzhiyun
411*4882a593Smuzhiyun /* For each orig_node */
412*4882a593Smuzhiyun for (i = 0; i < hash->size; i++) {
413*4882a593Smuzhiyun head = &hash->table[i];
414*4882a593Smuzhiyun
415*4882a593Smuzhiyun rcu_read_lock();
416*4882a593Smuzhiyun hlist_for_each_entry_rcu(orig_node, head, hash_entry)
417*4882a593Smuzhiyun batadv_nc_purge_orig(bat_priv, orig_node,
418*4882a593Smuzhiyun batadv_nc_to_purge_nc_node);
419*4882a593Smuzhiyun rcu_read_unlock();
420*4882a593Smuzhiyun }
421*4882a593Smuzhiyun }
422*4882a593Smuzhiyun
423*4882a593Smuzhiyun /**
424*4882a593Smuzhiyun * batadv_nc_purge_paths() - traverse all nc paths part of the hash and remove
425*4882a593Smuzhiyun * unused ones
426*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
427*4882a593Smuzhiyun * @hash: hash table containing the nc paths to check
428*4882a593Smuzhiyun * @to_purge: function in charge to decide whether an entry has to be purged or
429*4882a593Smuzhiyun * not. This function takes the nc node as argument and has to return
430*4882a593Smuzhiyun * a boolean value: true is the entry has to be deleted, false
431*4882a593Smuzhiyun * otherwise
432*4882a593Smuzhiyun */
batadv_nc_purge_paths(struct batadv_priv * bat_priv,struct batadv_hashtable * hash,bool (* to_purge)(struct batadv_priv *,struct batadv_nc_path *))433*4882a593Smuzhiyun static void batadv_nc_purge_paths(struct batadv_priv *bat_priv,
434*4882a593Smuzhiyun struct batadv_hashtable *hash,
435*4882a593Smuzhiyun bool (*to_purge)(struct batadv_priv *,
436*4882a593Smuzhiyun struct batadv_nc_path *))
437*4882a593Smuzhiyun {
438*4882a593Smuzhiyun struct hlist_head *head;
439*4882a593Smuzhiyun struct hlist_node *node_tmp;
440*4882a593Smuzhiyun struct batadv_nc_path *nc_path;
441*4882a593Smuzhiyun spinlock_t *lock; /* Protects lists in hash */
442*4882a593Smuzhiyun u32 i;
443*4882a593Smuzhiyun
444*4882a593Smuzhiyun for (i = 0; i < hash->size; i++) {
445*4882a593Smuzhiyun head = &hash->table[i];
446*4882a593Smuzhiyun lock = &hash->list_locks[i];
447*4882a593Smuzhiyun
448*4882a593Smuzhiyun /* For each nc_path in this bin */
449*4882a593Smuzhiyun spin_lock_bh(lock);
450*4882a593Smuzhiyun hlist_for_each_entry_safe(nc_path, node_tmp, head, hash_entry) {
451*4882a593Smuzhiyun /* if an helper function has been passed as parameter,
452*4882a593Smuzhiyun * ask it if the entry has to be purged or not
453*4882a593Smuzhiyun */
454*4882a593Smuzhiyun if (to_purge && !to_purge(bat_priv, nc_path))
455*4882a593Smuzhiyun continue;
456*4882a593Smuzhiyun
457*4882a593Smuzhiyun /* purging an non-empty nc_path should never happen, but
458*4882a593Smuzhiyun * is observed under high CPU load. Delay the purging
459*4882a593Smuzhiyun * until next iteration to allow the packet_list to be
460*4882a593Smuzhiyun * emptied first.
461*4882a593Smuzhiyun */
462*4882a593Smuzhiyun if (!unlikely(list_empty(&nc_path->packet_list))) {
463*4882a593Smuzhiyun net_ratelimited_function(printk,
464*4882a593Smuzhiyun KERN_WARNING
465*4882a593Smuzhiyun "Skipping free of non-empty nc_path (%pM -> %pM)!\n",
466*4882a593Smuzhiyun nc_path->prev_hop,
467*4882a593Smuzhiyun nc_path->next_hop);
468*4882a593Smuzhiyun continue;
469*4882a593Smuzhiyun }
470*4882a593Smuzhiyun
471*4882a593Smuzhiyun /* nc_path is unused, so remove it */
472*4882a593Smuzhiyun batadv_dbg(BATADV_DBG_NC, bat_priv,
473*4882a593Smuzhiyun "Remove nc_path %pM -> %pM\n",
474*4882a593Smuzhiyun nc_path->prev_hop, nc_path->next_hop);
475*4882a593Smuzhiyun hlist_del_rcu(&nc_path->hash_entry);
476*4882a593Smuzhiyun batadv_nc_path_put(nc_path);
477*4882a593Smuzhiyun }
478*4882a593Smuzhiyun spin_unlock_bh(lock);
479*4882a593Smuzhiyun }
480*4882a593Smuzhiyun }
481*4882a593Smuzhiyun
482*4882a593Smuzhiyun /**
483*4882a593Smuzhiyun * batadv_nc_hash_key_gen() - computes the nc_path hash key
484*4882a593Smuzhiyun * @key: buffer to hold the final hash key
485*4882a593Smuzhiyun * @src: source ethernet mac address going into the hash key
486*4882a593Smuzhiyun * @dst: destination ethernet mac address going into the hash key
487*4882a593Smuzhiyun */
batadv_nc_hash_key_gen(struct batadv_nc_path * key,const char * src,const char * dst)488*4882a593Smuzhiyun static void batadv_nc_hash_key_gen(struct batadv_nc_path *key, const char *src,
489*4882a593Smuzhiyun const char *dst)
490*4882a593Smuzhiyun {
491*4882a593Smuzhiyun memcpy(key->prev_hop, src, sizeof(key->prev_hop));
492*4882a593Smuzhiyun memcpy(key->next_hop, dst, sizeof(key->next_hop));
493*4882a593Smuzhiyun }
494*4882a593Smuzhiyun
495*4882a593Smuzhiyun /**
496*4882a593Smuzhiyun * batadv_nc_hash_choose() - compute the hash value for an nc path
497*4882a593Smuzhiyun * @data: data to hash
498*4882a593Smuzhiyun * @size: size of the hash table
499*4882a593Smuzhiyun *
500*4882a593Smuzhiyun * Return: the selected index in the hash table for the given data.
501*4882a593Smuzhiyun */
batadv_nc_hash_choose(const void * data,u32 size)502*4882a593Smuzhiyun static u32 batadv_nc_hash_choose(const void *data, u32 size)
503*4882a593Smuzhiyun {
504*4882a593Smuzhiyun const struct batadv_nc_path *nc_path = data;
505*4882a593Smuzhiyun u32 hash = 0;
506*4882a593Smuzhiyun
507*4882a593Smuzhiyun hash = jhash(&nc_path->prev_hop, sizeof(nc_path->prev_hop), hash);
508*4882a593Smuzhiyun hash = jhash(&nc_path->next_hop, sizeof(nc_path->next_hop), hash);
509*4882a593Smuzhiyun
510*4882a593Smuzhiyun return hash % size;
511*4882a593Smuzhiyun }
512*4882a593Smuzhiyun
513*4882a593Smuzhiyun /**
514*4882a593Smuzhiyun * batadv_nc_hash_compare() - comparing function used in the network coding hash
515*4882a593Smuzhiyun * tables
516*4882a593Smuzhiyun * @node: node in the local table
517*4882a593Smuzhiyun * @data2: second object to compare the node to
518*4882a593Smuzhiyun *
519*4882a593Smuzhiyun * Return: true if the two entry are the same, false otherwise
520*4882a593Smuzhiyun */
batadv_nc_hash_compare(const struct hlist_node * node,const void * data2)521*4882a593Smuzhiyun static bool batadv_nc_hash_compare(const struct hlist_node *node,
522*4882a593Smuzhiyun const void *data2)
523*4882a593Smuzhiyun {
524*4882a593Smuzhiyun const struct batadv_nc_path *nc_path1, *nc_path2;
525*4882a593Smuzhiyun
526*4882a593Smuzhiyun nc_path1 = container_of(node, struct batadv_nc_path, hash_entry);
527*4882a593Smuzhiyun nc_path2 = data2;
528*4882a593Smuzhiyun
529*4882a593Smuzhiyun /* Return 1 if the two keys are identical */
530*4882a593Smuzhiyun if (!batadv_compare_eth(nc_path1->prev_hop, nc_path2->prev_hop))
531*4882a593Smuzhiyun return false;
532*4882a593Smuzhiyun
533*4882a593Smuzhiyun if (!batadv_compare_eth(nc_path1->next_hop, nc_path2->next_hop))
534*4882a593Smuzhiyun return false;
535*4882a593Smuzhiyun
536*4882a593Smuzhiyun return true;
537*4882a593Smuzhiyun }
538*4882a593Smuzhiyun
539*4882a593Smuzhiyun /**
540*4882a593Smuzhiyun * batadv_nc_hash_find() - search for an existing nc path and return it
541*4882a593Smuzhiyun * @hash: hash table containing the nc path
542*4882a593Smuzhiyun * @data: search key
543*4882a593Smuzhiyun *
544*4882a593Smuzhiyun * Return: the nc_path if found, NULL otherwise.
545*4882a593Smuzhiyun */
546*4882a593Smuzhiyun static struct batadv_nc_path *
batadv_nc_hash_find(struct batadv_hashtable * hash,void * data)547*4882a593Smuzhiyun batadv_nc_hash_find(struct batadv_hashtable *hash,
548*4882a593Smuzhiyun void *data)
549*4882a593Smuzhiyun {
550*4882a593Smuzhiyun struct hlist_head *head;
551*4882a593Smuzhiyun struct batadv_nc_path *nc_path, *nc_path_tmp = NULL;
552*4882a593Smuzhiyun int index;
553*4882a593Smuzhiyun
554*4882a593Smuzhiyun if (!hash)
555*4882a593Smuzhiyun return NULL;
556*4882a593Smuzhiyun
557*4882a593Smuzhiyun index = batadv_nc_hash_choose(data, hash->size);
558*4882a593Smuzhiyun head = &hash->table[index];
559*4882a593Smuzhiyun
560*4882a593Smuzhiyun rcu_read_lock();
561*4882a593Smuzhiyun hlist_for_each_entry_rcu(nc_path, head, hash_entry) {
562*4882a593Smuzhiyun if (!batadv_nc_hash_compare(&nc_path->hash_entry, data))
563*4882a593Smuzhiyun continue;
564*4882a593Smuzhiyun
565*4882a593Smuzhiyun if (!kref_get_unless_zero(&nc_path->refcount))
566*4882a593Smuzhiyun continue;
567*4882a593Smuzhiyun
568*4882a593Smuzhiyun nc_path_tmp = nc_path;
569*4882a593Smuzhiyun break;
570*4882a593Smuzhiyun }
571*4882a593Smuzhiyun rcu_read_unlock();
572*4882a593Smuzhiyun
573*4882a593Smuzhiyun return nc_path_tmp;
574*4882a593Smuzhiyun }
575*4882a593Smuzhiyun
576*4882a593Smuzhiyun /**
577*4882a593Smuzhiyun * batadv_nc_send_packet() - send non-coded packet and free nc_packet struct
578*4882a593Smuzhiyun * @nc_packet: the nc packet to send
579*4882a593Smuzhiyun */
batadv_nc_send_packet(struct batadv_nc_packet * nc_packet)580*4882a593Smuzhiyun static void batadv_nc_send_packet(struct batadv_nc_packet *nc_packet)
581*4882a593Smuzhiyun {
582*4882a593Smuzhiyun batadv_send_unicast_skb(nc_packet->skb, nc_packet->neigh_node);
583*4882a593Smuzhiyun nc_packet->skb = NULL;
584*4882a593Smuzhiyun batadv_nc_packet_free(nc_packet, false);
585*4882a593Smuzhiyun }
586*4882a593Smuzhiyun
587*4882a593Smuzhiyun /**
588*4882a593Smuzhiyun * batadv_nc_sniffed_purge() - Checks timestamp of given sniffed nc_packet.
589*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
590*4882a593Smuzhiyun * @nc_path: the nc path the packet belongs to
591*4882a593Smuzhiyun * @nc_packet: the nc packet to be checked
592*4882a593Smuzhiyun *
593*4882a593Smuzhiyun * Checks whether the given sniffed (overheard) nc_packet has hit its buffering
594*4882a593Smuzhiyun * timeout. If so, the packet is no longer kept and the entry deleted from the
595*4882a593Smuzhiyun * queue. Has to be called with the appropriate locks.
596*4882a593Smuzhiyun *
597*4882a593Smuzhiyun * Return: false as soon as the entry in the fifo queue has not been timed out
598*4882a593Smuzhiyun * yet and true otherwise.
599*4882a593Smuzhiyun */
batadv_nc_sniffed_purge(struct batadv_priv * bat_priv,struct batadv_nc_path * nc_path,struct batadv_nc_packet * nc_packet)600*4882a593Smuzhiyun static bool batadv_nc_sniffed_purge(struct batadv_priv *bat_priv,
601*4882a593Smuzhiyun struct batadv_nc_path *nc_path,
602*4882a593Smuzhiyun struct batadv_nc_packet *nc_packet)
603*4882a593Smuzhiyun {
604*4882a593Smuzhiyun unsigned long timeout = bat_priv->nc.max_buffer_time;
605*4882a593Smuzhiyun bool res = false;
606*4882a593Smuzhiyun
607*4882a593Smuzhiyun lockdep_assert_held(&nc_path->packet_list_lock);
608*4882a593Smuzhiyun
609*4882a593Smuzhiyun /* Packets are added to tail, so the remaining packets did not time
610*4882a593Smuzhiyun * out and we can stop processing the current queue
611*4882a593Smuzhiyun */
612*4882a593Smuzhiyun if (atomic_read(&bat_priv->mesh_state) == BATADV_MESH_ACTIVE &&
613*4882a593Smuzhiyun !batadv_has_timed_out(nc_packet->timestamp, timeout))
614*4882a593Smuzhiyun goto out;
615*4882a593Smuzhiyun
616*4882a593Smuzhiyun /* purge nc packet */
617*4882a593Smuzhiyun list_del(&nc_packet->list);
618*4882a593Smuzhiyun batadv_nc_packet_free(nc_packet, true);
619*4882a593Smuzhiyun
620*4882a593Smuzhiyun res = true;
621*4882a593Smuzhiyun
622*4882a593Smuzhiyun out:
623*4882a593Smuzhiyun return res;
624*4882a593Smuzhiyun }
625*4882a593Smuzhiyun
626*4882a593Smuzhiyun /**
627*4882a593Smuzhiyun * batadv_nc_fwd_flush() - Checks the timestamp of the given nc packet.
628*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
629*4882a593Smuzhiyun * @nc_path: the nc path the packet belongs to
630*4882a593Smuzhiyun * @nc_packet: the nc packet to be checked
631*4882a593Smuzhiyun *
632*4882a593Smuzhiyun * Checks whether the given nc packet has hit its forward timeout. If so, the
633*4882a593Smuzhiyun * packet is no longer delayed, immediately sent and the entry deleted from the
634*4882a593Smuzhiyun * queue. Has to be called with the appropriate locks.
635*4882a593Smuzhiyun *
636*4882a593Smuzhiyun * Return: false as soon as the entry in the fifo queue has not been timed out
637*4882a593Smuzhiyun * yet and true otherwise.
638*4882a593Smuzhiyun */
batadv_nc_fwd_flush(struct batadv_priv * bat_priv,struct batadv_nc_path * nc_path,struct batadv_nc_packet * nc_packet)639*4882a593Smuzhiyun static bool batadv_nc_fwd_flush(struct batadv_priv *bat_priv,
640*4882a593Smuzhiyun struct batadv_nc_path *nc_path,
641*4882a593Smuzhiyun struct batadv_nc_packet *nc_packet)
642*4882a593Smuzhiyun {
643*4882a593Smuzhiyun unsigned long timeout = bat_priv->nc.max_fwd_delay;
644*4882a593Smuzhiyun
645*4882a593Smuzhiyun lockdep_assert_held(&nc_path->packet_list_lock);
646*4882a593Smuzhiyun
647*4882a593Smuzhiyun /* Packets are added to tail, so the remaining packets did not time
648*4882a593Smuzhiyun * out and we can stop processing the current queue
649*4882a593Smuzhiyun */
650*4882a593Smuzhiyun if (atomic_read(&bat_priv->mesh_state) == BATADV_MESH_ACTIVE &&
651*4882a593Smuzhiyun !batadv_has_timed_out(nc_packet->timestamp, timeout))
652*4882a593Smuzhiyun return false;
653*4882a593Smuzhiyun
654*4882a593Smuzhiyun /* Send packet */
655*4882a593Smuzhiyun batadv_inc_counter(bat_priv, BATADV_CNT_FORWARD);
656*4882a593Smuzhiyun batadv_add_counter(bat_priv, BATADV_CNT_FORWARD_BYTES,
657*4882a593Smuzhiyun nc_packet->skb->len + ETH_HLEN);
658*4882a593Smuzhiyun list_del(&nc_packet->list);
659*4882a593Smuzhiyun batadv_nc_send_packet(nc_packet);
660*4882a593Smuzhiyun
661*4882a593Smuzhiyun return true;
662*4882a593Smuzhiyun }
663*4882a593Smuzhiyun
664*4882a593Smuzhiyun /**
665*4882a593Smuzhiyun * batadv_nc_process_nc_paths() - traverse given nc packet pool and free timed
666*4882a593Smuzhiyun * out nc packets
667*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
668*4882a593Smuzhiyun * @hash: to be processed hash table
669*4882a593Smuzhiyun * @process_fn: Function called to process given nc packet. Should return true
670*4882a593Smuzhiyun * to encourage this function to proceed with the next packet.
671*4882a593Smuzhiyun * Otherwise the rest of the current queue is skipped.
672*4882a593Smuzhiyun */
673*4882a593Smuzhiyun static void
batadv_nc_process_nc_paths(struct batadv_priv * bat_priv,struct batadv_hashtable * hash,bool (* process_fn)(struct batadv_priv *,struct batadv_nc_path *,struct batadv_nc_packet *))674*4882a593Smuzhiyun batadv_nc_process_nc_paths(struct batadv_priv *bat_priv,
675*4882a593Smuzhiyun struct batadv_hashtable *hash,
676*4882a593Smuzhiyun bool (*process_fn)(struct batadv_priv *,
677*4882a593Smuzhiyun struct batadv_nc_path *,
678*4882a593Smuzhiyun struct batadv_nc_packet *))
679*4882a593Smuzhiyun {
680*4882a593Smuzhiyun struct hlist_head *head;
681*4882a593Smuzhiyun struct batadv_nc_packet *nc_packet, *nc_packet_tmp;
682*4882a593Smuzhiyun struct batadv_nc_path *nc_path;
683*4882a593Smuzhiyun bool ret;
684*4882a593Smuzhiyun int i;
685*4882a593Smuzhiyun
686*4882a593Smuzhiyun if (!hash)
687*4882a593Smuzhiyun return;
688*4882a593Smuzhiyun
689*4882a593Smuzhiyun /* Loop hash table bins */
690*4882a593Smuzhiyun for (i = 0; i < hash->size; i++) {
691*4882a593Smuzhiyun head = &hash->table[i];
692*4882a593Smuzhiyun
693*4882a593Smuzhiyun /* Loop coding paths */
694*4882a593Smuzhiyun rcu_read_lock();
695*4882a593Smuzhiyun hlist_for_each_entry_rcu(nc_path, head, hash_entry) {
696*4882a593Smuzhiyun /* Loop packets */
697*4882a593Smuzhiyun spin_lock_bh(&nc_path->packet_list_lock);
698*4882a593Smuzhiyun list_for_each_entry_safe(nc_packet, nc_packet_tmp,
699*4882a593Smuzhiyun &nc_path->packet_list, list) {
700*4882a593Smuzhiyun ret = process_fn(bat_priv, nc_path, nc_packet);
701*4882a593Smuzhiyun if (!ret)
702*4882a593Smuzhiyun break;
703*4882a593Smuzhiyun }
704*4882a593Smuzhiyun spin_unlock_bh(&nc_path->packet_list_lock);
705*4882a593Smuzhiyun }
706*4882a593Smuzhiyun rcu_read_unlock();
707*4882a593Smuzhiyun }
708*4882a593Smuzhiyun }
709*4882a593Smuzhiyun
710*4882a593Smuzhiyun /**
711*4882a593Smuzhiyun * batadv_nc_worker() - periodic task for housekeeping related to network
712*4882a593Smuzhiyun * coding
713*4882a593Smuzhiyun * @work: kernel work struct
714*4882a593Smuzhiyun */
batadv_nc_worker(struct work_struct * work)715*4882a593Smuzhiyun static void batadv_nc_worker(struct work_struct *work)
716*4882a593Smuzhiyun {
717*4882a593Smuzhiyun struct delayed_work *delayed_work;
718*4882a593Smuzhiyun struct batadv_priv_nc *priv_nc;
719*4882a593Smuzhiyun struct batadv_priv *bat_priv;
720*4882a593Smuzhiyun unsigned long timeout;
721*4882a593Smuzhiyun
722*4882a593Smuzhiyun delayed_work = to_delayed_work(work);
723*4882a593Smuzhiyun priv_nc = container_of(delayed_work, struct batadv_priv_nc, work);
724*4882a593Smuzhiyun bat_priv = container_of(priv_nc, struct batadv_priv, nc);
725*4882a593Smuzhiyun
726*4882a593Smuzhiyun batadv_nc_purge_orig_hash(bat_priv);
727*4882a593Smuzhiyun batadv_nc_purge_paths(bat_priv, bat_priv->nc.coding_hash,
728*4882a593Smuzhiyun batadv_nc_to_purge_nc_path_coding);
729*4882a593Smuzhiyun batadv_nc_purge_paths(bat_priv, bat_priv->nc.decoding_hash,
730*4882a593Smuzhiyun batadv_nc_to_purge_nc_path_decoding);
731*4882a593Smuzhiyun
732*4882a593Smuzhiyun timeout = bat_priv->nc.max_fwd_delay;
733*4882a593Smuzhiyun
734*4882a593Smuzhiyun if (batadv_has_timed_out(bat_priv->nc.timestamp_fwd_flush, timeout)) {
735*4882a593Smuzhiyun batadv_nc_process_nc_paths(bat_priv, bat_priv->nc.coding_hash,
736*4882a593Smuzhiyun batadv_nc_fwd_flush);
737*4882a593Smuzhiyun bat_priv->nc.timestamp_fwd_flush = jiffies;
738*4882a593Smuzhiyun }
739*4882a593Smuzhiyun
740*4882a593Smuzhiyun if (batadv_has_timed_out(bat_priv->nc.timestamp_sniffed_purge,
741*4882a593Smuzhiyun bat_priv->nc.max_buffer_time)) {
742*4882a593Smuzhiyun batadv_nc_process_nc_paths(bat_priv, bat_priv->nc.decoding_hash,
743*4882a593Smuzhiyun batadv_nc_sniffed_purge);
744*4882a593Smuzhiyun bat_priv->nc.timestamp_sniffed_purge = jiffies;
745*4882a593Smuzhiyun }
746*4882a593Smuzhiyun
747*4882a593Smuzhiyun /* Schedule a new check */
748*4882a593Smuzhiyun batadv_nc_start_timer(bat_priv);
749*4882a593Smuzhiyun }
750*4882a593Smuzhiyun
751*4882a593Smuzhiyun /**
752*4882a593Smuzhiyun * batadv_can_nc_with_orig() - checks whether the given orig node is suitable
753*4882a593Smuzhiyun * for coding or not
754*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
755*4882a593Smuzhiyun * @orig_node: neighboring orig node which may be used as nc candidate
756*4882a593Smuzhiyun * @ogm_packet: incoming ogm packet also used for the checks
757*4882a593Smuzhiyun *
758*4882a593Smuzhiyun * Return: true if:
759*4882a593Smuzhiyun * 1) The OGM must have the most recent sequence number.
760*4882a593Smuzhiyun * 2) The TTL must be decremented by one and only one.
761*4882a593Smuzhiyun * 3) The OGM must be received from the first hop from orig_node.
762*4882a593Smuzhiyun * 4) The TQ value of the OGM must be above bat_priv->nc.min_tq.
763*4882a593Smuzhiyun */
batadv_can_nc_with_orig(struct batadv_priv * bat_priv,struct batadv_orig_node * orig_node,struct batadv_ogm_packet * ogm_packet)764*4882a593Smuzhiyun static bool batadv_can_nc_with_orig(struct batadv_priv *bat_priv,
765*4882a593Smuzhiyun struct batadv_orig_node *orig_node,
766*4882a593Smuzhiyun struct batadv_ogm_packet *ogm_packet)
767*4882a593Smuzhiyun {
768*4882a593Smuzhiyun struct batadv_orig_ifinfo *orig_ifinfo;
769*4882a593Smuzhiyun u32 last_real_seqno;
770*4882a593Smuzhiyun u8 last_ttl;
771*4882a593Smuzhiyun
772*4882a593Smuzhiyun orig_ifinfo = batadv_orig_ifinfo_get(orig_node, BATADV_IF_DEFAULT);
773*4882a593Smuzhiyun if (!orig_ifinfo)
774*4882a593Smuzhiyun return false;
775*4882a593Smuzhiyun
776*4882a593Smuzhiyun last_ttl = orig_ifinfo->last_ttl;
777*4882a593Smuzhiyun last_real_seqno = orig_ifinfo->last_real_seqno;
778*4882a593Smuzhiyun batadv_orig_ifinfo_put(orig_ifinfo);
779*4882a593Smuzhiyun
780*4882a593Smuzhiyun if (last_real_seqno != ntohl(ogm_packet->seqno))
781*4882a593Smuzhiyun return false;
782*4882a593Smuzhiyun if (last_ttl != ogm_packet->ttl + 1)
783*4882a593Smuzhiyun return false;
784*4882a593Smuzhiyun if (!batadv_compare_eth(ogm_packet->orig, ogm_packet->prev_sender))
785*4882a593Smuzhiyun return false;
786*4882a593Smuzhiyun if (ogm_packet->tq < bat_priv->nc.min_tq)
787*4882a593Smuzhiyun return false;
788*4882a593Smuzhiyun
789*4882a593Smuzhiyun return true;
790*4882a593Smuzhiyun }
791*4882a593Smuzhiyun
792*4882a593Smuzhiyun /**
793*4882a593Smuzhiyun * batadv_nc_find_nc_node() - search for an existing nc node and return it
794*4882a593Smuzhiyun * @orig_node: orig node originating the ogm packet
795*4882a593Smuzhiyun * @orig_neigh_node: neighboring orig node from which we received the ogm packet
796*4882a593Smuzhiyun * (can be equal to orig_node)
797*4882a593Smuzhiyun * @in_coding: traverse incoming or outgoing network coding list
798*4882a593Smuzhiyun *
799*4882a593Smuzhiyun * Return: the nc_node if found, NULL otherwise.
800*4882a593Smuzhiyun */
801*4882a593Smuzhiyun static struct batadv_nc_node *
batadv_nc_find_nc_node(struct batadv_orig_node * orig_node,struct batadv_orig_node * orig_neigh_node,bool in_coding)802*4882a593Smuzhiyun batadv_nc_find_nc_node(struct batadv_orig_node *orig_node,
803*4882a593Smuzhiyun struct batadv_orig_node *orig_neigh_node,
804*4882a593Smuzhiyun bool in_coding)
805*4882a593Smuzhiyun {
806*4882a593Smuzhiyun struct batadv_nc_node *nc_node, *nc_node_out = NULL;
807*4882a593Smuzhiyun struct list_head *list;
808*4882a593Smuzhiyun
809*4882a593Smuzhiyun if (in_coding)
810*4882a593Smuzhiyun list = &orig_neigh_node->in_coding_list;
811*4882a593Smuzhiyun else
812*4882a593Smuzhiyun list = &orig_neigh_node->out_coding_list;
813*4882a593Smuzhiyun
814*4882a593Smuzhiyun /* Traverse list of nc_nodes to orig_node */
815*4882a593Smuzhiyun rcu_read_lock();
816*4882a593Smuzhiyun list_for_each_entry_rcu(nc_node, list, list) {
817*4882a593Smuzhiyun if (!batadv_compare_eth(nc_node->addr, orig_node->orig))
818*4882a593Smuzhiyun continue;
819*4882a593Smuzhiyun
820*4882a593Smuzhiyun if (!kref_get_unless_zero(&nc_node->refcount))
821*4882a593Smuzhiyun continue;
822*4882a593Smuzhiyun
823*4882a593Smuzhiyun /* Found a match */
824*4882a593Smuzhiyun nc_node_out = nc_node;
825*4882a593Smuzhiyun break;
826*4882a593Smuzhiyun }
827*4882a593Smuzhiyun rcu_read_unlock();
828*4882a593Smuzhiyun
829*4882a593Smuzhiyun return nc_node_out;
830*4882a593Smuzhiyun }
831*4882a593Smuzhiyun
832*4882a593Smuzhiyun /**
833*4882a593Smuzhiyun * batadv_nc_get_nc_node() - retrieves an nc node or creates the entry if it was
834*4882a593Smuzhiyun * not found
835*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
836*4882a593Smuzhiyun * @orig_node: orig node originating the ogm packet
837*4882a593Smuzhiyun * @orig_neigh_node: neighboring orig node from which we received the ogm packet
838*4882a593Smuzhiyun * (can be equal to orig_node)
839*4882a593Smuzhiyun * @in_coding: traverse incoming or outgoing network coding list
840*4882a593Smuzhiyun *
841*4882a593Smuzhiyun * Return: the nc_node if found or created, NULL in case of an error.
842*4882a593Smuzhiyun */
843*4882a593Smuzhiyun static struct batadv_nc_node *
batadv_nc_get_nc_node(struct batadv_priv * bat_priv,struct batadv_orig_node * orig_node,struct batadv_orig_node * orig_neigh_node,bool in_coding)844*4882a593Smuzhiyun batadv_nc_get_nc_node(struct batadv_priv *bat_priv,
845*4882a593Smuzhiyun struct batadv_orig_node *orig_node,
846*4882a593Smuzhiyun struct batadv_orig_node *orig_neigh_node,
847*4882a593Smuzhiyun bool in_coding)
848*4882a593Smuzhiyun {
849*4882a593Smuzhiyun struct batadv_nc_node *nc_node;
850*4882a593Smuzhiyun spinlock_t *lock; /* Used to lock list selected by "int in_coding" */
851*4882a593Smuzhiyun struct list_head *list;
852*4882a593Smuzhiyun
853*4882a593Smuzhiyun /* Select ingoing or outgoing coding node */
854*4882a593Smuzhiyun if (in_coding) {
855*4882a593Smuzhiyun lock = &orig_neigh_node->in_coding_list_lock;
856*4882a593Smuzhiyun list = &orig_neigh_node->in_coding_list;
857*4882a593Smuzhiyun } else {
858*4882a593Smuzhiyun lock = &orig_neigh_node->out_coding_list_lock;
859*4882a593Smuzhiyun list = &orig_neigh_node->out_coding_list;
860*4882a593Smuzhiyun }
861*4882a593Smuzhiyun
862*4882a593Smuzhiyun spin_lock_bh(lock);
863*4882a593Smuzhiyun
864*4882a593Smuzhiyun /* Check if nc_node is already added */
865*4882a593Smuzhiyun nc_node = batadv_nc_find_nc_node(orig_node, orig_neigh_node, in_coding);
866*4882a593Smuzhiyun
867*4882a593Smuzhiyun /* Node found */
868*4882a593Smuzhiyun if (nc_node)
869*4882a593Smuzhiyun goto unlock;
870*4882a593Smuzhiyun
871*4882a593Smuzhiyun nc_node = kzalloc(sizeof(*nc_node), GFP_ATOMIC);
872*4882a593Smuzhiyun if (!nc_node)
873*4882a593Smuzhiyun goto unlock;
874*4882a593Smuzhiyun
875*4882a593Smuzhiyun /* Initialize nc_node */
876*4882a593Smuzhiyun INIT_LIST_HEAD(&nc_node->list);
877*4882a593Smuzhiyun kref_init(&nc_node->refcount);
878*4882a593Smuzhiyun ether_addr_copy(nc_node->addr, orig_node->orig);
879*4882a593Smuzhiyun kref_get(&orig_neigh_node->refcount);
880*4882a593Smuzhiyun nc_node->orig_node = orig_neigh_node;
881*4882a593Smuzhiyun
882*4882a593Smuzhiyun batadv_dbg(BATADV_DBG_NC, bat_priv, "Adding nc_node %pM -> %pM\n",
883*4882a593Smuzhiyun nc_node->addr, nc_node->orig_node->orig);
884*4882a593Smuzhiyun
885*4882a593Smuzhiyun /* Add nc_node to orig_node */
886*4882a593Smuzhiyun kref_get(&nc_node->refcount);
887*4882a593Smuzhiyun list_add_tail_rcu(&nc_node->list, list);
888*4882a593Smuzhiyun
889*4882a593Smuzhiyun unlock:
890*4882a593Smuzhiyun spin_unlock_bh(lock);
891*4882a593Smuzhiyun
892*4882a593Smuzhiyun return nc_node;
893*4882a593Smuzhiyun }
894*4882a593Smuzhiyun
895*4882a593Smuzhiyun /**
896*4882a593Smuzhiyun * batadv_nc_update_nc_node() - updates stored incoming and outgoing nc node
897*4882a593Smuzhiyun * structs (best called on incoming OGMs)
898*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
899*4882a593Smuzhiyun * @orig_node: orig node originating the ogm packet
900*4882a593Smuzhiyun * @orig_neigh_node: neighboring orig node from which we received the ogm packet
901*4882a593Smuzhiyun * (can be equal to orig_node)
902*4882a593Smuzhiyun * @ogm_packet: incoming ogm packet
903*4882a593Smuzhiyun * @is_single_hop_neigh: orig_node is a single hop neighbor
904*4882a593Smuzhiyun */
batadv_nc_update_nc_node(struct batadv_priv * bat_priv,struct batadv_orig_node * orig_node,struct batadv_orig_node * orig_neigh_node,struct batadv_ogm_packet * ogm_packet,int is_single_hop_neigh)905*4882a593Smuzhiyun void batadv_nc_update_nc_node(struct batadv_priv *bat_priv,
906*4882a593Smuzhiyun struct batadv_orig_node *orig_node,
907*4882a593Smuzhiyun struct batadv_orig_node *orig_neigh_node,
908*4882a593Smuzhiyun struct batadv_ogm_packet *ogm_packet,
909*4882a593Smuzhiyun int is_single_hop_neigh)
910*4882a593Smuzhiyun {
911*4882a593Smuzhiyun struct batadv_nc_node *in_nc_node = NULL;
912*4882a593Smuzhiyun struct batadv_nc_node *out_nc_node = NULL;
913*4882a593Smuzhiyun
914*4882a593Smuzhiyun /* Check if network coding is enabled */
915*4882a593Smuzhiyun if (!atomic_read(&bat_priv->network_coding))
916*4882a593Smuzhiyun goto out;
917*4882a593Smuzhiyun
918*4882a593Smuzhiyun /* check if orig node is network coding enabled */
919*4882a593Smuzhiyun if (!test_bit(BATADV_ORIG_CAPA_HAS_NC, &orig_node->capabilities))
920*4882a593Smuzhiyun goto out;
921*4882a593Smuzhiyun
922*4882a593Smuzhiyun /* accept ogms from 'good' neighbors and single hop neighbors */
923*4882a593Smuzhiyun if (!batadv_can_nc_with_orig(bat_priv, orig_node, ogm_packet) &&
924*4882a593Smuzhiyun !is_single_hop_neigh)
925*4882a593Smuzhiyun goto out;
926*4882a593Smuzhiyun
927*4882a593Smuzhiyun /* Add orig_node as in_nc_node on hop */
928*4882a593Smuzhiyun in_nc_node = batadv_nc_get_nc_node(bat_priv, orig_node,
929*4882a593Smuzhiyun orig_neigh_node, true);
930*4882a593Smuzhiyun if (!in_nc_node)
931*4882a593Smuzhiyun goto out;
932*4882a593Smuzhiyun
933*4882a593Smuzhiyun in_nc_node->last_seen = jiffies;
934*4882a593Smuzhiyun
935*4882a593Smuzhiyun /* Add hop as out_nc_node on orig_node */
936*4882a593Smuzhiyun out_nc_node = batadv_nc_get_nc_node(bat_priv, orig_neigh_node,
937*4882a593Smuzhiyun orig_node, false);
938*4882a593Smuzhiyun if (!out_nc_node)
939*4882a593Smuzhiyun goto out;
940*4882a593Smuzhiyun
941*4882a593Smuzhiyun out_nc_node->last_seen = jiffies;
942*4882a593Smuzhiyun
943*4882a593Smuzhiyun out:
944*4882a593Smuzhiyun if (in_nc_node)
945*4882a593Smuzhiyun batadv_nc_node_put(in_nc_node);
946*4882a593Smuzhiyun if (out_nc_node)
947*4882a593Smuzhiyun batadv_nc_node_put(out_nc_node);
948*4882a593Smuzhiyun }
949*4882a593Smuzhiyun
950*4882a593Smuzhiyun /**
951*4882a593Smuzhiyun * batadv_nc_get_path() - get existing nc_path or allocate a new one
952*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
953*4882a593Smuzhiyun * @hash: hash table containing the nc path
954*4882a593Smuzhiyun * @src: ethernet source address - first half of the nc path search key
955*4882a593Smuzhiyun * @dst: ethernet destination address - second half of the nc path search key
956*4882a593Smuzhiyun *
957*4882a593Smuzhiyun * Return: pointer to nc_path if the path was found or created, returns NULL
958*4882a593Smuzhiyun * on error.
959*4882a593Smuzhiyun */
batadv_nc_get_path(struct batadv_priv * bat_priv,struct batadv_hashtable * hash,u8 * src,u8 * dst)960*4882a593Smuzhiyun static struct batadv_nc_path *batadv_nc_get_path(struct batadv_priv *bat_priv,
961*4882a593Smuzhiyun struct batadv_hashtable *hash,
962*4882a593Smuzhiyun u8 *src,
963*4882a593Smuzhiyun u8 *dst)
964*4882a593Smuzhiyun {
965*4882a593Smuzhiyun int hash_added;
966*4882a593Smuzhiyun struct batadv_nc_path *nc_path, nc_path_key;
967*4882a593Smuzhiyun
968*4882a593Smuzhiyun batadv_nc_hash_key_gen(&nc_path_key, src, dst);
969*4882a593Smuzhiyun
970*4882a593Smuzhiyun /* Search for existing nc_path */
971*4882a593Smuzhiyun nc_path = batadv_nc_hash_find(hash, (void *)&nc_path_key);
972*4882a593Smuzhiyun
973*4882a593Smuzhiyun if (nc_path) {
974*4882a593Smuzhiyun /* Set timestamp to delay removal of nc_path */
975*4882a593Smuzhiyun nc_path->last_valid = jiffies;
976*4882a593Smuzhiyun return nc_path;
977*4882a593Smuzhiyun }
978*4882a593Smuzhiyun
979*4882a593Smuzhiyun /* No existing nc_path was found; create a new */
980*4882a593Smuzhiyun nc_path = kzalloc(sizeof(*nc_path), GFP_ATOMIC);
981*4882a593Smuzhiyun
982*4882a593Smuzhiyun if (!nc_path)
983*4882a593Smuzhiyun return NULL;
984*4882a593Smuzhiyun
985*4882a593Smuzhiyun /* Initialize nc_path */
986*4882a593Smuzhiyun INIT_LIST_HEAD(&nc_path->packet_list);
987*4882a593Smuzhiyun spin_lock_init(&nc_path->packet_list_lock);
988*4882a593Smuzhiyun kref_init(&nc_path->refcount);
989*4882a593Smuzhiyun nc_path->last_valid = jiffies;
990*4882a593Smuzhiyun ether_addr_copy(nc_path->next_hop, dst);
991*4882a593Smuzhiyun ether_addr_copy(nc_path->prev_hop, src);
992*4882a593Smuzhiyun
993*4882a593Smuzhiyun batadv_dbg(BATADV_DBG_NC, bat_priv, "Adding nc_path %pM -> %pM\n",
994*4882a593Smuzhiyun nc_path->prev_hop,
995*4882a593Smuzhiyun nc_path->next_hop);
996*4882a593Smuzhiyun
997*4882a593Smuzhiyun /* Add nc_path to hash table */
998*4882a593Smuzhiyun kref_get(&nc_path->refcount);
999*4882a593Smuzhiyun hash_added = batadv_hash_add(hash, batadv_nc_hash_compare,
1000*4882a593Smuzhiyun batadv_nc_hash_choose, &nc_path_key,
1001*4882a593Smuzhiyun &nc_path->hash_entry);
1002*4882a593Smuzhiyun
1003*4882a593Smuzhiyun if (hash_added < 0) {
1004*4882a593Smuzhiyun kfree(nc_path);
1005*4882a593Smuzhiyun return NULL;
1006*4882a593Smuzhiyun }
1007*4882a593Smuzhiyun
1008*4882a593Smuzhiyun return nc_path;
1009*4882a593Smuzhiyun }
1010*4882a593Smuzhiyun
1011*4882a593Smuzhiyun /**
1012*4882a593Smuzhiyun * batadv_nc_random_weight_tq() - scale the receivers TQ-value to avoid unfair
1013*4882a593Smuzhiyun * selection of a receiver with slightly lower TQ than the other
1014*4882a593Smuzhiyun * @tq: to be weighted tq value
1015*4882a593Smuzhiyun *
1016*4882a593Smuzhiyun * Return: scaled tq value
1017*4882a593Smuzhiyun */
batadv_nc_random_weight_tq(u8 tq)1018*4882a593Smuzhiyun static u8 batadv_nc_random_weight_tq(u8 tq)
1019*4882a593Smuzhiyun {
1020*4882a593Smuzhiyun /* randomize the estimated packet loss (max TQ - estimated TQ) */
1021*4882a593Smuzhiyun u8 rand_tq = prandom_u32_max(BATADV_TQ_MAX_VALUE + 1 - tq);
1022*4882a593Smuzhiyun
1023*4882a593Smuzhiyun /* convert to (randomized) estimated tq again */
1024*4882a593Smuzhiyun return BATADV_TQ_MAX_VALUE - rand_tq;
1025*4882a593Smuzhiyun }
1026*4882a593Smuzhiyun
1027*4882a593Smuzhiyun /**
1028*4882a593Smuzhiyun * batadv_nc_memxor() - XOR destination with source
1029*4882a593Smuzhiyun * @dst: byte array to XOR into
1030*4882a593Smuzhiyun * @src: byte array to XOR from
1031*4882a593Smuzhiyun * @len: length of destination array
1032*4882a593Smuzhiyun */
batadv_nc_memxor(char * dst,const char * src,unsigned int len)1033*4882a593Smuzhiyun static void batadv_nc_memxor(char *dst, const char *src, unsigned int len)
1034*4882a593Smuzhiyun {
1035*4882a593Smuzhiyun unsigned int i;
1036*4882a593Smuzhiyun
1037*4882a593Smuzhiyun for (i = 0; i < len; ++i)
1038*4882a593Smuzhiyun dst[i] ^= src[i];
1039*4882a593Smuzhiyun }
1040*4882a593Smuzhiyun
1041*4882a593Smuzhiyun /**
1042*4882a593Smuzhiyun * batadv_nc_code_packets() - code a received unicast_packet with an nc packet
1043*4882a593Smuzhiyun * into a coded_packet and send it
1044*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
1045*4882a593Smuzhiyun * @skb: data skb to forward
1046*4882a593Smuzhiyun * @ethhdr: pointer to the ethernet header inside the skb
1047*4882a593Smuzhiyun * @nc_packet: structure containing the packet to the skb can be coded with
1048*4882a593Smuzhiyun * @neigh_node: next hop to forward packet to
1049*4882a593Smuzhiyun *
1050*4882a593Smuzhiyun * Return: true if both packets are consumed, false otherwise.
1051*4882a593Smuzhiyun */
batadv_nc_code_packets(struct batadv_priv * bat_priv,struct sk_buff * skb,struct ethhdr * ethhdr,struct batadv_nc_packet * nc_packet,struct batadv_neigh_node * neigh_node)1052*4882a593Smuzhiyun static bool batadv_nc_code_packets(struct batadv_priv *bat_priv,
1053*4882a593Smuzhiyun struct sk_buff *skb,
1054*4882a593Smuzhiyun struct ethhdr *ethhdr,
1055*4882a593Smuzhiyun struct batadv_nc_packet *nc_packet,
1056*4882a593Smuzhiyun struct batadv_neigh_node *neigh_node)
1057*4882a593Smuzhiyun {
1058*4882a593Smuzhiyun u8 tq_weighted_neigh, tq_weighted_coding, tq_tmp;
1059*4882a593Smuzhiyun struct sk_buff *skb_dest, *skb_src;
1060*4882a593Smuzhiyun struct batadv_unicast_packet *packet1;
1061*4882a593Smuzhiyun struct batadv_unicast_packet *packet2;
1062*4882a593Smuzhiyun struct batadv_coded_packet *coded_packet;
1063*4882a593Smuzhiyun struct batadv_neigh_node *neigh_tmp, *router_neigh, *first_dest;
1064*4882a593Smuzhiyun struct batadv_neigh_node *router_coding = NULL, *second_dest;
1065*4882a593Smuzhiyun struct batadv_neigh_ifinfo *router_neigh_ifinfo = NULL;
1066*4882a593Smuzhiyun struct batadv_neigh_ifinfo *router_coding_ifinfo = NULL;
1067*4882a593Smuzhiyun u8 *first_source, *second_source;
1068*4882a593Smuzhiyun __be32 packet_id1, packet_id2;
1069*4882a593Smuzhiyun size_t count;
1070*4882a593Smuzhiyun bool res = false;
1071*4882a593Smuzhiyun int coding_len;
1072*4882a593Smuzhiyun int unicast_size = sizeof(*packet1);
1073*4882a593Smuzhiyun int coded_size = sizeof(*coded_packet);
1074*4882a593Smuzhiyun int header_add = coded_size - unicast_size;
1075*4882a593Smuzhiyun
1076*4882a593Smuzhiyun /* TODO: do we need to consider the outgoing interface for
1077*4882a593Smuzhiyun * coded packets?
1078*4882a593Smuzhiyun */
1079*4882a593Smuzhiyun router_neigh = batadv_orig_router_get(neigh_node->orig_node,
1080*4882a593Smuzhiyun BATADV_IF_DEFAULT);
1081*4882a593Smuzhiyun if (!router_neigh)
1082*4882a593Smuzhiyun goto out;
1083*4882a593Smuzhiyun
1084*4882a593Smuzhiyun router_neigh_ifinfo = batadv_neigh_ifinfo_get(router_neigh,
1085*4882a593Smuzhiyun BATADV_IF_DEFAULT);
1086*4882a593Smuzhiyun if (!router_neigh_ifinfo)
1087*4882a593Smuzhiyun goto out;
1088*4882a593Smuzhiyun
1089*4882a593Smuzhiyun neigh_tmp = nc_packet->neigh_node;
1090*4882a593Smuzhiyun router_coding = batadv_orig_router_get(neigh_tmp->orig_node,
1091*4882a593Smuzhiyun BATADV_IF_DEFAULT);
1092*4882a593Smuzhiyun if (!router_coding)
1093*4882a593Smuzhiyun goto out;
1094*4882a593Smuzhiyun
1095*4882a593Smuzhiyun router_coding_ifinfo = batadv_neigh_ifinfo_get(router_coding,
1096*4882a593Smuzhiyun BATADV_IF_DEFAULT);
1097*4882a593Smuzhiyun if (!router_coding_ifinfo)
1098*4882a593Smuzhiyun goto out;
1099*4882a593Smuzhiyun
1100*4882a593Smuzhiyun tq_tmp = router_neigh_ifinfo->bat_iv.tq_avg;
1101*4882a593Smuzhiyun tq_weighted_neigh = batadv_nc_random_weight_tq(tq_tmp);
1102*4882a593Smuzhiyun tq_tmp = router_coding_ifinfo->bat_iv.tq_avg;
1103*4882a593Smuzhiyun tq_weighted_coding = batadv_nc_random_weight_tq(tq_tmp);
1104*4882a593Smuzhiyun
1105*4882a593Smuzhiyun /* Select one destination for the MAC-header dst-field based on
1106*4882a593Smuzhiyun * weighted TQ-values.
1107*4882a593Smuzhiyun */
1108*4882a593Smuzhiyun if (tq_weighted_neigh >= tq_weighted_coding) {
1109*4882a593Smuzhiyun /* Destination from nc_packet is selected for MAC-header */
1110*4882a593Smuzhiyun first_dest = nc_packet->neigh_node;
1111*4882a593Smuzhiyun first_source = nc_packet->nc_path->prev_hop;
1112*4882a593Smuzhiyun second_dest = neigh_node;
1113*4882a593Smuzhiyun second_source = ethhdr->h_source;
1114*4882a593Smuzhiyun packet1 = (struct batadv_unicast_packet *)nc_packet->skb->data;
1115*4882a593Smuzhiyun packet2 = (struct batadv_unicast_packet *)skb->data;
1116*4882a593Smuzhiyun packet_id1 = nc_packet->packet_id;
1117*4882a593Smuzhiyun packet_id2 = batadv_skb_crc32(skb,
1118*4882a593Smuzhiyun skb->data + sizeof(*packet2));
1119*4882a593Smuzhiyun } else {
1120*4882a593Smuzhiyun /* Destination for skb is selected for MAC-header */
1121*4882a593Smuzhiyun first_dest = neigh_node;
1122*4882a593Smuzhiyun first_source = ethhdr->h_source;
1123*4882a593Smuzhiyun second_dest = nc_packet->neigh_node;
1124*4882a593Smuzhiyun second_source = nc_packet->nc_path->prev_hop;
1125*4882a593Smuzhiyun packet1 = (struct batadv_unicast_packet *)skb->data;
1126*4882a593Smuzhiyun packet2 = (struct batadv_unicast_packet *)nc_packet->skb->data;
1127*4882a593Smuzhiyun packet_id1 = batadv_skb_crc32(skb,
1128*4882a593Smuzhiyun skb->data + sizeof(*packet1));
1129*4882a593Smuzhiyun packet_id2 = nc_packet->packet_id;
1130*4882a593Smuzhiyun }
1131*4882a593Smuzhiyun
1132*4882a593Smuzhiyun /* Instead of zero padding the smallest data buffer, we
1133*4882a593Smuzhiyun * code into the largest.
1134*4882a593Smuzhiyun */
1135*4882a593Smuzhiyun if (skb->len <= nc_packet->skb->len) {
1136*4882a593Smuzhiyun skb_dest = nc_packet->skb;
1137*4882a593Smuzhiyun skb_src = skb;
1138*4882a593Smuzhiyun } else {
1139*4882a593Smuzhiyun skb_dest = skb;
1140*4882a593Smuzhiyun skb_src = nc_packet->skb;
1141*4882a593Smuzhiyun }
1142*4882a593Smuzhiyun
1143*4882a593Smuzhiyun /* coding_len is used when decoding the packet shorter packet */
1144*4882a593Smuzhiyun coding_len = skb_src->len - unicast_size;
1145*4882a593Smuzhiyun
1146*4882a593Smuzhiyun if (skb_linearize(skb_dest) < 0 || skb_linearize(skb_src) < 0)
1147*4882a593Smuzhiyun goto out;
1148*4882a593Smuzhiyun
1149*4882a593Smuzhiyun skb_push(skb_dest, header_add);
1150*4882a593Smuzhiyun
1151*4882a593Smuzhiyun coded_packet = (struct batadv_coded_packet *)skb_dest->data;
1152*4882a593Smuzhiyun skb_reset_mac_header(skb_dest);
1153*4882a593Smuzhiyun
1154*4882a593Smuzhiyun coded_packet->packet_type = BATADV_CODED;
1155*4882a593Smuzhiyun coded_packet->version = BATADV_COMPAT_VERSION;
1156*4882a593Smuzhiyun coded_packet->ttl = packet1->ttl;
1157*4882a593Smuzhiyun
1158*4882a593Smuzhiyun /* Info about first unicast packet */
1159*4882a593Smuzhiyun ether_addr_copy(coded_packet->first_source, first_source);
1160*4882a593Smuzhiyun ether_addr_copy(coded_packet->first_orig_dest, packet1->dest);
1161*4882a593Smuzhiyun coded_packet->first_crc = packet_id1;
1162*4882a593Smuzhiyun coded_packet->first_ttvn = packet1->ttvn;
1163*4882a593Smuzhiyun
1164*4882a593Smuzhiyun /* Info about second unicast packet */
1165*4882a593Smuzhiyun ether_addr_copy(coded_packet->second_dest, second_dest->addr);
1166*4882a593Smuzhiyun ether_addr_copy(coded_packet->second_source, second_source);
1167*4882a593Smuzhiyun ether_addr_copy(coded_packet->second_orig_dest, packet2->dest);
1168*4882a593Smuzhiyun coded_packet->second_crc = packet_id2;
1169*4882a593Smuzhiyun coded_packet->second_ttl = packet2->ttl;
1170*4882a593Smuzhiyun coded_packet->second_ttvn = packet2->ttvn;
1171*4882a593Smuzhiyun coded_packet->coded_len = htons(coding_len);
1172*4882a593Smuzhiyun
1173*4882a593Smuzhiyun /* This is where the magic happens: Code skb_src into skb_dest */
1174*4882a593Smuzhiyun batadv_nc_memxor(skb_dest->data + coded_size,
1175*4882a593Smuzhiyun skb_src->data + unicast_size, coding_len);
1176*4882a593Smuzhiyun
1177*4882a593Smuzhiyun /* Update counters accordingly */
1178*4882a593Smuzhiyun if (BATADV_SKB_CB(skb_src)->decoded &&
1179*4882a593Smuzhiyun BATADV_SKB_CB(skb_dest)->decoded) {
1180*4882a593Smuzhiyun /* Both packets are recoded */
1181*4882a593Smuzhiyun count = skb_src->len + ETH_HLEN;
1182*4882a593Smuzhiyun count += skb_dest->len + ETH_HLEN;
1183*4882a593Smuzhiyun batadv_add_counter(bat_priv, BATADV_CNT_NC_RECODE, 2);
1184*4882a593Smuzhiyun batadv_add_counter(bat_priv, BATADV_CNT_NC_RECODE_BYTES, count);
1185*4882a593Smuzhiyun } else if (!BATADV_SKB_CB(skb_src)->decoded &&
1186*4882a593Smuzhiyun !BATADV_SKB_CB(skb_dest)->decoded) {
1187*4882a593Smuzhiyun /* Both packets are newly coded */
1188*4882a593Smuzhiyun count = skb_src->len + ETH_HLEN;
1189*4882a593Smuzhiyun count += skb_dest->len + ETH_HLEN;
1190*4882a593Smuzhiyun batadv_add_counter(bat_priv, BATADV_CNT_NC_CODE, 2);
1191*4882a593Smuzhiyun batadv_add_counter(bat_priv, BATADV_CNT_NC_CODE_BYTES, count);
1192*4882a593Smuzhiyun } else if (BATADV_SKB_CB(skb_src)->decoded &&
1193*4882a593Smuzhiyun !BATADV_SKB_CB(skb_dest)->decoded) {
1194*4882a593Smuzhiyun /* skb_src recoded and skb_dest is newly coded */
1195*4882a593Smuzhiyun batadv_inc_counter(bat_priv, BATADV_CNT_NC_RECODE);
1196*4882a593Smuzhiyun batadv_add_counter(bat_priv, BATADV_CNT_NC_RECODE_BYTES,
1197*4882a593Smuzhiyun skb_src->len + ETH_HLEN);
1198*4882a593Smuzhiyun batadv_inc_counter(bat_priv, BATADV_CNT_NC_CODE);
1199*4882a593Smuzhiyun batadv_add_counter(bat_priv, BATADV_CNT_NC_CODE_BYTES,
1200*4882a593Smuzhiyun skb_dest->len + ETH_HLEN);
1201*4882a593Smuzhiyun } else if (!BATADV_SKB_CB(skb_src)->decoded &&
1202*4882a593Smuzhiyun BATADV_SKB_CB(skb_dest)->decoded) {
1203*4882a593Smuzhiyun /* skb_src is newly coded and skb_dest is recoded */
1204*4882a593Smuzhiyun batadv_inc_counter(bat_priv, BATADV_CNT_NC_CODE);
1205*4882a593Smuzhiyun batadv_add_counter(bat_priv, BATADV_CNT_NC_CODE_BYTES,
1206*4882a593Smuzhiyun skb_src->len + ETH_HLEN);
1207*4882a593Smuzhiyun batadv_inc_counter(bat_priv, BATADV_CNT_NC_RECODE);
1208*4882a593Smuzhiyun batadv_add_counter(bat_priv, BATADV_CNT_NC_RECODE_BYTES,
1209*4882a593Smuzhiyun skb_dest->len + ETH_HLEN);
1210*4882a593Smuzhiyun }
1211*4882a593Smuzhiyun
1212*4882a593Smuzhiyun /* skb_src is now coded into skb_dest, so free it */
1213*4882a593Smuzhiyun consume_skb(skb_src);
1214*4882a593Smuzhiyun
1215*4882a593Smuzhiyun /* avoid duplicate free of skb from nc_packet */
1216*4882a593Smuzhiyun nc_packet->skb = NULL;
1217*4882a593Smuzhiyun batadv_nc_packet_free(nc_packet, false);
1218*4882a593Smuzhiyun
1219*4882a593Smuzhiyun /* Send the coded packet and return true */
1220*4882a593Smuzhiyun batadv_send_unicast_skb(skb_dest, first_dest);
1221*4882a593Smuzhiyun res = true;
1222*4882a593Smuzhiyun out:
1223*4882a593Smuzhiyun if (router_neigh)
1224*4882a593Smuzhiyun batadv_neigh_node_put(router_neigh);
1225*4882a593Smuzhiyun if (router_coding)
1226*4882a593Smuzhiyun batadv_neigh_node_put(router_coding);
1227*4882a593Smuzhiyun if (router_neigh_ifinfo)
1228*4882a593Smuzhiyun batadv_neigh_ifinfo_put(router_neigh_ifinfo);
1229*4882a593Smuzhiyun if (router_coding_ifinfo)
1230*4882a593Smuzhiyun batadv_neigh_ifinfo_put(router_coding_ifinfo);
1231*4882a593Smuzhiyun return res;
1232*4882a593Smuzhiyun }
1233*4882a593Smuzhiyun
1234*4882a593Smuzhiyun /**
1235*4882a593Smuzhiyun * batadv_nc_skb_coding_possible() - true if a decoded skb is available at dst.
1236*4882a593Smuzhiyun * @skb: data skb to forward
1237*4882a593Smuzhiyun * @dst: destination mac address of the other skb to code with
1238*4882a593Smuzhiyun * @src: source mac address of skb
1239*4882a593Smuzhiyun *
1240*4882a593Smuzhiyun * Whenever we network code a packet we have to check whether we received it in
1241*4882a593Smuzhiyun * a network coded form. If so, we may not be able to use it for coding because
1242*4882a593Smuzhiyun * some neighbors may also have received (overheard) the packet in the network
1243*4882a593Smuzhiyun * coded form without being able to decode it. It is hard to know which of the
1244*4882a593Smuzhiyun * neighboring nodes was able to decode the packet, therefore we can only
1245*4882a593Smuzhiyun * re-code the packet if the source of the previous encoded packet is involved.
1246*4882a593Smuzhiyun * Since the source encoded the packet we can be certain it has all necessary
1247*4882a593Smuzhiyun * decode information.
1248*4882a593Smuzhiyun *
1249*4882a593Smuzhiyun * Return: true if coding of a decoded packet is allowed.
1250*4882a593Smuzhiyun */
batadv_nc_skb_coding_possible(struct sk_buff * skb,u8 * dst,u8 * src)1251*4882a593Smuzhiyun static bool batadv_nc_skb_coding_possible(struct sk_buff *skb, u8 *dst, u8 *src)
1252*4882a593Smuzhiyun {
1253*4882a593Smuzhiyun if (BATADV_SKB_CB(skb)->decoded && !batadv_compare_eth(dst, src))
1254*4882a593Smuzhiyun return false;
1255*4882a593Smuzhiyun return true;
1256*4882a593Smuzhiyun }
1257*4882a593Smuzhiyun
1258*4882a593Smuzhiyun /**
1259*4882a593Smuzhiyun * batadv_nc_path_search() - Find the coding path matching in_nc_node and
1260*4882a593Smuzhiyun * out_nc_node to retrieve a buffered packet that can be used for coding.
1261*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
1262*4882a593Smuzhiyun * @in_nc_node: pointer to skb next hop's neighbor nc node
1263*4882a593Smuzhiyun * @out_nc_node: pointer to skb source's neighbor nc node
1264*4882a593Smuzhiyun * @skb: data skb to forward
1265*4882a593Smuzhiyun * @eth_dst: next hop mac address of skb
1266*4882a593Smuzhiyun *
1267*4882a593Smuzhiyun * Return: true if coding of a decoded skb is allowed.
1268*4882a593Smuzhiyun */
1269*4882a593Smuzhiyun static struct batadv_nc_packet *
batadv_nc_path_search(struct batadv_priv * bat_priv,struct batadv_nc_node * in_nc_node,struct batadv_nc_node * out_nc_node,struct sk_buff * skb,u8 * eth_dst)1270*4882a593Smuzhiyun batadv_nc_path_search(struct batadv_priv *bat_priv,
1271*4882a593Smuzhiyun struct batadv_nc_node *in_nc_node,
1272*4882a593Smuzhiyun struct batadv_nc_node *out_nc_node,
1273*4882a593Smuzhiyun struct sk_buff *skb,
1274*4882a593Smuzhiyun u8 *eth_dst)
1275*4882a593Smuzhiyun {
1276*4882a593Smuzhiyun struct batadv_nc_path *nc_path, nc_path_key;
1277*4882a593Smuzhiyun struct batadv_nc_packet *nc_packet_out = NULL;
1278*4882a593Smuzhiyun struct batadv_nc_packet *nc_packet, *nc_packet_tmp;
1279*4882a593Smuzhiyun struct batadv_hashtable *hash = bat_priv->nc.coding_hash;
1280*4882a593Smuzhiyun int idx;
1281*4882a593Smuzhiyun
1282*4882a593Smuzhiyun if (!hash)
1283*4882a593Smuzhiyun return NULL;
1284*4882a593Smuzhiyun
1285*4882a593Smuzhiyun /* Create almost path key */
1286*4882a593Smuzhiyun batadv_nc_hash_key_gen(&nc_path_key, in_nc_node->addr,
1287*4882a593Smuzhiyun out_nc_node->addr);
1288*4882a593Smuzhiyun idx = batadv_nc_hash_choose(&nc_path_key, hash->size);
1289*4882a593Smuzhiyun
1290*4882a593Smuzhiyun /* Check for coding opportunities in this nc_path */
1291*4882a593Smuzhiyun rcu_read_lock();
1292*4882a593Smuzhiyun hlist_for_each_entry_rcu(nc_path, &hash->table[idx], hash_entry) {
1293*4882a593Smuzhiyun if (!batadv_compare_eth(nc_path->prev_hop, in_nc_node->addr))
1294*4882a593Smuzhiyun continue;
1295*4882a593Smuzhiyun
1296*4882a593Smuzhiyun if (!batadv_compare_eth(nc_path->next_hop, out_nc_node->addr))
1297*4882a593Smuzhiyun continue;
1298*4882a593Smuzhiyun
1299*4882a593Smuzhiyun spin_lock_bh(&nc_path->packet_list_lock);
1300*4882a593Smuzhiyun if (list_empty(&nc_path->packet_list)) {
1301*4882a593Smuzhiyun spin_unlock_bh(&nc_path->packet_list_lock);
1302*4882a593Smuzhiyun continue;
1303*4882a593Smuzhiyun }
1304*4882a593Smuzhiyun
1305*4882a593Smuzhiyun list_for_each_entry_safe(nc_packet, nc_packet_tmp,
1306*4882a593Smuzhiyun &nc_path->packet_list, list) {
1307*4882a593Smuzhiyun if (!batadv_nc_skb_coding_possible(nc_packet->skb,
1308*4882a593Smuzhiyun eth_dst,
1309*4882a593Smuzhiyun in_nc_node->addr))
1310*4882a593Smuzhiyun continue;
1311*4882a593Smuzhiyun
1312*4882a593Smuzhiyun /* Coding opportunity is found! */
1313*4882a593Smuzhiyun list_del(&nc_packet->list);
1314*4882a593Smuzhiyun nc_packet_out = nc_packet;
1315*4882a593Smuzhiyun break;
1316*4882a593Smuzhiyun }
1317*4882a593Smuzhiyun
1318*4882a593Smuzhiyun spin_unlock_bh(&nc_path->packet_list_lock);
1319*4882a593Smuzhiyun break;
1320*4882a593Smuzhiyun }
1321*4882a593Smuzhiyun rcu_read_unlock();
1322*4882a593Smuzhiyun
1323*4882a593Smuzhiyun return nc_packet_out;
1324*4882a593Smuzhiyun }
1325*4882a593Smuzhiyun
1326*4882a593Smuzhiyun /**
1327*4882a593Smuzhiyun * batadv_nc_skb_src_search() - Loops through the list of neighboring nodes of
1328*4882a593Smuzhiyun * the skb's sender (may be equal to the originator).
1329*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
1330*4882a593Smuzhiyun * @skb: data skb to forward
1331*4882a593Smuzhiyun * @eth_dst: next hop mac address of skb
1332*4882a593Smuzhiyun * @eth_src: source mac address of skb
1333*4882a593Smuzhiyun * @in_nc_node: pointer to skb next hop's neighbor nc node
1334*4882a593Smuzhiyun *
1335*4882a593Smuzhiyun * Return: an nc packet if a suitable coding packet was found, NULL otherwise.
1336*4882a593Smuzhiyun */
1337*4882a593Smuzhiyun static struct batadv_nc_packet *
batadv_nc_skb_src_search(struct batadv_priv * bat_priv,struct sk_buff * skb,u8 * eth_dst,u8 * eth_src,struct batadv_nc_node * in_nc_node)1338*4882a593Smuzhiyun batadv_nc_skb_src_search(struct batadv_priv *bat_priv,
1339*4882a593Smuzhiyun struct sk_buff *skb,
1340*4882a593Smuzhiyun u8 *eth_dst,
1341*4882a593Smuzhiyun u8 *eth_src,
1342*4882a593Smuzhiyun struct batadv_nc_node *in_nc_node)
1343*4882a593Smuzhiyun {
1344*4882a593Smuzhiyun struct batadv_orig_node *orig_node;
1345*4882a593Smuzhiyun struct batadv_nc_node *out_nc_node;
1346*4882a593Smuzhiyun struct batadv_nc_packet *nc_packet = NULL;
1347*4882a593Smuzhiyun
1348*4882a593Smuzhiyun orig_node = batadv_orig_hash_find(bat_priv, eth_src);
1349*4882a593Smuzhiyun if (!orig_node)
1350*4882a593Smuzhiyun return NULL;
1351*4882a593Smuzhiyun
1352*4882a593Smuzhiyun rcu_read_lock();
1353*4882a593Smuzhiyun list_for_each_entry_rcu(out_nc_node,
1354*4882a593Smuzhiyun &orig_node->out_coding_list, list) {
1355*4882a593Smuzhiyun /* Check if the skb is decoded and if recoding is possible */
1356*4882a593Smuzhiyun if (!batadv_nc_skb_coding_possible(skb,
1357*4882a593Smuzhiyun out_nc_node->addr, eth_src))
1358*4882a593Smuzhiyun continue;
1359*4882a593Smuzhiyun
1360*4882a593Smuzhiyun /* Search for an opportunity in this nc_path */
1361*4882a593Smuzhiyun nc_packet = batadv_nc_path_search(bat_priv, in_nc_node,
1362*4882a593Smuzhiyun out_nc_node, skb, eth_dst);
1363*4882a593Smuzhiyun if (nc_packet)
1364*4882a593Smuzhiyun break;
1365*4882a593Smuzhiyun }
1366*4882a593Smuzhiyun rcu_read_unlock();
1367*4882a593Smuzhiyun
1368*4882a593Smuzhiyun batadv_orig_node_put(orig_node);
1369*4882a593Smuzhiyun return nc_packet;
1370*4882a593Smuzhiyun }
1371*4882a593Smuzhiyun
1372*4882a593Smuzhiyun /**
1373*4882a593Smuzhiyun * batadv_nc_skb_store_before_coding() - set the ethernet src and dst of the
1374*4882a593Smuzhiyun * unicast skb before it is stored for use in later decoding
1375*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
1376*4882a593Smuzhiyun * @skb: data skb to store
1377*4882a593Smuzhiyun * @eth_dst_new: new destination mac address of skb
1378*4882a593Smuzhiyun */
batadv_nc_skb_store_before_coding(struct batadv_priv * bat_priv,struct sk_buff * skb,u8 * eth_dst_new)1379*4882a593Smuzhiyun static void batadv_nc_skb_store_before_coding(struct batadv_priv *bat_priv,
1380*4882a593Smuzhiyun struct sk_buff *skb,
1381*4882a593Smuzhiyun u8 *eth_dst_new)
1382*4882a593Smuzhiyun {
1383*4882a593Smuzhiyun struct ethhdr *ethhdr;
1384*4882a593Smuzhiyun
1385*4882a593Smuzhiyun /* Copy skb header to change the mac header */
1386*4882a593Smuzhiyun skb = pskb_copy_for_clone(skb, GFP_ATOMIC);
1387*4882a593Smuzhiyun if (!skb)
1388*4882a593Smuzhiyun return;
1389*4882a593Smuzhiyun
1390*4882a593Smuzhiyun /* Set the mac header as if we actually sent the packet uncoded */
1391*4882a593Smuzhiyun ethhdr = eth_hdr(skb);
1392*4882a593Smuzhiyun ether_addr_copy(ethhdr->h_source, ethhdr->h_dest);
1393*4882a593Smuzhiyun ether_addr_copy(ethhdr->h_dest, eth_dst_new);
1394*4882a593Smuzhiyun
1395*4882a593Smuzhiyun /* Set data pointer to MAC header to mimic packets from our tx path */
1396*4882a593Smuzhiyun skb_push(skb, ETH_HLEN);
1397*4882a593Smuzhiyun
1398*4882a593Smuzhiyun /* Add the packet to the decoding packet pool */
1399*4882a593Smuzhiyun batadv_nc_skb_store_for_decoding(bat_priv, skb);
1400*4882a593Smuzhiyun
1401*4882a593Smuzhiyun /* batadv_nc_skb_store_for_decoding() clones the skb, so we must free
1402*4882a593Smuzhiyun * our ref
1403*4882a593Smuzhiyun */
1404*4882a593Smuzhiyun consume_skb(skb);
1405*4882a593Smuzhiyun }
1406*4882a593Smuzhiyun
1407*4882a593Smuzhiyun /**
1408*4882a593Smuzhiyun * batadv_nc_skb_dst_search() - Loops through list of neighboring nodes to dst.
1409*4882a593Smuzhiyun * @skb: data skb to forward
1410*4882a593Smuzhiyun * @neigh_node: next hop to forward packet to
1411*4882a593Smuzhiyun * @ethhdr: pointer to the ethernet header inside the skb
1412*4882a593Smuzhiyun *
1413*4882a593Smuzhiyun * Loops through the list of neighboring nodes the next hop has a good
1414*4882a593Smuzhiyun * connection to (receives OGMs with a sufficient quality). We need to find a
1415*4882a593Smuzhiyun * neighbor of our next hop that potentially sent a packet which our next hop
1416*4882a593Smuzhiyun * also received (overheard) and has stored for later decoding.
1417*4882a593Smuzhiyun *
1418*4882a593Smuzhiyun * Return: true if the skb was consumed (encoded packet sent) or false otherwise
1419*4882a593Smuzhiyun */
batadv_nc_skb_dst_search(struct sk_buff * skb,struct batadv_neigh_node * neigh_node,struct ethhdr * ethhdr)1420*4882a593Smuzhiyun static bool batadv_nc_skb_dst_search(struct sk_buff *skb,
1421*4882a593Smuzhiyun struct batadv_neigh_node *neigh_node,
1422*4882a593Smuzhiyun struct ethhdr *ethhdr)
1423*4882a593Smuzhiyun {
1424*4882a593Smuzhiyun struct net_device *netdev = neigh_node->if_incoming->soft_iface;
1425*4882a593Smuzhiyun struct batadv_priv *bat_priv = netdev_priv(netdev);
1426*4882a593Smuzhiyun struct batadv_orig_node *orig_node = neigh_node->orig_node;
1427*4882a593Smuzhiyun struct batadv_nc_node *nc_node;
1428*4882a593Smuzhiyun struct batadv_nc_packet *nc_packet = NULL;
1429*4882a593Smuzhiyun
1430*4882a593Smuzhiyun rcu_read_lock();
1431*4882a593Smuzhiyun list_for_each_entry_rcu(nc_node, &orig_node->in_coding_list, list) {
1432*4882a593Smuzhiyun /* Search for coding opportunity with this in_nc_node */
1433*4882a593Smuzhiyun nc_packet = batadv_nc_skb_src_search(bat_priv, skb,
1434*4882a593Smuzhiyun neigh_node->addr,
1435*4882a593Smuzhiyun ethhdr->h_source, nc_node);
1436*4882a593Smuzhiyun
1437*4882a593Smuzhiyun /* Opportunity was found, so stop searching */
1438*4882a593Smuzhiyun if (nc_packet)
1439*4882a593Smuzhiyun break;
1440*4882a593Smuzhiyun }
1441*4882a593Smuzhiyun rcu_read_unlock();
1442*4882a593Smuzhiyun
1443*4882a593Smuzhiyun if (!nc_packet)
1444*4882a593Smuzhiyun return false;
1445*4882a593Smuzhiyun
1446*4882a593Smuzhiyun /* Save packets for later decoding */
1447*4882a593Smuzhiyun batadv_nc_skb_store_before_coding(bat_priv, skb,
1448*4882a593Smuzhiyun neigh_node->addr);
1449*4882a593Smuzhiyun batadv_nc_skb_store_before_coding(bat_priv, nc_packet->skb,
1450*4882a593Smuzhiyun nc_packet->neigh_node->addr);
1451*4882a593Smuzhiyun
1452*4882a593Smuzhiyun /* Code and send packets */
1453*4882a593Smuzhiyun if (batadv_nc_code_packets(bat_priv, skb, ethhdr, nc_packet,
1454*4882a593Smuzhiyun neigh_node))
1455*4882a593Smuzhiyun return true;
1456*4882a593Smuzhiyun
1457*4882a593Smuzhiyun /* out of mem ? Coding failed - we have to free the buffered packet
1458*4882a593Smuzhiyun * to avoid memleaks. The skb passed as argument will be dealt with
1459*4882a593Smuzhiyun * by the calling function.
1460*4882a593Smuzhiyun */
1461*4882a593Smuzhiyun batadv_nc_send_packet(nc_packet);
1462*4882a593Smuzhiyun return false;
1463*4882a593Smuzhiyun }
1464*4882a593Smuzhiyun
1465*4882a593Smuzhiyun /**
1466*4882a593Smuzhiyun * batadv_nc_skb_add_to_path() - buffer skb for later encoding / decoding
1467*4882a593Smuzhiyun * @skb: skb to add to path
1468*4882a593Smuzhiyun * @nc_path: path to add skb to
1469*4882a593Smuzhiyun * @neigh_node: next hop to forward packet to
1470*4882a593Smuzhiyun * @packet_id: checksum to identify packet
1471*4882a593Smuzhiyun *
1472*4882a593Smuzhiyun * Return: true if the packet was buffered or false in case of an error.
1473*4882a593Smuzhiyun */
batadv_nc_skb_add_to_path(struct sk_buff * skb,struct batadv_nc_path * nc_path,struct batadv_neigh_node * neigh_node,__be32 packet_id)1474*4882a593Smuzhiyun static bool batadv_nc_skb_add_to_path(struct sk_buff *skb,
1475*4882a593Smuzhiyun struct batadv_nc_path *nc_path,
1476*4882a593Smuzhiyun struct batadv_neigh_node *neigh_node,
1477*4882a593Smuzhiyun __be32 packet_id)
1478*4882a593Smuzhiyun {
1479*4882a593Smuzhiyun struct batadv_nc_packet *nc_packet;
1480*4882a593Smuzhiyun
1481*4882a593Smuzhiyun nc_packet = kzalloc(sizeof(*nc_packet), GFP_ATOMIC);
1482*4882a593Smuzhiyun if (!nc_packet)
1483*4882a593Smuzhiyun return false;
1484*4882a593Smuzhiyun
1485*4882a593Smuzhiyun /* Initialize nc_packet */
1486*4882a593Smuzhiyun nc_packet->timestamp = jiffies;
1487*4882a593Smuzhiyun nc_packet->packet_id = packet_id;
1488*4882a593Smuzhiyun nc_packet->skb = skb;
1489*4882a593Smuzhiyun nc_packet->neigh_node = neigh_node;
1490*4882a593Smuzhiyun nc_packet->nc_path = nc_path;
1491*4882a593Smuzhiyun
1492*4882a593Smuzhiyun /* Add coding packet to list */
1493*4882a593Smuzhiyun spin_lock_bh(&nc_path->packet_list_lock);
1494*4882a593Smuzhiyun list_add_tail(&nc_packet->list, &nc_path->packet_list);
1495*4882a593Smuzhiyun spin_unlock_bh(&nc_path->packet_list_lock);
1496*4882a593Smuzhiyun
1497*4882a593Smuzhiyun return true;
1498*4882a593Smuzhiyun }
1499*4882a593Smuzhiyun
1500*4882a593Smuzhiyun /**
1501*4882a593Smuzhiyun * batadv_nc_skb_forward() - try to code a packet or add it to the coding packet
1502*4882a593Smuzhiyun * buffer
1503*4882a593Smuzhiyun * @skb: data skb to forward
1504*4882a593Smuzhiyun * @neigh_node: next hop to forward packet to
1505*4882a593Smuzhiyun *
1506*4882a593Smuzhiyun * Return: true if the skb was consumed (encoded packet sent) or false otherwise
1507*4882a593Smuzhiyun */
batadv_nc_skb_forward(struct sk_buff * skb,struct batadv_neigh_node * neigh_node)1508*4882a593Smuzhiyun bool batadv_nc_skb_forward(struct sk_buff *skb,
1509*4882a593Smuzhiyun struct batadv_neigh_node *neigh_node)
1510*4882a593Smuzhiyun {
1511*4882a593Smuzhiyun const struct net_device *netdev = neigh_node->if_incoming->soft_iface;
1512*4882a593Smuzhiyun struct batadv_priv *bat_priv = netdev_priv(netdev);
1513*4882a593Smuzhiyun struct batadv_unicast_packet *packet;
1514*4882a593Smuzhiyun struct batadv_nc_path *nc_path;
1515*4882a593Smuzhiyun struct ethhdr *ethhdr = eth_hdr(skb);
1516*4882a593Smuzhiyun __be32 packet_id;
1517*4882a593Smuzhiyun u8 *payload;
1518*4882a593Smuzhiyun
1519*4882a593Smuzhiyun /* Check if network coding is enabled */
1520*4882a593Smuzhiyun if (!atomic_read(&bat_priv->network_coding))
1521*4882a593Smuzhiyun goto out;
1522*4882a593Smuzhiyun
1523*4882a593Smuzhiyun /* We only handle unicast packets */
1524*4882a593Smuzhiyun payload = skb_network_header(skb);
1525*4882a593Smuzhiyun packet = (struct batadv_unicast_packet *)payload;
1526*4882a593Smuzhiyun if (packet->packet_type != BATADV_UNICAST)
1527*4882a593Smuzhiyun goto out;
1528*4882a593Smuzhiyun
1529*4882a593Smuzhiyun /* Try to find a coding opportunity and send the skb if one is found */
1530*4882a593Smuzhiyun if (batadv_nc_skb_dst_search(skb, neigh_node, ethhdr))
1531*4882a593Smuzhiyun return true;
1532*4882a593Smuzhiyun
1533*4882a593Smuzhiyun /* Find or create a nc_path for this src-dst pair */
1534*4882a593Smuzhiyun nc_path = batadv_nc_get_path(bat_priv,
1535*4882a593Smuzhiyun bat_priv->nc.coding_hash,
1536*4882a593Smuzhiyun ethhdr->h_source,
1537*4882a593Smuzhiyun neigh_node->addr);
1538*4882a593Smuzhiyun
1539*4882a593Smuzhiyun if (!nc_path)
1540*4882a593Smuzhiyun goto out;
1541*4882a593Smuzhiyun
1542*4882a593Smuzhiyun /* Add skb to nc_path */
1543*4882a593Smuzhiyun packet_id = batadv_skb_crc32(skb, payload + sizeof(*packet));
1544*4882a593Smuzhiyun if (!batadv_nc_skb_add_to_path(skb, nc_path, neigh_node, packet_id))
1545*4882a593Smuzhiyun goto free_nc_path;
1546*4882a593Smuzhiyun
1547*4882a593Smuzhiyun /* Packet is consumed */
1548*4882a593Smuzhiyun return true;
1549*4882a593Smuzhiyun
1550*4882a593Smuzhiyun free_nc_path:
1551*4882a593Smuzhiyun batadv_nc_path_put(nc_path);
1552*4882a593Smuzhiyun out:
1553*4882a593Smuzhiyun /* Packet is not consumed */
1554*4882a593Smuzhiyun return false;
1555*4882a593Smuzhiyun }
1556*4882a593Smuzhiyun
1557*4882a593Smuzhiyun /**
1558*4882a593Smuzhiyun * batadv_nc_skb_store_for_decoding() - save a clone of the skb which can be
1559*4882a593Smuzhiyun * used when decoding coded packets
1560*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
1561*4882a593Smuzhiyun * @skb: data skb to store
1562*4882a593Smuzhiyun */
batadv_nc_skb_store_for_decoding(struct batadv_priv * bat_priv,struct sk_buff * skb)1563*4882a593Smuzhiyun void batadv_nc_skb_store_for_decoding(struct batadv_priv *bat_priv,
1564*4882a593Smuzhiyun struct sk_buff *skb)
1565*4882a593Smuzhiyun {
1566*4882a593Smuzhiyun struct batadv_unicast_packet *packet;
1567*4882a593Smuzhiyun struct batadv_nc_path *nc_path;
1568*4882a593Smuzhiyun struct ethhdr *ethhdr = eth_hdr(skb);
1569*4882a593Smuzhiyun __be32 packet_id;
1570*4882a593Smuzhiyun u8 *payload;
1571*4882a593Smuzhiyun
1572*4882a593Smuzhiyun /* Check if network coding is enabled */
1573*4882a593Smuzhiyun if (!atomic_read(&bat_priv->network_coding))
1574*4882a593Smuzhiyun goto out;
1575*4882a593Smuzhiyun
1576*4882a593Smuzhiyun /* Check for supported packet type */
1577*4882a593Smuzhiyun payload = skb_network_header(skb);
1578*4882a593Smuzhiyun packet = (struct batadv_unicast_packet *)payload;
1579*4882a593Smuzhiyun if (packet->packet_type != BATADV_UNICAST)
1580*4882a593Smuzhiyun goto out;
1581*4882a593Smuzhiyun
1582*4882a593Smuzhiyun /* Find existing nc_path or create a new */
1583*4882a593Smuzhiyun nc_path = batadv_nc_get_path(bat_priv,
1584*4882a593Smuzhiyun bat_priv->nc.decoding_hash,
1585*4882a593Smuzhiyun ethhdr->h_source,
1586*4882a593Smuzhiyun ethhdr->h_dest);
1587*4882a593Smuzhiyun
1588*4882a593Smuzhiyun if (!nc_path)
1589*4882a593Smuzhiyun goto out;
1590*4882a593Smuzhiyun
1591*4882a593Smuzhiyun /* Clone skb and adjust skb->data to point at batman header */
1592*4882a593Smuzhiyun skb = skb_clone(skb, GFP_ATOMIC);
1593*4882a593Smuzhiyun if (unlikely(!skb))
1594*4882a593Smuzhiyun goto free_nc_path;
1595*4882a593Smuzhiyun
1596*4882a593Smuzhiyun if (unlikely(!pskb_may_pull(skb, ETH_HLEN)))
1597*4882a593Smuzhiyun goto free_skb;
1598*4882a593Smuzhiyun
1599*4882a593Smuzhiyun if (unlikely(!skb_pull_rcsum(skb, ETH_HLEN)))
1600*4882a593Smuzhiyun goto free_skb;
1601*4882a593Smuzhiyun
1602*4882a593Smuzhiyun /* Add skb to nc_path */
1603*4882a593Smuzhiyun packet_id = batadv_skb_crc32(skb, payload + sizeof(*packet));
1604*4882a593Smuzhiyun if (!batadv_nc_skb_add_to_path(skb, nc_path, NULL, packet_id))
1605*4882a593Smuzhiyun goto free_skb;
1606*4882a593Smuzhiyun
1607*4882a593Smuzhiyun batadv_inc_counter(bat_priv, BATADV_CNT_NC_BUFFER);
1608*4882a593Smuzhiyun return;
1609*4882a593Smuzhiyun
1610*4882a593Smuzhiyun free_skb:
1611*4882a593Smuzhiyun kfree_skb(skb);
1612*4882a593Smuzhiyun free_nc_path:
1613*4882a593Smuzhiyun batadv_nc_path_put(nc_path);
1614*4882a593Smuzhiyun out:
1615*4882a593Smuzhiyun return;
1616*4882a593Smuzhiyun }
1617*4882a593Smuzhiyun
1618*4882a593Smuzhiyun /**
1619*4882a593Smuzhiyun * batadv_nc_skb_store_sniffed_unicast() - check if a received unicast packet
1620*4882a593Smuzhiyun * should be saved in the decoding buffer and, if so, store it there
1621*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
1622*4882a593Smuzhiyun * @skb: unicast skb to store
1623*4882a593Smuzhiyun */
batadv_nc_skb_store_sniffed_unicast(struct batadv_priv * bat_priv,struct sk_buff * skb)1624*4882a593Smuzhiyun void batadv_nc_skb_store_sniffed_unicast(struct batadv_priv *bat_priv,
1625*4882a593Smuzhiyun struct sk_buff *skb)
1626*4882a593Smuzhiyun {
1627*4882a593Smuzhiyun struct ethhdr *ethhdr = eth_hdr(skb);
1628*4882a593Smuzhiyun
1629*4882a593Smuzhiyun if (batadv_is_my_mac(bat_priv, ethhdr->h_dest))
1630*4882a593Smuzhiyun return;
1631*4882a593Smuzhiyun
1632*4882a593Smuzhiyun /* Set data pointer to MAC header to mimic packets from our tx path */
1633*4882a593Smuzhiyun skb_push(skb, ETH_HLEN);
1634*4882a593Smuzhiyun
1635*4882a593Smuzhiyun batadv_nc_skb_store_for_decoding(bat_priv, skb);
1636*4882a593Smuzhiyun }
1637*4882a593Smuzhiyun
1638*4882a593Smuzhiyun /**
1639*4882a593Smuzhiyun * batadv_nc_skb_decode_packet() - decode given skb using the decode data stored
1640*4882a593Smuzhiyun * in nc_packet
1641*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
1642*4882a593Smuzhiyun * @skb: unicast skb to decode
1643*4882a593Smuzhiyun * @nc_packet: decode data needed to decode the skb
1644*4882a593Smuzhiyun *
1645*4882a593Smuzhiyun * Return: pointer to decoded unicast packet if the packet was decoded or NULL
1646*4882a593Smuzhiyun * in case of an error.
1647*4882a593Smuzhiyun */
1648*4882a593Smuzhiyun static struct batadv_unicast_packet *
batadv_nc_skb_decode_packet(struct batadv_priv * bat_priv,struct sk_buff * skb,struct batadv_nc_packet * nc_packet)1649*4882a593Smuzhiyun batadv_nc_skb_decode_packet(struct batadv_priv *bat_priv, struct sk_buff *skb,
1650*4882a593Smuzhiyun struct batadv_nc_packet *nc_packet)
1651*4882a593Smuzhiyun {
1652*4882a593Smuzhiyun const int h_size = sizeof(struct batadv_unicast_packet);
1653*4882a593Smuzhiyun const int h_diff = sizeof(struct batadv_coded_packet) - h_size;
1654*4882a593Smuzhiyun struct batadv_unicast_packet *unicast_packet;
1655*4882a593Smuzhiyun struct batadv_coded_packet coded_packet_tmp;
1656*4882a593Smuzhiyun struct ethhdr *ethhdr, ethhdr_tmp;
1657*4882a593Smuzhiyun u8 *orig_dest, ttl, ttvn;
1658*4882a593Smuzhiyun unsigned int coding_len;
1659*4882a593Smuzhiyun int err;
1660*4882a593Smuzhiyun
1661*4882a593Smuzhiyun /* Save headers temporarily */
1662*4882a593Smuzhiyun memcpy(&coded_packet_tmp, skb->data, sizeof(coded_packet_tmp));
1663*4882a593Smuzhiyun memcpy(ðhdr_tmp, skb_mac_header(skb), sizeof(ethhdr_tmp));
1664*4882a593Smuzhiyun
1665*4882a593Smuzhiyun if (skb_cow(skb, 0) < 0)
1666*4882a593Smuzhiyun return NULL;
1667*4882a593Smuzhiyun
1668*4882a593Smuzhiyun if (unlikely(!skb_pull_rcsum(skb, h_diff)))
1669*4882a593Smuzhiyun return NULL;
1670*4882a593Smuzhiyun
1671*4882a593Smuzhiyun /* Data points to batman header, so set mac header 14 bytes before
1672*4882a593Smuzhiyun * and network to data
1673*4882a593Smuzhiyun */
1674*4882a593Smuzhiyun skb_set_mac_header(skb, -ETH_HLEN);
1675*4882a593Smuzhiyun skb_reset_network_header(skb);
1676*4882a593Smuzhiyun
1677*4882a593Smuzhiyun /* Reconstruct original mac header */
1678*4882a593Smuzhiyun ethhdr = eth_hdr(skb);
1679*4882a593Smuzhiyun *ethhdr = ethhdr_tmp;
1680*4882a593Smuzhiyun
1681*4882a593Smuzhiyun /* Select the correct unicast header information based on the location
1682*4882a593Smuzhiyun * of our mac address in the coded_packet header
1683*4882a593Smuzhiyun */
1684*4882a593Smuzhiyun if (batadv_is_my_mac(bat_priv, coded_packet_tmp.second_dest)) {
1685*4882a593Smuzhiyun /* If we are the second destination the packet was overheard,
1686*4882a593Smuzhiyun * so the Ethernet address must be copied to h_dest and
1687*4882a593Smuzhiyun * pkt_type changed from PACKET_OTHERHOST to PACKET_HOST
1688*4882a593Smuzhiyun */
1689*4882a593Smuzhiyun ether_addr_copy(ethhdr->h_dest, coded_packet_tmp.second_dest);
1690*4882a593Smuzhiyun skb->pkt_type = PACKET_HOST;
1691*4882a593Smuzhiyun
1692*4882a593Smuzhiyun orig_dest = coded_packet_tmp.second_orig_dest;
1693*4882a593Smuzhiyun ttl = coded_packet_tmp.second_ttl;
1694*4882a593Smuzhiyun ttvn = coded_packet_tmp.second_ttvn;
1695*4882a593Smuzhiyun } else {
1696*4882a593Smuzhiyun orig_dest = coded_packet_tmp.first_orig_dest;
1697*4882a593Smuzhiyun ttl = coded_packet_tmp.ttl;
1698*4882a593Smuzhiyun ttvn = coded_packet_tmp.first_ttvn;
1699*4882a593Smuzhiyun }
1700*4882a593Smuzhiyun
1701*4882a593Smuzhiyun coding_len = ntohs(coded_packet_tmp.coded_len);
1702*4882a593Smuzhiyun
1703*4882a593Smuzhiyun if (coding_len > skb->len)
1704*4882a593Smuzhiyun return NULL;
1705*4882a593Smuzhiyun
1706*4882a593Smuzhiyun /* Here the magic is reversed:
1707*4882a593Smuzhiyun * extract the missing packet from the received coded packet
1708*4882a593Smuzhiyun */
1709*4882a593Smuzhiyun batadv_nc_memxor(skb->data + h_size,
1710*4882a593Smuzhiyun nc_packet->skb->data + h_size,
1711*4882a593Smuzhiyun coding_len);
1712*4882a593Smuzhiyun
1713*4882a593Smuzhiyun /* Resize decoded skb if decoded with larger packet */
1714*4882a593Smuzhiyun if (nc_packet->skb->len > coding_len + h_size) {
1715*4882a593Smuzhiyun err = pskb_trim_rcsum(skb, coding_len + h_size);
1716*4882a593Smuzhiyun if (err)
1717*4882a593Smuzhiyun return NULL;
1718*4882a593Smuzhiyun }
1719*4882a593Smuzhiyun
1720*4882a593Smuzhiyun /* Create decoded unicast packet */
1721*4882a593Smuzhiyun unicast_packet = (struct batadv_unicast_packet *)skb->data;
1722*4882a593Smuzhiyun unicast_packet->packet_type = BATADV_UNICAST;
1723*4882a593Smuzhiyun unicast_packet->version = BATADV_COMPAT_VERSION;
1724*4882a593Smuzhiyun unicast_packet->ttl = ttl;
1725*4882a593Smuzhiyun ether_addr_copy(unicast_packet->dest, orig_dest);
1726*4882a593Smuzhiyun unicast_packet->ttvn = ttvn;
1727*4882a593Smuzhiyun
1728*4882a593Smuzhiyun batadv_nc_packet_free(nc_packet, false);
1729*4882a593Smuzhiyun return unicast_packet;
1730*4882a593Smuzhiyun }
1731*4882a593Smuzhiyun
1732*4882a593Smuzhiyun /**
1733*4882a593Smuzhiyun * batadv_nc_find_decoding_packet() - search through buffered decoding data to
1734*4882a593Smuzhiyun * find the data needed to decode the coded packet
1735*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
1736*4882a593Smuzhiyun * @ethhdr: pointer to the ethernet header inside the coded packet
1737*4882a593Smuzhiyun * @coded: coded packet we try to find decode data for
1738*4882a593Smuzhiyun *
1739*4882a593Smuzhiyun * Return: pointer to nc packet if the needed data was found or NULL otherwise.
1740*4882a593Smuzhiyun */
1741*4882a593Smuzhiyun static struct batadv_nc_packet *
batadv_nc_find_decoding_packet(struct batadv_priv * bat_priv,struct ethhdr * ethhdr,struct batadv_coded_packet * coded)1742*4882a593Smuzhiyun batadv_nc_find_decoding_packet(struct batadv_priv *bat_priv,
1743*4882a593Smuzhiyun struct ethhdr *ethhdr,
1744*4882a593Smuzhiyun struct batadv_coded_packet *coded)
1745*4882a593Smuzhiyun {
1746*4882a593Smuzhiyun struct batadv_hashtable *hash = bat_priv->nc.decoding_hash;
1747*4882a593Smuzhiyun struct batadv_nc_packet *tmp_nc_packet, *nc_packet = NULL;
1748*4882a593Smuzhiyun struct batadv_nc_path *nc_path, nc_path_key;
1749*4882a593Smuzhiyun u8 *dest, *source;
1750*4882a593Smuzhiyun __be32 packet_id;
1751*4882a593Smuzhiyun int index;
1752*4882a593Smuzhiyun
1753*4882a593Smuzhiyun if (!hash)
1754*4882a593Smuzhiyun return NULL;
1755*4882a593Smuzhiyun
1756*4882a593Smuzhiyun /* Select the correct packet id based on the location of our mac-addr */
1757*4882a593Smuzhiyun dest = ethhdr->h_source;
1758*4882a593Smuzhiyun if (!batadv_is_my_mac(bat_priv, coded->second_dest)) {
1759*4882a593Smuzhiyun source = coded->second_source;
1760*4882a593Smuzhiyun packet_id = coded->second_crc;
1761*4882a593Smuzhiyun } else {
1762*4882a593Smuzhiyun source = coded->first_source;
1763*4882a593Smuzhiyun packet_id = coded->first_crc;
1764*4882a593Smuzhiyun }
1765*4882a593Smuzhiyun
1766*4882a593Smuzhiyun batadv_nc_hash_key_gen(&nc_path_key, source, dest);
1767*4882a593Smuzhiyun index = batadv_nc_hash_choose(&nc_path_key, hash->size);
1768*4882a593Smuzhiyun
1769*4882a593Smuzhiyun /* Search for matching coding path */
1770*4882a593Smuzhiyun rcu_read_lock();
1771*4882a593Smuzhiyun hlist_for_each_entry_rcu(nc_path, &hash->table[index], hash_entry) {
1772*4882a593Smuzhiyun /* Find matching nc_packet */
1773*4882a593Smuzhiyun spin_lock_bh(&nc_path->packet_list_lock);
1774*4882a593Smuzhiyun list_for_each_entry(tmp_nc_packet,
1775*4882a593Smuzhiyun &nc_path->packet_list, list) {
1776*4882a593Smuzhiyun if (packet_id == tmp_nc_packet->packet_id) {
1777*4882a593Smuzhiyun list_del(&tmp_nc_packet->list);
1778*4882a593Smuzhiyun
1779*4882a593Smuzhiyun nc_packet = tmp_nc_packet;
1780*4882a593Smuzhiyun break;
1781*4882a593Smuzhiyun }
1782*4882a593Smuzhiyun }
1783*4882a593Smuzhiyun spin_unlock_bh(&nc_path->packet_list_lock);
1784*4882a593Smuzhiyun
1785*4882a593Smuzhiyun if (nc_packet)
1786*4882a593Smuzhiyun break;
1787*4882a593Smuzhiyun }
1788*4882a593Smuzhiyun rcu_read_unlock();
1789*4882a593Smuzhiyun
1790*4882a593Smuzhiyun if (!nc_packet)
1791*4882a593Smuzhiyun batadv_dbg(BATADV_DBG_NC, bat_priv,
1792*4882a593Smuzhiyun "No decoding packet found for %u\n", packet_id);
1793*4882a593Smuzhiyun
1794*4882a593Smuzhiyun return nc_packet;
1795*4882a593Smuzhiyun }
1796*4882a593Smuzhiyun
1797*4882a593Smuzhiyun /**
1798*4882a593Smuzhiyun * batadv_nc_recv_coded_packet() - try to decode coded packet and enqueue the
1799*4882a593Smuzhiyun * resulting unicast packet
1800*4882a593Smuzhiyun * @skb: incoming coded packet
1801*4882a593Smuzhiyun * @recv_if: pointer to interface this packet was received on
1802*4882a593Smuzhiyun *
1803*4882a593Smuzhiyun * Return: NET_RX_SUCCESS if the packet has been consumed or NET_RX_DROP
1804*4882a593Smuzhiyun * otherwise.
1805*4882a593Smuzhiyun */
batadv_nc_recv_coded_packet(struct sk_buff * skb,struct batadv_hard_iface * recv_if)1806*4882a593Smuzhiyun static int batadv_nc_recv_coded_packet(struct sk_buff *skb,
1807*4882a593Smuzhiyun struct batadv_hard_iface *recv_if)
1808*4882a593Smuzhiyun {
1809*4882a593Smuzhiyun struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
1810*4882a593Smuzhiyun struct batadv_unicast_packet *unicast_packet;
1811*4882a593Smuzhiyun struct batadv_coded_packet *coded_packet;
1812*4882a593Smuzhiyun struct batadv_nc_packet *nc_packet;
1813*4882a593Smuzhiyun struct ethhdr *ethhdr;
1814*4882a593Smuzhiyun int hdr_size = sizeof(*coded_packet);
1815*4882a593Smuzhiyun
1816*4882a593Smuzhiyun /* Check if network coding is enabled */
1817*4882a593Smuzhiyun if (!atomic_read(&bat_priv->network_coding))
1818*4882a593Smuzhiyun goto free_skb;
1819*4882a593Smuzhiyun
1820*4882a593Smuzhiyun /* Make sure we can access (and remove) header */
1821*4882a593Smuzhiyun if (unlikely(!pskb_may_pull(skb, hdr_size)))
1822*4882a593Smuzhiyun goto free_skb;
1823*4882a593Smuzhiyun
1824*4882a593Smuzhiyun coded_packet = (struct batadv_coded_packet *)skb->data;
1825*4882a593Smuzhiyun ethhdr = eth_hdr(skb);
1826*4882a593Smuzhiyun
1827*4882a593Smuzhiyun /* Verify frame is destined for us */
1828*4882a593Smuzhiyun if (!batadv_is_my_mac(bat_priv, ethhdr->h_dest) &&
1829*4882a593Smuzhiyun !batadv_is_my_mac(bat_priv, coded_packet->second_dest))
1830*4882a593Smuzhiyun goto free_skb;
1831*4882a593Smuzhiyun
1832*4882a593Smuzhiyun /* Update stat counter */
1833*4882a593Smuzhiyun if (batadv_is_my_mac(bat_priv, coded_packet->second_dest))
1834*4882a593Smuzhiyun batadv_inc_counter(bat_priv, BATADV_CNT_NC_SNIFFED);
1835*4882a593Smuzhiyun
1836*4882a593Smuzhiyun nc_packet = batadv_nc_find_decoding_packet(bat_priv, ethhdr,
1837*4882a593Smuzhiyun coded_packet);
1838*4882a593Smuzhiyun if (!nc_packet) {
1839*4882a593Smuzhiyun batadv_inc_counter(bat_priv, BATADV_CNT_NC_DECODE_FAILED);
1840*4882a593Smuzhiyun goto free_skb;
1841*4882a593Smuzhiyun }
1842*4882a593Smuzhiyun
1843*4882a593Smuzhiyun /* Make skb's linear, because decoding accesses the entire buffer */
1844*4882a593Smuzhiyun if (skb_linearize(skb) < 0)
1845*4882a593Smuzhiyun goto free_nc_packet;
1846*4882a593Smuzhiyun
1847*4882a593Smuzhiyun if (skb_linearize(nc_packet->skb) < 0)
1848*4882a593Smuzhiyun goto free_nc_packet;
1849*4882a593Smuzhiyun
1850*4882a593Smuzhiyun /* Decode the packet */
1851*4882a593Smuzhiyun unicast_packet = batadv_nc_skb_decode_packet(bat_priv, skb, nc_packet);
1852*4882a593Smuzhiyun if (!unicast_packet) {
1853*4882a593Smuzhiyun batadv_inc_counter(bat_priv, BATADV_CNT_NC_DECODE_FAILED);
1854*4882a593Smuzhiyun goto free_nc_packet;
1855*4882a593Smuzhiyun }
1856*4882a593Smuzhiyun
1857*4882a593Smuzhiyun /* Mark packet as decoded to do correct recoding when forwarding */
1858*4882a593Smuzhiyun BATADV_SKB_CB(skb)->decoded = true;
1859*4882a593Smuzhiyun batadv_inc_counter(bat_priv, BATADV_CNT_NC_DECODE);
1860*4882a593Smuzhiyun batadv_add_counter(bat_priv, BATADV_CNT_NC_DECODE_BYTES,
1861*4882a593Smuzhiyun skb->len + ETH_HLEN);
1862*4882a593Smuzhiyun return batadv_recv_unicast_packet(skb, recv_if);
1863*4882a593Smuzhiyun
1864*4882a593Smuzhiyun free_nc_packet:
1865*4882a593Smuzhiyun batadv_nc_packet_free(nc_packet, true);
1866*4882a593Smuzhiyun free_skb:
1867*4882a593Smuzhiyun kfree_skb(skb);
1868*4882a593Smuzhiyun
1869*4882a593Smuzhiyun return NET_RX_DROP;
1870*4882a593Smuzhiyun }
1871*4882a593Smuzhiyun
1872*4882a593Smuzhiyun /**
1873*4882a593Smuzhiyun * batadv_nc_mesh_free() - clean up network coding memory
1874*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
1875*4882a593Smuzhiyun */
batadv_nc_mesh_free(struct batadv_priv * bat_priv)1876*4882a593Smuzhiyun void batadv_nc_mesh_free(struct batadv_priv *bat_priv)
1877*4882a593Smuzhiyun {
1878*4882a593Smuzhiyun batadv_tvlv_container_unregister(bat_priv, BATADV_TVLV_NC, 1);
1879*4882a593Smuzhiyun batadv_tvlv_handler_unregister(bat_priv, BATADV_TVLV_NC, 1);
1880*4882a593Smuzhiyun cancel_delayed_work_sync(&bat_priv->nc.work);
1881*4882a593Smuzhiyun
1882*4882a593Smuzhiyun batadv_nc_purge_paths(bat_priv, bat_priv->nc.coding_hash, NULL);
1883*4882a593Smuzhiyun batadv_hash_destroy(bat_priv->nc.coding_hash);
1884*4882a593Smuzhiyun batadv_nc_purge_paths(bat_priv, bat_priv->nc.decoding_hash, NULL);
1885*4882a593Smuzhiyun batadv_hash_destroy(bat_priv->nc.decoding_hash);
1886*4882a593Smuzhiyun }
1887*4882a593Smuzhiyun
1888*4882a593Smuzhiyun #ifdef CONFIG_BATMAN_ADV_DEBUGFS
1889*4882a593Smuzhiyun /**
1890*4882a593Smuzhiyun * batadv_nc_nodes_seq_print_text() - print the nc node information
1891*4882a593Smuzhiyun * @seq: seq file to print on
1892*4882a593Smuzhiyun * @offset: not used
1893*4882a593Smuzhiyun *
1894*4882a593Smuzhiyun * Return: always 0
1895*4882a593Smuzhiyun */
batadv_nc_nodes_seq_print_text(struct seq_file * seq,void * offset)1896*4882a593Smuzhiyun int batadv_nc_nodes_seq_print_text(struct seq_file *seq, void *offset)
1897*4882a593Smuzhiyun {
1898*4882a593Smuzhiyun struct net_device *net_dev = (struct net_device *)seq->private;
1899*4882a593Smuzhiyun struct batadv_priv *bat_priv = netdev_priv(net_dev);
1900*4882a593Smuzhiyun struct batadv_hashtable *hash = bat_priv->orig_hash;
1901*4882a593Smuzhiyun struct batadv_hard_iface *primary_if;
1902*4882a593Smuzhiyun struct hlist_head *head;
1903*4882a593Smuzhiyun struct batadv_orig_node *orig_node;
1904*4882a593Smuzhiyun struct batadv_nc_node *nc_node;
1905*4882a593Smuzhiyun int i;
1906*4882a593Smuzhiyun
1907*4882a593Smuzhiyun primary_if = batadv_seq_print_text_primary_if_get(seq);
1908*4882a593Smuzhiyun if (!primary_if)
1909*4882a593Smuzhiyun goto out;
1910*4882a593Smuzhiyun
1911*4882a593Smuzhiyun /* Traverse list of originators */
1912*4882a593Smuzhiyun for (i = 0; i < hash->size; i++) {
1913*4882a593Smuzhiyun head = &hash->table[i];
1914*4882a593Smuzhiyun
1915*4882a593Smuzhiyun /* For each orig_node in this bin */
1916*4882a593Smuzhiyun rcu_read_lock();
1917*4882a593Smuzhiyun hlist_for_each_entry_rcu(orig_node, head, hash_entry) {
1918*4882a593Smuzhiyun /* no need to print the orig node if it does not have
1919*4882a593Smuzhiyun * network coding neighbors
1920*4882a593Smuzhiyun */
1921*4882a593Smuzhiyun if (list_empty(&orig_node->in_coding_list) &&
1922*4882a593Smuzhiyun list_empty(&orig_node->out_coding_list))
1923*4882a593Smuzhiyun continue;
1924*4882a593Smuzhiyun
1925*4882a593Smuzhiyun seq_printf(seq, "Node: %pM\n", orig_node->orig);
1926*4882a593Smuzhiyun
1927*4882a593Smuzhiyun seq_puts(seq, " Ingoing: ");
1928*4882a593Smuzhiyun /* For each in_nc_node to this orig_node */
1929*4882a593Smuzhiyun list_for_each_entry_rcu(nc_node,
1930*4882a593Smuzhiyun &orig_node->in_coding_list,
1931*4882a593Smuzhiyun list)
1932*4882a593Smuzhiyun seq_printf(seq, "%pM ",
1933*4882a593Smuzhiyun nc_node->addr);
1934*4882a593Smuzhiyun seq_puts(seq, "\n Outgoing: ");
1935*4882a593Smuzhiyun /* For out_nc_node to this orig_node */
1936*4882a593Smuzhiyun list_for_each_entry_rcu(nc_node,
1937*4882a593Smuzhiyun &orig_node->out_coding_list,
1938*4882a593Smuzhiyun list)
1939*4882a593Smuzhiyun seq_printf(seq, "%pM ",
1940*4882a593Smuzhiyun nc_node->addr);
1941*4882a593Smuzhiyun seq_puts(seq, "\n\n");
1942*4882a593Smuzhiyun }
1943*4882a593Smuzhiyun rcu_read_unlock();
1944*4882a593Smuzhiyun }
1945*4882a593Smuzhiyun
1946*4882a593Smuzhiyun out:
1947*4882a593Smuzhiyun if (primary_if)
1948*4882a593Smuzhiyun batadv_hardif_put(primary_if);
1949*4882a593Smuzhiyun return 0;
1950*4882a593Smuzhiyun }
1951*4882a593Smuzhiyun
1952*4882a593Smuzhiyun /**
1953*4882a593Smuzhiyun * batadv_nc_init_debugfs() - create nc folder and related files in debugfs
1954*4882a593Smuzhiyun * @bat_priv: the bat priv with all the soft interface information
1955*4882a593Smuzhiyun */
batadv_nc_init_debugfs(struct batadv_priv * bat_priv)1956*4882a593Smuzhiyun void batadv_nc_init_debugfs(struct batadv_priv *bat_priv)
1957*4882a593Smuzhiyun {
1958*4882a593Smuzhiyun struct dentry *nc_dir;
1959*4882a593Smuzhiyun
1960*4882a593Smuzhiyun nc_dir = debugfs_create_dir("nc", bat_priv->debug_dir);
1961*4882a593Smuzhiyun
1962*4882a593Smuzhiyun debugfs_create_u8("min_tq", 0644, nc_dir, &bat_priv->nc.min_tq);
1963*4882a593Smuzhiyun
1964*4882a593Smuzhiyun debugfs_create_u32("max_fwd_delay", 0644, nc_dir,
1965*4882a593Smuzhiyun &bat_priv->nc.max_fwd_delay);
1966*4882a593Smuzhiyun
1967*4882a593Smuzhiyun debugfs_create_u32("max_buffer_time", 0644, nc_dir,
1968*4882a593Smuzhiyun &bat_priv->nc.max_buffer_time);
1969*4882a593Smuzhiyun }
1970*4882a593Smuzhiyun #endif
1971