Sven Eckelmann | 7db7d9f | 2017-11-19 15:05:11 +0100 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0 |
Sven Eckelmann | cfa55c6 | 2021-01-01 00:00:01 +0100 | [diff] [blame] | 2 | /* Copyright (C) B.A.T.M.A.N. contributors: |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 3 | * |
| 4 | * Marek Lindner, Simon Wunderlich |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 5 | */ |
| 6 | |
| 7 | #include "main.h" |
Sven Eckelmann | 1e2c2a4 | 2015-04-17 19:40:28 +0200 | [diff] [blame] | 8 | |
| 9 | #include <linux/atomic.h> |
Sven Eckelmann | ecc36f5 | 2017-11-19 17:12:03 +0100 | [diff] [blame] | 10 | #include <linux/build_bug.h> |
Sven Eckelmann | 1e2c2a4 | 2015-04-17 19:40:28 +0200 | [diff] [blame] | 11 | #include <linux/byteorder/generic.h> |
| 12 | #include <linux/crc32c.h> |
Sven Eckelmann | 0fa4c30 | 2019-03-03 18:02:57 +0100 | [diff] [blame] | 13 | #include <linux/device.h> |
Sven Eckelmann | 1e2c2a4 | 2015-04-17 19:40:28 +0200 | [diff] [blame] | 14 | #include <linux/errno.h> |
Sven Eckelmann | 2c0c06f | 2016-10-29 13:56:23 +0200 | [diff] [blame] | 15 | #include <linux/genetlink.h> |
Sven Eckelmann | b92b94a | 2017-11-19 17:12:02 +0100 | [diff] [blame] | 16 | #include <linux/gfp.h> |
Sven Eckelmann | 1e2c2a4 | 2015-04-17 19:40:28 +0200 | [diff] [blame] | 17 | #include <linux/if_ether.h> |
| 18 | #include <linux/if_vlan.h> |
| 19 | #include <linux/init.h> |
| 20 | #include <linux/ip.h> |
| 21 | #include <linux/ipv6.h> |
| 22 | #include <linux/kernel.h> |
Sven Eckelmann | 0fa4c30 | 2019-03-03 18:02:57 +0100 | [diff] [blame] | 23 | #include <linux/kobject.h> |
Sven Eckelmann | f7157dd | 2016-01-16 10:29:48 +0100 | [diff] [blame] | 24 | #include <linux/kref.h> |
Sven Eckelmann | 1e2c2a4 | 2015-04-17 19:40:28 +0200 | [diff] [blame] | 25 | #include <linux/list.h> |
Sven Eckelmann | fcd193e | 2020-10-26 21:01:59 +0100 | [diff] [blame] | 26 | #include <linux/minmax.h> |
Sven Eckelmann | 1e2c2a4 | 2015-04-17 19:40:28 +0200 | [diff] [blame] | 27 | #include <linux/module.h> |
Sven Eckelmann | 1e2c2a4 | 2015-04-17 19:40:28 +0200 | [diff] [blame] | 28 | #include <linux/netdevice.h> |
Sven Eckelmann | ba41208 | 2016-05-15 23:48:31 +0200 | [diff] [blame] | 29 | #include <linux/printk.h> |
Sven Eckelmann | 1e2c2a4 | 2015-04-17 19:40:28 +0200 | [diff] [blame] | 30 | #include <linux/rculist.h> |
| 31 | #include <linux/rcupdate.h> |
Sven Eckelmann | 1e2c2a4 | 2015-04-17 19:40:28 +0200 | [diff] [blame] | 32 | #include <linux/skbuff.h> |
Sven Eckelmann | 0fa4c30 | 2019-03-03 18:02:57 +0100 | [diff] [blame] | 33 | #include <linux/slab.h> |
Sven Eckelmann | 1e2c2a4 | 2015-04-17 19:40:28 +0200 | [diff] [blame] | 34 | #include <linux/spinlock.h> |
| 35 | #include <linux/stddef.h> |
| 36 | #include <linux/string.h> |
| 37 | #include <linux/workqueue.h> |
| 38 | #include <net/dsfield.h> |
| 39 | #include <net/rtnetlink.h> |
Sven Eckelmann | fec149f | 2017-12-21 10:17:41 +0100 | [diff] [blame] | 40 | #include <uapi/linux/batadv_packet.h> |
Sven Eckelmann | 2c0c06f | 2016-10-29 13:56:23 +0200 | [diff] [blame] | 41 | #include <uapi/linux/batman_adv.h> |
Sven Eckelmann | 1e2c2a4 | 2015-04-17 19:40:28 +0200 | [diff] [blame] | 42 | |
| 43 | #include "bat_algo.h" |
Sven Eckelmann | a2d0816 | 2016-05-15 11:07:46 +0200 | [diff] [blame] | 44 | #include "bat_iv_ogm.h" |
| 45 | #include "bat_v.h" |
Sven Eckelmann | 1e2c2a4 | 2015-04-17 19:40:28 +0200 | [diff] [blame] | 46 | #include "bridge_loop_avoidance.h" |
Sven Eckelmann | 1e2c2a4 | 2015-04-17 19:40:28 +0200 | [diff] [blame] | 47 | #include "distributed-arp-table.h" |
| 48 | #include "gateway_client.h" |
| 49 | #include "gateway_common.h" |
| 50 | #include "hard-interface.h" |
Sven Eckelmann | ba41208 | 2016-05-15 23:48:31 +0200 | [diff] [blame] | 51 | #include "log.h" |
Sven Eckelmann | 1e2c2a4 | 2015-04-17 19:40:28 +0200 | [diff] [blame] | 52 | #include "multicast.h" |
Matthias Schiffer | 09748a2 | 2016-05-09 18:41:08 +0200 | [diff] [blame] | 53 | #include "netlink.h" |
Sven Eckelmann | 1e2c2a4 | 2015-04-17 19:40:28 +0200 | [diff] [blame] | 54 | #include "network-coding.h" |
| 55 | #include "originator.h" |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 56 | #include "routing.h" |
| 57 | #include "send.h" |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 58 | #include "soft-interface.h" |
Antonio Quartulli | 33a3bb4 | 2016-05-05 13:09:43 +0200 | [diff] [blame] | 59 | #include "tp_meter.h" |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 60 | #include "translation-table.h" |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 61 | |
Sven Eckelmann | c3caf51 | 2011-05-03 11:51:38 +0200 | [diff] [blame] | 62 | /* List manipulations on hardif_list have to be rtnl_lock()'ed, |
Sven Eckelmann | 9cfc7bd | 2012-05-12 02:09:43 +0200 | [diff] [blame] | 63 | * list traversals just rcu-locked |
| 64 | */ |
Sven Eckelmann | 3193e8f | 2012-05-12 02:09:42 +0200 | [diff] [blame] | 65 | struct list_head batadv_hardif_list; |
Sven Eckelmann | fb69be6 | 2018-10-30 22:01:24 +0100 | [diff] [blame] | 66 | unsigned int batadv_hardif_generation; |
Sven Eckelmann | 706cc9f | 2017-09-30 09:24:28 +0200 | [diff] [blame] | 67 | static int (*batadv_rx_handler[256])(struct sk_buff *skb, |
| 68 | struct batadv_hard_iface *recv_if); |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 69 | |
Sven Eckelmann | 3193e8f | 2012-05-12 02:09:42 +0200 | [diff] [blame] | 70 | unsigned char batadv_broadcast_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 71 | |
Sven Eckelmann | 3193e8f | 2012-05-12 02:09:42 +0200 | [diff] [blame] | 72 | struct workqueue_struct *batadv_event_workqueue; |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 73 | |
Sven Eckelmann | ee11ad6 | 2012-05-16 20:23:19 +0200 | [diff] [blame] | 74 | static void batadv_recv_handler_init(void); |
Marek Lindner | ffa995e | 2012-03-01 15:35:17 +0800 | [diff] [blame] | 75 | |
Sven Eckelmann | 0fa4c30 | 2019-03-03 18:02:57 +0100 | [diff] [blame] | 76 | #define BATADV_UEV_TYPE_VAR "BATTYPE=" |
| 77 | #define BATADV_UEV_ACTION_VAR "BATACTION=" |
| 78 | #define BATADV_UEV_DATA_VAR "BATDATA=" |
| 79 | |
| 80 | static char *batadv_uev_action_str[] = { |
| 81 | "add", |
| 82 | "del", |
| 83 | "change", |
| 84 | "loopdetect", |
| 85 | }; |
| 86 | |
| 87 | static char *batadv_uev_type_str[] = { |
| 88 | "gw", |
| 89 | "bla", |
| 90 | }; |
| 91 | |
Sven Eckelmann | ee11ad6 | 2012-05-16 20:23:19 +0200 | [diff] [blame] | 92 | static int __init batadv_init(void) |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 93 | { |
Sven Eckelmann | 86452f8 | 2016-06-25 16:44:06 +0200 | [diff] [blame] | 94 | int ret; |
| 95 | |
| 96 | ret = batadv_tt_cache_init(); |
| 97 | if (ret < 0) |
| 98 | return ret; |
| 99 | |
Sven Eckelmann | 3193e8f | 2012-05-12 02:09:42 +0200 | [diff] [blame] | 100 | INIT_LIST_HEAD(&batadv_hardif_list); |
Sven Eckelmann | 01d350d | 2016-05-15 11:07:44 +0200 | [diff] [blame] | 101 | batadv_algo_init(); |
Marek Lindner | 1c28047 | 2011-11-28 17:40:17 +0800 | [diff] [blame] | 102 | |
Sven Eckelmann | ee11ad6 | 2012-05-16 20:23:19 +0200 | [diff] [blame] | 103 | batadv_recv_handler_init(); |
Marek Lindner | ffa995e | 2012-03-01 15:35:17 +0800 | [diff] [blame] | 104 | |
Linus Luessing | d6f94d9 | 2016-01-16 16:40:09 +0800 | [diff] [blame] | 105 | batadv_v_init(); |
Sven Eckelmann | 81c524f | 2012-05-12 02:09:22 +0200 | [diff] [blame] | 106 | batadv_iv_init(); |
Matthias Schiffer | 6c519ba | 2013-09-27 18:03:39 +0200 | [diff] [blame] | 107 | batadv_nc_init(); |
Antonio Quartulli | 33a3bb4 | 2016-05-05 13:09:43 +0200 | [diff] [blame] | 108 | batadv_tp_meter_init(); |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 109 | |
Sven Eckelmann | 3193e8f | 2012-05-12 02:09:42 +0200 | [diff] [blame] | 110 | batadv_event_workqueue = create_singlethread_workqueue("bat_events"); |
Sven Eckelmann | 3193e8f | 2012-05-12 02:09:42 +0200 | [diff] [blame] | 111 | if (!batadv_event_workqueue) |
Sven Eckelmann | 86452f8 | 2016-06-25 16:44:06 +0200 | [diff] [blame] | 112 | goto err_create_wq; |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 113 | |
Sven Eckelmann | 9563877 | 2012-05-12 02:09:31 +0200 | [diff] [blame] | 114 | register_netdevice_notifier(&batadv_hard_if_notifier); |
Sven Eckelmann | a4ac28c | 2013-02-11 17:10:26 +0800 | [diff] [blame] | 115 | rtnl_link_register(&batadv_link_ops); |
Matthias Schiffer | 09748a2 | 2016-05-09 18:41:08 +0200 | [diff] [blame] | 116 | batadv_netlink_register(); |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 117 | |
Sven Eckelmann | 86ceb36 | 2012-03-07 09:07:45 +0100 | [diff] [blame] | 118 | pr_info("B.A.T.M.A.N. advanced %s (compatibility version %i) loaded\n", |
Sven Eckelmann | 42d0b04 | 2012-06-03 22:19:17 +0200 | [diff] [blame] | 119 | BATADV_SOURCE_VERSION, BATADV_COMPAT_VERSION); |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 120 | |
| 121 | return 0; |
Sven Eckelmann | 86452f8 | 2016-06-25 16:44:06 +0200 | [diff] [blame] | 122 | |
| 123 | err_create_wq: |
| 124 | batadv_tt_cache_destroy(); |
| 125 | |
| 126 | return -ENOMEM; |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 127 | } |
| 128 | |
Sven Eckelmann | ee11ad6 | 2012-05-16 20:23:19 +0200 | [diff] [blame] | 129 | static void __exit batadv_exit(void) |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 130 | { |
Matthias Schiffer | 09748a2 | 2016-05-09 18:41:08 +0200 | [diff] [blame] | 131 | batadv_netlink_unregister(); |
Sven Eckelmann | a4ac28c | 2013-02-11 17:10:26 +0800 | [diff] [blame] | 132 | rtnl_link_unregister(&batadv_link_ops); |
Sven Eckelmann | 9563877 | 2012-05-12 02:09:31 +0200 | [diff] [blame] | 133 | unregister_netdevice_notifier(&batadv_hard_if_notifier); |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 134 | |
Sven Eckelmann | 3193e8f | 2012-05-12 02:09:42 +0200 | [diff] [blame] | 135 | flush_workqueue(batadv_event_workqueue); |
| 136 | destroy_workqueue(batadv_event_workqueue); |
| 137 | batadv_event_workqueue = NULL; |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 138 | |
| 139 | rcu_barrier(); |
Sven Eckelmann | 86452f8 | 2016-06-25 16:44:06 +0200 | [diff] [blame] | 140 | |
| 141 | batadv_tt_cache_destroy(); |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 142 | } |
| 143 | |
Sven Eckelmann | ff15c27 | 2017-12-02 19:51:53 +0100 | [diff] [blame] | 144 | /** |
| 145 | * batadv_mesh_init() - Initialize soft interface |
| 146 | * @soft_iface: netdev struct of the soft interface |
| 147 | * |
| 148 | * Return: 0 on success or negative error number in case of failure |
| 149 | */ |
Sven Eckelmann | 3193e8f | 2012-05-12 02:09:42 +0200 | [diff] [blame] | 150 | int batadv_mesh_init(struct net_device *soft_iface) |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 151 | { |
Sven Eckelmann | 56303d3 | 2012-06-05 22:31:31 +0200 | [diff] [blame] | 152 | struct batadv_priv *bat_priv = netdev_priv(soft_iface); |
Sven Eckelmann | 5346c35 | 2012-05-05 13:27:28 +0200 | [diff] [blame] | 153 | int ret; |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 154 | |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 155 | spin_lock_init(&bat_priv->forw_bat_list_lock); |
| 156 | spin_lock_init(&bat_priv->forw_bcast_list_lock); |
Sven Eckelmann | 807736f | 2012-07-15 22:26:51 +0200 | [diff] [blame] | 157 | spin_lock_init(&bat_priv->tt.changes_list_lock); |
| 158 | spin_lock_init(&bat_priv->tt.req_list_lock); |
| 159 | spin_lock_init(&bat_priv->tt.roam_list_lock); |
| 160 | spin_lock_init(&bat_priv->tt.last_changeset_lock); |
Antonio Quartulli | a70a9aa | 2013-07-30 22:16:24 +0200 | [diff] [blame] | 161 | spin_lock_init(&bat_priv->tt.commit_lock); |
Sven Eckelmann | 807736f | 2012-07-15 22:26:51 +0200 | [diff] [blame] | 162 | spin_lock_init(&bat_priv->gw.list_lock); |
Linus Lüssing | ab49886 | 2014-02-15 17:47:53 +0100 | [diff] [blame] | 163 | #ifdef CONFIG_BATMAN_ADV_MCAST |
Linus Lüssing | a3c7cd0 | 2019-04-24 03:19:14 +0200 | [diff] [blame] | 164 | spin_lock_init(&bat_priv->mcast.mla_lock); |
Linus Lüssing | ab49886 | 2014-02-15 17:47:53 +0100 | [diff] [blame] | 165 | spin_lock_init(&bat_priv->mcast.want_lists_lock); |
| 166 | #endif |
Marek Lindner | ef26157 | 2013-04-23 21:39:57 +0800 | [diff] [blame] | 167 | spin_lock_init(&bat_priv->tvlv.container_list_lock); |
| 168 | spin_lock_init(&bat_priv->tvlv.handler_list_lock); |
Antonio Quartulli | 5d2c05b | 2013-07-02 11:04:34 +0200 | [diff] [blame] | 169 | spin_lock_init(&bat_priv->softif_vlan_list_lock); |
Antonio Quartulli | 33a3bb4 | 2016-05-05 13:09:43 +0200 | [diff] [blame] | 170 | spin_lock_init(&bat_priv->tp_list_lock); |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 171 | |
| 172 | INIT_HLIST_HEAD(&bat_priv->forw_bat_list); |
| 173 | INIT_HLIST_HEAD(&bat_priv->forw_bcast_list); |
Sven Eckelmann | 70ea5ce | 2016-07-27 12:31:08 +0200 | [diff] [blame] | 174 | INIT_HLIST_HEAD(&bat_priv->gw.gateway_list); |
Linus Lüssing | ab49886 | 2014-02-15 17:47:53 +0100 | [diff] [blame] | 175 | #ifdef CONFIG_BATMAN_ADV_MCAST |
| 176 | INIT_HLIST_HEAD(&bat_priv->mcast.want_all_unsnoopables_list); |
Linus Lüssing | 4c8755d | 2014-02-15 17:47:54 +0100 | [diff] [blame] | 177 | INIT_HLIST_HEAD(&bat_priv->mcast.want_all_ipv4_list); |
| 178 | INIT_HLIST_HEAD(&bat_priv->mcast.want_all_ipv6_list); |
Linus Lüssing | ab49886 | 2014-02-15 17:47:53 +0100 | [diff] [blame] | 179 | #endif |
Sven Eckelmann | 807736f | 2012-07-15 22:26:51 +0200 | [diff] [blame] | 180 | INIT_LIST_HEAD(&bat_priv->tt.changes_list); |
Marek Lindner | 7c26a53 | 2015-06-28 22:16:06 +0800 | [diff] [blame] | 181 | INIT_HLIST_HEAD(&bat_priv->tt.req_list); |
Sven Eckelmann | 807736f | 2012-07-15 22:26:51 +0200 | [diff] [blame] | 182 | INIT_LIST_HEAD(&bat_priv->tt.roam_list); |
Linus Lüssing | c5caf4e | 2014-02-15 17:47:49 +0100 | [diff] [blame] | 183 | #ifdef CONFIG_BATMAN_ADV_MCAST |
| 184 | INIT_HLIST_HEAD(&bat_priv->mcast.mla_list); |
| 185 | #endif |
Marek Lindner | ef26157 | 2013-04-23 21:39:57 +0800 | [diff] [blame] | 186 | INIT_HLIST_HEAD(&bat_priv->tvlv.container_list); |
| 187 | INIT_HLIST_HEAD(&bat_priv->tvlv.handler_list); |
Antonio Quartulli | 5d2c05b | 2013-07-02 11:04:34 +0200 | [diff] [blame] | 188 | INIT_HLIST_HEAD(&bat_priv->softif_vlan_list); |
Antonio Quartulli | 33a3bb4 | 2016-05-05 13:09:43 +0200 | [diff] [blame] | 189 | INIT_HLIST_HEAD(&bat_priv->tp_list); |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 190 | |
Sven Eckelmann | 9264c85 | 2018-10-30 22:01:23 +0100 | [diff] [blame] | 191 | bat_priv->gw.generation = 0; |
| 192 | |
Antonio Quartulli | 0da0035 | 2016-01-16 16:40:12 +0800 | [diff] [blame] | 193 | ret = batadv_v_mesh_init(bat_priv); |
| 194 | if (ret < 0) |
| 195 | goto err; |
| 196 | |
Sven Eckelmann | 7d211ef | 2012-05-12 02:09:34 +0200 | [diff] [blame] | 197 | ret = batadv_originator_init(bat_priv); |
Sven Eckelmann | 5346c35 | 2012-05-05 13:27:28 +0200 | [diff] [blame] | 198 | if (ret < 0) |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 199 | goto err; |
| 200 | |
Sven Eckelmann | 08c36d3 | 2012-05-12 02:09:39 +0200 | [diff] [blame] | 201 | ret = batadv_tt_init(bat_priv); |
Sven Eckelmann | 5346c35 | 2012-05-05 13:27:28 +0200 | [diff] [blame] | 202 | if (ret < 0) |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 203 | goto err; |
| 204 | |
Sven Eckelmann | 08adf15 | 2012-05-12 13:38:47 +0200 | [diff] [blame] | 205 | ret = batadv_bla_init(bat_priv); |
Sven Eckelmann | 5346c35 | 2012-05-05 13:27:28 +0200 | [diff] [blame] | 206 | if (ret < 0) |
Simon Wunderlich | 2372138 | 2012-01-22 20:00:19 +0100 | [diff] [blame] | 207 | goto err; |
| 208 | |
Antonio Quartulli | 2f1dfbe | 2012-06-30 20:01:19 +0200 | [diff] [blame] | 209 | ret = batadv_dat_init(bat_priv); |
| 210 | if (ret < 0) |
| 211 | goto err; |
| 212 | |
Matthias Schiffer | 6c519ba | 2013-09-27 18:03:39 +0200 | [diff] [blame] | 213 | ret = batadv_nc_mesh_init(bat_priv); |
Martin Hundebøll | d353d8d | 2013-01-25 11:12:38 +0100 | [diff] [blame] | 214 | if (ret < 0) |
| 215 | goto err; |
| 216 | |
Marek Lindner | 414254e | 2013-04-23 21:39:58 +0800 | [diff] [blame] | 217 | batadv_gw_init(bat_priv); |
Linus Lüssing | 60432d7 | 2014-02-15 17:47:51 +0100 | [diff] [blame] | 218 | batadv_mcast_init(bat_priv); |
Marek Lindner | 414254e | 2013-04-23 21:39:58 +0800 | [diff] [blame] | 219 | |
Sven Eckelmann | 807736f | 2012-07-15 22:26:51 +0200 | [diff] [blame] | 220 | atomic_set(&bat_priv->gw.reselect, 0); |
Sven Eckelmann | 39c75a5 | 2012-06-03 22:19:22 +0200 | [diff] [blame] | 221 | atomic_set(&bat_priv->mesh_state, BATADV_MESH_ACTIVE); |
Sven Eckelmann | 5346c35 | 2012-05-05 13:27:28 +0200 | [diff] [blame] | 222 | |
| 223 | return 0; |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 224 | |
| 225 | err: |
Sven Eckelmann | 3193e8f | 2012-05-12 02:09:42 +0200 | [diff] [blame] | 226 | batadv_mesh_free(soft_iface); |
Sven Eckelmann | 5346c35 | 2012-05-05 13:27:28 +0200 | [diff] [blame] | 227 | return ret; |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 228 | } |
| 229 | |
Sven Eckelmann | ff15c27 | 2017-12-02 19:51:53 +0100 | [diff] [blame] | 230 | /** |
| 231 | * batadv_mesh_free() - Deinitialize soft interface |
| 232 | * @soft_iface: netdev struct of the soft interface |
| 233 | */ |
Sven Eckelmann | 3193e8f | 2012-05-12 02:09:42 +0200 | [diff] [blame] | 234 | void batadv_mesh_free(struct net_device *soft_iface) |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 235 | { |
Sven Eckelmann | 56303d3 | 2012-06-05 22:31:31 +0200 | [diff] [blame] | 236 | struct batadv_priv *bat_priv = netdev_priv(soft_iface); |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 237 | |
Sven Eckelmann | 39c75a5 | 2012-06-03 22:19:22 +0200 | [diff] [blame] | 238 | atomic_set(&bat_priv->mesh_state, BATADV_MESH_DEACTIVATING); |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 239 | |
Sven Eckelmann | 9455e34 | 2012-05-12 02:09:37 +0200 | [diff] [blame] | 240 | batadv_purge_outstanding_packets(bat_priv, NULL); |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 241 | |
Simon Wunderlich | bd3524c | 2015-08-03 19:13:58 +0200 | [diff] [blame] | 242 | batadv_gw_node_free(bat_priv); |
Antonio Quartulli | 0da0035 | 2016-01-16 16:40:12 +0800 | [diff] [blame] | 243 | |
| 244 | batadv_v_mesh_free(bat_priv); |
Matthias Schiffer | 6c519ba | 2013-09-27 18:03:39 +0200 | [diff] [blame] | 245 | batadv_nc_mesh_free(bat_priv); |
Antonio Quartulli | a436186 | 2013-05-07 01:06:18 +0200 | [diff] [blame] | 246 | batadv_dat_free(bat_priv); |
Sven Eckelmann | 08adf15 | 2012-05-12 13:38:47 +0200 | [diff] [blame] | 247 | batadv_bla_free(bat_priv); |
Simon Wunderlich | 2372138 | 2012-01-22 20:00:19 +0100 | [diff] [blame] | 248 | |
Linus Lüssing | c5caf4e | 2014-02-15 17:47:49 +0100 | [diff] [blame] | 249 | batadv_mcast_free(bat_priv); |
| 250 | |
Antonio Quartulli | a436186 | 2013-05-07 01:06:18 +0200 | [diff] [blame] | 251 | /* Free the TT and the originator tables only after having terminated |
| 252 | * all the other depending components which may use these structures for |
| 253 | * their purposes. |
| 254 | */ |
| 255 | batadv_tt_free(bat_priv); |
| 256 | |
| 257 | /* Since the originator table clean up routine is accessing the TT |
| 258 | * tables as well, it has to be invoked after the TT tables have been |
| 259 | * freed and marked as empty. This ensures that no cleanup RCU callbacks |
| 260 | * accessing the TT data are scheduled for later execution. |
| 261 | */ |
| 262 | batadv_originator_free(bat_priv); |
Antonio Quartulli | 2f1dfbe | 2012-06-30 20:01:19 +0200 | [diff] [blame] | 263 | |
Marek Lindner | 414254e | 2013-04-23 21:39:58 +0800 | [diff] [blame] | 264 | batadv_gw_free(bat_priv); |
| 265 | |
Martin Hundebøll | f821486 | 2012-04-20 17:02:45 +0200 | [diff] [blame] | 266 | free_percpu(bat_priv->bat_counters); |
Martin Hundebøll | f69ae77 | 2013-04-17 21:13:16 +0200 | [diff] [blame] | 267 | bat_priv->bat_counters = NULL; |
Martin Hundebøll | f821486 | 2012-04-20 17:02:45 +0200 | [diff] [blame] | 268 | |
Sven Eckelmann | 39c75a5 | 2012-06-03 22:19:22 +0200 | [diff] [blame] | 269 | atomic_set(&bat_priv->mesh_state, BATADV_MESH_INACTIVE); |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 270 | } |
| 271 | |
David S. Miller | 6e0895c | 2013-04-22 20:32:51 -0400 | [diff] [blame] | 272 | /** |
Sven Eckelmann | 7e9a8c2 | 2017-12-02 19:51:47 +0100 | [diff] [blame] | 273 | * batadv_is_my_mac() - check if the given mac address belongs to any of the |
| 274 | * real interfaces in the current mesh |
David S. Miller | 6e0895c | 2013-04-22 20:32:51 -0400 | [diff] [blame] | 275 | * @bat_priv: the bat priv with all the soft interface information |
| 276 | * @addr: the address to check |
Markus Pargmann | e8ad3b1 | 2014-12-26 12:41:38 +0100 | [diff] [blame] | 277 | * |
Sven Eckelmann | 62fe710 | 2015-09-15 19:00:48 +0200 | [diff] [blame] | 278 | * Return: 'true' if the mac address was found, false otherwise. |
David S. Miller | 6e0895c | 2013-04-22 20:32:51 -0400 | [diff] [blame] | 279 | */ |
Sven Eckelmann | 6b5e971 | 2015-05-26 18:34:26 +0200 | [diff] [blame] | 280 | bool batadv_is_my_mac(struct batadv_priv *bat_priv, const u8 *addr) |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 281 | { |
Sven Eckelmann | 56303d3 | 2012-06-05 22:31:31 +0200 | [diff] [blame] | 282 | const struct batadv_hard_iface *hard_iface; |
Markus Pargmann | e8ad3b1 | 2014-12-26 12:41:38 +0100 | [diff] [blame] | 283 | bool is_my_mac = false; |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 284 | |
| 285 | rcu_read_lock(); |
Sven Eckelmann | 3193e8f | 2012-05-12 02:09:42 +0200 | [diff] [blame] | 286 | list_for_each_entry_rcu(hard_iface, &batadv_hardif_list, list) { |
Sven Eckelmann | e9a4f29 | 2012-06-03 22:19:19 +0200 | [diff] [blame] | 287 | if (hard_iface->if_status != BATADV_IF_ACTIVE) |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 288 | continue; |
| 289 | |
Antonio Quartulli | fe8a93b | 2013-04-03 19:10:26 +0200 | [diff] [blame] | 290 | if (hard_iface->soft_iface != bat_priv->soft_iface) |
| 291 | continue; |
| 292 | |
Sven Eckelmann | 1eda58b | 2012-05-12 13:48:58 +0200 | [diff] [blame] | 293 | if (batadv_compare_eth(hard_iface->net_dev->dev_addr, addr)) { |
Markus Pargmann | e8ad3b1 | 2014-12-26 12:41:38 +0100 | [diff] [blame] | 294 | is_my_mac = true; |
| 295 | break; |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 296 | } |
| 297 | } |
| 298 | rcu_read_unlock(); |
Markus Pargmann | e8ad3b1 | 2014-12-26 12:41:38 +0100 | [diff] [blame] | 299 | return is_my_mac; |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 300 | } |
| 301 | |
Simon Wunderlich | c54f38c | 2013-07-29 17:56:44 +0200 | [diff] [blame] | 302 | /** |
Sven Eckelmann | 7e9a8c2 | 2017-12-02 19:51:47 +0100 | [diff] [blame] | 303 | * batadv_max_header_len() - calculate maximum encapsulation overhead for a |
Marek Lindner | 411d6ed | 2013-05-08 13:31:59 +0800 | [diff] [blame] | 304 | * payload packet |
| 305 | * |
Sven Eckelmann | 62fe710 | 2015-09-15 19:00:48 +0200 | [diff] [blame] | 306 | * Return: the maximum encapsulation overhead in bytes. |
Marek Lindner | 411d6ed | 2013-05-08 13:31:59 +0800 | [diff] [blame] | 307 | */ |
| 308 | int batadv_max_header_len(void) |
| 309 | { |
| 310 | int header_len = 0; |
| 311 | |
| 312 | header_len = max_t(int, header_len, |
| 313 | sizeof(struct batadv_unicast_packet)); |
| 314 | header_len = max_t(int, header_len, |
| 315 | sizeof(struct batadv_unicast_4addr_packet)); |
| 316 | header_len = max_t(int, header_len, |
| 317 | sizeof(struct batadv_bcast_packet)); |
| 318 | |
| 319 | #ifdef CONFIG_BATMAN_ADV_NC |
| 320 | header_len = max_t(int, header_len, |
| 321 | sizeof(struct batadv_coded_packet)); |
| 322 | #endif |
| 323 | |
Marek Lindner | 1df0cbd | 2014-01-15 20:31:18 +0800 | [diff] [blame] | 324 | return header_len + ETH_HLEN; |
Marek Lindner | 411d6ed | 2013-05-08 13:31:59 +0800 | [diff] [blame] | 325 | } |
| 326 | |
| 327 | /** |
Sven Eckelmann | 7e9a8c2 | 2017-12-02 19:51:47 +0100 | [diff] [blame] | 328 | * batadv_skb_set_priority() - sets skb priority according to packet content |
Simon Wunderlich | c54f38c | 2013-07-29 17:56:44 +0200 | [diff] [blame] | 329 | * @skb: the packet to be sent |
| 330 | * @offset: offset to the packet content |
| 331 | * |
| 332 | * This function sets a value between 256 and 263 (802.1d priority), which |
| 333 | * can be interpreted by the cfg80211 or other drivers. |
| 334 | */ |
| 335 | void batadv_skb_set_priority(struct sk_buff *skb, int offset) |
| 336 | { |
| 337 | struct iphdr ip_hdr_tmp, *ip_hdr; |
| 338 | struct ipv6hdr ip6_hdr_tmp, *ip6_hdr; |
| 339 | struct ethhdr ethhdr_tmp, *ethhdr; |
| 340 | struct vlan_ethhdr *vhdr, vhdr_tmp; |
| 341 | u32 prio; |
| 342 | |
| 343 | /* already set, do nothing */ |
| 344 | if (skb->priority >= 256 && skb->priority <= 263) |
| 345 | return; |
| 346 | |
| 347 | ethhdr = skb_header_pointer(skb, offset, sizeof(*ethhdr), ðhdr_tmp); |
| 348 | if (!ethhdr) |
| 349 | return; |
| 350 | |
| 351 | switch (ethhdr->h_proto) { |
| 352 | case htons(ETH_P_8021Q): |
| 353 | vhdr = skb_header_pointer(skb, offset + sizeof(*vhdr), |
| 354 | sizeof(*vhdr), &vhdr_tmp); |
| 355 | if (!vhdr) |
| 356 | return; |
| 357 | prio = ntohs(vhdr->h_vlan_TCI) & VLAN_PRIO_MASK; |
| 358 | prio = prio >> VLAN_PRIO_SHIFT; |
| 359 | break; |
| 360 | case htons(ETH_P_IP): |
| 361 | ip_hdr = skb_header_pointer(skb, offset + sizeof(*ethhdr), |
| 362 | sizeof(*ip_hdr), &ip_hdr_tmp); |
| 363 | if (!ip_hdr) |
| 364 | return; |
| 365 | prio = (ipv4_get_dsfield(ip_hdr) & 0xfc) >> 5; |
| 366 | break; |
| 367 | case htons(ETH_P_IPV6): |
| 368 | ip6_hdr = skb_header_pointer(skb, offset + sizeof(*ethhdr), |
| 369 | sizeof(*ip6_hdr), &ip6_hdr_tmp); |
| 370 | if (!ip6_hdr) |
| 371 | return; |
| 372 | prio = (ipv6_get_dsfield(ip6_hdr) & 0xfc) >> 5; |
| 373 | break; |
| 374 | default: |
| 375 | return; |
| 376 | } |
| 377 | |
| 378 | skb->priority = prio + 256; |
| 379 | } |
| 380 | |
Sven Eckelmann | ee11ad6 | 2012-05-16 20:23:19 +0200 | [diff] [blame] | 381 | static int batadv_recv_unhandled_packet(struct sk_buff *skb, |
Sven Eckelmann | 56303d3 | 2012-06-05 22:31:31 +0200 | [diff] [blame] | 382 | struct batadv_hard_iface *recv_if) |
Marek Lindner | ffa995e | 2012-03-01 15:35:17 +0800 | [diff] [blame] | 383 | { |
Sven Eckelmann | b91a254 | 2016-07-17 21:04:04 +0200 | [diff] [blame] | 384 | kfree_skb(skb); |
| 385 | |
Marek Lindner | ffa995e | 2012-03-01 15:35:17 +0800 | [diff] [blame] | 386 | return NET_RX_DROP; |
| 387 | } |
| 388 | |
| 389 | /* incoming packets with the batman ethertype received on any active hard |
| 390 | * interface |
| 391 | */ |
Sven Eckelmann | ff15c27 | 2017-12-02 19:51:53 +0100 | [diff] [blame] | 392 | |
| 393 | /** |
| 394 | * batadv_batman_skb_recv() - Handle incoming message from an hard interface |
| 395 | * @skb: the received packet |
| 396 | * @dev: the net device that the packet was received on |
| 397 | * @ptype: packet type of incoming packet (ETH_P_BATMAN) |
| 398 | * @orig_dev: the original receive net device (e.g. bonded device) |
| 399 | * |
| 400 | * Return: NET_RX_SUCCESS on success or NET_RX_DROP in case of failure |
| 401 | */ |
Sven Eckelmann | 3193e8f | 2012-05-12 02:09:42 +0200 | [diff] [blame] | 402 | int batadv_batman_skb_recv(struct sk_buff *skb, struct net_device *dev, |
| 403 | struct packet_type *ptype, |
| 404 | struct net_device *orig_dev) |
Marek Lindner | ffa995e | 2012-03-01 15:35:17 +0800 | [diff] [blame] | 405 | { |
Sven Eckelmann | 56303d3 | 2012-06-05 22:31:31 +0200 | [diff] [blame] | 406 | struct batadv_priv *bat_priv; |
Sven Eckelmann | 9641269 | 2012-06-05 22:31:30 +0200 | [diff] [blame] | 407 | struct batadv_ogm_packet *batadv_ogm_packet; |
Sven Eckelmann | 56303d3 | 2012-06-05 22:31:31 +0200 | [diff] [blame] | 408 | struct batadv_hard_iface *hard_iface; |
Sven Eckelmann | 6b5e971 | 2015-05-26 18:34:26 +0200 | [diff] [blame] | 409 | u8 idx; |
Marek Lindner | ffa995e | 2012-03-01 15:35:17 +0800 | [diff] [blame] | 410 | |
Sven Eckelmann | 56303d3 | 2012-06-05 22:31:31 +0200 | [diff] [blame] | 411 | hard_iface = container_of(ptype, struct batadv_hard_iface, |
| 412 | batman_adv_ptype); |
Sven Eckelmann | 4fe56e6 | 2016-03-05 16:09:17 +0100 | [diff] [blame] | 413 | |
| 414 | /* Prevent processing a packet received on an interface which is getting |
| 415 | * shut down otherwise the packet may trigger de-reference errors |
| 416 | * further down in the receive path. |
| 417 | */ |
| 418 | if (!kref_get_unless_zero(&hard_iface->refcount)) |
| 419 | goto err_out; |
| 420 | |
Marek Lindner | ffa995e | 2012-03-01 15:35:17 +0800 | [diff] [blame] | 421 | skb = skb_share_check(skb, GFP_ATOMIC); |
| 422 | |
| 423 | /* skb was released by skb_share_check() */ |
| 424 | if (!skb) |
Sven Eckelmann | 4fe56e6 | 2016-03-05 16:09:17 +0100 | [diff] [blame] | 425 | goto err_put; |
Marek Lindner | ffa995e | 2012-03-01 15:35:17 +0800 | [diff] [blame] | 426 | |
| 427 | /* packet should hold at least type and version */ |
| 428 | if (unlikely(!pskb_may_pull(skb, 2))) |
| 429 | goto err_free; |
| 430 | |
| 431 | /* expect a valid ethernet header here. */ |
| 432 | if (unlikely(skb->mac_len != ETH_HLEN || !skb_mac_header(skb))) |
| 433 | goto err_free; |
| 434 | |
| 435 | if (!hard_iface->soft_iface) |
| 436 | goto err_free; |
| 437 | |
| 438 | bat_priv = netdev_priv(hard_iface->soft_iface); |
| 439 | |
Sven Eckelmann | 39c75a5 | 2012-06-03 22:19:22 +0200 | [diff] [blame] | 440 | if (atomic_read(&bat_priv->mesh_state) != BATADV_MESH_ACTIVE) |
Marek Lindner | ffa995e | 2012-03-01 15:35:17 +0800 | [diff] [blame] | 441 | goto err_free; |
| 442 | |
| 443 | /* discard frames on not active interfaces */ |
Sven Eckelmann | e9a4f29 | 2012-06-03 22:19:19 +0200 | [diff] [blame] | 444 | if (hard_iface->if_status != BATADV_IF_ACTIVE) |
Marek Lindner | ffa995e | 2012-03-01 15:35:17 +0800 | [diff] [blame] | 445 | goto err_free; |
| 446 | |
Sven Eckelmann | 9641269 | 2012-06-05 22:31:30 +0200 | [diff] [blame] | 447 | batadv_ogm_packet = (struct batadv_ogm_packet *)skb->data; |
Marek Lindner | ffa995e | 2012-03-01 15:35:17 +0800 | [diff] [blame] | 448 | |
Simon Wunderlich | a40d9b0 | 2013-12-02 20:38:31 +0100 | [diff] [blame] | 449 | if (batadv_ogm_packet->version != BATADV_COMPAT_VERSION) { |
Sven Eckelmann | 39c75a5 | 2012-06-03 22:19:22 +0200 | [diff] [blame] | 450 | batadv_dbg(BATADV_DBG_BATMAN, bat_priv, |
Sven Eckelmann | 1eda58b | 2012-05-12 13:48:58 +0200 | [diff] [blame] | 451 | "Drop packet: incompatible batman version (%i)\n", |
Simon Wunderlich | a40d9b0 | 2013-12-02 20:38:31 +0100 | [diff] [blame] | 452 | batadv_ogm_packet->version); |
Marek Lindner | ffa995e | 2012-03-01 15:35:17 +0800 | [diff] [blame] | 453 | goto err_free; |
| 454 | } |
| 455 | |
Martin Hundebøll | e0d9677 | 2014-09-17 08:56:19 +0200 | [diff] [blame] | 456 | /* reset control block to avoid left overs from previous users */ |
| 457 | memset(skb->cb, 0, sizeof(struct batadv_skb_cb)); |
| 458 | |
Simon Wunderlich | a40d9b0 | 2013-12-02 20:38:31 +0100 | [diff] [blame] | 459 | idx = batadv_ogm_packet->packet_type; |
Sven Eckelmann | b91a254 | 2016-07-17 21:04:04 +0200 | [diff] [blame] | 460 | (*batadv_rx_handler[idx])(skb, hard_iface); |
Marek Lindner | ffa995e | 2012-03-01 15:35:17 +0800 | [diff] [blame] | 461 | |
Sven Eckelmann | 4fe56e6 | 2016-03-05 16:09:17 +0100 | [diff] [blame] | 462 | batadv_hardif_put(hard_iface); |
| 463 | |
Marek Lindner | ffa995e | 2012-03-01 15:35:17 +0800 | [diff] [blame] | 464 | /* return NET_RX_SUCCESS in any case as we |
| 465 | * most probably dropped the packet for |
| 466 | * routing-logical reasons. |
| 467 | */ |
| 468 | return NET_RX_SUCCESS; |
| 469 | |
| 470 | err_free: |
| 471 | kfree_skb(skb); |
Sven Eckelmann | 4fe56e6 | 2016-03-05 16:09:17 +0100 | [diff] [blame] | 472 | err_put: |
| 473 | batadv_hardif_put(hard_iface); |
Marek Lindner | ffa995e | 2012-03-01 15:35:17 +0800 | [diff] [blame] | 474 | err_out: |
| 475 | return NET_RX_DROP; |
| 476 | } |
| 477 | |
Sven Eckelmann | ee11ad6 | 2012-05-16 20:23:19 +0200 | [diff] [blame] | 478 | static void batadv_recv_handler_init(void) |
Marek Lindner | ffa995e | 2012-03-01 15:35:17 +0800 | [diff] [blame] | 479 | { |
| 480 | int i; |
| 481 | |
Sven Eckelmann | ee11ad6 | 2012-05-16 20:23:19 +0200 | [diff] [blame] | 482 | for (i = 0; i < ARRAY_SIZE(batadv_rx_handler); i++) |
| 483 | batadv_rx_handler[i] = batadv_recv_unhandled_packet; |
Marek Lindner | ffa995e | 2012-03-01 15:35:17 +0800 | [diff] [blame] | 484 | |
Simon Wunderlich | a1f1ac5 | 2013-04-25 10:37:23 +0200 | [diff] [blame] | 485 | for (i = BATADV_UNICAST_MIN; i <= BATADV_UNICAST_MAX; i++) |
| 486 | batadv_rx_handler[i] = batadv_recv_unhandled_unicast_packet; |
| 487 | |
Simon Wunderlich | 031ace8 | 2013-12-17 19:12:12 +0100 | [diff] [blame] | 488 | /* compile time checks for sizes */ |
| 489 | BUILD_BUG_ON(sizeof(struct batadv_bla_claim_dst) != 6); |
| 490 | BUILD_BUG_ON(sizeof(struct batadv_ogm_packet) != 24); |
| 491 | BUILD_BUG_ON(sizeof(struct batadv_icmp_header) != 20); |
| 492 | BUILD_BUG_ON(sizeof(struct batadv_icmp_packet) != 20); |
| 493 | BUILD_BUG_ON(sizeof(struct batadv_icmp_packet_rr) != 116); |
| 494 | BUILD_BUG_ON(sizeof(struct batadv_unicast_packet) != 10); |
| 495 | BUILD_BUG_ON(sizeof(struct batadv_unicast_4addr_packet) != 18); |
| 496 | BUILD_BUG_ON(sizeof(struct batadv_frag_packet) != 20); |
| 497 | BUILD_BUG_ON(sizeof(struct batadv_bcast_packet) != 14); |
| 498 | BUILD_BUG_ON(sizeof(struct batadv_coded_packet) != 46); |
| 499 | BUILD_BUG_ON(sizeof(struct batadv_unicast_tvlv_packet) != 20); |
| 500 | BUILD_BUG_ON(sizeof(struct batadv_tvlv_hdr) != 4); |
| 501 | BUILD_BUG_ON(sizeof(struct batadv_tvlv_gateway_data) != 8); |
| 502 | BUILD_BUG_ON(sizeof(struct batadv_tvlv_tt_vlan_data) != 8); |
| 503 | BUILD_BUG_ON(sizeof(struct batadv_tvlv_tt_change) != 12); |
| 504 | BUILD_BUG_ON(sizeof(struct batadv_tvlv_roam_adv) != 8); |
Simon Wunderlich | 80067c8 | 2013-04-25 10:37:22 +0200 | [diff] [blame] | 505 | |
Pankaj Bharadiya | c593642 | 2019-12-09 10:31:43 -0800 | [diff] [blame] | 506 | i = sizeof_field(struct sk_buff, cb); |
Linus Lüssing | e2d9ba4 | 2017-02-17 11:17:07 +0100 | [diff] [blame] | 507 | BUILD_BUG_ON(sizeof(struct batadv_skb_cb) > i); |
| 508 | |
Simon Wunderlich | a1f1ac5 | 2013-04-25 10:37:23 +0200 | [diff] [blame] | 509 | /* broadcast packet */ |
| 510 | batadv_rx_handler[BATADV_BCAST] = batadv_recv_bcast_packet; |
| 511 | |
| 512 | /* unicast packets ... */ |
Antonio Quartulli | 7cdcf6d | 2012-10-01 09:57:35 +0200 | [diff] [blame] | 513 | /* unicast with 4 addresses packet */ |
| 514 | batadv_rx_handler[BATADV_UNICAST_4ADDR] = batadv_recv_unicast_packet; |
Marek Lindner | ffa995e | 2012-03-01 15:35:17 +0800 | [diff] [blame] | 515 | /* unicast packet */ |
Sven Eckelmann | acd34af | 2012-06-03 22:19:21 +0200 | [diff] [blame] | 516 | batadv_rx_handler[BATADV_UNICAST] = batadv_recv_unicast_packet; |
Marek Lindner | ef26157 | 2013-04-23 21:39:57 +0800 | [diff] [blame] | 517 | /* unicast tvlv packet */ |
| 518 | batadv_rx_handler[BATADV_UNICAST_TVLV] = batadv_recv_unicast_tvlv; |
Simon Wunderlich | a1f1ac5 | 2013-04-25 10:37:23 +0200 | [diff] [blame] | 519 | /* batman icmp packet */ |
| 520 | batadv_rx_handler[BATADV_ICMP] = batadv_recv_icmp_packet; |
Martin Hundebøll | 610bfc6bc | 2013-05-23 16:53:02 +0200 | [diff] [blame] | 521 | /* Fragmented packets */ |
| 522 | batadv_rx_handler[BATADV_UNICAST_FRAG] = batadv_recv_frag_packet; |
Marek Lindner | ffa995e | 2012-03-01 15:35:17 +0800 | [diff] [blame] | 523 | } |
| 524 | |
Sven Eckelmann | ff15c27 | 2017-12-02 19:51:53 +0100 | [diff] [blame] | 525 | /** |
| 526 | * batadv_recv_handler_register() - Register handler for batman-adv packet type |
| 527 | * @packet_type: batadv_packettype which should be handled |
| 528 | * @recv_handler: receive handler for the packet type |
| 529 | * |
| 530 | * Return: 0 on success or negative error number in case of failure |
| 531 | */ |
Sven Eckelmann | 56303d3 | 2012-06-05 22:31:31 +0200 | [diff] [blame] | 532 | int |
Sven Eckelmann | 6b5e971 | 2015-05-26 18:34:26 +0200 | [diff] [blame] | 533 | batadv_recv_handler_register(u8 packet_type, |
Sven Eckelmann | 56303d3 | 2012-06-05 22:31:31 +0200 | [diff] [blame] | 534 | int (*recv_handler)(struct sk_buff *, |
| 535 | struct batadv_hard_iface *)) |
Marek Lindner | ffa995e | 2012-03-01 15:35:17 +0800 | [diff] [blame] | 536 | { |
Sven Eckelmann | 706cc9f | 2017-09-30 09:24:28 +0200 | [diff] [blame] | 537 | int (*curr)(struct sk_buff *skb, |
| 538 | struct batadv_hard_iface *recv_if); |
Simon Wunderlich | a1f1ac5 | 2013-04-25 10:37:23 +0200 | [diff] [blame] | 539 | curr = batadv_rx_handler[packet_type]; |
| 540 | |
Sven Eckelmann | 825ffe1 | 2017-08-23 21:52:13 +0200 | [diff] [blame] | 541 | if (curr != batadv_recv_unhandled_packet && |
| 542 | curr != batadv_recv_unhandled_unicast_packet) |
Marek Lindner | ffa995e | 2012-03-01 15:35:17 +0800 | [diff] [blame] | 543 | return -EBUSY; |
| 544 | |
Sven Eckelmann | ee11ad6 | 2012-05-16 20:23:19 +0200 | [diff] [blame] | 545 | batadv_rx_handler[packet_type] = recv_handler; |
Marek Lindner | ffa995e | 2012-03-01 15:35:17 +0800 | [diff] [blame] | 546 | return 0; |
| 547 | } |
| 548 | |
Sven Eckelmann | ff15c27 | 2017-12-02 19:51:53 +0100 | [diff] [blame] | 549 | /** |
| 550 | * batadv_recv_handler_unregister() - Unregister handler for packet type |
| 551 | * @packet_type: batadv_packettype which should no longer be handled |
| 552 | */ |
Sven Eckelmann | 6b5e971 | 2015-05-26 18:34:26 +0200 | [diff] [blame] | 553 | void batadv_recv_handler_unregister(u8 packet_type) |
Marek Lindner | ffa995e | 2012-03-01 15:35:17 +0800 | [diff] [blame] | 554 | { |
Sven Eckelmann | ee11ad6 | 2012-05-16 20:23:19 +0200 | [diff] [blame] | 555 | batadv_rx_handler[packet_type] = batadv_recv_unhandled_packet; |
Marek Lindner | ffa995e | 2012-03-01 15:35:17 +0800 | [diff] [blame] | 556 | } |
| 557 | |
Sven Eckelmann | 95a066d | 2012-10-17 21:10:39 +0200 | [diff] [blame] | 558 | /** |
Sven Eckelmann | 7e9a8c2 | 2017-12-02 19:51:47 +0100 | [diff] [blame] | 559 | * batadv_skb_crc32() - calculate CRC32 of the whole packet and skip bytes in |
Sven Eckelmann | 95a066d | 2012-10-17 21:10:39 +0200 | [diff] [blame] | 560 | * the header |
| 561 | * @skb: skb pointing to fragmented socket buffers |
| 562 | * @payload_ptr: Pointer to position inside the head buffer of the skb |
| 563 | * marking the start of the data to be CRC'ed |
| 564 | * |
| 565 | * payload_ptr must always point to an address in the skb head buffer and not to |
| 566 | * a fragment. |
Sven Eckelmann | 7afcbbe | 2015-10-31 12:29:29 +0100 | [diff] [blame] | 567 | * |
| 568 | * Return: big endian crc32c of the checksummed data |
Sven Eckelmann | 95a066d | 2012-10-17 21:10:39 +0200 | [diff] [blame] | 569 | */ |
| 570 | __be32 batadv_skb_crc32(struct sk_buff *skb, u8 *payload_ptr) |
| 571 | { |
| 572 | u32 crc = 0; |
| 573 | unsigned int from; |
| 574 | unsigned int to = skb->len; |
| 575 | struct skb_seq_state st; |
| 576 | const u8 *data; |
| 577 | unsigned int len; |
| 578 | unsigned int consumed = 0; |
| 579 | |
| 580 | from = (unsigned int)(payload_ptr - skb->data); |
| 581 | |
| 582 | skb_prepare_seq_read(skb, from, to, &st); |
| 583 | while ((len = skb_seq_read(consumed, &data, &st)) != 0) { |
| 584 | crc = crc32c(crc, data, len); |
| 585 | consumed += len; |
| 586 | } |
Sven Eckelmann | 95a066d | 2012-10-17 21:10:39 +0200 | [diff] [blame] | 587 | |
| 588 | return htonl(crc); |
| 589 | } |
| 590 | |
Marek Lindner | ef26157 | 2013-04-23 21:39:57 +0800 | [diff] [blame] | 591 | /** |
Sven Eckelmann | 7e9a8c2 | 2017-12-02 19:51:47 +0100 | [diff] [blame] | 592 | * batadv_get_vid() - extract the VLAN identifier from skb if any |
Antonio Quartulli | c018ad3 | 2013-06-04 12:11:39 +0200 | [diff] [blame] | 593 | * @skb: the buffer containing the packet |
| 594 | * @header_len: length of the batman header preceding the ethernet header |
| 595 | * |
Sven Eckelmann | 62fe710 | 2015-09-15 19:00:48 +0200 | [diff] [blame] | 596 | * Return: VID with the BATADV_VLAN_HAS_TAG flag when the packet embedded in the |
| 597 | * skb is vlan tagged. Otherwise BATADV_NO_FLAGS. |
Antonio Quartulli | c018ad3 | 2013-06-04 12:11:39 +0200 | [diff] [blame] | 598 | */ |
| 599 | unsigned short batadv_get_vid(struct sk_buff *skb, size_t header_len) |
| 600 | { |
| 601 | struct ethhdr *ethhdr = (struct ethhdr *)(skb->data + header_len); |
| 602 | struct vlan_ethhdr *vhdr; |
| 603 | unsigned short vid; |
| 604 | |
| 605 | if (ethhdr->h_proto != htons(ETH_P_8021Q)) |
| 606 | return BATADV_NO_FLAGS; |
| 607 | |
| 608 | if (!pskb_may_pull(skb, header_len + VLAN_ETH_HLEN)) |
| 609 | return BATADV_NO_FLAGS; |
| 610 | |
| 611 | vhdr = (struct vlan_ethhdr *)(skb->data + header_len); |
| 612 | vid = ntohs(vhdr->h_vlan_TCI) & VLAN_VID_MASK; |
| 613 | vid |= BATADV_VLAN_HAS_TAG; |
| 614 | |
| 615 | return vid; |
| 616 | } |
| 617 | |
Antonio Quartulli | eceb22a | 2013-11-16 12:03:51 +0100 | [diff] [blame] | 618 | /** |
Sven Eckelmann | 7e9a8c2 | 2017-12-02 19:51:47 +0100 | [diff] [blame] | 619 | * batadv_vlan_ap_isola_get() - return AP isolation status for the given vlan |
Antonio Quartulli | eceb22a | 2013-11-16 12:03:51 +0100 | [diff] [blame] | 620 | * @bat_priv: the bat priv with all the soft interface information |
| 621 | * @vid: the VLAN identifier for which the AP isolation attributed as to be |
| 622 | * looked up |
| 623 | * |
Sven Eckelmann | bccb48c | 2020-06-01 20:13:21 +0200 | [diff] [blame] | 624 | * Return: true if AP isolation is on for the VLAN identified by vid, false |
Antonio Quartulli | eceb22a | 2013-11-16 12:03:51 +0100 | [diff] [blame] | 625 | * otherwise |
| 626 | */ |
| 627 | bool batadv_vlan_ap_isola_get(struct batadv_priv *bat_priv, unsigned short vid) |
| 628 | { |
| 629 | bool ap_isolation_enabled = false; |
| 630 | struct batadv_softif_vlan *vlan; |
| 631 | |
| 632 | /* if the AP isolation is requested on a VLAN, then check for its |
| 633 | * setting in the proper VLAN private data structure |
| 634 | */ |
| 635 | vlan = batadv_softif_vlan_get(bat_priv, vid); |
| 636 | if (vlan) { |
| 637 | ap_isolation_enabled = atomic_read(&vlan->ap_isolation); |
Sven Eckelmann | 9c3bf08 | 2016-01-17 11:01:21 +0100 | [diff] [blame] | 638 | batadv_softif_vlan_put(vlan); |
Antonio Quartulli | eceb22a | 2013-11-16 12:03:51 +0100 | [diff] [blame] | 639 | } |
| 640 | |
| 641 | return ap_isolation_enabled; |
| 642 | } |
| 643 | |
Sven Eckelmann | 0fa4c30 | 2019-03-03 18:02:57 +0100 | [diff] [blame] | 644 | /** |
| 645 | * batadv_throw_uevent() - Send an uevent with batman-adv specific env data |
| 646 | * @bat_priv: the bat priv with all the soft interface information |
| 647 | * @type: subsystem type of event. Stored in uevent's BATTYPE |
| 648 | * @action: action type of event. Stored in uevent's BATACTION |
| 649 | * @data: string with additional information to the event (ignored for |
| 650 | * BATADV_UEV_DEL). Stored in uevent's BATDATA |
| 651 | * |
| 652 | * Return: 0 on success or negative error number in case of failure |
| 653 | */ |
| 654 | int batadv_throw_uevent(struct batadv_priv *bat_priv, enum batadv_uev_type type, |
| 655 | enum batadv_uev_action action, const char *data) |
| 656 | { |
| 657 | int ret = -ENOMEM; |
| 658 | struct kobject *bat_kobj; |
| 659 | char *uevent_env[4] = { NULL, NULL, NULL, NULL }; |
| 660 | |
| 661 | bat_kobj = &bat_priv->soft_iface->dev.kobj; |
| 662 | |
| 663 | uevent_env[0] = kasprintf(GFP_ATOMIC, |
| 664 | "%s%s", BATADV_UEV_TYPE_VAR, |
| 665 | batadv_uev_type_str[type]); |
| 666 | if (!uevent_env[0]) |
| 667 | goto out; |
| 668 | |
| 669 | uevent_env[1] = kasprintf(GFP_ATOMIC, |
| 670 | "%s%s", BATADV_UEV_ACTION_VAR, |
| 671 | batadv_uev_action_str[action]); |
| 672 | if (!uevent_env[1]) |
| 673 | goto out; |
| 674 | |
| 675 | /* If the event is DEL, ignore the data field */ |
| 676 | if (action != BATADV_UEV_DEL) { |
| 677 | uevent_env[2] = kasprintf(GFP_ATOMIC, |
| 678 | "%s%s", BATADV_UEV_DATA_VAR, data); |
| 679 | if (!uevent_env[2]) |
| 680 | goto out; |
| 681 | } |
| 682 | |
| 683 | ret = kobject_uevent_env(bat_kobj, KOBJ_CHANGE, uevent_env); |
| 684 | out: |
| 685 | kfree(uevent_env[0]); |
| 686 | kfree(uevent_env[1]); |
| 687 | kfree(uevent_env[2]); |
| 688 | |
| 689 | if (ret) |
| 690 | batadv_dbg(BATADV_DBG_BATMAN, bat_priv, |
| 691 | "Impossible to send uevent for (%s,%s,%s) event (err: %d)\n", |
| 692 | batadv_uev_type_str[type], |
| 693 | batadv_uev_action_str[action], |
| 694 | (action == BATADV_UEV_DEL ? "NULL" : data), ret); |
| 695 | return ret; |
| 696 | } |
| 697 | |
Sven Eckelmann | ee11ad6 | 2012-05-16 20:23:19 +0200 | [diff] [blame] | 698 | module_init(batadv_init); |
| 699 | module_exit(batadv_exit); |
Sven Eckelmann | c6c8fea | 2010-12-13 11:19:28 +0000 | [diff] [blame] | 700 | |
| 701 | MODULE_LICENSE("GPL"); |
| 702 | |
Sven Eckelmann | 42d0b04 | 2012-06-03 22:19:17 +0200 | [diff] [blame] | 703 | MODULE_AUTHOR(BATADV_DRIVER_AUTHOR); |
| 704 | MODULE_DESCRIPTION(BATADV_DRIVER_DESC); |
Sven Eckelmann | 42d0b04 | 2012-06-03 22:19:17 +0200 | [diff] [blame] | 705 | MODULE_VERSION(BATADV_SOURCE_VERSION); |
Sven Eckelmann | 9791860c | 2016-06-10 23:00:55 +0200 | [diff] [blame] | 706 | MODULE_ALIAS_RTNL_LINK("batadv"); |
Sven Eckelmann | 2c0c06f | 2016-10-29 13:56:23 +0200 | [diff] [blame] | 707 | MODULE_ALIAS_GENL_FAMILY(BATADV_NL_NAME); |