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