Commit | Line | Data |
---|---|---|
0b873931 | 1 | /* Copyright (C) 2007-2013 B.A.T.M.A.N. contributors: |
c6c8fea2 SE |
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, write to the Free Software | |
16 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA | |
17 | * 02110-1301, USA | |
c6c8fea2 SE |
18 | */ |
19 | ||
20 | #include "main.h" | |
21 | #include "soft-interface.h" | |
22 | #include "hard-interface.h" | |
c384ea3e | 23 | #include "distributed-arp-table.h" |
c6c8fea2 SE |
24 | #include "routing.h" |
25 | #include "send.h" | |
b706b13b | 26 | #include "debugfs.h" |
c6c8fea2 | 27 | #include "translation-table.h" |
c6c8fea2 SE |
28 | #include "hash.h" |
29 | #include "gateway_common.h" | |
30 | #include "gateway_client.h" | |
b706b13b | 31 | #include "sysfs.h" |
43676ab5 | 32 | #include "originator.h" |
c6c8fea2 SE |
33 | #include <linux/slab.h> |
34 | #include <linux/ethtool.h> | |
35 | #include <linux/etherdevice.h> | |
36 | #include <linux/if_vlan.h> | |
af5d4f77 | 37 | #include <linux/if_ether.h> |
c6c8fea2 | 38 | #include "unicast.h" |
23721387 | 39 | #include "bridge_loop_avoidance.h" |
d353d8d4 | 40 | #include "network-coding.h" |
c6c8fea2 SE |
41 | |
42 | ||
0294ca0d SE |
43 | static int batadv_get_settings(struct net_device *dev, struct ethtool_cmd *cmd); |
44 | static void batadv_get_drvinfo(struct net_device *dev, | |
45 | struct ethtool_drvinfo *info); | |
46 | static u32 batadv_get_msglevel(struct net_device *dev); | |
47 | static void batadv_set_msglevel(struct net_device *dev, u32 value); | |
48 | static u32 batadv_get_link(struct net_device *dev); | |
f8214865 MH |
49 | static void batadv_get_strings(struct net_device *dev, u32 stringset, u8 *data); |
50 | static void batadv_get_ethtool_stats(struct net_device *dev, | |
51 | struct ethtool_stats *stats, u64 *data); | |
52 | static int batadv_get_sset_count(struct net_device *dev, int stringset); | |
c6c8fea2 | 53 | |
0294ca0d SE |
54 | static const struct ethtool_ops batadv_ethtool_ops = { |
55 | .get_settings = batadv_get_settings, | |
56 | .get_drvinfo = batadv_get_drvinfo, | |
57 | .get_msglevel = batadv_get_msglevel, | |
58 | .set_msglevel = batadv_set_msglevel, | |
59 | .get_link = batadv_get_link, | |
f8214865 MH |
60 | .get_strings = batadv_get_strings, |
61 | .get_ethtool_stats = batadv_get_ethtool_stats, | |
62 | .get_sset_count = batadv_get_sset_count, | |
c6c8fea2 SE |
63 | }; |
64 | ||
04b482a2 | 65 | int batadv_skb_head_push(struct sk_buff *skb, unsigned int len) |
c6c8fea2 SE |
66 | { |
67 | int result; | |
68 | ||
9cfc7bd6 | 69 | /* TODO: We must check if we can release all references to non-payload |
c6c8fea2 SE |
70 | * data using skb_header_release in our skbs to allow skb_cow_header to |
71 | * work optimally. This means that those skbs are not allowed to read | |
72 | * or write any data which is before the current position of skb->data | |
73 | * after that call and thus allow other skbs with the same data buffer | |
74 | * to write freely in that area. | |
75 | */ | |
76 | result = skb_cow_head(skb, len); | |
77 | if (result < 0) | |
78 | return result; | |
79 | ||
80 | skb_push(skb, len); | |
81 | return 0; | |
82 | } | |
83 | ||
0294ca0d | 84 | static int batadv_interface_open(struct net_device *dev) |
c6c8fea2 SE |
85 | { |
86 | netif_start_queue(dev); | |
87 | return 0; | |
88 | } | |
89 | ||
0294ca0d | 90 | static int batadv_interface_release(struct net_device *dev) |
c6c8fea2 SE |
91 | { |
92 | netif_stop_queue(dev); | |
93 | return 0; | |
94 | } | |
95 | ||
0294ca0d | 96 | static struct net_device_stats *batadv_interface_stats(struct net_device *dev) |
c6c8fea2 | 97 | { |
56303d34 | 98 | struct batadv_priv *bat_priv = netdev_priv(dev); |
1c9b0550 ML |
99 | struct net_device_stats *stats = &bat_priv->stats; |
100 | ||
101 | stats->tx_packets = batadv_sum_counter(bat_priv, BATADV_CNT_TX); | |
102 | stats->tx_bytes = batadv_sum_counter(bat_priv, BATADV_CNT_TX_BYTES); | |
103 | stats->tx_dropped = batadv_sum_counter(bat_priv, BATADV_CNT_TX_DROPPED); | |
104 | stats->rx_packets = batadv_sum_counter(bat_priv, BATADV_CNT_RX); | |
105 | stats->rx_bytes = batadv_sum_counter(bat_priv, BATADV_CNT_RX_BYTES); | |
106 | return stats; | |
c6c8fea2 SE |
107 | } |
108 | ||
0294ca0d | 109 | static int batadv_interface_set_mac_addr(struct net_device *dev, void *p) |
c6c8fea2 | 110 | { |
56303d34 | 111 | struct batadv_priv *bat_priv = netdev_priv(dev); |
c6c8fea2 | 112 | struct sockaddr *addr = p; |
40a3eb33 | 113 | uint8_t old_addr[ETH_ALEN]; |
c6c8fea2 SE |
114 | |
115 | if (!is_valid_ether_addr(addr->sa_data)) | |
116 | return -EADDRNOTAVAIL; | |
117 | ||
40a3eb33 D |
118 | memcpy(old_addr, dev->dev_addr, ETH_ALEN); |
119 | memcpy(dev->dev_addr, addr->sa_data, ETH_ALEN); | |
120 | ||
015758d0 | 121 | /* only modify transtable if it has been initialized before */ |
39c75a51 | 122 | if (atomic_read(&bat_priv->mesh_state) == BATADV_MESH_ACTIVE) { |
40a3eb33 | 123 | batadv_tt_local_remove(bat_priv, old_addr, |
08c36d3e | 124 | "mac address changed", false); |
42d0b044 | 125 | batadv_tt_local_add(dev, addr->sa_data, BATADV_NULL_IFINDEX); |
c6c8fea2 SE |
126 | } |
127 | ||
c6c8fea2 SE |
128 | return 0; |
129 | } | |
130 | ||
0294ca0d | 131 | static int batadv_interface_change_mtu(struct net_device *dev, int new_mtu) |
c6c8fea2 SE |
132 | { |
133 | /* check ranges */ | |
9563877e | 134 | if ((new_mtu < 68) || (new_mtu > batadv_hardif_min_mtu(dev))) |
c6c8fea2 SE |
135 | return -EINVAL; |
136 | ||
137 | dev->mtu = new_mtu; | |
138 | ||
139 | return 0; | |
140 | } | |
141 | ||
0294ca0d SE |
142 | static int batadv_interface_tx(struct sk_buff *skb, |
143 | struct net_device *soft_iface) | |
c6c8fea2 SE |
144 | { |
145 | struct ethhdr *ethhdr = (struct ethhdr *)skb->data; | |
56303d34 SE |
146 | struct batadv_priv *bat_priv = netdev_priv(soft_iface); |
147 | struct batadv_hard_iface *primary_if = NULL; | |
96412690 | 148 | struct batadv_bcast_packet *bcast_packet; |
c6c8fea2 | 149 | struct vlan_ethhdr *vhdr; |
af5d4f77 | 150 | __be16 ethertype = __constant_htons(ETH_P_BATMAN); |
4934ab95 SW |
151 | static const uint8_t stp_addr[ETH_ALEN] = {0x01, 0x80, 0xC2, 0x00, |
152 | 0x00, 0x00}; | |
153 | static const uint8_t ectp_addr[ETH_ALEN] = {0xCF, 0x00, 0x00, 0x00, | |
154 | 0x00, 0x00}; | |
be7af5cf | 155 | unsigned int header_len = 0; |
c6c8fea2 | 156 | int data_len = skb->len, ret; |
eb2deb6b | 157 | unsigned short vid __maybe_unused = BATADV_NO_FLAGS; |
be7af5cf | 158 | bool do_bcast = false; |
bbb1f90e | 159 | uint32_t seqno; |
c384ea3e | 160 | unsigned long brd_delay = 1; |
c6c8fea2 | 161 | |
39c75a51 | 162 | if (atomic_read(&bat_priv->mesh_state) != BATADV_MESH_ACTIVE) |
c6c8fea2 SE |
163 | goto dropped; |
164 | ||
165 | soft_iface->trans_start = jiffies; | |
166 | ||
167 | switch (ntohs(ethhdr->h_proto)) { | |
168 | case ETH_P_8021Q: | |
169 | vhdr = (struct vlan_ethhdr *)skb->data; | |
170 | vid = ntohs(vhdr->h_vlan_TCI) & VLAN_VID_MASK; | |
4c18c425 | 171 | vid |= BATADV_VLAN_HAS_TAG; |
c6c8fea2 | 172 | |
7e071c79 | 173 | if (vhdr->h_vlan_encapsulated_proto != ethertype) |
c6c8fea2 SE |
174 | break; |
175 | ||
176 | /* fall through */ | |
af5d4f77 | 177 | case ETH_P_BATMAN: |
c6c8fea2 | 178 | goto dropped; |
a7f6ee94 | 179 | } |
c6c8fea2 | 180 | |
08adf151 | 181 | if (batadv_bla_tx(bat_priv, skb, vid)) |
23721387 SW |
182 | goto dropped; |
183 | ||
9d2c9488 LL |
184 | /* skb->data might have been reallocated by batadv_bla_tx() */ |
185 | ethhdr = (struct ethhdr *)skb->data; | |
186 | ||
a73105b8 | 187 | /* Register the client MAC in the transtable */ |
02233e0c LL |
188 | if (!is_multicast_ether_addr(ethhdr->h_source)) |
189 | batadv_tt_local_add(soft_iface, ethhdr->h_source, skb->skb_iif); | |
c6c8fea2 | 190 | |
b1a8c04b SW |
191 | /* don't accept stp packets. STP does not help in meshes. |
192 | * better use the bridge loop avoidance ... | |
4934ab95 SW |
193 | * |
194 | * The same goes for ECTP sent at least by some Cisco Switches, | |
195 | * it might confuse the mesh when used with bridge loop avoidance. | |
b1a8c04b | 196 | */ |
1eda58bf | 197 | if (batadv_compare_eth(ethhdr->h_dest, stp_addr)) |
b1a8c04b SW |
198 | goto dropped; |
199 | ||
4934ab95 SW |
200 | if (batadv_compare_eth(ethhdr->h_dest, ectp_addr)) |
201 | goto dropped; | |
202 | ||
be7af5cf ML |
203 | if (is_multicast_ether_addr(ethhdr->h_dest)) { |
204 | do_bcast = true; | |
c6c8fea2 | 205 | |
be7af5cf | 206 | switch (atomic_read(&bat_priv->gw_mode)) { |
cd646ab1 | 207 | case BATADV_GW_MODE_SERVER: |
be7af5cf | 208 | /* gateway servers should not send dhcp |
9cfc7bd6 SE |
209 | * requests into the mesh |
210 | */ | |
7cf06bc6 | 211 | ret = batadv_gw_is_dhcp_target(skb, &header_len); |
be7af5cf ML |
212 | if (ret) |
213 | goto dropped; | |
214 | break; | |
cd646ab1 | 215 | case BATADV_GW_MODE_CLIENT: |
be7af5cf | 216 | /* gateway clients should send dhcp requests |
9cfc7bd6 SE |
217 | * via unicast to their gateway |
218 | */ | |
7cf06bc6 | 219 | ret = batadv_gw_is_dhcp_target(skb, &header_len); |
be7af5cf ML |
220 | if (ret) |
221 | do_bcast = false; | |
222 | break; | |
cd646ab1 | 223 | case BATADV_GW_MODE_OFF: |
be7af5cf ML |
224 | default: |
225 | break; | |
226 | } | |
9d2c9488 LL |
227 | |
228 | /* reminder: ethhdr might have become unusable from here on | |
229 | * (batadv_gw_is_dhcp_target() might have reallocated skb data) | |
230 | */ | |
c6c8fea2 SE |
231 | } |
232 | ||
c54f38c9 SW |
233 | batadv_skb_set_priority(skb, 0); |
234 | ||
c6c8fea2 SE |
235 | /* ethernet packet should be broadcasted */ |
236 | if (do_bcast) { | |
e5d89254 | 237 | primary_if = batadv_primary_if_get_selected(bat_priv); |
32ae9b22 | 238 | if (!primary_if) |
c6c8fea2 SE |
239 | goto dropped; |
240 | ||
c384ea3e AQ |
241 | /* in case of ARP request, we do not immediately broadcasti the |
242 | * packet, instead we first wait for DAT to try to retrieve the | |
243 | * correct ARP entry | |
244 | */ | |
245 | if (batadv_dat_snoop_outgoing_arp_request(bat_priv, skb)) | |
246 | brd_delay = msecs_to_jiffies(ARP_REQ_DELAY); | |
247 | ||
04b482a2 | 248 | if (batadv_skb_head_push(skb, sizeof(*bcast_packet)) < 0) |
c6c8fea2 SE |
249 | goto dropped; |
250 | ||
96412690 | 251 | bcast_packet = (struct batadv_bcast_packet *)skb->data; |
7e071c79 | 252 | bcast_packet->header.version = BATADV_COMPAT_VERSION; |
42d0b044 | 253 | bcast_packet->header.ttl = BATADV_TTL; |
c6c8fea2 SE |
254 | |
255 | /* batman packet type: broadcast */ | |
acd34afa | 256 | bcast_packet->header.packet_type = BATADV_BCAST; |
162d549c | 257 | bcast_packet->reserved = 0; |
c6c8fea2 SE |
258 | |
259 | /* hw address of first interface is the orig mac because only | |
9cfc7bd6 SE |
260 | * this mac is known throughout the mesh |
261 | */ | |
c6c8fea2 | 262 | memcpy(bcast_packet->orig, |
32ae9b22 | 263 | primary_if->net_dev->dev_addr, ETH_ALEN); |
c6c8fea2 SE |
264 | |
265 | /* set broadcast sequence number */ | |
bbb1f90e SE |
266 | seqno = atomic_inc_return(&bat_priv->bcast_seqno); |
267 | bcast_packet->seqno = htonl(seqno); | |
c6c8fea2 | 268 | |
c384ea3e | 269 | batadv_add_bcast_packet_to_list(bat_priv, skb, brd_delay); |
c6c8fea2 SE |
270 | |
271 | /* a copy is stored in the bcast list, therefore removing | |
9cfc7bd6 SE |
272 | * the original skb. |
273 | */ | |
c6c8fea2 SE |
274 | kfree_skb(skb); |
275 | ||
276 | /* unicast packet */ | |
277 | } else { | |
cd646ab1 | 278 | if (atomic_read(&bat_priv->gw_mode) != BATADV_GW_MODE_OFF) { |
9d2c9488 | 279 | ret = batadv_gw_out_of_range(bat_priv, skb); |
be7af5cf ML |
280 | if (ret) |
281 | goto dropped; | |
282 | } | |
283 | ||
c384ea3e AQ |
284 | if (batadv_dat_snoop_outgoing_arp_request(bat_priv, skb)) |
285 | goto dropped; | |
286 | ||
287 | batadv_dat_snoop_outgoing_arp_reply(bat_priv, skb); | |
288 | ||
7cdcf6dd | 289 | ret = batadv_unicast_send_skb(bat_priv, skb); |
c6c8fea2 SE |
290 | if (ret != 0) |
291 | goto dropped_freed; | |
292 | } | |
293 | ||
1c9b0550 ML |
294 | batadv_inc_counter(bat_priv, BATADV_CNT_TX); |
295 | batadv_add_counter(bat_priv, BATADV_CNT_TX_BYTES, data_len); | |
c6c8fea2 SE |
296 | goto end; |
297 | ||
298 | dropped: | |
299 | kfree_skb(skb); | |
300 | dropped_freed: | |
1c9b0550 | 301 | batadv_inc_counter(bat_priv, BATADV_CNT_TX_DROPPED); |
c6c8fea2 | 302 | end: |
32ae9b22 | 303 | if (primary_if) |
e5d89254 | 304 | batadv_hardif_free_ref(primary_if); |
c6c8fea2 SE |
305 | return NETDEV_TX_OK; |
306 | } | |
307 | ||
04b482a2 | 308 | void batadv_interface_rx(struct net_device *soft_iface, |
56303d34 | 309 | struct sk_buff *skb, struct batadv_hard_iface *recv_if, |
37135173 | 310 | int hdr_size, struct batadv_orig_node *orig_node) |
c6c8fea2 | 311 | { |
56303d34 | 312 | struct batadv_priv *bat_priv = netdev_priv(soft_iface); |
c6c8fea2 SE |
313 | struct ethhdr *ethhdr; |
314 | struct vlan_ethhdr *vhdr; | |
04c9f416 | 315 | struct batadv_header *batadv_header = (struct batadv_header *)skb->data; |
eb2deb6b | 316 | unsigned short vid __maybe_unused = BATADV_NO_FLAGS; |
af5d4f77 | 317 | __be16 ethertype = __constant_htons(ETH_P_BATMAN); |
2d3f6ccc SW |
318 | bool is_bcast; |
319 | ||
04c9f416 | 320 | is_bcast = (batadv_header->packet_type == BATADV_BCAST); |
c6c8fea2 SE |
321 | |
322 | /* check if enough space is available for pulling, and pull */ | |
323 | if (!pskb_may_pull(skb, hdr_size)) | |
324 | goto dropped; | |
325 | ||
326 | skb_pull_rcsum(skb, hdr_size); | |
327 | skb_reset_mac_header(skb); | |
328 | ||
7ed4be95 | 329 | ethhdr = eth_hdr(skb); |
c6c8fea2 SE |
330 | |
331 | switch (ntohs(ethhdr->h_proto)) { | |
332 | case ETH_P_8021Q: | |
333 | vhdr = (struct vlan_ethhdr *)skb->data; | |
334 | vid = ntohs(vhdr->h_vlan_TCI) & VLAN_VID_MASK; | |
4c18c425 | 335 | vid |= BATADV_VLAN_HAS_TAG; |
c6c8fea2 | 336 | |
7e071c79 | 337 | if (vhdr->h_vlan_encapsulated_proto != ethertype) |
c6c8fea2 SE |
338 | break; |
339 | ||
340 | /* fall through */ | |
af5d4f77 | 341 | case ETH_P_BATMAN: |
c6c8fea2 SE |
342 | goto dropped; |
343 | } | |
344 | ||
c6c8fea2 SE |
345 | /* skb->dev & skb->pkt_type are set here */ |
346 | if (unlikely(!pskb_may_pull(skb, ETH_HLEN))) | |
347 | goto dropped; | |
348 | skb->protocol = eth_type_trans(skb, soft_iface); | |
349 | ||
25985edc | 350 | /* should not be necessary anymore as we use skb_pull_rcsum() |
c6c8fea2 | 351 | * TODO: please verify this and remove this TODO |
9cfc7bd6 SE |
352 | * -- Dec 21st 2009, Simon Wunderlich |
353 | */ | |
c6c8fea2 | 354 | |
9cfc7bd6 | 355 | /* skb->ip_summed = CHECKSUM_UNNECESSARY; */ |
c6c8fea2 | 356 | |
1c9b0550 ML |
357 | batadv_inc_counter(bat_priv, BATADV_CNT_RX); |
358 | batadv_add_counter(bat_priv, BATADV_CNT_RX_BYTES, | |
359 | skb->len + ETH_HLEN); | |
c6c8fea2 SE |
360 | |
361 | soft_iface->last_rx = jiffies; | |
362 | ||
74490f96 AQ |
363 | /* Let the bridge loop avoidance check the packet. If will |
364 | * not handle it, we can safely push it up. | |
365 | */ | |
366 | if (batadv_bla_rx(bat_priv, skb, vid, is_bcast)) | |
367 | goto out; | |
368 | ||
37135173 AQ |
369 | if (orig_node) |
370 | batadv_tt_add_temporary_global_entry(bat_priv, orig_node, | |
371 | ethhdr->h_source); | |
372 | ||
08c36d3e | 373 | if (batadv_is_ap_isolated(bat_priv, ethhdr->h_source, ethhdr->h_dest)) |
59b699cd AQ |
374 | goto dropped; |
375 | ||
c6c8fea2 | 376 | netif_rx(skb); |
ba85fac2 | 377 | goto out; |
c6c8fea2 SE |
378 | |
379 | dropped: | |
380 | kfree_skb(skb); | |
381 | out: | |
382 | return; | |
383 | } | |
384 | ||
36c1d153 SE |
385 | /* batman-adv network devices have devices nesting below it and are a special |
386 | * "super class" of normal network devices; split their locks off into a | |
387 | * separate class since they always nest. | |
388 | */ | |
389 | static struct lock_class_key batadv_netdev_xmit_lock_key; | |
390 | static struct lock_class_key batadv_netdev_addr_lock_key; | |
391 | ||
392 | /** | |
393 | * batadv_set_lockdep_class_one - Set lockdep class for a single tx queue | |
394 | * @dev: device which owns the tx queue | |
395 | * @txq: tx queue to modify | |
396 | * @_unused: always NULL | |
397 | */ | |
398 | static void batadv_set_lockdep_class_one(struct net_device *dev, | |
399 | struct netdev_queue *txq, | |
400 | void *_unused) | |
401 | { | |
402 | lockdep_set_class(&txq->_xmit_lock, &batadv_netdev_xmit_lock_key); | |
403 | } | |
404 | ||
405 | /** | |
406 | * batadv_set_lockdep_class - Set txq and addr_list lockdep class | |
407 | * @dev: network device to modify | |
408 | */ | |
409 | static void batadv_set_lockdep_class(struct net_device *dev) | |
410 | { | |
411 | lockdep_set_class(&dev->addr_list_lock, &batadv_netdev_addr_lock_key); | |
412 | netdev_for_each_tx_queue(dev, batadv_set_lockdep_class_one, NULL); | |
413 | } | |
414 | ||
5bc44dc8 SW |
415 | /** |
416 | * batadv_softif_destroy_finish - cleans up the remains of a softif | |
417 | * @work: work queue item | |
418 | * | |
419 | * Free the parts of the soft interface which can not be removed under | |
420 | * rtnl lock (to prevent deadlock situations). | |
421 | */ | |
422 | static void batadv_softif_destroy_finish(struct work_struct *work) | |
423 | { | |
424 | struct batadv_priv *bat_priv; | |
425 | struct net_device *soft_iface; | |
426 | ||
427 | bat_priv = container_of(work, struct batadv_priv, | |
428 | cleanup_work); | |
429 | soft_iface = bat_priv->soft_iface; | |
430 | ||
5bc44dc8 SW |
431 | batadv_sysfs_del_meshif(soft_iface); |
432 | ||
433 | rtnl_lock(); | |
434 | unregister_netdevice(soft_iface); | |
435 | rtnl_unlock(); | |
436 | } | |
437 | ||
37130293 SE |
438 | /** |
439 | * batadv_softif_init_late - late stage initialization of soft interface | |
440 | * @dev: registered network device to modify | |
441 | * | |
442 | * Returns error code on failures | |
443 | */ | |
444 | static int batadv_softif_init_late(struct net_device *dev) | |
c6c8fea2 | 445 | { |
56303d34 | 446 | struct batadv_priv *bat_priv; |
c6c8fea2 | 447 | int ret; |
d69909d2 | 448 | size_t cnt_len = sizeof(uint64_t) * BATADV_CNT_NUM; |
c6c8fea2 | 449 | |
37130293 | 450 | batadv_set_lockdep_class(dev); |
c6c8fea2 | 451 | |
37130293 SE |
452 | bat_priv = netdev_priv(dev); |
453 | bat_priv->soft_iface = dev; | |
5bc44dc8 | 454 | INIT_WORK(&bat_priv->cleanup_work, batadv_softif_destroy_finish); |
1c9b0550 ML |
455 | |
456 | /* batadv_interface_stats() needs to be available as soon as | |
457 | * register_netdevice() has been called | |
458 | */ | |
459 | bat_priv->bat_counters = __alloc_percpu(cnt_len, __alignof__(uint64_t)); | |
460 | if (!bat_priv->bat_counters) | |
37130293 | 461 | return -ENOMEM; |
c6c8fea2 | 462 | |
c6c8fea2 SE |
463 | atomic_set(&bat_priv->aggregated_ogms, 1); |
464 | atomic_set(&bat_priv->bonding, 0); | |
fa706554 | 465 | #ifdef CONFIG_BATMAN_ADV_BLA |
23721387 | 466 | atomic_set(&bat_priv->bridge_loop_avoidance, 0); |
fa706554 | 467 | #endif |
33af49ad AQ |
468 | #ifdef CONFIG_BATMAN_ADV_DAT |
469 | atomic_set(&bat_priv->distributed_arp_table, 1); | |
470 | #endif | |
59b699cd | 471 | atomic_set(&bat_priv->ap_isolation, 0); |
acd34afa | 472 | atomic_set(&bat_priv->vis_mode, BATADV_VIS_TYPE_CLIENT_UPDATE); |
cd646ab1 | 473 | atomic_set(&bat_priv->gw_mode, BATADV_GW_MODE_OFF); |
c6c8fea2 SE |
474 | atomic_set(&bat_priv->gw_sel_class, 20); |
475 | atomic_set(&bat_priv->gw_bandwidth, 41); | |
476 | atomic_set(&bat_priv->orig_interval, 1000); | |
8681a1c4 | 477 | atomic_set(&bat_priv->hop_penalty, 30); |
0c430d0d | 478 | #ifdef CONFIG_BATMAN_ADV_DEBUG |
c6c8fea2 | 479 | atomic_set(&bat_priv->log_level, 0); |
0c430d0d | 480 | #endif |
c6c8fea2 | 481 | atomic_set(&bat_priv->fragmentation, 1); |
42d0b044 SE |
482 | atomic_set(&bat_priv->bcast_queue_left, BATADV_BCAST_QUEUE_LEN); |
483 | atomic_set(&bat_priv->batman_queue_left, BATADV_BATMAN_QUEUE_LEN); | |
c6c8fea2 | 484 | |
39c75a51 | 485 | atomic_set(&bat_priv->mesh_state, BATADV_MESH_INACTIVE); |
c6c8fea2 | 486 | atomic_set(&bat_priv->bcast_seqno, 1); |
807736f6 SE |
487 | atomic_set(&bat_priv->tt.vn, 0); |
488 | atomic_set(&bat_priv->tt.local_changes, 0); | |
489 | atomic_set(&bat_priv->tt.ogm_append_cnt, 0); | |
490 | #ifdef CONFIG_BATMAN_ADV_BLA | |
491 | atomic_set(&bat_priv->bla.num_requests, 0); | |
492 | #endif | |
493 | bat_priv->tt.last_changeset = NULL; | |
494 | bat_priv->tt.last_changeset_len = 0; | |
c6c8fea2 SE |
495 | |
496 | bat_priv->primary_if = NULL; | |
497 | bat_priv->num_ifaces = 0; | |
c6c8fea2 | 498 | |
d353d8d4 MH |
499 | batadv_nc_init_bat_priv(bat_priv); |
500 | ||
37130293 | 501 | ret = batadv_algo_select(bat_priv, batadv_routing_algo); |
c6c8fea2 | 502 | if (ret < 0) |
37130293 | 503 | goto free_bat_counters; |
c6c8fea2 | 504 | |
37130293 | 505 | ret = batadv_debugfs_add_meshif(dev); |
c6c8fea2 | 506 | if (ret < 0) |
37130293 | 507 | goto free_bat_counters; |
c6c8fea2 | 508 | |
37130293 | 509 | ret = batadv_mesh_init(dev); |
c6c8fea2 SE |
510 | if (ret < 0) |
511 | goto unreg_debugfs; | |
512 | ||
37130293 | 513 | return 0; |
c6c8fea2 SE |
514 | |
515 | unreg_debugfs: | |
37130293 | 516 | batadv_debugfs_del_meshif(dev); |
1c9b0550 ML |
517 | free_bat_counters: |
518 | free_percpu(bat_priv->bat_counters); | |
f69ae770 | 519 | bat_priv->bat_counters = NULL; |
37130293 SE |
520 | |
521 | return ret; | |
522 | } | |
523 | ||
3dbd550b SE |
524 | /** |
525 | * batadv_softif_slave_add - Add a slave interface to a batadv_soft_interface | |
526 | * @dev: batadv_soft_interface used as master interface | |
527 | * @slave_dev: net_device which should become the slave interface | |
528 | * | |
529 | * Return 0 if successful or error otherwise. | |
530 | */ | |
531 | static int batadv_softif_slave_add(struct net_device *dev, | |
532 | struct net_device *slave_dev) | |
533 | { | |
534 | struct batadv_hard_iface *hard_iface; | |
535 | int ret = -EINVAL; | |
536 | ||
537 | hard_iface = batadv_hardif_get_by_netdev(slave_dev); | |
538 | if (!hard_iface || hard_iface->soft_iface != NULL) | |
539 | goto out; | |
540 | ||
541 | ret = batadv_hardif_enable_interface(hard_iface, dev->name); | |
542 | ||
543 | out: | |
544 | if (hard_iface) | |
545 | batadv_hardif_free_ref(hard_iface); | |
546 | return ret; | |
547 | } | |
548 | ||
549 | /** | |
550 | * batadv_softif_slave_del - Delete a slave iface from a batadv_soft_interface | |
551 | * @dev: batadv_soft_interface used as master interface | |
552 | * @slave_dev: net_device which should be removed from the master interface | |
553 | * | |
554 | * Return 0 if successful or error otherwise. | |
555 | */ | |
556 | static int batadv_softif_slave_del(struct net_device *dev, | |
557 | struct net_device *slave_dev) | |
558 | { | |
559 | struct batadv_hard_iface *hard_iface; | |
560 | int ret = -EINVAL; | |
561 | ||
562 | hard_iface = batadv_hardif_get_by_netdev(slave_dev); | |
563 | ||
564 | if (!hard_iface || hard_iface->soft_iface != dev) | |
565 | goto out; | |
566 | ||
567 | batadv_hardif_disable_interface(hard_iface, BATADV_IF_CLEANUP_KEEP); | |
568 | ret = 0; | |
569 | ||
570 | out: | |
571 | if (hard_iface) | |
572 | batadv_hardif_free_ref(hard_iface); | |
573 | return ret; | |
574 | } | |
575 | ||
37130293 SE |
576 | static const struct net_device_ops batadv_netdev_ops = { |
577 | .ndo_init = batadv_softif_init_late, | |
578 | .ndo_open = batadv_interface_open, | |
579 | .ndo_stop = batadv_interface_release, | |
580 | .ndo_get_stats = batadv_interface_stats, | |
581 | .ndo_set_mac_address = batadv_interface_set_mac_addr, | |
582 | .ndo_change_mtu = batadv_interface_change_mtu, | |
583 | .ndo_start_xmit = batadv_interface_tx, | |
3dbd550b SE |
584 | .ndo_validate_addr = eth_validate_addr, |
585 | .ndo_add_slave = batadv_softif_slave_add, | |
586 | .ndo_del_slave = batadv_softif_slave_del, | |
37130293 SE |
587 | }; |
588 | ||
b3246020 SE |
589 | /** |
590 | * batadv_softif_free - Deconstructor of batadv_soft_interface | |
591 | * @dev: Device to cleanup and remove | |
592 | */ | |
593 | static void batadv_softif_free(struct net_device *dev) | |
594 | { | |
595 | batadv_debugfs_del_meshif(dev); | |
596 | batadv_mesh_free(dev); | |
0c501345 AQ |
597 | |
598 | /* some scheduled RCU callbacks need the bat_priv struct to accomplish | |
599 | * their tasks. Wait for them all to be finished before freeing the | |
600 | * netdev and its private data (bat_priv) | |
601 | */ | |
602 | rcu_barrier(); | |
603 | ||
b3246020 SE |
604 | free_netdev(dev); |
605 | } | |
606 | ||
37130293 SE |
607 | /** |
608 | * batadv_softif_init_early - early stage initialization of soft interface | |
609 | * @dev: registered network device to modify | |
610 | */ | |
611 | static void batadv_softif_init_early(struct net_device *dev) | |
612 | { | |
613 | struct batadv_priv *priv = netdev_priv(dev); | |
614 | ||
615 | ether_setup(dev); | |
616 | ||
617 | dev->netdev_ops = &batadv_netdev_ops; | |
b3246020 | 618 | dev->destructor = batadv_softif_free; |
37130293 SE |
619 | dev->tx_queue_len = 0; |
620 | ||
621 | /* can't call min_mtu, because the needed variables | |
622 | * have not been initialized yet | |
623 | */ | |
624 | dev->mtu = ETH_DATA_LEN; | |
625 | /* reserve more space in the skbuff for our header */ | |
626 | dev->hard_header_len = BATADV_HEADER_LEN; | |
627 | ||
628 | /* generate random address */ | |
629 | eth_hw_addr_random(dev); | |
630 | ||
631 | SET_ETHTOOL_OPS(dev, &batadv_ethtool_ops); | |
632 | ||
633 | memset(priv, 0, sizeof(*priv)); | |
634 | } | |
635 | ||
636 | struct net_device *batadv_softif_create(const char *name) | |
637 | { | |
638 | struct net_device *soft_iface; | |
639 | int ret; | |
640 | ||
641 | soft_iface = alloc_netdev(sizeof(struct batadv_priv), name, | |
642 | batadv_softif_init_early); | |
643 | if (!soft_iface) | |
644 | return NULL; | |
645 | ||
a4ac28c0 SE |
646 | soft_iface->rtnl_link_ops = &batadv_link_ops; |
647 | ||
37130293 SE |
648 | ret = register_netdevice(soft_iface); |
649 | if (ret < 0) { | |
650 | pr_err("Unable to register the batman interface '%s': %i\n", | |
651 | name, ret); | |
652 | free_netdev(soft_iface); | |
653 | return NULL; | |
654 | } | |
655 | ||
656 | return soft_iface; | |
c6c8fea2 SE |
657 | } |
658 | ||
e07932ae ML |
659 | /** |
660 | * batadv_softif_destroy_sysfs - deletion of batadv_soft_interface via sysfs | |
661 | * @soft_iface: the to-be-removed batman-adv interface | |
662 | */ | |
663 | void batadv_softif_destroy_sysfs(struct net_device *soft_iface) | |
c6c8fea2 | 664 | { |
5bc44dc8 SW |
665 | struct batadv_priv *bat_priv = netdev_priv(soft_iface); |
666 | ||
5bc44dc8 | 667 | queue_work(batadv_event_workqueue, &bat_priv->cleanup_work); |
c6c8fea2 SE |
668 | } |
669 | ||
a4ac28c0 SE |
670 | /** |
671 | * batadv_softif_destroy_netlink - deletion of batadv_soft_interface via netlink | |
672 | * @soft_iface: the to-be-removed batman-adv interface | |
673 | * @head: list pointer | |
674 | */ | |
675 | static void batadv_softif_destroy_netlink(struct net_device *soft_iface, | |
676 | struct list_head *head) | |
677 | { | |
678 | struct batadv_hard_iface *hard_iface; | |
679 | ||
680 | list_for_each_entry(hard_iface, &batadv_hardif_list, list) { | |
681 | if (hard_iface->soft_iface == soft_iface) | |
682 | batadv_hardif_disable_interface(hard_iface, | |
683 | BATADV_IF_CLEANUP_KEEP); | |
684 | } | |
685 | ||
686 | batadv_sysfs_del_meshif(soft_iface); | |
687 | unregister_netdevice_queue(soft_iface, head); | |
688 | } | |
689 | ||
04b482a2 | 690 | int batadv_softif_is_valid(const struct net_device *net_dev) |
e44d8fe2 | 691 | { |
0294ca0d | 692 | if (net_dev->netdev_ops->ndo_start_xmit == batadv_interface_tx) |
e44d8fe2 | 693 | return 1; |
e44d8fe2 SE |
694 | |
695 | return 0; | |
696 | } | |
697 | ||
a4ac28c0 SE |
698 | struct rtnl_link_ops batadv_link_ops __read_mostly = { |
699 | .kind = "batadv", | |
700 | .priv_size = sizeof(struct batadv_priv), | |
701 | .setup = batadv_softif_init_early, | |
702 | .dellink = batadv_softif_destroy_netlink, | |
703 | }; | |
704 | ||
c6c8fea2 | 705 | /* ethtool */ |
0294ca0d | 706 | static int batadv_get_settings(struct net_device *dev, struct ethtool_cmd *cmd) |
c6c8fea2 SE |
707 | { |
708 | cmd->supported = 0; | |
709 | cmd->advertising = 0; | |
70739497 | 710 | ethtool_cmd_speed_set(cmd, SPEED_10); |
c6c8fea2 SE |
711 | cmd->duplex = DUPLEX_FULL; |
712 | cmd->port = PORT_TP; | |
713 | cmd->phy_address = 0; | |
714 | cmd->transceiver = XCVR_INTERNAL; | |
715 | cmd->autoneg = AUTONEG_DISABLE; | |
716 | cmd->maxtxpkt = 0; | |
717 | cmd->maxrxpkt = 0; | |
718 | ||
719 | return 0; | |
720 | } | |
721 | ||
0294ca0d SE |
722 | static void batadv_get_drvinfo(struct net_device *dev, |
723 | struct ethtool_drvinfo *info) | |
c6c8fea2 | 724 | { |
7826d43f JP |
725 | strlcpy(info->driver, "B.A.T.M.A.N. advanced", sizeof(info->driver)); |
726 | strlcpy(info->version, BATADV_SOURCE_VERSION, sizeof(info->version)); | |
727 | strlcpy(info->fw_version, "N/A", sizeof(info->fw_version)); | |
728 | strlcpy(info->bus_info, "batman", sizeof(info->bus_info)); | |
c6c8fea2 SE |
729 | } |
730 | ||
0294ca0d | 731 | static u32 batadv_get_msglevel(struct net_device *dev) |
c6c8fea2 SE |
732 | { |
733 | return -EOPNOTSUPP; | |
734 | } | |
735 | ||
0294ca0d | 736 | static void batadv_set_msglevel(struct net_device *dev, u32 value) |
c6c8fea2 SE |
737 | { |
738 | } | |
739 | ||
0294ca0d | 740 | static u32 batadv_get_link(struct net_device *dev) |
c6c8fea2 SE |
741 | { |
742 | return 1; | |
743 | } | |
f8214865 MH |
744 | |
745 | /* Inspired by drivers/net/ethernet/dlink/sundance.c:1702 | |
746 | * Declare each description string in struct.name[] to get fixed sized buffer | |
747 | * and compile time checking for strings longer than ETH_GSTRING_LEN. | |
748 | */ | |
749 | static const struct { | |
750 | const char name[ETH_GSTRING_LEN]; | |
0294ca0d | 751 | } batadv_counters_strings[] = { |
1c9b0550 ML |
752 | { "tx" }, |
753 | { "tx_bytes" }, | |
754 | { "tx_dropped" }, | |
755 | { "rx" }, | |
756 | { "rx_bytes" }, | |
f8214865 MH |
757 | { "forward" }, |
758 | { "forward_bytes" }, | |
759 | { "mgmt_tx" }, | |
760 | { "mgmt_tx_bytes" }, | |
761 | { "mgmt_rx" }, | |
762 | { "mgmt_rx_bytes" }, | |
763 | { "tt_request_tx" }, | |
764 | { "tt_request_rx" }, | |
765 | { "tt_response_tx" }, | |
766 | { "tt_response_rx" }, | |
767 | { "tt_roam_adv_tx" }, | |
768 | { "tt_roam_adv_rx" }, | |
4046b24a MH |
769 | #ifdef CONFIG_BATMAN_ADV_DAT |
770 | { "dat_get_tx" }, | |
771 | { "dat_get_rx" }, | |
772 | { "dat_put_tx" }, | |
773 | { "dat_put_rx" }, | |
774 | { "dat_cached_reply_tx" }, | |
775 | #endif | |
3c12de9a MH |
776 | #ifdef CONFIG_BATMAN_ADV_NC |
777 | { "nc_code" }, | |
778 | { "nc_code_bytes" }, | |
779 | { "nc_recode" }, | |
780 | { "nc_recode_bytes" }, | |
612d2b4f | 781 | { "nc_buffer" }, |
2df5278b MH |
782 | { "nc_decode" }, |
783 | { "nc_decode_bytes" }, | |
784 | { "nc_decode_failed" }, | |
785 | { "nc_sniffed" }, | |
3c12de9a | 786 | #endif |
f8214865 MH |
787 | }; |
788 | ||
789 | static void batadv_get_strings(struct net_device *dev, uint32_t stringset, | |
790 | uint8_t *data) | |
791 | { | |
792 | if (stringset == ETH_SS_STATS) | |
0294ca0d SE |
793 | memcpy(data, batadv_counters_strings, |
794 | sizeof(batadv_counters_strings)); | |
f8214865 MH |
795 | } |
796 | ||
797 | static void batadv_get_ethtool_stats(struct net_device *dev, | |
798 | struct ethtool_stats *stats, | |
799 | uint64_t *data) | |
800 | { | |
56303d34 | 801 | struct batadv_priv *bat_priv = netdev_priv(dev); |
f8214865 MH |
802 | int i; |
803 | ||
d69909d2 | 804 | for (i = 0; i < BATADV_CNT_NUM; i++) |
f8214865 MH |
805 | data[i] = batadv_sum_counter(bat_priv, i); |
806 | } | |
807 | ||
808 | static int batadv_get_sset_count(struct net_device *dev, int stringset) | |
809 | { | |
810 | if (stringset == ETH_SS_STATS) | |
d69909d2 | 811 | return BATADV_CNT_NUM; |
f8214865 MH |
812 | |
813 | return -EOPNOTSUPP; | |
814 | } |