~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

TOMOYO Linux Cross Reference
Linux/net/batman-adv/tvlv.c

Version: ~ [ linux-6.2-rc3 ] ~ [ linux-6.1.5 ] ~ [ linux-6.0.19 ] ~ [ linux-5.19.17 ] ~ [ linux-5.18.19 ] ~ [ linux-5.17.15 ] ~ [ linux-5.16.20 ] ~ [ linux-5.15.87 ] ~ [ linux-5.14.21 ] ~ [ linux-5.13.19 ] ~ [ linux-5.12.19 ] ~ [ linux-5.11.22 ] ~ [ linux-5.10.162 ] ~ [ linux-5.9.16 ] ~ [ linux-5.8.18 ] ~ [ linux-5.7.19 ] ~ [ linux-5.6.19 ] ~ [ linux-5.5.19 ] ~ [ linux-5.4.228 ] ~ [ linux-5.3.18 ] ~ [ linux-5.2.21 ] ~ [ linux-5.1.21 ] ~ [ linux-5.0.21 ] ~ [ linux-4.20.17 ] ~ [ linux-4.19.269 ] ~ [ linux-4.18.20 ] ~ [ linux-4.17.19 ] ~ [ linux-4.16.18 ] ~ [ linux-4.15.18 ] ~ [ linux-4.14.302 ] ~ [ linux-4.13.16 ] ~ [ linux-4.12.14 ] ~ [ linux-4.11.12 ] ~ [ linux-4.10.17 ] ~ [ linux-4.9.337 ] ~ [ linux-4.8.17 ] ~ [ linux-4.7.10 ] ~ [ linux-4.6.7 ] ~ [ linux-4.5.7 ] ~ [ linux-4.4.302 ] ~ [ linux-4.3.6 ] ~ [ linux-4.2.8 ] ~ [ linux-4.1.52 ] ~ [ linux-4.0.9 ] ~ [ linux-3.10.108 ] ~ [ linux-2.6.32.71 ] ~ [ linux-2.6.0 ] ~ [ linux-2.4.37.11 ] ~ [ unix-v6-master ] ~ [ ccs-tools-1.8.9 ] ~ [ policy-sample ] ~
Architecture: ~ [ i386 ] ~ [ alpha ] ~ [ m68k ] ~ [ mips ] ~ [ ppc ] ~ [ sparc ] ~ [ sparc64 ] ~

  1 /* Copyright (C) 2007-2016  B.A.T.M.A.N. contributors:
  2  *
  3  * Marek Lindner, Simon Wunderlich
  4  *
  5  * This program is free software; you can redistribute it and/or
  6  * modify it under the terms of version 2 of the GNU General Public
  7  * License as published by the Free Software Foundation.
  8  *
  9  * This program is distributed in the hope that it will be useful, but
 10  * WITHOUT ANY WARRANTY; without even the implied warranty of
 11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
 12  * General Public License for more details.
 13  *
 14  * You should have received a copy of the GNU General Public License
 15  * along with this program; if not, see <http://www.gnu.org/licenses/>.
 16  */
 17 
 18 #include "main.h"
 19 
 20 #include <linux/byteorder/generic.h>
 21 #include <linux/etherdevice.h>
 22 #include <linux/fs.h>
 23 #include <linux/if_ether.h>
 24 #include <linux/kernel.h>
 25 #include <linux/kref.h>
 26 #include <linux/list.h>
 27 #include <linux/lockdep.h>
 28 #include <linux/netdevice.h>
 29 #include <linux/pkt_sched.h>
 30 #include <linux/rculist.h>
 31 #include <linux/rcupdate.h>
 32 #include <linux/skbuff.h>
 33 #include <linux/slab.h>
 34 #include <linux/spinlock.h>
 35 #include <linux/stddef.h>
 36 #include <linux/string.h>
 37 #include <linux/types.h>
 38 
 39 #include "originator.h"
 40 #include "packet.h"
 41 #include "send.h"
 42 #include "tvlv.h"
 43 
 44 /**
 45  * batadv_tvlv_handler_release - release tvlv handler from lists and queue for
 46  *  free after rcu grace period
 47  * @ref: kref pointer of the tvlv
 48  */
 49 static void batadv_tvlv_handler_release(struct kref *ref)
 50 {
 51         struct batadv_tvlv_handler *tvlv_handler;
 52 
 53         tvlv_handler = container_of(ref, struct batadv_tvlv_handler, refcount);
 54         kfree_rcu(tvlv_handler, rcu);
 55 }
 56 
 57 /**
 58  * batadv_tvlv_handler_put - decrement the tvlv container refcounter and
 59  *  possibly release it
 60  * @tvlv_handler: the tvlv handler to free
 61  */
 62 static void batadv_tvlv_handler_put(struct batadv_tvlv_handler *tvlv_handler)
 63 {
 64         kref_put(&tvlv_handler->refcount, batadv_tvlv_handler_release);
 65 }
 66 
 67 /**
 68  * batadv_tvlv_handler_get - retrieve tvlv handler from the tvlv handler list
 69  *  based on the provided type and version (both need to match)
 70  * @bat_priv: the bat priv with all the soft interface information
 71  * @type: tvlv handler type to look for
 72  * @version: tvlv handler version to look for
 73  *
 74  * Return: tvlv handler if found or NULL otherwise.
 75  */
 76 static struct batadv_tvlv_handler *
 77 batadv_tvlv_handler_get(struct batadv_priv *bat_priv, u8 type, u8 version)
 78 {
 79         struct batadv_tvlv_handler *tvlv_handler_tmp, *tvlv_handler = NULL;
 80 
 81         rcu_read_lock();
 82         hlist_for_each_entry_rcu(tvlv_handler_tmp,
 83                                  &bat_priv->tvlv.handler_list, list) {
 84                 if (tvlv_handler_tmp->type != type)
 85                         continue;
 86 
 87                 if (tvlv_handler_tmp->version != version)
 88                         continue;
 89 
 90                 if (!kref_get_unless_zero(&tvlv_handler_tmp->refcount))
 91                         continue;
 92 
 93                 tvlv_handler = tvlv_handler_tmp;
 94                 break;
 95         }
 96         rcu_read_unlock();
 97 
 98         return tvlv_handler;
 99 }
100 
101 /**
102  * batadv_tvlv_container_release - release tvlv from lists and free
103  * @ref: kref pointer of the tvlv
104  */
105 static void batadv_tvlv_container_release(struct kref *ref)
106 {
107         struct batadv_tvlv_container *tvlv;
108 
109         tvlv = container_of(ref, struct batadv_tvlv_container, refcount);
110         kfree(tvlv);
111 }
112 
113 /**
114  * batadv_tvlv_container_put - decrement the tvlv container refcounter and
115  *  possibly release it
116  * @tvlv: the tvlv container to free
117  */
118 static void batadv_tvlv_container_put(struct batadv_tvlv_container *tvlv)
119 {
120         kref_put(&tvlv->refcount, batadv_tvlv_container_release);
121 }
122 
123 /**
124  * batadv_tvlv_container_get - retrieve tvlv container from the tvlv container
125  *  list based on the provided type and version (both need to match)
126  * @bat_priv: the bat priv with all the soft interface information
127  * @type: tvlv container type to look for
128  * @version: tvlv container version to look for
129  *
130  * Has to be called with the appropriate locks being acquired
131  * (tvlv.container_list_lock).
132  *
133  * Return: tvlv container if found or NULL otherwise.
134  */
135 static struct batadv_tvlv_container *
136 batadv_tvlv_container_get(struct batadv_priv *bat_priv, u8 type, u8 version)
137 {
138         struct batadv_tvlv_container *tvlv_tmp, *tvlv = NULL;
139 
140         lockdep_assert_held(&bat_priv->tvlv.container_list_lock);
141 
142         hlist_for_each_entry(tvlv_tmp, &bat_priv->tvlv.container_list, list) {
143                 if (tvlv_tmp->tvlv_hdr.type != type)
144                         continue;
145 
146                 if (tvlv_tmp->tvlv_hdr.version != version)
147                         continue;
148 
149                 kref_get(&tvlv_tmp->refcount);
150                 tvlv = tvlv_tmp;
151                 break;
152         }
153 
154         return tvlv;
155 }
156 
157 /**
158  * batadv_tvlv_container_list_size - calculate the size of the tvlv container
159  *  list entries
160  * @bat_priv: the bat priv with all the soft interface information
161  *
162  * Has to be called with the appropriate locks being acquired
163  * (tvlv.container_list_lock).
164  *
165  * Return: size of all currently registered tvlv containers in bytes.
166  */
167 static u16 batadv_tvlv_container_list_size(struct batadv_priv *bat_priv)
168 {
169         struct batadv_tvlv_container *tvlv;
170         u16 tvlv_len = 0;
171 
172         lockdep_assert_held(&bat_priv->tvlv.container_list_lock);
173 
174         hlist_for_each_entry(tvlv, &bat_priv->tvlv.container_list, list) {
175                 tvlv_len += sizeof(struct batadv_tvlv_hdr);
176                 tvlv_len += ntohs(tvlv->tvlv_hdr.len);
177         }
178 
179         return tvlv_len;
180 }
181 
182 /**
183  * batadv_tvlv_container_remove - remove tvlv container from the tvlv container
184  *  list
185  * @bat_priv: the bat priv with all the soft interface information
186  * @tvlv: the to be removed tvlv container
187  *
188  * Has to be called with the appropriate locks being acquired
189  * (tvlv.container_list_lock).
190  */
191 static void batadv_tvlv_container_remove(struct batadv_priv *bat_priv,
192                                          struct batadv_tvlv_container *tvlv)
193 {
194         lockdep_assert_held(&bat_priv->tvlv.container_list_lock);
195 
196         if (!tvlv)
197                 return;
198 
199         hlist_del(&tvlv->list);
200 
201         /* first call to decrement the counter, second call to free */
202         batadv_tvlv_container_put(tvlv);
203         batadv_tvlv_container_put(tvlv);
204 }
205 
206 /**
207  * batadv_tvlv_container_unregister - unregister tvlv container based on the
208  *  provided type and version (both need to match)
209  * @bat_priv: the bat priv with all the soft interface information
210  * @type: tvlv container type to unregister
211  * @version: tvlv container type to unregister
212  */
213 void batadv_tvlv_container_unregister(struct batadv_priv *bat_priv,
214                                       u8 type, u8 version)
215 {
216         struct batadv_tvlv_container *tvlv;
217 
218         spin_lock_bh(&bat_priv->tvlv.container_list_lock);
219         tvlv = batadv_tvlv_container_get(bat_priv, type, version);
220         batadv_tvlv_container_remove(bat_priv, tvlv);
221         spin_unlock_bh(&bat_priv->tvlv.container_list_lock);
222 }
223 
224 /**
225  * batadv_tvlv_container_register - register tvlv type, version and content
226  *  to be propagated with each (primary interface) OGM
227  * @bat_priv: the bat priv with all the soft interface information
228  * @type: tvlv container type
229  * @version: tvlv container version
230  * @tvlv_value: tvlv container content
231  * @tvlv_value_len: tvlv container content length
232  *
233  * If a container of the same type and version was already registered the new
234  * content is going to replace the old one.
235  */
236 void batadv_tvlv_container_register(struct batadv_priv *bat_priv,
237                                     u8 type, u8 version,
238                                     void *tvlv_value, u16 tvlv_value_len)
239 {
240         struct batadv_tvlv_container *tvlv_old, *tvlv_new;
241 
242         if (!tvlv_value)
243                 tvlv_value_len = 0;
244 
245         tvlv_new = kzalloc(sizeof(*tvlv_new) + tvlv_value_len, GFP_ATOMIC);
246         if (!tvlv_new)
247                 return;
248 
249         tvlv_new->tvlv_hdr.version = version;
250         tvlv_new->tvlv_hdr.type = type;
251         tvlv_new->tvlv_hdr.len = htons(tvlv_value_len);
252 
253         memcpy(tvlv_new + 1, tvlv_value, ntohs(tvlv_new->tvlv_hdr.len));
254         INIT_HLIST_NODE(&tvlv_new->list);
255         kref_init(&tvlv_new->refcount);
256 
257         spin_lock_bh(&bat_priv->tvlv.container_list_lock);
258         tvlv_old = batadv_tvlv_container_get(bat_priv, type, version);
259         batadv_tvlv_container_remove(bat_priv, tvlv_old);
260 
261         kref_get(&tvlv_new->refcount);
262         hlist_add_head(&tvlv_new->list, &bat_priv->tvlv.container_list);
263         spin_unlock_bh(&bat_priv->tvlv.container_list_lock);
264 
265         /* don't return reference to new tvlv_container */
266         batadv_tvlv_container_put(tvlv_new);
267 }
268 
269 /**
270  * batadv_tvlv_realloc_packet_buff - reallocate packet buffer to accommodate
271  *  requested packet size
272  * @packet_buff: packet buffer
273  * @packet_buff_len: packet buffer size
274  * @min_packet_len: requested packet minimum size
275  * @additional_packet_len: requested additional packet size on top of minimum
276  *  size
277  *
278  * Return: true of the packet buffer could be changed to the requested size,
279  * false otherwise.
280  */
281 static bool batadv_tvlv_realloc_packet_buff(unsigned char **packet_buff,
282                                             int *packet_buff_len,
283                                             int min_packet_len,
284                                             int additional_packet_len)
285 {
286         unsigned char *new_buff;
287 
288         new_buff = kmalloc(min_packet_len + additional_packet_len, GFP_ATOMIC);
289 
290         /* keep old buffer if kmalloc should fail */
291         if (!new_buff)
292                 return false;
293 
294         memcpy(new_buff, *packet_buff, min_packet_len);
295         kfree(*packet_buff);
296         *packet_buff = new_buff;
297         *packet_buff_len = min_packet_len + additional_packet_len;
298 
299         return true;
300 }
301 
302 /**
303  * batadv_tvlv_container_ogm_append - append tvlv container content to given
304  *  OGM packet buffer
305  * @bat_priv: the bat priv with all the soft interface information
306  * @packet_buff: ogm packet buffer
307  * @packet_buff_len: ogm packet buffer size including ogm header and tvlv
308  *  content
309  * @packet_min_len: ogm header size to be preserved for the OGM itself
310  *
311  * The ogm packet might be enlarged or shrunk depending on the current size
312  * and the size of the to-be-appended tvlv containers.
313  *
314  * Return: size of all appended tvlv containers in bytes.
315  */
316 u16 batadv_tvlv_container_ogm_append(struct batadv_priv *bat_priv,
317                                      unsigned char **packet_buff,
318                                      int *packet_buff_len, int packet_min_len)
319 {
320         struct batadv_tvlv_container *tvlv;
321         struct batadv_tvlv_hdr *tvlv_hdr;
322         u16 tvlv_value_len;
323         void *tvlv_value;
324         bool ret;
325 
326         spin_lock_bh(&bat_priv->tvlv.container_list_lock);
327         tvlv_value_len = batadv_tvlv_container_list_size(bat_priv);
328 
329         ret = batadv_tvlv_realloc_packet_buff(packet_buff, packet_buff_len,
330                                               packet_min_len, tvlv_value_len);
331 
332         if (!ret)
333                 goto end;
334 
335         if (!tvlv_value_len)
336                 goto end;
337 
338         tvlv_value = (*packet_buff) + packet_min_len;
339 
340         hlist_for_each_entry(tvlv, &bat_priv->tvlv.container_list, list) {
341                 tvlv_hdr = tvlv_value;
342                 tvlv_hdr->type = tvlv->tvlv_hdr.type;
343                 tvlv_hdr->version = tvlv->tvlv_hdr.version;
344                 tvlv_hdr->len = tvlv->tvlv_hdr.len;
345                 tvlv_value = tvlv_hdr + 1;
346                 memcpy(tvlv_value, tvlv + 1, ntohs(tvlv->tvlv_hdr.len));
347                 tvlv_value = (u8 *)tvlv_value + ntohs(tvlv->tvlv_hdr.len);
348         }
349 
350 end:
351         spin_unlock_bh(&bat_priv->tvlv.container_list_lock);
352         return tvlv_value_len;
353 }
354 
355 /**
356  * batadv_tvlv_call_handler - parse the given tvlv buffer to call the
357  *  appropriate handlers
358  * @bat_priv: the bat priv with all the soft interface information
359  * @tvlv_handler: tvlv callback function handling the tvlv content
360  * @ogm_source: flag indicating whether the tvlv is an ogm or a unicast packet
361  * @orig_node: orig node emitting the ogm packet
362  * @src: source mac address of the unicast packet
363  * @dst: destination mac address of the unicast packet
364  * @tvlv_value: tvlv content
365  * @tvlv_value_len: tvlv content length
366  *
367  * Return: success if handler was not found or the return value of the handler
368  * callback.
369  */
370 static int batadv_tvlv_call_handler(struct batadv_priv *bat_priv,
371                                     struct batadv_tvlv_handler *tvlv_handler,
372                                     bool ogm_source,
373                                     struct batadv_orig_node *orig_node,
374                                     u8 *src, u8 *dst,
375                                     void *tvlv_value, u16 tvlv_value_len)
376 {
377         if (!tvlv_handler)
378                 return NET_RX_SUCCESS;
379 
380         if (ogm_source) {
381                 if (!tvlv_handler->ogm_handler)
382                         return NET_RX_SUCCESS;
383 
384                 if (!orig_node)
385                         return NET_RX_SUCCESS;
386 
387                 tvlv_handler->ogm_handler(bat_priv, orig_node,
388                                           BATADV_NO_FLAGS,
389                                           tvlv_value, tvlv_value_len);
390                 tvlv_handler->flags |= BATADV_TVLV_HANDLER_OGM_CALLED;
391         } else {
392                 if (!src)
393                         return NET_RX_SUCCESS;
394 
395                 if (!dst)
396                         return NET_RX_SUCCESS;
397 
398                 if (!tvlv_handler->unicast_handler)
399                         return NET_RX_SUCCESS;
400 
401                 return tvlv_handler->unicast_handler(bat_priv, src,
402                                                      dst, tvlv_value,
403                                                      tvlv_value_len);
404         }
405 
406         return NET_RX_SUCCESS;
407 }
408 
409 /**
410  * batadv_tvlv_containers_process - parse the given tvlv buffer to call the
411  *  appropriate handlers
412  * @bat_priv: the bat priv with all the soft interface information
413  * @ogm_source: flag indicating whether the tvlv is an ogm or a unicast packet
414  * @orig_node: orig node emitting the ogm packet
415  * @src: source mac address of the unicast packet
416  * @dst: destination mac address of the unicast packet
417  * @tvlv_value: tvlv content
418  * @tvlv_value_len: tvlv content length
419  *
420  * Return: success when processing an OGM or the return value of all called
421  * handler callbacks.
422  */
423 int batadv_tvlv_containers_process(struct batadv_priv *bat_priv,
424                                    bool ogm_source,
425                                    struct batadv_orig_node *orig_node,
426                                    u8 *src, u8 *dst,
427                                    void *tvlv_value, u16 tvlv_value_len)
428 {
429         struct batadv_tvlv_handler *tvlv_handler;
430         struct batadv_tvlv_hdr *tvlv_hdr;
431         u16 tvlv_value_cont_len;
432         u8 cifnotfound = BATADV_TVLV_HANDLER_OGM_CIFNOTFND;
433         int ret = NET_RX_SUCCESS;
434 
435         while (tvlv_value_len >= sizeof(*tvlv_hdr)) {
436                 tvlv_hdr = tvlv_value;
437                 tvlv_value_cont_len = ntohs(tvlv_hdr->len);
438                 tvlv_value = tvlv_hdr + 1;
439                 tvlv_value_len -= sizeof(*tvlv_hdr);
440 
441                 if (tvlv_value_cont_len > tvlv_value_len)
442                         break;
443 
444                 tvlv_handler = batadv_tvlv_handler_get(bat_priv,
445                                                        tvlv_hdr->type,
446                                                        tvlv_hdr->version);
447 
448                 ret |= batadv_tvlv_call_handler(bat_priv, tvlv_handler,
449                                                 ogm_source, orig_node,
450                                                 src, dst, tvlv_value,
451                                                 tvlv_value_cont_len);
452                 if (tvlv_handler)
453                         batadv_tvlv_handler_put(tvlv_handler);
454                 tvlv_value = (u8 *)tvlv_value + tvlv_value_cont_len;
455                 tvlv_value_len -= tvlv_value_cont_len;
456         }
457 
458         if (!ogm_source)
459                 return ret;
460 
461         rcu_read_lock();
462         hlist_for_each_entry_rcu(tvlv_handler,
463                                  &bat_priv->tvlv.handler_list, list) {
464                 if ((tvlv_handler->flags & BATADV_TVLV_HANDLER_OGM_CIFNOTFND) &&
465                     !(tvlv_handler->flags & BATADV_TVLV_HANDLER_OGM_CALLED))
466                         tvlv_handler->ogm_handler(bat_priv, orig_node,
467                                                   cifnotfound, NULL, 0);
468 
469                 tvlv_handler->flags &= ~BATADV_TVLV_HANDLER_OGM_CALLED;
470         }
471         rcu_read_unlock();
472 
473         return NET_RX_SUCCESS;
474 }
475 
476 /**
477  * batadv_tvlv_ogm_receive - process an incoming ogm and call the appropriate
478  *  handlers
479  * @bat_priv: the bat priv with all the soft interface information
480  * @batadv_ogm_packet: ogm packet containing the tvlv containers
481  * @orig_node: orig node emitting the ogm packet
482  */
483 void batadv_tvlv_ogm_receive(struct batadv_priv *bat_priv,
484                              struct batadv_ogm_packet *batadv_ogm_packet,
485                              struct batadv_orig_node *orig_node)
486 {
487         void *tvlv_value;
488         u16 tvlv_value_len;
489 
490         if (!batadv_ogm_packet)
491                 return;
492 
493         tvlv_value_len = ntohs(batadv_ogm_packet->tvlv_len);
494         if (!tvlv_value_len)
495                 return;
496 
497         tvlv_value = batadv_ogm_packet + 1;
498 
499         batadv_tvlv_containers_process(bat_priv, true, orig_node, NULL, NULL,
500                                        tvlv_value, tvlv_value_len);
501 }
502 
503 /**
504  * batadv_tvlv_handler_register - register tvlv handler based on the provided
505  *  type and version (both need to match) for ogm tvlv payload and/or unicast
506  *  payload
507  * @bat_priv: the bat priv with all the soft interface information
508  * @optr: ogm tvlv handler callback function. This function receives the orig
509  *  node, flags and the tvlv content as argument to process.
510  * @uptr: unicast tvlv handler callback function. This function receives the
511  *  source & destination of the unicast packet as well as the tvlv content
512  *  to process.
513  * @type: tvlv handler type to be registered
514  * @version: tvlv handler version to be registered
515  * @flags: flags to enable or disable TVLV API behavior
516  */
517 void batadv_tvlv_handler_register(struct batadv_priv *bat_priv,
518                                   void (*optr)(struct batadv_priv *bat_priv,
519                                                struct batadv_orig_node *orig,
520                                                u8 flags,
521                                                void *tvlv_value,
522                                                u16 tvlv_value_len),
523                                   int (*uptr)(struct batadv_priv *bat_priv,
524                                               u8 *src, u8 *dst,
525                                               void *tvlv_value,
526                                               u16 tvlv_value_len),
527                                   u8 type, u8 version, u8 flags)
528 {
529         struct batadv_tvlv_handler *tvlv_handler;
530 
531         tvlv_handler = batadv_tvlv_handler_get(bat_priv, type, version);
532         if (tvlv_handler) {
533                 batadv_tvlv_handler_put(tvlv_handler);
534                 return;
535         }
536 
537         tvlv_handler = kzalloc(sizeof(*tvlv_handler), GFP_ATOMIC);
538         if (!tvlv_handler)
539                 return;
540 
541         tvlv_handler->ogm_handler = optr;
542         tvlv_handler->unicast_handler = uptr;
543         tvlv_handler->type = type;
544         tvlv_handler->version = version;
545         tvlv_handler->flags = flags;
546         kref_init(&tvlv_handler->refcount);
547         INIT_HLIST_NODE(&tvlv_handler->list);
548 
549         spin_lock_bh(&bat_priv->tvlv.handler_list_lock);
550         kref_get(&tvlv_handler->refcount);
551         hlist_add_head_rcu(&tvlv_handler->list, &bat_priv->tvlv.handler_list);
552         spin_unlock_bh(&bat_priv->tvlv.handler_list_lock);
553 
554         /* don't return reference to new tvlv_handler */
555         batadv_tvlv_handler_put(tvlv_handler);
556 }
557 
558 /**
559  * batadv_tvlv_handler_unregister - unregister tvlv handler based on the
560  *  provided type and version (both need to match)
561  * @bat_priv: the bat priv with all the soft interface information
562  * @type: tvlv handler type to be unregistered
563  * @version: tvlv handler version to be unregistered
564  */
565 void batadv_tvlv_handler_unregister(struct batadv_priv *bat_priv,
566                                     u8 type, u8 version)
567 {
568         struct batadv_tvlv_handler *tvlv_handler;
569 
570         tvlv_handler = batadv_tvlv_handler_get(bat_priv, type, version);
571         if (!tvlv_handler)
572                 return;
573 
574         batadv_tvlv_handler_put(tvlv_handler);
575         spin_lock_bh(&bat_priv->tvlv.handler_list_lock);
576         hlist_del_rcu(&tvlv_handler->list);
577         spin_unlock_bh(&bat_priv->tvlv.handler_list_lock);
578         batadv_tvlv_handler_put(tvlv_handler);
579 }
580 
581 /**
582  * batadv_tvlv_unicast_send - send a unicast packet with tvlv payload to the
583  *  specified host
584  * @bat_priv: the bat priv with all the soft interface information
585  * @src: source mac address of the unicast packet
586  * @dst: destination mac address of the unicast packet
587  * @type: tvlv type
588  * @version: tvlv version
589  * @tvlv_value: tvlv content
590  * @tvlv_value_len: tvlv content length
591  */
592 void batadv_tvlv_unicast_send(struct batadv_priv *bat_priv, u8 *src,
593                               u8 *dst, u8 type, u8 version,
594                               void *tvlv_value, u16 tvlv_value_len)
595 {
596         struct batadv_unicast_tvlv_packet *unicast_tvlv_packet;
597         struct batadv_tvlv_hdr *tvlv_hdr;
598         struct batadv_orig_node *orig_node;
599         struct sk_buff *skb;
600         unsigned char *tvlv_buff;
601         unsigned int tvlv_len;
602         ssize_t hdr_len = sizeof(*unicast_tvlv_packet);
603 
604         orig_node = batadv_orig_hash_find(bat_priv, dst);
605         if (!orig_node)
606                 return;
607 
608         tvlv_len = sizeof(*tvlv_hdr) + tvlv_value_len;
609 
610         skb = netdev_alloc_skb_ip_align(NULL, ETH_HLEN + hdr_len + tvlv_len);
611         if (!skb)
612                 goto out;
613 
614         skb->priority = TC_PRIO_CONTROL;
615         skb_reserve(skb, ETH_HLEN);
616         tvlv_buff = skb_put(skb, sizeof(*unicast_tvlv_packet) + tvlv_len);
617         unicast_tvlv_packet = (struct batadv_unicast_tvlv_packet *)tvlv_buff;
618         unicast_tvlv_packet->packet_type = BATADV_UNICAST_TVLV;
619         unicast_tvlv_packet->version = BATADV_COMPAT_VERSION;
620         unicast_tvlv_packet->ttl = BATADV_TTL;
621         unicast_tvlv_packet->reserved = 0;
622         unicast_tvlv_packet->tvlv_len = htons(tvlv_len);
623         unicast_tvlv_packet->align = 0;
624         ether_addr_copy(unicast_tvlv_packet->src, src);
625         ether_addr_copy(unicast_tvlv_packet->dst, dst);
626 
627         tvlv_buff = (unsigned char *)(unicast_tvlv_packet + 1);
628         tvlv_hdr = (struct batadv_tvlv_hdr *)tvlv_buff;
629         tvlv_hdr->version = version;
630         tvlv_hdr->type = type;
631         tvlv_hdr->len = htons(tvlv_value_len);
632         tvlv_buff += sizeof(*tvlv_hdr);
633         memcpy(tvlv_buff, tvlv_value, tvlv_value_len);
634 
635         batadv_send_skb_to_orig(skb, orig_node, NULL);
636 out:
637         batadv_orig_node_put(orig_node);
638 }
639 

~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

kernel.org | git.kernel.org | LWN.net | Project Home | Wiki (Japanese) | Wiki (English) | SVN repository | Mail admin

Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.

osdn.jp