2 * Copyright (c) 2007 Patrick McHardy <kaber@trash.net>
4 * This program is free software; you can redistribute it and/or
5 * modify it under the terms of the GNU General Public License as
6 * published by the Free Software Foundation; either version 2 of
7 * the License, or (at your option) any later version.
9 * The code this is based on carried the following copyright notice:
11 * (C) Copyright 2001-2006
12 * Alex Zeffertt, Cambridge Broadband Ltd, ajz@cambridgebroadband.com
13 * Re-worked by Ben Greear <greearb@candelatech.com>
16 #include <linux/kernel.h>
17 #include <linux/types.h>
18 #include <linux/module.h>
19 #include <linux/init.h>
20 #include <linux/errno.h>
21 #include <linux/slab.h>
22 #include <linux/string.h>
23 #include <linux/list.h>
24 #include <linux/notifier.h>
25 #include <linux/netdevice.h>
26 #include <linux/etherdevice.h>
27 #include <linux/ethtool.h>
28 #include <linux/if_arp.h>
29 #include <linux/if_link.h>
30 #include <linux/if_macvlan.h>
31 #include <net/rtnetlink.h>
33 #define MACVLAN_HASH_SIZE (1 << BITS_PER_BYTE)
36 struct net_device
*dev
;
37 struct hlist_head vlan_hash
[MACVLAN_HASH_SIZE
];
38 struct list_head vlans
;
42 struct net_device
*dev
;
43 struct list_head list
;
44 struct hlist_node hlist
;
45 struct macvlan_port
*port
;
46 struct net_device
*lowerdev
;
50 static struct macvlan_dev
*macvlan_hash_lookup(const struct macvlan_port
*port
,
51 const unsigned char *addr
)
53 struct macvlan_dev
*vlan
;
56 hlist_for_each_entry_rcu(vlan
, n
, &port
->vlan_hash
[addr
[5]], hlist
) {
57 if (!compare_ether_addr(vlan
->dev
->dev_addr
, addr
))
63 static void macvlan_broadcast(struct sk_buff
*skb
,
64 const struct macvlan_port
*port
)
66 const struct ethhdr
*eth
= eth_hdr(skb
);
67 const struct macvlan_dev
*vlan
;
69 struct net_device
*dev
;
73 for (i
= 0; i
< MACVLAN_HASH_SIZE
; i
++) {
74 hlist_for_each_entry_rcu(vlan
, n
, &port
->vlan_hash
[i
], hlist
) {
76 if (unlikely(!(dev
->flags
& IFF_UP
)))
79 nskb
= skb_clone(skb
, GFP_ATOMIC
);
81 dev
->stats
.rx_errors
++;
82 dev
->stats
.rx_dropped
++;
86 dev
->stats
.rx_bytes
+= skb
->len
+ ETH_HLEN
;
87 dev
->stats
.rx_packets
++;
88 dev
->stats
.multicast
++;
89 dev
->last_rx
= jiffies
;
92 if (!compare_ether_addr(eth
->h_dest
, dev
->broadcast
))
93 nskb
->pkt_type
= PACKET_BROADCAST
;
95 nskb
->pkt_type
= PACKET_MULTICAST
;
102 /* called under rcu_read_lock() from netif_receive_skb */
103 static struct sk_buff
*macvlan_handle_frame(struct sk_buff
*skb
)
105 const struct ethhdr
*eth
= eth_hdr(skb
);
106 const struct macvlan_port
*port
;
107 const struct macvlan_dev
*vlan
;
108 struct net_device
*dev
;
110 port
= rcu_dereference(skb
->dev
->macvlan_port
);
114 if (is_multicast_ether_addr(eth
->h_dest
)) {
115 macvlan_broadcast(skb
, port
);
119 vlan
= macvlan_hash_lookup(port
, eth
->h_dest
);
124 if (unlikely(!(dev
->flags
& IFF_UP
))) {
129 skb
= skb_share_check(skb
, GFP_ATOMIC
);
131 dev
->stats
.rx_errors
++;
132 dev
->stats
.rx_dropped
++;
136 dev
->stats
.rx_bytes
+= skb
->len
+ ETH_HLEN
;
137 dev
->stats
.rx_packets
++;
138 dev
->last_rx
= jiffies
;
141 skb
->pkt_type
= PACKET_HOST
;
147 static int macvlan_hard_start_xmit(struct sk_buff
*skb
, struct net_device
*dev
)
149 const struct macvlan_dev
*vlan
= netdev_priv(dev
);
150 unsigned int len
= skb
->len
;
153 skb
->dev
= vlan
->lowerdev
;
154 ret
= dev_queue_xmit(skb
);
156 if (likely(ret
== NET_XMIT_SUCCESS
)) {
157 dev
->stats
.tx_packets
++;
158 dev
->stats
.tx_bytes
+= len
;
160 dev
->stats
.tx_errors
++;
161 dev
->stats
.tx_aborted_errors
++;
166 static int macvlan_hard_header(struct sk_buff
*skb
, struct net_device
*dev
,
167 unsigned short type
, void *daddr
, void *saddr
,
170 const struct macvlan_dev
*vlan
= netdev_priv(dev
);
171 struct net_device
*lowerdev
= vlan
->lowerdev
;
173 return dev_hard_header(skb
, lowerdev
, type
, daddr
,
174 saddr
? : dev
->dev_addr
, len
);
177 static int macvlan_open(struct net_device
*dev
)
179 struct macvlan_dev
*vlan
= netdev_priv(dev
);
180 struct macvlan_port
*port
= vlan
->port
;
181 struct net_device
*lowerdev
= vlan
->lowerdev
;
184 err
= dev_unicast_add(lowerdev
, dev
->dev_addr
, ETH_ALEN
);
187 if (dev
->flags
& IFF_ALLMULTI
)
188 dev_set_allmulti(lowerdev
, 1);
190 hlist_add_head_rcu(&vlan
->hlist
, &port
->vlan_hash
[dev
->dev_addr
[5]]);
194 static int macvlan_stop(struct net_device
*dev
)
196 struct macvlan_dev
*vlan
= netdev_priv(dev
);
197 struct net_device
*lowerdev
= vlan
->lowerdev
;
199 dev_mc_unsync(lowerdev
, dev
);
200 if (dev
->flags
& IFF_ALLMULTI
)
201 dev_set_allmulti(lowerdev
, -1);
203 dev_unicast_delete(lowerdev
, dev
->dev_addr
, ETH_ALEN
);
205 hlist_del_rcu(&vlan
->hlist
);
210 static void macvlan_change_rx_flags(struct net_device
*dev
, int change
)
212 struct macvlan_dev
*vlan
= netdev_priv(dev
);
213 struct net_device
*lowerdev
= vlan
->lowerdev
;
215 if (change
& IFF_ALLMULTI
)
216 dev_set_allmulti(lowerdev
, dev
->flags
& IFF_ALLMULTI
? 1 : -1);
219 static void macvlan_set_multicast_list(struct net_device
*dev
)
221 struct macvlan_dev
*vlan
= netdev_priv(dev
);
223 dev_mc_sync(vlan
->lowerdev
, dev
);
226 static int macvlan_change_mtu(struct net_device
*dev
, int new_mtu
)
228 struct macvlan_dev
*vlan
= netdev_priv(dev
);
230 if (new_mtu
< 68 || vlan
->lowerdev
->mtu
< new_mtu
)
237 * macvlan network devices have devices nesting below it and are a special
238 * "super class" of normal network devices; split their locks off into a
239 * separate class since they always nest.
241 static struct lock_class_key macvlan_netdev_xmit_lock_key
;
243 #define MACVLAN_FEATURES \
244 (NETIF_F_SG | NETIF_F_ALL_CSUM | NETIF_F_HIGHDMA | NETIF_F_FRAGLIST | \
245 NETIF_F_GSO | NETIF_F_TSO | NETIF_F_UFO | NETIF_F_GSO_ROBUST | \
246 NETIF_F_TSO_ECN | NETIF_F_TSO6)
248 #define MACVLAN_STATE_MASK \
249 ((1<<__LINK_STATE_NOCARRIER) | (1<<__LINK_STATE_DORMANT))
251 static int macvlan_init(struct net_device
*dev
)
253 struct macvlan_dev
*vlan
= netdev_priv(dev
);
254 const struct net_device
*lowerdev
= vlan
->lowerdev
;
256 dev
->state
= (dev
->state
& ~MACVLAN_STATE_MASK
) |
257 (lowerdev
->state
& MACVLAN_STATE_MASK
);
258 dev
->features
= lowerdev
->features
& MACVLAN_FEATURES
;
259 dev
->iflink
= lowerdev
->ifindex
;
261 lockdep_set_class(&dev
->_xmit_lock
, &macvlan_netdev_xmit_lock_key
);
265 static void macvlan_ethtool_get_drvinfo(struct net_device
*dev
,
266 struct ethtool_drvinfo
*drvinfo
)
268 snprintf(drvinfo
->driver
, 32, "macvlan");
269 snprintf(drvinfo
->version
, 32, "0.1");
272 static u32
macvlan_ethtool_get_rx_csum(struct net_device
*dev
)
274 const struct macvlan_dev
*vlan
= netdev_priv(dev
);
275 struct net_device
*lowerdev
= vlan
->lowerdev
;
277 if (lowerdev
->ethtool_ops
->get_rx_csum
== NULL
)
279 return lowerdev
->ethtool_ops
->get_rx_csum(lowerdev
);
282 static const struct ethtool_ops macvlan_ethtool_ops
= {
283 .get_link
= ethtool_op_get_link
,
284 .get_rx_csum
= macvlan_ethtool_get_rx_csum
,
285 .get_drvinfo
= macvlan_ethtool_get_drvinfo
,
288 static void macvlan_setup(struct net_device
*dev
)
292 dev
->init
= macvlan_init
;
293 dev
->open
= macvlan_open
;
294 dev
->stop
= macvlan_stop
;
295 dev
->change_mtu
= macvlan_change_mtu
;
296 dev
->change_rx_flags
= macvlan_change_rx_flags
;
297 dev
->set_multicast_list
= macvlan_set_multicast_list
;
298 dev
->hard_header
= macvlan_hard_header
;
299 dev
->hard_start_xmit
= macvlan_hard_start_xmit
;
300 dev
->destructor
= free_netdev
;
301 dev
->ethtool_ops
= &macvlan_ethtool_ops
;
302 dev
->tx_queue_len
= 0;
305 static int macvlan_port_create(struct net_device
*dev
)
307 struct macvlan_port
*port
;
310 if (dev
->type
!= ARPHRD_ETHER
|| dev
->flags
& IFF_LOOPBACK
)
313 port
= kzalloc(sizeof(*port
), GFP_KERNEL
);
318 INIT_LIST_HEAD(&port
->vlans
);
319 for (i
= 0; i
< MACVLAN_HASH_SIZE
; i
++)
320 INIT_HLIST_HEAD(&port
->vlan_hash
[i
]);
321 rcu_assign_pointer(dev
->macvlan_port
, port
);
325 static void macvlan_port_destroy(struct net_device
*dev
)
327 struct macvlan_port
*port
= dev
->macvlan_port
;
329 rcu_assign_pointer(dev
->macvlan_port
, NULL
);
334 static void macvlan_transfer_operstate(struct net_device
*dev
)
336 struct macvlan_dev
*vlan
= netdev_priv(dev
);
337 const struct net_device
*lowerdev
= vlan
->lowerdev
;
339 if (lowerdev
->operstate
== IF_OPER_DORMANT
)
340 netif_dormant_on(dev
);
342 netif_dormant_off(dev
);
344 if (netif_carrier_ok(lowerdev
)) {
345 if (!netif_carrier_ok(dev
))
346 netif_carrier_on(dev
);
348 if (netif_carrier_ok(lowerdev
))
349 netif_carrier_off(dev
);
353 static int macvlan_validate(struct nlattr
*tb
[], struct nlattr
*data
[])
355 if (tb
[IFLA_ADDRESS
]) {
356 if (nla_len(tb
[IFLA_ADDRESS
]) != ETH_ALEN
)
358 if (!is_valid_ether_addr(nla_data(tb
[IFLA_ADDRESS
])))
359 return -EADDRNOTAVAIL
;
364 static int macvlan_newlink(struct net_device
*dev
,
365 struct nlattr
*tb
[], struct nlattr
*data
[])
367 struct macvlan_dev
*vlan
= netdev_priv(dev
);
368 struct macvlan_port
*port
;
369 struct net_device
*lowerdev
;
375 lowerdev
= __dev_get_by_index(dev
->nd_net
, nla_get_u32(tb
[IFLA_LINK
]));
376 if (lowerdev
== NULL
)
380 dev
->mtu
= lowerdev
->mtu
;
381 else if (dev
->mtu
> lowerdev
->mtu
)
384 if (!tb
[IFLA_ADDRESS
])
385 random_ether_addr(dev
->dev_addr
);
387 if (lowerdev
->macvlan_port
== NULL
) {
388 err
= macvlan_port_create(lowerdev
);
392 port
= lowerdev
->macvlan_port
;
394 vlan
->lowerdev
= lowerdev
;
398 err
= register_netdevice(dev
);
402 list_add_tail(&vlan
->list
, &port
->vlans
);
403 macvlan_transfer_operstate(dev
);
407 static void macvlan_dellink(struct net_device
*dev
)
409 struct macvlan_dev
*vlan
= netdev_priv(dev
);
410 struct macvlan_port
*port
= vlan
->port
;
412 list_del(&vlan
->list
);
413 unregister_netdevice(dev
);
415 if (list_empty(&port
->vlans
))
416 macvlan_port_destroy(dev
);
419 static struct rtnl_link_ops macvlan_link_ops __read_mostly
= {
421 .priv_size
= sizeof(struct macvlan_dev
),
422 .setup
= macvlan_setup
,
423 .validate
= macvlan_validate
,
424 .newlink
= macvlan_newlink
,
425 .dellink
= macvlan_dellink
,
428 static int macvlan_device_event(struct notifier_block
*unused
,
429 unsigned long event
, void *ptr
)
431 struct net_device
*dev
= ptr
;
432 struct macvlan_dev
*vlan
, *next
;
433 struct macvlan_port
*port
;
435 port
= dev
->macvlan_port
;
441 list_for_each_entry(vlan
, &port
->vlans
, list
)
442 macvlan_transfer_operstate(vlan
->dev
);
444 case NETDEV_FEAT_CHANGE
:
445 list_for_each_entry(vlan
, &port
->vlans
, list
) {
446 vlan
->dev
->features
= dev
->features
& MACVLAN_FEATURES
;
447 netdev_features_change(vlan
->dev
);
450 case NETDEV_UNREGISTER
:
451 list_for_each_entry_safe(vlan
, next
, &port
->vlans
, list
)
452 macvlan_dellink(vlan
->dev
);
458 static struct notifier_block macvlan_notifier_block __read_mostly
= {
459 .notifier_call
= macvlan_device_event
,
462 static int __init
macvlan_init_module(void)
466 register_netdevice_notifier(&macvlan_notifier_block
);
467 macvlan_handle_frame_hook
= macvlan_handle_frame
;
469 err
= rtnl_link_register(&macvlan_link_ops
);
474 macvlan_handle_frame_hook
= macvlan_handle_frame
;
475 unregister_netdevice_notifier(&macvlan_notifier_block
);
479 static void __exit
macvlan_cleanup_module(void)
481 rtnl_link_unregister(&macvlan_link_ops
);
482 macvlan_handle_frame_hook
= NULL
;
483 unregister_netdevice_notifier(&macvlan_notifier_block
);
486 module_init(macvlan_init_module
);
487 module_exit(macvlan_cleanup_module
);
489 MODULE_LICENSE("GPL");
490 MODULE_AUTHOR("Patrick McHardy <kaber@trash.net>");
491 MODULE_DESCRIPTION("Driver for MAC address based VLANs");
492 MODULE_ALIAS_RTNL_LINK("macvlan");