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