1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright (C) 2007-2020  B.A.T.M.A.N. contributors:
7 #include "soft-interface.h"
47 #include "distributed-arp-table.h"
49 #include "hard-interface.h"
51 #include "network-coding.h"
55 #include "translation-table.h"
58  * batadv_skb_head_push() - Increase header size and move (push) head pointer
68 	/* TODO: We must check if we can release all references to non-payload  in batadv_skb_head_push()
71 	 * or write any data which is before the current position of skb->data  in batadv_skb_head_push()
96  * batadv_sum_counter() - Sum the cpu-local counters for index 'idx'
98  * @idx: index of counter to sum up
100  * Return: sum of all cpu-local counters
108 		counters = per_cpu_ptr(bat_priv->bat_counters, cpu);  in batadv_sum_counter()
118 	struct net_device_stats *stats = &dev->stats;  in batadv_interface_stats()
120 	stats->tx_packets = batadv_sum_counter(bat_priv, BATADV_CNT_TX);  in batadv_interface_stats()
121 	stats->tx_bytes = batadv_sum_counter(bat_priv, BATADV_CNT_TX_BYTES);  in batadv_interface_stats()
122 	stats->tx_dropped = batadv_sum_counter(bat_priv, BATADV_CNT_TX_DROPPED);  in batadv_interface_stats()
123 	stats->rx_packets = batadv_sum_counter(bat_priv, BATADV_CNT_RX);  in batadv_interface_stats()
124 	stats->rx_bytes = batadv_sum_counter(bat_priv, BATADV_CNT_RX_BYTES);  in batadv_interface_stats()
135 	if (!is_valid_ether_addr(addr->sa_data))  in batadv_interface_set_mac_addr()
136 		return -EADDRNOTAVAIL;  in batadv_interface_set_mac_addr()
138 	ether_addr_copy(old_addr, dev->dev_addr);  in batadv_interface_set_mac_addr()
139 	ether_addr_copy(dev->dev_addr, addr->sa_data);  in batadv_interface_set_mac_addr()
142 	if (atomic_read(&bat_priv->mesh_state) != BATADV_MESH_ACTIVE)  in batadv_interface_set_mac_addr()
146 	hlist_for_each_entry_rcu(vlan, &bat_priv->softif_vlan_list, list) {  in batadv_interface_set_mac_addr()
147 		batadv_tt_local_remove(bat_priv, old_addr, vlan->vid,  in batadv_interface_set_mac_addr()
149 		batadv_tt_local_add(dev, addr->sa_data, vlan->vid,  in batadv_interface_set_mac_addr()
161 		return -EINVAL;  in batadv_interface_change_mtu()
163 	dev->mtu = new_mtu;  in batadv_interface_change_mtu()
169  * batadv_interface_set_rx_mode() - set the rx mode of a device
195 	int data_len = skb->len, ret;  in batadv_interface_tx()
206 	if (atomic_read(&bat_priv->mesh_state) != BATADV_MESH_ACTIVE)  in batadv_interface_tx()
210 	memset(skb->cb, 0, sizeof(struct batadv_skb_cb));  in batadv_interface_tx()
218 	proto = ethhdr->h_proto;  in batadv_interface_tx()
225 		proto = vhdr->h_vlan_encapsulated_proto;  in batadv_interface_tx()
227 		/* drop batman-in-batman packets to prevent loops */  in batadv_interface_tx()
243 	/* skb->data might have been reallocated by batadv_bla_tx() */  in batadv_interface_tx()
247 	if (!is_multicast_ether_addr(ethhdr->h_source) &&  in batadv_interface_tx()
248 	    !batadv_bla_is_loopdetect_mac(ethhdr->h_source)) {  in batadv_interface_tx()
249 		client_added = batadv_tt_local_add(soft_iface, ethhdr->h_source,  in batadv_interface_tx()
250 						   vid, skb->skb_iif,  in batadv_interface_tx()
251 						   skb->mark);  in batadv_interface_tx()
265 	if (batadv_compare_eth(ethhdr->h_dest, stp_addr))  in batadv_interface_tx()
268 	if (batadv_compare_eth(ethhdr->h_dest, ectp_addr))  in batadv_interface_tx()
271 	gw_mode = atomic_read(&bat_priv->gw.mode);  in batadv_interface_tx()
272 	if (is_multicast_ether_addr(ethhdr->h_dest)) {  in batadv_interface_tx()
281 		/* skb->data may have been modified by  in batadv_interface_tx()
285 		/* if gw_mode is on, broadcast any non-DHCP message.  in batadv_interface_tx()
303 		if (do_bcast && !is_broadcast_ether_addr(ethhdr->h_dest)) {  in batadv_interface_tx()
333 		bcast_packet = (struct batadv_bcast_packet *)skb->data;  in batadv_interface_tx()
334 		bcast_packet->version = BATADV_COMPAT_VERSION;  in batadv_interface_tx()
335 		bcast_packet->ttl = BATADV_TTL;  in batadv_interface_tx()
338 		bcast_packet->packet_type = BATADV_BCAST;  in batadv_interface_tx()
339 		bcast_packet->reserved = 0;  in batadv_interface_tx()
344 		ether_addr_copy(bcast_packet->orig,  in batadv_interface_tx()
345 				primary_if->net_dev->dev_addr);  in batadv_interface_tx()
348 		seqno = atomic_inc_return(&bat_priv->bcast_seqno);  in batadv_interface_tx()
349 		bcast_packet->seqno = htonl(seqno);  in batadv_interface_tx()
402  * batadv_interface_rx() - receive ethernet frame on local batman-adv interface
405  * @hdr_size: size of already parsed batman-adv header
406  * @orig_node: originator from which the batman-adv packet was sent
409  * skb->data has still point to the batman-adv header with the size @hdr_size.
411  * @hdr_size bytes are still available for pull in @skb.
414  * ethernet frame is invalid or contains again an batman-adv packet. Also
429 	batadv_bcast_packet = (struct batadv_bcast_packet *)skb->data;  in batadv_interface_rx()
430 	packet_type = batadv_bcast_packet->packet_type;  in batadv_interface_rx()
435 	/* clean the netfilter state now that the batman-adv header has been  in batadv_interface_rx()
446 	switch (ntohs(ethhdr->h_proto)) {  in batadv_interface_rx()
451 		vhdr = (struct vlan_ethhdr *)skb->data;  in batadv_interface_rx()
453 		/* drop batman-in-batman packets to prevent loops */  in batadv_interface_rx()
454 		if (vhdr->h_vlan_encapsulated_proto != htons(ETH_P_BATMAN))  in batadv_interface_rx()
462 	/* skb->dev & skb->pkt_type are set here */  in batadv_interface_rx()
463 	skb->protocol = eth_type_trans(skb, soft_iface);  in batadv_interface_rx()
468 			   skb->len + ETH_HLEN);  in batadv_interface_rx()
471 	 * not handle it, we can safely push it up.  in batadv_interface_rx()
478 						     ethhdr->h_source, vid);  in batadv_interface_rx()
480 	if (is_multicast_ether_addr(ethhdr->h_dest)) {  in batadv_interface_rx()
485 		    batadv_tt_global_is_isolated(bat_priv, ethhdr->h_source,  in batadv_interface_rx()
487 			/* save bits in skb->mark not covered by the mask and  in batadv_interface_rx()
490 			skb->mark &= ~bat_priv->isolation_mark_mask;  in batadv_interface_rx()
491 			skb->mark |= bat_priv->isolation_mark;  in batadv_interface_rx()
493 	} else if (batadv_is_ap_isolated(bat_priv, ethhdr->h_source,  in batadv_interface_rx()
494 					 ethhdr->h_dest, vid)) {  in batadv_interface_rx()
508  * batadv_softif_vlan_release() - release vlan from lists and queue for free
518 	spin_lock_bh(&vlan->bat_priv->softif_vlan_list_lock);  in batadv_softif_vlan_release()
519 	hlist_del_rcu(&vlan->list);  in batadv_softif_vlan_release()
520 	spin_unlock_bh(&vlan->bat_priv->softif_vlan_list_lock);  in batadv_softif_vlan_release()
526  * batadv_softif_vlan_put() - decrease the vlan object refcounter and
535 	kref_put(&vlan->refcount, batadv_softif_vlan_release);  in batadv_softif_vlan_put()
539  * batadv_softif_vlan_get() - get the vlan object for a specific vid
552 	hlist_for_each_entry_rcu(vlan_tmp, &bat_priv->softif_vlan_list, list) {  in batadv_softif_vlan_get()
553 		if (vlan_tmp->vid != vid)  in batadv_softif_vlan_get()
556 		if (!kref_get_unless_zero(&vlan_tmp->refcount))  in batadv_softif_vlan_get()
568  * batadv_softif_create_vlan() - allocate the needed resources for a new vlan
579 	spin_lock_bh(&bat_priv->softif_vlan_list_lock);  in batadv_softif_create_vlan()
584 		spin_unlock_bh(&bat_priv->softif_vlan_list_lock);  in batadv_softif_create_vlan()
585 		return -EEXIST;  in batadv_softif_create_vlan()
590 		spin_unlock_bh(&bat_priv->softif_vlan_list_lock);  in batadv_softif_create_vlan()
591 		return -ENOMEM;  in batadv_softif_create_vlan()
594 	vlan->bat_priv = bat_priv;  in batadv_softif_create_vlan()
595 	vlan->vid = vid;  in batadv_softif_create_vlan()
596 	kref_init(&vlan->refcount);  in batadv_softif_create_vlan()
598 	atomic_set(&vlan->ap_isolation, 0);  in batadv_softif_create_vlan()
600 	kref_get(&vlan->refcount);  in batadv_softif_create_vlan()
601 	hlist_add_head_rcu(&vlan->list, &bat_priv->softif_vlan_list);  in batadv_softif_create_vlan()
602 	spin_unlock_bh(&bat_priv->softif_vlan_list_lock);  in batadv_softif_create_vlan()
607 	err = batadv_sysfs_add_vlan(bat_priv->soft_iface, vlan);  in batadv_softif_create_vlan()
620 	batadv_tt_local_add(bat_priv->soft_iface,  in batadv_softif_create_vlan()
621 			    bat_priv->soft_iface->dev_addr, vid,  in batadv_softif_create_vlan()
631  * batadv_softif_destroy_vlan() - remove and destroy a softif_vlan object
641 	batadv_tt_local_remove(bat_priv, bat_priv->soft_iface->dev_addr,  in batadv_softif_destroy_vlan()
642 			       vlan->vid, "vlan interface destroyed", false);  in batadv_softif_destroy_vlan()
649  * batadv_interface_add_vid() - ndo_add_vid API implementation
654  * Set up all the internal structures for handling the new vlan on top of the
667 	 * batman-adv does not know how to handle other types  in batadv_interface_add_vid()
670 		return -EINVAL;  in batadv_interface_add_vid()
687 	if (!vlan->kobj) {  in batadv_interface_add_vid()
688 		ret = batadv_sysfs_add_vlan(bat_priv->soft_iface, vlan);  in batadv_interface_add_vid()
699 	batadv_tt_local_add(bat_priv->soft_iface,  in batadv_interface_add_vid()
700 			    bat_priv->soft_iface->dev_addr, vid,  in batadv_interface_add_vid()
707  * batadv_interface_kill_vid() - ndo_kill_vid API implementation
715  * Return: 0 on success, -EINVAL if the specified prototype is not ETH_P_8021Q
716  * or -ENOENT if the specified vlan id wasn't registered.
724 	/* only 802.1Q vlans are supported. batman-adv does not know how to  in batadv_interface_kill_vid()
728 		return -EINVAL;  in batadv_interface_kill_vid()
732 		return -ENOENT;  in batadv_interface_kill_vid()
742 /* batman-adv network devices have devices nesting below it and are a special
750  * batadv_set_lockdep_class_one() - Set lockdep class for a single tx queue
759 	lockdep_set_class(&txq->_xmit_lock, &batadv_netdev_xmit_lock_key);  in batadv_set_lockdep_class_one()
763  * batadv_set_lockdep_class() - Set txq and addr_list lockdep class
768 	lockdep_set_class(&dev->addr_list_lock, &batadv_netdev_addr_lock_key);  in batadv_set_lockdep_class()
773  * batadv_softif_init_late() - late stage initialization of soft interface
788 	bat_priv->soft_iface = dev;  in batadv_softif_init_late()
793 	bat_priv->bat_counters = __alloc_percpu(cnt_len, __alignof__(u64));  in batadv_softif_init_late()
794 	if (!bat_priv->bat_counters)  in batadv_softif_init_late()
795 		return -ENOMEM;  in batadv_softif_init_late()
797 	atomic_set(&bat_priv->aggregated_ogms, 1);  in batadv_softif_init_late()
798 	atomic_set(&bat_priv->bonding, 0);  in batadv_softif_init_late()
800 	atomic_set(&bat_priv->bridge_loop_avoidance, 1);  in batadv_softif_init_late()
803 	atomic_set(&bat_priv->distributed_arp_table, 1);  in batadv_softif_init_late()
806 	atomic_set(&bat_priv->multicast_mode, 1);  in batadv_softif_init_late()
807 	atomic_set(&bat_priv->multicast_fanout, 16);  in batadv_softif_init_late()
808 	atomic_set(&bat_priv->mcast.num_want_all_unsnoopables, 0);  in batadv_softif_init_late()
809 	atomic_set(&bat_priv->mcast.num_want_all_ipv4, 0);  in batadv_softif_init_late()
810 	atomic_set(&bat_priv->mcast.num_want_all_ipv6, 0);  in batadv_softif_init_late()
812 	atomic_set(&bat_priv->gw.mode, BATADV_GW_MODE_OFF);  in batadv_softif_init_late()
813 	atomic_set(&bat_priv->gw.bandwidth_down, 100);  in batadv_softif_init_late()
814 	atomic_set(&bat_priv->gw.bandwidth_up, 20);  in batadv_softif_init_late()
815 	atomic_set(&bat_priv->orig_interval, 1000);  in batadv_softif_init_late()
816 	atomic_set(&bat_priv->hop_penalty, 30);  in batadv_softif_init_late()
818 	atomic_set(&bat_priv->log_level, 0);  in batadv_softif_init_late()
820 	atomic_set(&bat_priv->fragmentation, 1);  in batadv_softif_init_late()
821 	atomic_set(&bat_priv->packet_size_max, ETH_DATA_LEN);  in batadv_softif_init_late()
822 	atomic_set(&bat_priv->bcast_queue_left, BATADV_BCAST_QUEUE_LEN);  in batadv_softif_init_late()
823 	atomic_set(&bat_priv->batman_queue_left, BATADV_BATMAN_QUEUE_LEN);  in batadv_softif_init_late()
825 	atomic_set(&bat_priv->mesh_state, BATADV_MESH_INACTIVE);  in batadv_softif_init_late()
826 	atomic_set(&bat_priv->bcast_seqno, 1);  in batadv_softif_init_late()
827 	atomic_set(&bat_priv->tt.vn, 0);  in batadv_softif_init_late()
828 	atomic_set(&bat_priv->tt.local_changes, 0);  in batadv_softif_init_late()
829 	atomic_set(&bat_priv->tt.ogm_append_cnt, 0);  in batadv_softif_init_late()
831 	atomic_set(&bat_priv->bla.num_requests, 0);  in batadv_softif_init_late()
833 	atomic_set(&bat_priv->tp_num, 0);  in batadv_softif_init_late()
835 	bat_priv->tt.last_changeset = NULL;  in batadv_softif_init_late()
836 	bat_priv->tt.last_changeset_len = 0;  in batadv_softif_init_late()
837 	bat_priv->isolation_mark = 0;  in batadv_softif_init_late()
838 	bat_priv->isolation_mark_mask = 0;  in batadv_softif_init_late()
842 	atomic_set(&bat_priv->frag_seqno, random_seqno);  in batadv_softif_init_late()
844 	bat_priv->primary_if = NULL;  in batadv_softif_init_late()
865 	free_percpu(bat_priv->bat_counters);  in batadv_softif_init_late()
866 	bat_priv->bat_counters = NULL;  in batadv_softif_init_late()
872  * batadv_softif_slave_add() - Add a slave interface to a batadv_soft_interface
885 	int ret = -EINVAL;  in batadv_softif_slave_add()
888 	if (!hard_iface || hard_iface->soft_iface)  in batadv_softif_slave_add()
891 	ret = batadv_hardif_enable_interface(hard_iface, net, dev->name);  in batadv_softif_slave_add()
900  * batadv_softif_slave_del() - Delete a slave iface from a batadv_soft_interface
910 	int ret = -EINVAL;  in batadv_softif_slave_del()
914 	if (!hard_iface || hard_iface->soft_iface != dev)  in batadv_softif_slave_del()
945 	strscpy(info->driver, "B.A.T.M.A.N. advanced", sizeof(info->driver));  in batadv_get_drvinfo()
946 	strscpy(info->version, BATADV_SOURCE_VERSION, sizeof(info->version));  in batadv_get_drvinfo()
947 	strscpy(info->fw_version, "N/A", sizeof(info->fw_version));  in batadv_get_drvinfo()
948 	strscpy(info->bus_info, "batman", sizeof(info->bus_info));  in batadv_get_drvinfo()
1023 	return -EOPNOTSUPP;  in batadv_get_sset_count()
1035  * batadv_softif_free() - Deconstructor of batadv_soft_interface
1051  * batadv_softif_init_early() - early stage initialization of soft interface
1058 	dev->netdev_ops = &batadv_netdev_ops;  in batadv_softif_init_early()
1059 	dev->needs_free_netdev = true;  in batadv_softif_init_early()
1060 	dev->priv_destructor = batadv_softif_free;  in batadv_softif_init_early()
1061 	dev->features |= NETIF_F_HW_VLAN_CTAG_FILTER | NETIF_F_NETNS_LOCAL;  in batadv_softif_init_early()
1062 	dev->features |= NETIF_F_LLTX;  in batadv_softif_init_early()
1063 	dev->priv_flags |= IFF_NO_QUEUE;  in batadv_softif_init_early()
1068 	dev->mtu = ETH_DATA_LEN;  in batadv_softif_init_early()
1073 	dev->ethtool_ops = &batadv_ethtool_ops;  in batadv_softif_init_early()
1077  * batadv_softif_create() - Create and register soft interface
1095 	soft_iface->rtnl_link_ops = &batadv_link_ops;  in batadv_softif_create()
1109  * batadv_softif_destroy_sysfs() - deletion of batadv_soft_interface via sysfs
1110  * @soft_iface: the to-be-removed batman-adv interface
1131  * batadv_softif_destroy_netlink() - deletion of batadv_soft_interface via
1133  * @soft_iface: the to-be-removed batman-adv interface
1144 		if (hard_iface->soft_iface == soft_iface)  in batadv_softif_destroy_netlink()
1161  * batadv_softif_is_valid() - Check whether device is a batadv soft interface
1164  * Return: true when net_dev is a batman-adv interface, false otherwise
1168 	if (net_dev->netdev_ops->ndo_start_xmit == batadv_interface_tx)  in batadv_softif_is_valid()