| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
 | 2 |  *	Handle incoming frames | 
 | 3 |  *	Linux ethernet bridge | 
 | 4 |  * | 
 | 5 |  *	Authors: | 
 | 6 |  *	Lennert Buytenhek		<buytenh@gnu.org> | 
 | 7 |  * | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 8 |  *	This program is free software; you can redistribute it and/or | 
 | 9 |  *	modify it under the terms of the GNU General Public License | 
 | 10 |  *	as published by the Free Software Foundation; either version | 
 | 11 |  *	2 of the License, or (at your option) any later version. | 
 | 12 |  */ | 
 | 13 |  | 
 | 14 | #include <linux/kernel.h> | 
 | 15 | #include <linux/netdevice.h> | 
 | 16 | #include <linux/etherdevice.h> | 
 | 17 | #include <linux/netfilter_bridge.h> | 
 | 18 | #include "br_private.h" | 
 | 19 |  | 
| Stephen Hemminger | fda93d9 | 2006-03-20 22:59:21 -0800 | [diff] [blame] | 20 | /* Bridge group multicast address 802.1d (pg 51). */ | 
 | 21 | const u8 br_group_address[ETH_ALEN] = { 0x01, 0x80, 0xc2, 0x00, 0x00, 0x00 }; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 22 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 23 | static void br_pass_frame_up(struct net_bridge *br, struct sk_buff *skb) | 
 | 24 | { | 
| Pavel Emelyanov | a339f1c | 2008-05-21 14:13:47 -0700 | [diff] [blame] | 25 | 	struct net_device *indev, *brdev = br->dev; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 26 |  | 
| Pavel Emelyanov | a339f1c | 2008-05-21 14:13:47 -0700 | [diff] [blame] | 27 | 	brdev->stats.rx_packets++; | 
 | 28 | 	brdev->stats.rx_bytes += skb->len; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 29 |  | 
 | 30 | 	indev = skb->dev; | 
| Pavel Emelyanov | a339f1c | 2008-05-21 14:13:47 -0700 | [diff] [blame] | 31 | 	skb->dev = brdev; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 32 |  | 
 | 33 | 	NF_HOOK(PF_BRIDGE, NF_BR_LOCAL_IN, skb, indev, NULL, | 
| Stephen Hemminger | d5513a7 | 2006-03-20 22:57:18 -0800 | [diff] [blame] | 34 | 		netif_receive_skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 35 | } | 
 | 36 |  | 
 | 37 | /* note: already called with rcu_read_lock (preempt_disabled) */ | 
 | 38 | int br_handle_frame_finish(struct sk_buff *skb) | 
 | 39 | { | 
 | 40 | 	const unsigned char *dest = eth_hdr(skb)->h_dest; | 
| Stephen Hemminger | b3f1be4 | 2006-02-09 17:08:52 -0800 | [diff] [blame] | 41 | 	struct net_bridge_port *p = rcu_dereference(skb->dev->br_port); | 
 | 42 | 	struct net_bridge *br; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 43 | 	struct net_bridge_fdb_entry *dst; | 
| Herbert Xu | e081e1e | 2007-09-16 16:20:48 -0700 | [diff] [blame] | 44 | 	struct sk_buff *skb2; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 45 |  | 
| Stephen Hemminger | b3f1be4 | 2006-02-09 17:08:52 -0800 | [diff] [blame] | 46 | 	if (!p || p->state == BR_STATE_DISABLED) | 
 | 47 | 		goto drop; | 
| Stephen Hemminger | 85967bb | 2005-05-29 14:15:55 -0700 | [diff] [blame] | 48 |  | 
| Stephen Hemminger | b3f1be4 | 2006-02-09 17:08:52 -0800 | [diff] [blame] | 49 | 	/* insert into forwarding database after filtering to avoid spoofing */ | 
 | 50 | 	br = p->br; | 
 | 51 | 	br_fdb_update(br, p, eth_hdr(skb)->h_source); | 
 | 52 |  | 
 | 53 | 	if (p->state == BR_STATE_LEARNING) | 
 | 54 | 		goto drop; | 
| Stephen Hemminger | 0e5eaba | 2005-12-21 19:00:18 -0800 | [diff] [blame] | 55 |  | 
| Herbert Xu | e081e1e | 2007-09-16 16:20:48 -0700 | [diff] [blame] | 56 | 	/* The packet skb2 goes to the local host (NULL to skip). */ | 
 | 57 | 	skb2 = NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 58 |  | 
| Herbert Xu | e081e1e | 2007-09-16 16:20:48 -0700 | [diff] [blame] | 59 | 	if (br->dev->flags & IFF_PROMISC) | 
 | 60 | 		skb2 = skb; | 
 | 61 |  | 
 | 62 | 	dst = NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 63 |  | 
| Kris Katterjohn | dbbc098 | 2006-01-06 13:05:58 -0800 | [diff] [blame] | 64 | 	if (is_multicast_ether_addr(dest)) { | 
| Pavel Emelyanov | a339f1c | 2008-05-21 14:13:47 -0700 | [diff] [blame] | 65 | 		br->dev->stats.multicast++; | 
| Herbert Xu | e081e1e | 2007-09-16 16:20:48 -0700 | [diff] [blame] | 66 | 		skb2 = skb; | 
 | 67 | 	} else if ((dst = __br_fdb_get(br, dest)) && dst->is_local) { | 
 | 68 | 		skb2 = skb; | 
 | 69 | 		/* Do not forward the packet since it's local. */ | 
 | 70 | 		skb = NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 71 | 	} | 
 | 72 |  | 
| Herbert Xu | e081e1e | 2007-09-16 16:20:48 -0700 | [diff] [blame] | 73 | 	if (skb2 == skb) | 
 | 74 | 		skb2 = skb_clone(skb, GFP_ATOMIC); | 
 | 75 |  | 
 | 76 | 	if (skb2) | 
 | 77 | 		br_pass_frame_up(br, skb2); | 
 | 78 |  | 
 | 79 | 	if (skb) { | 
 | 80 | 		if (dst) | 
 | 81 | 			br_forward(dst->dst, skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 82 | 		else | 
| Herbert Xu | e081e1e | 2007-09-16 16:20:48 -0700 | [diff] [blame] | 83 | 			br_flood_forward(br, skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 84 | 	} | 
 | 85 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 86 | out: | 
 | 87 | 	return 0; | 
| Stephen Hemminger | b3f1be4 | 2006-02-09 17:08:52 -0800 | [diff] [blame] | 88 | drop: | 
 | 89 | 	kfree_skb(skb); | 
 | 90 | 	goto out; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 91 | } | 
 | 92 |  | 
| Stephen Hemminger | cf0f02d | 2006-03-20 22:59:06 -0800 | [diff] [blame] | 93 | /* note: already called with rcu_read_lock (preempt_disabled) */ | 
 | 94 | static int br_handle_local_finish(struct sk_buff *skb) | 
 | 95 | { | 
 | 96 | 	struct net_bridge_port *p = rcu_dereference(skb->dev->br_port); | 
 | 97 |  | 
| Stephen Hemminger | df1c0b8 | 2007-08-30 22:15:35 -0700 | [diff] [blame] | 98 | 	if (p) | 
| Stephen Hemminger | cf0f02d | 2006-03-20 22:59:06 -0800 | [diff] [blame] | 99 | 		br_fdb_update(p->br, p, eth_hdr(skb)->h_source); | 
| Stephen Hemminger | cf0f02d | 2006-03-20 22:59:06 -0800 | [diff] [blame] | 100 | 	return 0;	 /* process further */ | 
 | 101 | } | 
 | 102 |  | 
 | 103 | /* Does address match the link local multicast address. | 
 | 104 |  * 01:80:c2:00:00:0X | 
 | 105 |  */ | 
| Andrew Morton | b3e83d6 | 2006-03-20 23:00:56 -0800 | [diff] [blame] | 106 | static inline int is_link_local(const unsigned char *dest) | 
| Stephen Hemminger | cf0f02d | 2006-03-20 22:59:06 -0800 | [diff] [blame] | 107 | { | 
| Al Viro | 582ee43 | 2007-07-26 17:33:39 +0100 | [diff] [blame] | 108 | 	__be16 *a = (__be16 *)dest; | 
 | 109 | 	static const __be16 *b = (const __be16 *)br_group_address; | 
| YOSHIFUJI Hideaki | 91c5ec3 | 2007-12-12 03:51:03 +0900 | [diff] [blame] | 110 | 	static const __be16 m = cpu_to_be16(0xfff0); | 
| Stephen Hemminger | fd74e6c | 2007-03-12 16:25:32 -0700 | [diff] [blame] | 111 |  | 
 | 112 | 	return ((a[0] ^ b[0]) | (a[1] ^ b[1]) | ((a[2] ^ b[2]) & m)) == 0; | 
| Stephen Hemminger | cf0f02d | 2006-03-20 22:59:06 -0800 | [diff] [blame] | 113 | } | 
 | 114 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 115 | /* | 
 | 116 |  * Called via br_handle_frame_hook. | 
| Stephen Hemminger | 6229e36 | 2007-03-21 13:38:47 -0700 | [diff] [blame] | 117 |  * Return NULL if skb is handled | 
| YOSHIFUJI Hideaki | 9d6f229 | 2007-02-09 23:24:35 +0900 | [diff] [blame] | 118 |  * note: already called with rcu_read_lock (preempt_disabled) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 119 |  */ | 
| Stephen Hemminger | 6229e36 | 2007-03-21 13:38:47 -0700 | [diff] [blame] | 120 | struct sk_buff *br_handle_frame(struct net_bridge_port *p, struct sk_buff *skb) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 121 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 122 | 	const unsigned char *dest = eth_hdr(skb)->h_dest; | 
| Pavel Emelyanov | 82de382 | 2007-11-29 23:58:58 +1100 | [diff] [blame] | 123 | 	int (*rhook)(struct sk_buff *skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 124 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 125 | 	if (!is_valid_ether_addr(eth_hdr(skb)->h_source)) | 
| Stephen Hemminger | 467aea0 | 2007-03-21 13:42:06 -0700 | [diff] [blame] | 126 | 		goto drop; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 127 |  | 
| Herbert Xu | 7b99565 | 2007-10-14 00:39:01 -0700 | [diff] [blame] | 128 | 	skb = skb_share_check(skb, GFP_ATOMIC); | 
 | 129 | 	if (!skb) | 
 | 130 | 		return NULL; | 
 | 131 |  | 
| Stephen Hemminger | 2111f8b | 2007-04-25 22:05:55 -0700 | [diff] [blame] | 132 | 	if (unlikely(is_link_local(dest))) { | 
 | 133 | 		/* Pause frames shouldn't be passed up by driver anyway */ | 
 | 134 | 		if (skb->protocol == htons(ETH_P_PAUSE)) | 
 | 135 | 			goto drop; | 
 | 136 |  | 
| Stephen Hemminger | 43aa192 | 2008-06-17 16:09:45 -0700 | [diff] [blame] | 137 | 		if (NF_HOOK(PF_BRIDGE, NF_BR_LOCAL_IN, skb, skb->dev, | 
 | 138 | 			    NULL, br_handle_local_finish)) | 
 | 139 | 			return NULL;	/* frame consumed by filter */ | 
 | 140 | 		else | 
 | 141 | 			return skb;	/* continue processing */ | 
| Stephen Hemminger | 2111f8b | 2007-04-25 22:05:55 -0700 | [diff] [blame] | 142 | 	} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 143 |  | 
| Stephen Hemminger | 467aea0 | 2007-03-21 13:42:06 -0700 | [diff] [blame] | 144 | 	switch (p->state) { | 
 | 145 | 	case BR_STATE_FORWARDING: | 
| Pavel Emelyanov | 82de382 | 2007-11-29 23:58:58 +1100 | [diff] [blame] | 146 | 		rhook = rcu_dereference(br_should_route_hook); | 
 | 147 | 		if (rhook != NULL) { | 
 | 148 | 			if (rhook(skb)) | 
| Stephen Hemminger | 6229e36 | 2007-03-21 13:38:47 -0700 | [diff] [blame] | 149 | 				return skb; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 150 | 			dest = eth_hdr(skb)->h_dest; | 
 | 151 | 		} | 
| Stephen Hemminger | 467aea0 | 2007-03-21 13:42:06 -0700 | [diff] [blame] | 152 | 		/* fall through */ | 
 | 153 | 	case BR_STATE_LEARNING: | 
| Stephen Hemminger | 6ede246 | 2005-10-25 15:04:59 -0700 | [diff] [blame] | 154 | 		if (!compare_ether_addr(p->br->dev->dev_addr, dest)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 155 | 			skb->pkt_type = PACKET_HOST; | 
 | 156 |  | 
 | 157 | 		NF_HOOK(PF_BRIDGE, NF_BR_PRE_ROUTING, skb, skb->dev, NULL, | 
 | 158 | 			br_handle_frame_finish); | 
| Stephen Hemminger | 467aea0 | 2007-03-21 13:42:06 -0700 | [diff] [blame] | 159 | 		break; | 
 | 160 | 	default: | 
 | 161 | drop: | 
 | 162 | 		kfree_skb(skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 163 | 	} | 
| Stephen Hemminger | 6229e36 | 2007-03-21 13:38:47 -0700 | [diff] [blame] | 164 | 	return NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 165 | } |