net/batman-adv/main.c

   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/atomic.h>
  21 #include <linux/bug.h>
  22 #include <linux/byteorder/generic.h>
  23 #include <linux/crc32c.h>
  24 #include <linux/errno.h>
  25 #include <linux/fs.h>
  26 #include <linux/if_ether.h>
  27 #include <linux/if_vlan.h>
  28 #include <linux/init.h>
  29 #include <linux/ip.h>
  30 #include <linux/ipv6.h>
  31 #include <linux/kernel.h>
  32 #include <linux/kref.h>
  33 #include <linux/list.h>
  34 #include <linux/lockdep.h>
  35 #include <linux/module.h>
  36 #include <linux/moduleparam.h>
  37 #include <linux/netdevice.h>
  38 #include <linux/pkt_sched.h>
  39 #include <linux/rculist.h>
  40 #include <linux/rcupdate.h>
  41 #include <linux/seq_file.h>
  42 #include <linux/skbuff.h>
  43 #include <linux/slab.h>
  44 #include <linux/spinlock.h>
  45 #include <linux/stddef.h>
  46 #include <linux/string.h>
  47 #include <linux/workqueue.h>
  48 #include <net/dsfield.h>
  49 #include <net/rtnetlink.h>
  50
  51 #include "bat_algo.h"
  52 #include "bridge_loop_avoidance.h"
  53 #include "debugfs.h"
  54 #include "distributed-arp-table.h"
  55 #include "gateway_client.h"
  56 #include "gateway_common.h"
  57 #include "hard-interface.h"
  58 #include "icmp_socket.h"
  59 #include "multicast.h"
  60 #include "network-coding.h"
  61 #include "originator.h"
  62 #include "packet.h"
  63 #include "routing.h"
  64 #include "send.h"
  65 #include "soft-interface.h"
  66 #include "translation-table.h"
  67
  68 /* List manipulations on hardif_list have to be rtnl_lock()'ed,
  69  * list traversals just rcu-locked
  70  */
  71 struct list_head batadv_hardif_list;
  72 static int (*batadv_rx_handler[256])(struct sk_buff *,
  73                                      struct batadv_hard_iface *);
  74 char batadv_routing_algo[20] = "BATMAN_IV";
  75 static struct hlist_head batadv_algo_list;
  76
  77 unsigned char batadv_broadcast_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
  78
  79 struct workqueue_struct *batadv_event_workqueue;
  80
  81 static void batadv_recv_handler_init(void);
  82
  83 static int __init batadv_init(void)
  84 {
  85         INIT_LIST_HEAD(&batadv_hardif_list);
  86         INIT_HLIST_HEAD(&batadv_algo_list);
  87
  88         batadv_recv_handler_init();
  89
  90         batadv_iv_init();
  91         batadv_nc_init();
  92
  93         batadv_event_workqueue = create_singlethread_workqueue("bat_events");
  94
  95         if (!batadv_event_workqueue)
  96                 return -ENOMEM;
  97
  98         batadv_socket_init();
  99         batadv_debugfs_init();
 100
 101         register_netdevice_notifier(&batadv_hard_if_notifier);
 102         rtnl_link_register(&batadv_link_ops);
 103
 104         pr_info("B.A.T.M.A.N. advanced %s (compatibility version %i) loaded\n",
 105                 BATADV_SOURCE_VERSION, BATADV_COMPAT_VERSION);
 106
 107         return 0;
 108 }
 109
 110 static void __exit batadv_exit(void)
 111 {
 112         batadv_debugfs_destroy();
 113         rtnl_link_unregister(&batadv_link_ops);
 114         unregister_netdevice_notifier(&batadv_hard_if_notifier);
 115         batadv_hardif_remove_interfaces();
 116
 117         flush_workqueue(batadv_event_workqueue);
 118         destroy_workqueue(batadv_event_workqueue);
 119         batadv_event_workqueue = NULL;
 120
 121         rcu_barrier();
 122 }
 123
 124 int batadv_mesh_init(struct net_device *soft_iface)
 125 {
 126         struct batadv_priv *bat_priv = netdev_priv(soft_iface);
 127         int ret;
 128
 129         spin_lock_init(&bat_priv->forw_bat_list_lock);
 130         spin_lock_init(&bat_priv->forw_bcast_list_lock);
 131         spin_lock_init(&bat_priv->tt.changes_list_lock);
 132         spin_lock_init(&bat_priv->tt.req_list_lock);
 133         spin_lock_init(&bat_priv->tt.roam_list_lock);
 134         spin_lock_init(&bat_priv->tt.last_changeset_lock);
 135         spin_lock_init(&bat_priv->tt.commit_lock);
 136         spin_lock_init(&bat_priv->gw.list_lock);
 137 #ifdef CONFIG_BATMAN_ADV_MCAST
 138         spin_lock_init(&bat_priv->mcast.want_lists_lock);
 139 #endif
 140         spin_lock_init(&bat_priv->tvlv.container_list_lock);
 141         spin_lock_init(&bat_priv->tvlv.handler_list_lock);
 142         spin_lock_init(&bat_priv->softif_vlan_list_lock);
 143
 144         INIT_HLIST_HEAD(&bat_priv->forw_bat_list);
 145         INIT_HLIST_HEAD(&bat_priv->forw_bcast_list);
 146         INIT_HLIST_HEAD(&bat_priv->gw.list);
 147 #ifdef CONFIG_BATMAN_ADV_MCAST
 148         INIT_HLIST_HEAD(&bat_priv->mcast.want_all_unsnoopables_list);
 149         INIT_HLIST_HEAD(&bat_priv->mcast.want_all_ipv4_list);
 150         INIT_HLIST_HEAD(&bat_priv->mcast.want_all_ipv6_list);
 151 #endif
 152         INIT_LIST_HEAD(&bat_priv->tt.changes_list);
 153         INIT_HLIST_HEAD(&bat_priv->tt.req_list);
 154         INIT_LIST_HEAD(&bat_priv->tt.roam_list);
 155 #ifdef CONFIG_BATMAN_ADV_MCAST
 156         INIT_HLIST_HEAD(&bat_priv->mcast.mla_list);
 157 #endif
 158         INIT_HLIST_HEAD(&bat_priv->tvlv.container_list);
 159         INIT_HLIST_HEAD(&bat_priv->tvlv.handler_list);
 160         INIT_HLIST_HEAD(&bat_priv->softif_vlan_list);
 161
 162         ret = batadv_originator_init(bat_priv);
 163         if (ret < 0)
 164                 goto err;
 165
 166         ret = batadv_tt_init(bat_priv);
 167         if (ret < 0)
 168                 goto err;
 169
 170         ret = batadv_bla_init(bat_priv);
 171         if (ret < 0)
 172                 goto err;
 173
 174         ret = batadv_dat_init(bat_priv);
 175         if (ret < 0)
 176                 goto err;
 177
 178         ret = batadv_nc_mesh_init(bat_priv);
 179         if (ret < 0)
 180                 goto err;
 181
 182         batadv_gw_init(bat_priv);
 183         batadv_mcast_init(bat_priv);
 184
 185         atomic_set(&bat_priv->gw.reselect, 0);
 186         atomic_set(&bat_priv->mesh_state, BATADV_MESH_ACTIVE);
 187
 188         return 0;
 189
 190 err:
 191         batadv_mesh_free(soft_iface);
 192         return ret;
 193 }
 194
 195 void batadv_mesh_free(struct net_device *soft_iface)
 196 {
 197         struct batadv_priv *bat_priv = netdev_priv(soft_iface);
 198
 199         atomic_set(&bat_priv->mesh_state, BATADV_MESH_DEACTIVATING);
 200
 201         batadv_purge_outstanding_packets(bat_priv, NULL);
 202
 203         batadv_gw_node_free(bat_priv);
 204         batadv_nc_mesh_free(bat_priv);
 205         batadv_dat_free(bat_priv);
 206         batadv_bla_free(bat_priv);
 207
 208         batadv_mcast_free(bat_priv);
 209
 210         /* Free the TT and the originator tables only after having terminated
 211          * all the other depending components which may use these structures for
 212          * their purposes.
 213          */
 214         batadv_tt_free(bat_priv);
 215
 216         /* Since the originator table clean up routine is accessing the TT
 217          * tables as well, it has to be invoked after the TT tables have been
 218          * freed and marked as empty. This ensures that no cleanup RCU callbacks
 219          * accessing the TT data are scheduled for later execution.
 220          */
 221         batadv_originator_free(bat_priv);
 222
 223         batadv_gw_free(bat_priv);
 224
 225         free_percpu(bat_priv->bat_counters);
 226         bat_priv->bat_counters = NULL;
 227
 228         atomic_set(&bat_priv->mesh_state, BATADV_MESH_INACTIVE);
 229 }
 230
 231 /**
 232  * batadv_is_my_mac - check if the given mac address belongs to any of the real
 233  * interfaces in the current mesh
 234  * @bat_priv: the bat priv with all the soft interface information
 235  * @addr: the address to check
 236  *
 237  * Return: 'true' if the mac address was found, false otherwise.
 238  */
 239 bool batadv_is_my_mac(struct batadv_priv *bat_priv, const u8 *addr)
 240 {
 241         const struct batadv_hard_iface *hard_iface;
 242         bool is_my_mac = false;
 243
 244         rcu_read_lock();
 245         list_for_each_entry_rcu(hard_iface, &batadv_hardif_list, list) {
 246                 if (hard_iface->if_status != BATADV_IF_ACTIVE)
 247                         continue;
 248
 249                 if (hard_iface->soft_iface != bat_priv->soft_iface)
 250                         continue;
 251
 252                 if (batadv_compare_eth(hard_iface->net_dev->dev_addr, addr)) {
 253                         is_my_mac = true;
 254                         break;
 255                 }
 256         }
 257         rcu_read_unlock();
 258         return is_my_mac;
 259 }
 260
 261 /**
 262  * batadv_seq_print_text_primary_if_get - called from debugfs table printing
 263  *  function that requires the primary interface
 264  * @seq: debugfs table seq_file struct
 265  *
 266  * Return: primary interface if found or NULL otherwise.
 267  */
 268 struct batadv_hard_iface *
 269 batadv_seq_print_text_primary_if_get(struct seq_file *seq)
 270 {
 271         struct net_device *net_dev = (struct net_device *)seq->private;
 272         struct batadv_priv *bat_priv = netdev_priv(net_dev);
 273         struct batadv_hard_iface *primary_if;
 274
 275         primary_if = batadv_primary_if_get_selected(bat_priv);
 276
 277         if (!primary_if) {
 278                 seq_printf(seq,
 279                            "BATMAN mesh %s disabled - please specify interfaces to enable it\n",
 280                            net_dev->name);
 281                 goto out;
 282         }
 283
 284         if (primary_if->if_status == BATADV_IF_ACTIVE)
 285                 goto out;
 286
 287         seq_printf(seq,
 288                    "BATMAN mesh %s disabled - primary interface not active\n",
 289                    net_dev->name);
 290         batadv_hardif_free_ref(primary_if);
 291         primary_if = NULL;
 292
 293 out:
 294         return primary_if;
 295 }
 296
 297 /**
 298  * batadv_max_header_len - calculate maximum encapsulation overhead for a
 299  *  payload packet
 300  *
 301  * Return: the maximum encapsulation overhead in bytes.
 302  */
 303 int batadv_max_header_len(void)
 304 {
 305         int header_len = 0;
 306
 307         header_len = max_t(int, header_len,
 308                            sizeof(struct batadv_unicast_packet));
 309         header_len = max_t(int, header_len,
 310                            sizeof(struct batadv_unicast_4addr_packet));
 311         header_len = max_t(int, header_len,
 312                            sizeof(struct batadv_bcast_packet));
 313
 314 #ifdef CONFIG_BATMAN_ADV_NC
 315         header_len = max_t(int, header_len,
 316                            sizeof(struct batadv_coded_packet));
 317 #endif
 318
 319         return header_len + ETH_HLEN;
 320 }
 321
 322 /**
 323  * batadv_skb_set_priority - sets skb priority according to packet content
 324  * @skb: the packet to be sent
 325  * @offset: offset to the packet content
 326  *
 327  * This function sets a value between 256 and 263 (802.1d priority), which
 328  * can be interpreted by the cfg80211 or other drivers.
 329  */
 330 void batadv_skb_set_priority(struct sk_buff *skb, int offset)
 331 {
 332         struct iphdr ip_hdr_tmp, *ip_hdr;
 333         struct ipv6hdr ip6_hdr_tmp, *ip6_hdr;
 334         struct ethhdr ethhdr_tmp, *ethhdr;
 335         struct vlan_ethhdr *vhdr, vhdr_tmp;
 336         u32 prio;
 337
 338         /* already set, do nothing */
 339         if (skb->priority >= 256 && skb->priority <= 263)
 340                 return;
 341
 342         ethhdr = skb_header_pointer(skb, offset, sizeof(*ethhdr), &ethhdr_tmp);
 343         if (!ethhdr)
 344                 return;
 345
 346         switch (ethhdr->h_proto) {
 347         case htons(ETH_P_8021Q):
 348                 vhdr = skb_header_pointer(skb, offset + sizeof(*vhdr),
 349                                           sizeof(*vhdr), &vhdr_tmp);
 350                 if (!vhdr)
 351                         return;
 352                 prio = ntohs(vhdr->h_vlan_TCI) & VLAN_PRIO_MASK;
 353                 prio = prio >> VLAN_PRIO_SHIFT;
 354                 break;
 355         case htons(ETH_P_IP):
 356                 ip_hdr = skb_header_pointer(skb, offset + sizeof(*ethhdr),
 357                                             sizeof(*ip_hdr), &ip_hdr_tmp);
 358                 if (!ip_hdr)
 359                         return;
 360                 prio = (ipv4_get_dsfield(ip_hdr) & 0xfc) >> 5;
 361                 break;
 362         case htons(ETH_P_IPV6):
 363                 ip6_hdr = skb_header_pointer(skb, offset + sizeof(*ethhdr),
 364                                              sizeof(*ip6_hdr), &ip6_hdr_tmp);
 365                 if (!ip6_hdr)
 366                         return;
 367                 prio = (ipv6_get_dsfield(ip6_hdr) & 0xfc) >> 5;
 368                 break;
 369         default:
 370                 return;
 371         }
 372
 373         skb->priority = prio + 256;
 374 }
 375
 376 static int batadv_recv_unhandled_packet(struct sk_buff *skb,
 377                                         struct batadv_hard_iface *recv_if)
 378 {
 379         return NET_RX_DROP;
 380 }
 381
 382 /* incoming packets with the batman ethertype received on any active hard
 383  * interface
 384  */
 385 int batadv_batman_skb_recv(struct sk_buff *skb, struct net_device *dev,
 386                            struct packet_type *ptype,
 387                            struct net_device *orig_dev)
 388 {
 389         struct batadv_priv *bat_priv;
 390         struct batadv_ogm_packet *batadv_ogm_packet;
 391         struct batadv_hard_iface *hard_iface;
 392         u8 idx;
 393         int ret;
 394
 395         hard_iface = container_of(ptype, struct batadv_hard_iface,
 396                                   batman_adv_ptype);
 397         skb = skb_share_check(skb, GFP_ATOMIC);
 398
 399         /* skb was released by skb_share_check() */
 400         if (!skb)
 401                 goto err_out;
 402
 403         /* packet should hold at least type and version */
 404         if (unlikely(!pskb_may_pull(skb, 2)))
 405                 goto err_free;
 406
 407         /* expect a valid ethernet header here. */
 408         if (unlikely(skb->mac_len != ETH_HLEN || !skb_mac_header(skb)))
 409                 goto err_free;
 410
 411         if (!hard_iface->soft_iface)
 412                 goto err_free;
 413
 414         bat_priv = netdev_priv(hard_iface->soft_iface);
 415
 416         if (atomic_read(&bat_priv->mesh_state) != BATADV_MESH_ACTIVE)
 417                 goto err_free;
 418
 419         /* discard frames on not active interfaces */
 420         if (hard_iface->if_status != BATADV_IF_ACTIVE)
 421                 goto err_free;
 422
 423         batadv_ogm_packet = (struct batadv_ogm_packet *)skb->data;
 424
 425         if (batadv_ogm_packet->version != BATADV_COMPAT_VERSION) {
 426                 batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
 427                            "Drop packet: incompatible batman version (%i)\n",
 428                            batadv_ogm_packet->version);
 429                 goto err_free;
 430         }
 431
 432         /* reset control block to avoid left overs from previous users */
 433         memset(skb->cb, 0, sizeof(struct batadv_skb_cb));
 434
 435         /* all receive handlers return whether they received or reused
 436          * the supplied skb. if not, we have to free the skb.
 437          */
 438         idx = batadv_ogm_packet->packet_type;
 439         ret = (*batadv_rx_handler[idx])(skb, hard_iface);
 440
 441         if (ret == NET_RX_DROP)
 442                 kfree_skb(skb);
 443
 444         /* return NET_RX_SUCCESS in any case as we
 445          * most probably dropped the packet for
 446          * routing-logical reasons.
 447          */
 448         return NET_RX_SUCCESS;
 449
 450 err_free:
 451         kfree_skb(skb);
 452 err_out:
 453         return NET_RX_DROP;
 454 }
 455
 456 static void batadv_recv_handler_init(void)
 457 {
 458         int i;
 459
 460         for (i = 0; i < ARRAY_SIZE(batadv_rx_handler); i++)
 461                 batadv_rx_handler[i] = batadv_recv_unhandled_packet;
 462
 463         for (i = BATADV_UNICAST_MIN; i <= BATADV_UNICAST_MAX; i++)
 464                 batadv_rx_handler[i] = batadv_recv_unhandled_unicast_packet;
 465
 466         /* compile time checks for sizes */
 467         BUILD_BUG_ON(sizeof(struct batadv_bla_claim_dst) != 6);
 468         BUILD_BUG_ON(sizeof(struct batadv_ogm_packet) != 24);
 469         BUILD_BUG_ON(sizeof(struct batadv_icmp_header) != 20);
 470         BUILD_BUG_ON(sizeof(struct batadv_icmp_packet) != 20);
 471         BUILD_BUG_ON(sizeof(struct batadv_icmp_packet_rr) != 116);
 472         BUILD_BUG_ON(sizeof(struct batadv_unicast_packet) != 10);
 473         BUILD_BUG_ON(sizeof(struct batadv_unicast_4addr_packet) != 18);
 474         BUILD_BUG_ON(sizeof(struct batadv_frag_packet) != 20);
 475         BUILD_BUG_ON(sizeof(struct batadv_bcast_packet) != 14);
 476         BUILD_BUG_ON(sizeof(struct batadv_coded_packet) != 46);
 477         BUILD_BUG_ON(sizeof(struct batadv_unicast_tvlv_packet) != 20);
 478         BUILD_BUG_ON(sizeof(struct batadv_tvlv_hdr) != 4);
 479         BUILD_BUG_ON(sizeof(struct batadv_tvlv_gateway_data) != 8);
 480         BUILD_BUG_ON(sizeof(struct batadv_tvlv_tt_vlan_data) != 8);
 481         BUILD_BUG_ON(sizeof(struct batadv_tvlv_tt_change) != 12);
 482         BUILD_BUG_ON(sizeof(struct batadv_tvlv_roam_adv) != 8);
 483
 484         /* broadcast packet */
 485         batadv_rx_handler[BATADV_BCAST] = batadv_recv_bcast_packet;
 486
 487         /* unicast packets ... */
 488         /* unicast with 4 addresses packet */
 489         batadv_rx_handler[BATADV_UNICAST_4ADDR] = batadv_recv_unicast_packet;
 490         /* unicast packet */
 491         batadv_rx_handler[BATADV_UNICAST] = batadv_recv_unicast_packet;
 492         /* unicast tvlv packet */
 493         batadv_rx_handler[BATADV_UNICAST_TVLV] = batadv_recv_unicast_tvlv;
 494         /* batman icmp packet */
 495         batadv_rx_handler[BATADV_ICMP] = batadv_recv_icmp_packet;
 496         /* Fragmented packets */
 497         batadv_rx_handler[BATADV_UNICAST_FRAG] = batadv_recv_frag_packet;
 498 }
 499
 500 int
 501 batadv_recv_handler_register(u8 packet_type,
 502                              int (*recv_handler)(struct sk_buff *,
 503                                                  struct batadv_hard_iface *))
 504 {
 505         int (*curr)(struct sk_buff *,
 506                     struct batadv_hard_iface *);
 507         curr = batadv_rx_handler[packet_type];
 508
 509         if ((curr != batadv_recv_unhandled_packet) &&
 510             (curr != batadv_recv_unhandled_unicast_packet))
 511                 return -EBUSY;
 512
 513         batadv_rx_handler[packet_type] = recv_handler;
 514         return 0;
 515 }
 516
 517 void batadv_recv_handler_unregister(u8 packet_type)
 518 {
 519         batadv_rx_handler[packet_type] = batadv_recv_unhandled_packet;
 520 }
 521
 522 static struct batadv_algo_ops *batadv_algo_get(char *name)
 523 {
 524         struct batadv_algo_ops *bat_algo_ops = NULL, *bat_algo_ops_tmp;
 525
 526         hlist_for_each_entry(bat_algo_ops_tmp, &batadv_algo_list, list) {
 527                 if (strcmp(bat_algo_ops_tmp->name, name) != 0)
 528                         continue;
 529
 530                 bat_algo_ops = bat_algo_ops_tmp;
 531                 break;
 532         }
 533
 534         return bat_algo_ops;
 535 }
 536
 537 int batadv_algo_register(struct batadv_algo_ops *bat_algo_ops)
 538 {
 539         struct batadv_algo_ops *bat_algo_ops_tmp;
 540
 541         bat_algo_ops_tmp = batadv_algo_get(bat_algo_ops->name);
 542         if (bat_algo_ops_tmp) {
 543                 pr_info("Trying to register already registered routing algorithm: %s\n",
 544                         bat_algo_ops->name);
 545                 return -EEXIST;
 546         }
 547
 548         /* all algorithms must implement all ops (for now) */
 549         if (!bat_algo_ops->bat_iface_enable ||
 550             !bat_algo_ops->bat_iface_disable ||
 551             !bat_algo_ops->bat_iface_update_mac ||
 552             !bat_algo_ops->bat_primary_iface_set ||
 553             !bat_algo_ops->bat_ogm_schedule ||
 554             !bat_algo_ops->bat_ogm_emit ||
 555             !bat_algo_ops->bat_neigh_cmp ||
 556             !bat_algo_ops->bat_neigh_is_similar_or_better) {
 557                 pr_info("Routing algo '%s' does not implement required ops\n",
 558                         bat_algo_ops->name);
 559                 return -EINVAL;
 560         }
 561
 562         INIT_HLIST_NODE(&bat_algo_ops->list);
 563         hlist_add_head(&bat_algo_ops->list, &batadv_algo_list);
 564
 565         return 0;
 566 }
 567
 568 int batadv_algo_select(struct batadv_priv *bat_priv, char *name)
 569 {
 570         struct batadv_algo_ops *bat_algo_ops;
 571
 572         bat_algo_ops = batadv_algo_get(name);
 573         if (!bat_algo_ops)
 574                 return -EINVAL;
 575
 576         bat_priv->bat_algo_ops = bat_algo_ops;
 577
 578         return 0;
 579 }
 580
 581 int batadv_algo_seq_print_text(struct seq_file *seq, void *offset)
 582 {
 583         struct batadv_algo_ops *bat_algo_ops;
 584
 585         seq_puts(seq, "Available routing algorithms:\n");
 586
 587         hlist_for_each_entry(bat_algo_ops, &batadv_algo_list, list) {
 588                 seq_printf(seq, " * %s\n", bat_algo_ops->name);
 589         }
 590
 591         return 0;
 592 }
 593
 594 /**
 595  * batadv_skb_crc32 - calculate CRC32 of the whole packet and skip bytes in
 596  *  the header
 597  * @skb: skb pointing to fragmented socket buffers
 598  * @payload_ptr: Pointer to position inside the head buffer of the skb
 599  *  marking the start of the data to be CRC'ed
 600  *
 601  * payload_ptr must always point to an address in the skb head buffer and not to
 602  * a fragment.
 603  *
 604  * Return: big endian crc32c of the checksummed data
 605  */
 606 __be32 batadv_skb_crc32(struct sk_buff *skb, u8 *payload_ptr)
 607 {
 608         u32 crc = 0;
 609         unsigned int from;
 610         unsigned int to = skb->len;
 611         struct skb_seq_state st;
 612         const u8 *data;
 613         unsigned int len;
 614         unsigned int consumed = 0;
 615
 616         from = (unsigned int)(payload_ptr - skb->data);
 617
 618         skb_prepare_seq_read(skb, from, to, &st);
 619         while ((len = skb_seq_read(consumed, &data, &st)) != 0) {
 620                 crc = crc32c(crc, data, len);
 621                 consumed += len;
 622         }
 623
 624         return htonl(crc);
 625 }
 626
 627 /**
 628  * batadv_tvlv_handler_release - release tvlv handler from lists and queue for
 629  *  free after rcu grace period
 630  * @ref: kref pointer of the tvlv
 631  */
 632 static void batadv_tvlv_handler_release(struct kref *ref)
 633 {
 634         struct batadv_tvlv_handler *tvlv_handler;
 635
 636         tvlv_handler = container_of(ref, struct batadv_tvlv_handler, refcount);
 637         kfree_rcu(tvlv_handler, rcu);
 638 }
 639
 640 /**
 641  * batadv_tvlv_handler_free_ref - decrement the tvlv container refcounter and
 642  *  possibly release it
 643  * @tvlv_handler: the tvlv handler to free
 644  */
 645 static void
 646 batadv_tvlv_handler_free_ref(struct batadv_tvlv_handler *tvlv_handler)
 647 {
 648         kref_put(&tvlv_handler->refcount, batadv_tvlv_handler_release);
 649 }
 650
 651 /**
 652  * batadv_tvlv_handler_get - retrieve tvlv handler from the tvlv handler list
 653  *  based on the provided type and version (both need to match)
 654  * @bat_priv: the bat priv with all the soft interface information
 655  * @type: tvlv handler type to look for
 656  * @version: tvlv handler version to look for
 657  *
 658  * Return: tvlv handler if found or NULL otherwise.
 659  */
 660 static struct batadv_tvlv_handler
 661 *batadv_tvlv_handler_get(struct batadv_priv *bat_priv, u8 type, u8 version)
 662 {
 663         struct batadv_tvlv_handler *tvlv_handler_tmp, *tvlv_handler = NULL;
 664
 665         rcu_read_lock();
 666         hlist_for_each_entry_rcu(tvlv_handler_tmp,
 667                                  &bat_priv->tvlv.handler_list, list) {
 668                 if (tvlv_handler_tmp->type != type)
 669                         continue;
 670
 671                 if (tvlv_handler_tmp->version != version)
 672                         continue;
 673
 674                 if (!kref_get_unless_zero(&tvlv_handler_tmp->refcount))
 675                         continue;
 676
 677                 tvlv_handler = tvlv_handler_tmp;
 678                 break;
 679         }
 680         rcu_read_unlock();
 681
 682         return tvlv_handler;
 683 }
 684
 685 /**
 686  * batadv_tvlv_container_release - release tvlv from lists and free
 687  * @ref: kref pointer of the tvlv
 688  */
 689 static void batadv_tvlv_container_release(struct kref *ref)
 690 {
 691         struct batadv_tvlv_container *tvlv;
 692
 693         tvlv = container_of(ref, struct batadv_tvlv_container, refcount);
 694         kfree(tvlv);
 695 }
 696
 697 /**
 698  * batadv_tvlv_container_free_ref - decrement the tvlv container refcounter and
 699  *  possibly release it
 700  * @tvlv: the tvlv container to free
 701  */
 702 static void batadv_tvlv_container_free_ref(struct batadv_tvlv_container *tvlv)
 703 {
 704         kref_put(&tvlv->refcount, batadv_tvlv_container_release);
 705 }
 706
 707 /**
 708  * batadv_tvlv_container_get - retrieve tvlv container from the tvlv container
 709  *  list based on the provided type and version (both need to match)
 710  * @bat_priv: the bat priv with all the soft interface information
 711  * @type: tvlv container type to look for
 712  * @version: tvlv container version to look for
 713  *
 714  * Has to be called with the appropriate locks being acquired
 715  * (tvlv.container_list_lock).
 716  *
 717  * Return: tvlv container if found or NULL otherwise.
 718  */
 719 static struct batadv_tvlv_container
 720 *batadv_tvlv_container_get(struct batadv_priv *bat_priv, u8 type, u8 version)
 721 {
 722         struct batadv_tvlv_container *tvlv_tmp, *tvlv = NULL;
 723
 724         lockdep_assert_held(&bat_priv->tvlv.container_list_lock);
 725
 726         hlist_for_each_entry(tvlv_tmp, &bat_priv->tvlv.container_list, list) {
 727                 if (tvlv_tmp->tvlv_hdr.type != type)
 728                         continue;
 729
 730                 if (tvlv_tmp->tvlv_hdr.version != version)
 731                         continue;
 732
 733                 if (!kref_get_unless_zero(&tvlv_tmp->refcount))
 734                         continue;
 735
 736                 tvlv = tvlv_tmp;
 737                 break;
 738         }
 739
 740         return tvlv;
 741 }
 742
 743 /**
 744  * batadv_tvlv_container_list_size - calculate the size of the tvlv container
 745  *  list entries
 746  * @bat_priv: the bat priv with all the soft interface information
 747  *
 748  * Has to be called with the appropriate locks being acquired
 749  * (tvlv.container_list_lock).
 750  *
 751  * Return: size of all currently registered tvlv containers in bytes.
 752  */
 753 static u16 batadv_tvlv_container_list_size(struct batadv_priv *bat_priv)
 754 {
 755         struct batadv_tvlv_container *tvlv;
 756         u16 tvlv_len = 0;
 757
 758         lockdep_assert_held(&bat_priv->tvlv.container_list_lock);
 759
 760         hlist_for_each_entry(tvlv, &bat_priv->tvlv.container_list, list) {
 761                 tvlv_len += sizeof(struct batadv_tvlv_hdr);
 762                 tvlv_len += ntohs(tvlv->tvlv_hdr.len);
 763         }
 764
 765         return tvlv_len;
 766 }
 767
 768 /**
 769  * batadv_tvlv_container_remove - remove tvlv container from the tvlv container
 770  *  list
 771  * @bat_priv: the bat priv with all the soft interface information
 772  * @tvlv: the to be removed tvlv container
 773  *
 774  * Has to be called with the appropriate locks being acquired
 775  * (tvlv.container_list_lock).
 776  */
 777 static void batadv_tvlv_container_remove(struct batadv_priv *bat_priv,
 778                                          struct batadv_tvlv_container *tvlv)
 779 {
 780         lockdep_assert_held(&bat_priv->tvlv.container_list_lock);
 781
 782         if (!tvlv)
 783                 return;
 784
 785         hlist_del(&tvlv->list);
 786
 787         /* first call to decrement the counter, second call to free */
 788         batadv_tvlv_container_free_ref(tvlv);
 789         batadv_tvlv_container_free_ref(tvlv);
 790 }
 791
 792 /**
 793  * batadv_tvlv_container_unregister - unregister tvlv container based on the
 794  *  provided type and version (both need to match)
 795  * @bat_priv: the bat priv with all the soft interface information
 796  * @type: tvlv container type to unregister
 797  * @version: tvlv container type to unregister
 798  */
 799 void batadv_tvlv_container_unregister(struct batadv_priv *bat_priv,
 800                                       u8 type, u8 version)
 801 {
 802         struct batadv_tvlv_container *tvlv;
 803
 804         spin_lock_bh(&bat_priv->tvlv.container_list_lock);
 805         tvlv = batadv_tvlv_container_get(bat_priv, type, version);
 806         batadv_tvlv_container_remove(bat_priv, tvlv);
 807         spin_unlock_bh(&bat_priv->tvlv.container_list_lock);
 808 }
 809
 810 /**
 811  * batadv_tvlv_container_register - register tvlv type, version and content
 812  *  to be propagated with each (primary interface) OGM
 813  * @bat_priv: the bat priv with all the soft interface information
 814  * @type: tvlv container type
 815  * @version: tvlv container version
 816  * @tvlv_value: tvlv container content
 817  * @tvlv_value_len: tvlv container content length
 818  *
 819  * If a container of the same type and version was already registered the new
 820  * content is going to replace the old one.
 821  */
 822 void batadv_tvlv_container_register(struct batadv_priv *bat_priv,
 823                                     u8 type, u8 version,
 824                                     void *tvlv_value, u16 tvlv_value_len)
 825 {
 826         struct batadv_tvlv_container *tvlv_old, *tvlv_new;
 827
 828         if (!tvlv_value)
 829                 tvlv_value_len = 0;
 830
 831         tvlv_new = kzalloc(sizeof(*tvlv_new) + tvlv_value_len, GFP_ATOMIC);
 832         if (!tvlv_new)
 833                 return;
 834
 835         tvlv_new->tvlv_hdr.version = version;
 836         tvlv_new->tvlv_hdr.type = type;
 837         tvlv_new->tvlv_hdr.len = htons(tvlv_value_len);
 838
 839         memcpy(tvlv_new + 1, tvlv_value, ntohs(tvlv_new->tvlv_hdr.len));
 840         INIT_HLIST_NODE(&tvlv_new->list);
 841         kref_init(&tvlv_new->refcount);
 842
 843         spin_lock_bh(&bat_priv->tvlv.container_list_lock);
 844         tvlv_old = batadv_tvlv_container_get(bat_priv, type, version);
 845         batadv_tvlv_container_remove(bat_priv, tvlv_old);
 846         hlist_add_head(&tvlv_new->list, &bat_priv->tvlv.container_list);
 847         spin_unlock_bh(&bat_priv->tvlv.container_list_lock);
 848 }
 849
 850 /**
 851  * batadv_tvlv_realloc_packet_buff - reallocate packet buffer to accommodate
 852  *  requested packet size
 853  * @packet_buff: packet buffer
 854  * @packet_buff_len: packet buffer size
 855  * @min_packet_len: requested packet minimum size
 856  * @additional_packet_len: requested additional packet size on top of minimum
 857  *  size
 858  *
 859  * Return: true of the packet buffer could be changed to the requested size,
 860  * false otherwise.
 861  */
 862 static bool batadv_tvlv_realloc_packet_buff(unsigned char **packet_buff,
 863                                             int *packet_buff_len,
 864                                             int min_packet_len,
 865                                             int additional_packet_len)
 866 {
 867         unsigned char *new_buff;
 868
 869         new_buff = kmalloc(min_packet_len + additional_packet_len, GFP_ATOMIC);
 870
 871         /* keep old buffer if kmalloc should fail */
 872         if (!new_buff)
 873                 return false;
 874
 875         memcpy(new_buff, *packet_buff, min_packet_len);
 876         kfree(*packet_buff);
 877         *packet_buff = new_buff;
 878         *packet_buff_len = min_packet_len + additional_packet_len;
 879
 880         return true;
 881 }
 882
 883 /**
 884  * batadv_tvlv_container_ogm_append - append tvlv container content to given
 885  *  OGM packet buffer
 886  * @bat_priv: the bat priv with all the soft interface information
 887  * @packet_buff: ogm packet buffer
 888  * @packet_buff_len: ogm packet buffer size including ogm header and tvlv
 889  *  content
 890  * @packet_min_len: ogm header size to be preserved for the OGM itself
 891  *
 892  * The ogm packet might be enlarged or shrunk depending on the current size
 893  * and the size of the to-be-appended tvlv containers.
 894  *
 895  * Return: size of all appended tvlv containers in bytes.
 896  */
 897 u16 batadv_tvlv_container_ogm_append(struct batadv_priv *bat_priv,
 898                                      unsigned char **packet_buff,
 899                                      int *packet_buff_len, int packet_min_len)
 900 {
 901         struct batadv_tvlv_container *tvlv;
 902         struct batadv_tvlv_hdr *tvlv_hdr;
 903         u16 tvlv_value_len;
 904         void *tvlv_value;
 905         bool ret;
 906
 907         spin_lock_bh(&bat_priv->tvlv.container_list_lock);
 908         tvlv_value_len = batadv_tvlv_container_list_size(bat_priv);
 909
 910         ret = batadv_tvlv_realloc_packet_buff(packet_buff, packet_buff_len,
 911                                               packet_min_len, tvlv_value_len);
 912
 913         if (!ret)
 914                 goto end;
 915
 916         if (!tvlv_value_len)
 917                 goto end;
 918
 919         tvlv_value = (*packet_buff) + packet_min_len;
 920
 921         hlist_for_each_entry(tvlv, &bat_priv->tvlv.container_list, list) {
 922                 tvlv_hdr = tvlv_value;
 923                 tvlv_hdr->type = tvlv->tvlv_hdr.type;
 924                 tvlv_hdr->version = tvlv->tvlv_hdr.version;
 925                 tvlv_hdr->len = tvlv->tvlv_hdr.len;
 926                 tvlv_value = tvlv_hdr + 1;
 927                 memcpy(tvlv_value, tvlv + 1, ntohs(tvlv->tvlv_hdr.len));
 928                 tvlv_value = (u8 *)tvlv_value + ntohs(tvlv->tvlv_hdr.len);
 929         }
 930
 931 end:
 932         spin_unlock_bh(&bat_priv->tvlv.container_list_lock);
 933         return tvlv_value_len;
 934 }
 935
 936 /**
 937  * batadv_tvlv_call_handler - parse the given tvlv buffer to call the
 938  *  appropriate handlers
 939  * @bat_priv: the bat priv with all the soft interface information
 940  * @tvlv_handler: tvlv callback function handling the tvlv content
 941  * @ogm_source: flag indicating whether the tvlv is an ogm or a unicast packet
 942  * @orig_node: orig node emitting the ogm packet
 943  * @src: source mac address of the unicast packet
 944  * @dst: destination mac address of the unicast packet
 945  * @tvlv_value: tvlv content
 946  * @tvlv_value_len: tvlv content length
 947  *
 948  * Return: success if handler was not found or the return value of the handler
 949  * callback.
 950  */
 951 static int batadv_tvlv_call_handler(struct batadv_priv *bat_priv,
 952                                     struct batadv_tvlv_handler *tvlv_handler,
 953                                     bool ogm_source,
 954                                     struct batadv_orig_node *orig_node,
 955                                     u8 *src, u8 *dst,
 956                                     void *tvlv_value, u16 tvlv_value_len)
 957 {
 958         if (!tvlv_handler)
 959                 return NET_RX_SUCCESS;
 960
 961         if (ogm_source) {
 962                 if (!tvlv_handler->ogm_handler)
 963                         return NET_RX_SUCCESS;
 964
 965                 if (!orig_node)
 966                         return NET_RX_SUCCESS;
 967
 968                 tvlv_handler->ogm_handler(bat_priv, orig_node,
 969                                           BATADV_NO_FLAGS,
 970                                           tvlv_value, tvlv_value_len);
 971                 tvlv_handler->flags |= BATADV_TVLV_HANDLER_OGM_CALLED;
 972         } else {
 973                 if (!src)
 974                         return NET_RX_SUCCESS;
 975
 976                 if (!dst)
 977                         return NET_RX_SUCCESS;
 978
 979                 if (!tvlv_handler->unicast_handler)
 980                         return NET_RX_SUCCESS;
 981
 982                 return tvlv_handler->unicast_handler(bat_priv, src,
 983                                                      dst, tvlv_value,
 984                                                      tvlv_value_len);
 985         }
 986
 987         return NET_RX_SUCCESS;
 988 }
 989
 990 /**
 991  * batadv_tvlv_containers_process - parse the given tvlv buffer to call the
 992  *  appropriate handlers
 993  * @bat_priv: the bat priv with all the soft interface information
 994  * @ogm_source: flag indicating whether the tvlv is an ogm or a unicast packet
 995  * @orig_node: orig node emitting the ogm packet
 996  * @src: source mac address of the unicast packet
 997  * @dst: destination mac address of the unicast packet
 998  * @tvlv_value: tvlv content
 999  * @tvlv_value_len: tvlv content length
1000  *
1001  * Return: success when processing an OGM or the return value of all called
1002  * handler callbacks.
1003  */
1004 int batadv_tvlv_containers_process(struct batadv_priv *bat_priv,
1005                                    bool ogm_source,
1006                                    struct batadv_orig_node *orig_node,
1007                                    u8 *src, u8 *dst,
1008                                    void *tvlv_value, u16 tvlv_value_len)
1009 {
1010         struct batadv_tvlv_handler *tvlv_handler;
1011         struct batadv_tvlv_hdr *tvlv_hdr;
1012         u16 tvlv_value_cont_len;
1013         u8 cifnotfound = BATADV_TVLV_HANDLER_OGM_CIFNOTFND;
1014         int ret = NET_RX_SUCCESS;
1015
1016         while (tvlv_value_len >= sizeof(*tvlv_hdr)) {
1017                 tvlv_hdr = tvlv_value;
1018                 tvlv_value_cont_len = ntohs(tvlv_hdr->len);
1019                 tvlv_value = tvlv_hdr + 1;
1020                 tvlv_value_len -= sizeof(*tvlv_hdr);
1021
1022                 if (tvlv_value_cont_len > tvlv_value_len)
1023                         break;
1024
1025                 tvlv_handler = batadv_tvlv_handler_get(bat_priv,
1026                                                        tvlv_hdr->type,
1027                                                        tvlv_hdr->version);
1028
1029                 ret |= batadv_tvlv_call_handler(bat_priv, tvlv_handler,
1030                                                 ogm_source, orig_node,
1031                                                 src, dst, tvlv_value,
1032                                                 tvlv_value_cont_len);
1033                 if (tvlv_handler)
1034                         batadv_tvlv_handler_free_ref(tvlv_handler);
1035                 tvlv_value = (u8 *)tvlv_value + tvlv_value_cont_len;
1036                 tvlv_value_len -= tvlv_value_cont_len;
1037         }
1038
1039         if (!ogm_source)
1040                 return ret;
1041
1042         rcu_read_lock();
1043         hlist_for_each_entry_rcu(tvlv_handler,
1044                                  &bat_priv->tvlv.handler_list, list) {
1045                 if ((tvlv_handler->flags & BATADV_TVLV_HANDLER_OGM_CIFNOTFND) &&
1046                     !(tvlv_handler->flags & BATADV_TVLV_HANDLER_OGM_CALLED))
1047                         tvlv_handler->ogm_handler(bat_priv, orig_node,
1048                                                   cifnotfound, NULL, 0);
1049
1050                 tvlv_handler->flags &= ~BATADV_TVLV_HANDLER_OGM_CALLED;
1051         }
1052         rcu_read_unlock();
1053
1054         return NET_RX_SUCCESS;
1055 }
1056
1057 /**
1058  * batadv_tvlv_ogm_receive - process an incoming ogm and call the appropriate
1059  *  handlers
1060  * @bat_priv: the bat priv with all the soft interface information
1061  * @batadv_ogm_packet: ogm packet containing the tvlv containers
1062  * @orig_node: orig node emitting the ogm packet
1063  */
1064 void batadv_tvlv_ogm_receive(struct batadv_priv *bat_priv,
1065                              struct batadv_ogm_packet *batadv_ogm_packet,
1066                              struct batadv_orig_node *orig_node)
1067 {
1068         void *tvlv_value;
1069         u16 tvlv_value_len;
1070
1071         if (!batadv_ogm_packet)
1072                 return;
1073
1074         tvlv_value_len = ntohs(batadv_ogm_packet->tvlv_len);
1075         if (!tvlv_value_len)
1076                 return;
1077
1078         tvlv_value = batadv_ogm_packet + 1;
1079
1080         batadv_tvlv_containers_process(bat_priv, true, orig_node, NULL, NULL,
1081                                        tvlv_value, tvlv_value_len);
1082 }
1083
1084 /**
1085  * batadv_tvlv_handler_register - register tvlv handler based on the provided
1086  *  type and version (both need to match) for ogm tvlv payload and/or unicast
1087  *  payload
1088  * @bat_priv: the bat priv with all the soft interface information
1089  * @optr: ogm tvlv handler callback function. This function receives the orig
1090  *  node, flags and the tvlv content as argument to process.
1091  * @uptr: unicast tvlv handler callback function. This function receives the
1092  *  source & destination of the unicast packet as well as the tvlv content
1093  *  to process.
1094  * @type: tvlv handler type to be registered
1095  * @version: tvlv handler version to be registered
1096  * @flags: flags to enable or disable TVLV API behavior
1097  */
1098 void batadv_tvlv_handler_register(struct batadv_priv *bat_priv,
1099                                   void (*optr)(struct batadv_priv *bat_priv,
1100                                                struct batadv_orig_node *orig,
1101                                                u8 flags,
1102                                                void *tvlv_value,
1103                                                u16 tvlv_value_len),
1104                                   int (*uptr)(struct batadv_priv *bat_priv,
1105                                               u8 *src, u8 *dst,
1106                                               void *tvlv_value,
1107                                               u16 tvlv_value_len),
1108                                   u8 type, u8 version, u8 flags)
1109 {
1110         struct batadv_tvlv_handler *tvlv_handler;
1111
1112         tvlv_handler = batadv_tvlv_handler_get(bat_priv, type, version);
1113         if (tvlv_handler) {
1114                 batadv_tvlv_handler_free_ref(tvlv_handler);
1115                 return;
1116         }
1117
1118         tvlv_handler = kzalloc(sizeof(*tvlv_handler), GFP_ATOMIC);
1119         if (!tvlv_handler)
1120                 return;
1121
1122         tvlv_handler->ogm_handler = optr;
1123         tvlv_handler->unicast_handler = uptr;
1124         tvlv_handler->type = type;
1125         tvlv_handler->version = version;
1126         tvlv_handler->flags = flags;
1127         kref_init(&tvlv_handler->refcount);
1128         INIT_HLIST_NODE(&tvlv_handler->list);
1129
1130         spin_lock_bh(&bat_priv->tvlv.handler_list_lock);
1131         hlist_add_head_rcu(&tvlv_handler->list, &bat_priv->tvlv.handler_list);
1132         spin_unlock_bh(&bat_priv->tvlv.handler_list_lock);
1133 }
1134
1135 /**
1136  * batadv_tvlv_handler_unregister - unregister tvlv handler based on the
1137  *  provided type and version (both need to match)
1138  * @bat_priv: the bat priv with all the soft interface information
1139  * @type: tvlv handler type to be unregistered
1140  * @version: tvlv handler version to be unregistered
1141  */
1142 void batadv_tvlv_handler_unregister(struct batadv_priv *bat_priv,
1143                                     u8 type, u8 version)
1144 {
1145         struct batadv_tvlv_handler *tvlv_handler;
1146
1147         tvlv_handler = batadv_tvlv_handler_get(bat_priv, type, version);
1148         if (!tvlv_handler)
1149                 return;
1150
1151         batadv_tvlv_handler_free_ref(tvlv_handler);
1152         spin_lock_bh(&bat_priv->tvlv.handler_list_lock);
1153         hlist_del_rcu(&tvlv_handler->list);
1154         spin_unlock_bh(&bat_priv->tvlv.handler_list_lock);
1155         batadv_tvlv_handler_free_ref(tvlv_handler);
1156 }
1157
1158 /**
1159  * batadv_tvlv_unicast_send - send a unicast packet with tvlv payload to the
1160  *  specified host
1161  * @bat_priv: the bat priv with all the soft interface information
1162  * @src: source mac address of the unicast packet
1163  * @dst: destination mac address of the unicast packet
1164  * @type: tvlv type
1165  * @version: tvlv version
1166  * @tvlv_value: tvlv content
1167  * @tvlv_value_len: tvlv content length
1168  */
1169 void batadv_tvlv_unicast_send(struct batadv_priv *bat_priv, u8 *src,
1170                               u8 *dst, u8 type, u8 version,
1171                               void *tvlv_value, u16 tvlv_value_len)
1172 {
1173         struct batadv_unicast_tvlv_packet *unicast_tvlv_packet;
1174         struct batadv_tvlv_hdr *tvlv_hdr;
1175         struct batadv_orig_node *orig_node;
1176         struct sk_buff *skb;
1177         unsigned char *tvlv_buff;
1178         unsigned int tvlv_len;
1179         ssize_t hdr_len = sizeof(*unicast_tvlv_packet);
1180
1181         orig_node = batadv_orig_hash_find(bat_priv, dst);
1182         if (!orig_node)
1183                 return;
1184
1185         tvlv_len = sizeof(*tvlv_hdr) + tvlv_value_len;
1186
1187         skb = netdev_alloc_skb_ip_align(NULL, ETH_HLEN + hdr_len + tvlv_len);
1188         if (!skb)
1189                 goto out;
1190
1191         skb->priority = TC_PRIO_CONTROL;
1192         skb_reserve(skb, ETH_HLEN);
1193         tvlv_buff = skb_put(skb, sizeof(*unicast_tvlv_packet) + tvlv_len);
1194         unicast_tvlv_packet = (struct batadv_unicast_tvlv_packet *)tvlv_buff;
1195         unicast_tvlv_packet->packet_type = BATADV_UNICAST_TVLV;
1196         unicast_tvlv_packet->version = BATADV_COMPAT_VERSION;
1197         unicast_tvlv_packet->ttl = BATADV_TTL;
1198         unicast_tvlv_packet->reserved = 0;
1199         unicast_tvlv_packet->tvlv_len = htons(tvlv_len);
1200         unicast_tvlv_packet->align = 0;
1201         ether_addr_copy(unicast_tvlv_packet->src, src);
1202         ether_addr_copy(unicast_tvlv_packet->dst, dst);
1203
1204         tvlv_buff = (unsigned char *)(unicast_tvlv_packet + 1);
1205         tvlv_hdr = (struct batadv_tvlv_hdr *)tvlv_buff;
1206         tvlv_hdr->version = version;
1207         tvlv_hdr->type = type;
1208         tvlv_hdr->len = htons(tvlv_value_len);
1209         tvlv_buff += sizeof(*tvlv_hdr);
1210         memcpy(tvlv_buff, tvlv_value, tvlv_value_len);
1211
1212         if (batadv_send_skb_to_orig(skb, orig_node, NULL) == NET_XMIT_DROP)
1213                 kfree_skb(skb);
1214 out:
1215         batadv_orig_node_free_ref(orig_node);
1216 }
1217
1218 /**
1219  * batadv_get_vid - extract the VLAN identifier from skb if any
1220  * @skb: the buffer containing the packet
1221  * @header_len: length of the batman header preceding the ethernet header
1222  *
1223  * Return: VID with the BATADV_VLAN_HAS_TAG flag when the packet embedded in the
1224  * skb is vlan tagged. Otherwise BATADV_NO_FLAGS.
1225  */
1226 unsigned short batadv_get_vid(struct sk_buff *skb, size_t header_len)
1227 {
1228         struct ethhdr *ethhdr = (struct ethhdr *)(skb->data + header_len);
1229         struct vlan_ethhdr *vhdr;
1230         unsigned short vid;
1231
1232         if (ethhdr->h_proto != htons(ETH_P_8021Q))
1233                 return BATADV_NO_FLAGS;
1234
1235         if (!pskb_may_pull(skb, header_len + VLAN_ETH_HLEN))
1236                 return BATADV_NO_FLAGS;
1237
1238         vhdr = (struct vlan_ethhdr *)(skb->data + header_len);
1239         vid = ntohs(vhdr->h_vlan_TCI) & VLAN_VID_MASK;
1240         vid |= BATADV_VLAN_HAS_TAG;
1241
1242         return vid;
1243 }
1244
1245 /**
1246  * batadv_vlan_ap_isola_get - return the AP isolation status for the given vlan
1247  * @bat_priv: the bat priv with all the soft interface information
1248  * @vid: the VLAN identifier for which the AP isolation attributed as to be
1249  *  looked up
1250  *
1251  * Return: true if AP isolation is on for the VLAN idenfied by vid, false
1252  * otherwise
1253  */
1254 bool batadv_vlan_ap_isola_get(struct batadv_priv *bat_priv, unsigned short vid)
1255 {
1256         bool ap_isolation_enabled = false;
1257         struct batadv_softif_vlan *vlan;
1258
1259         /* if the AP isolation is requested on a VLAN, then check for its
1260          * setting in the proper VLAN private data structure
1261          */
1262         vlan = batadv_softif_vlan_get(bat_priv, vid);
1263         if (vlan) {
1264                 ap_isolation_enabled = atomic_read(&vlan->ap_isolation);
1265                 batadv_softif_vlan_free_ref(vlan);
1266         }
1267
1268         return ap_isolation_enabled;
1269 }
1270
1271 static int batadv_param_set_ra(const char *val, const struct kernel_param *kp)
1272 {
1273         struct batadv_algo_ops *bat_algo_ops;
1274         char *algo_name = (char *)val;
1275         size_t name_len = strlen(algo_name);
1276
1277         if (name_len > 0 && algo_name[name_len - 1] == '\n')
1278                 algo_name[name_len - 1] = '\0';
1279
1280         bat_algo_ops = batadv_algo_get(algo_name);
1281         if (!bat_algo_ops) {
1282                 pr_err("Routing algorithm '%s' is not supported\n", algo_name);
1283                 return -EINVAL;
1284         }
1285
1286         return param_set_copystring(algo_name, kp);
1287 }
1288
1289 static const struct kernel_param_ops batadv_param_ops_ra = {
1290         .set = batadv_param_set_ra,
1291         .get = param_get_string,
1292 };
1293
1294 static struct kparam_string batadv_param_string_ra = {
1295         .maxlen = sizeof(batadv_routing_algo),
1296         .string = batadv_routing_algo,
1297 };
1298
1299 module_param_cb(routing_algo, &batadv_param_ops_ra, &batadv_param_string_ra,
1300                 0644);
1301 module_init(batadv_init);
1302 module_exit(batadv_exit);
1303
1304 MODULE_LICENSE("GPL");
1305
1306 MODULE_AUTHOR(BATADV_DRIVER_AUTHOR);
1307 MODULE_DESCRIPTION(BATADV_DRIVER_DESC);
1308 MODULE_SUPPORTED_DEVICE(BATADV_DRIVER_DEVICE);
1309 MODULE_VERSION(BATADV_SOURCE_VERSION);