]>
git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blob - net/bridge/br_stp_bpdu.c
2 * Spanning tree protocol; BPDU handling
3 * Linux ethernet bridge
6 * Lennert Buytenhek <buytenh@gnu.org>
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.
14 #include <linux/kernel.h>
15 #include <linux/netfilter_bridge.h>
16 #include <linux/etherdevice.h>
17 #include <linux/llc.h>
18 #include <linux/slab.h>
19 #include <net/net_namespace.h>
21 #include <net/llc_pdu.h>
23 #include <asm/unaligned.h>
25 #include "br_private.h"
26 #include "br_private_stp.h"
30 #define LLC_RESERVE sizeof(struct llc_pdu_un)
32 static void br_send_bpdu(struct net_bridge_port
*p
,
33 const unsigned char *data
, int length
)
37 skb
= dev_alloc_skb(length
+LLC_RESERVE
);
42 skb
->protocol
= htons(ETH_P_802_2
);
44 skb_reserve(skb
, LLC_RESERVE
);
45 memcpy(__skb_put(skb
, length
), data
, length
);
47 llc_pdu_header_init(skb
, LLC_PDU_TYPE_U
, LLC_SAP_BSPAN
,
48 LLC_SAP_BSPAN
, LLC_PDU_CMD
);
49 llc_pdu_init_as_ui_cmd(skb
);
51 llc_mac_hdr_init(skb
, p
->dev
->dev_addr
, p
->br
->group_addr
);
53 NF_HOOK(NFPROTO_BRIDGE
, NF_BR_LOCAL_OUT
, skb
, NULL
, skb
->dev
,
57 static inline void br_set_ticks(unsigned char *dest
, int j
)
59 unsigned long ticks
= (STP_HZ
* j
)/ HZ
;
61 put_unaligned_be16(ticks
, dest
);
64 static inline int br_get_ticks(const unsigned char *src
)
66 unsigned long ticks
= get_unaligned_be16(src
);
68 return DIV_ROUND_UP(ticks
* HZ
, STP_HZ
);
71 /* called under bridge lock */
72 void br_send_config_bpdu(struct net_bridge_port
*p
, struct br_config_bpdu
*bpdu
)
74 unsigned char buf
[35];
76 if (p
->br
->stp_enabled
!= BR_KERNEL_STP
)
82 buf
[3] = BPDU_TYPE_CONFIG
;
83 buf
[4] = (bpdu
->topology_change
? 0x01 : 0) |
84 (bpdu
->topology_change_ack
? 0x80 : 0);
85 buf
[5] = bpdu
->root
.prio
[0];
86 buf
[6] = bpdu
->root
.prio
[1];
87 buf
[7] = bpdu
->root
.addr
[0];
88 buf
[8] = bpdu
->root
.addr
[1];
89 buf
[9] = bpdu
->root
.addr
[2];
90 buf
[10] = bpdu
->root
.addr
[3];
91 buf
[11] = bpdu
->root
.addr
[4];
92 buf
[12] = bpdu
->root
.addr
[5];
93 buf
[13] = (bpdu
->root_path_cost
>> 24) & 0xFF;
94 buf
[14] = (bpdu
->root_path_cost
>> 16) & 0xFF;
95 buf
[15] = (bpdu
->root_path_cost
>> 8) & 0xFF;
96 buf
[16] = bpdu
->root_path_cost
& 0xFF;
97 buf
[17] = bpdu
->bridge_id
.prio
[0];
98 buf
[18] = bpdu
->bridge_id
.prio
[1];
99 buf
[19] = bpdu
->bridge_id
.addr
[0];
100 buf
[20] = bpdu
->bridge_id
.addr
[1];
101 buf
[21] = bpdu
->bridge_id
.addr
[2];
102 buf
[22] = bpdu
->bridge_id
.addr
[3];
103 buf
[23] = bpdu
->bridge_id
.addr
[4];
104 buf
[24] = bpdu
->bridge_id
.addr
[5];
105 buf
[25] = (bpdu
->port_id
>> 8) & 0xFF;
106 buf
[26] = bpdu
->port_id
& 0xFF;
108 br_set_ticks(buf
+27, bpdu
->message_age
);
109 br_set_ticks(buf
+29, bpdu
->max_age
);
110 br_set_ticks(buf
+31, bpdu
->hello_time
);
111 br_set_ticks(buf
+33, bpdu
->forward_delay
);
113 br_send_bpdu(p
, buf
, 35);
116 /* called under bridge lock */
117 void br_send_tcn_bpdu(struct net_bridge_port
*p
)
119 unsigned char buf
[4];
121 if (p
->br
->stp_enabled
!= BR_KERNEL_STP
)
127 buf
[3] = BPDU_TYPE_TCN
;
128 br_send_bpdu(p
, buf
, 4);
134 * NO locks, but rcu_read_lock (preempt_disabled)
136 void br_stp_rcv(const struct stp_proto
*proto
, struct sk_buff
*skb
,
137 struct net_device
*dev
)
139 const unsigned char *dest
= eth_hdr(skb
)->h_dest
;
140 struct net_bridge_port
*p
= rcu_dereference(dev
->br_port
);
141 struct net_bridge
*br
;
142 const unsigned char *buf
;
147 if (!pskb_may_pull(skb
, 4))
150 /* compare of protocol id and version */
152 if (buf
[0] != 0 || buf
[1] != 0 || buf
[2] != 0)
156 spin_lock(&br
->lock
);
158 if (br
->stp_enabled
!= BR_KERNEL_STP
)
161 if (!(br
->dev
->flags
& IFF_UP
))
164 if (p
->state
== BR_STATE_DISABLED
)
167 if (compare_ether_addr(dest
, br
->group_addr
) != 0)
170 buf
= skb_pull(skb
, 3);
172 if (buf
[0] == BPDU_TYPE_CONFIG
) {
173 struct br_config_bpdu bpdu
;
175 if (!pskb_may_pull(skb
, 32))
179 bpdu
.topology_change
= (buf
[1] & 0x01) ? 1 : 0;
180 bpdu
.topology_change_ack
= (buf
[1] & 0x80) ? 1 : 0;
182 bpdu
.root
.prio
[0] = buf
[2];
183 bpdu
.root
.prio
[1] = buf
[3];
184 bpdu
.root
.addr
[0] = buf
[4];
185 bpdu
.root
.addr
[1] = buf
[5];
186 bpdu
.root
.addr
[2] = buf
[6];
187 bpdu
.root
.addr
[3] = buf
[7];
188 bpdu
.root
.addr
[4] = buf
[8];
189 bpdu
.root
.addr
[5] = buf
[9];
190 bpdu
.root_path_cost
=
195 bpdu
.bridge_id
.prio
[0] = buf
[14];
196 bpdu
.bridge_id
.prio
[1] = buf
[15];
197 bpdu
.bridge_id
.addr
[0] = buf
[16];
198 bpdu
.bridge_id
.addr
[1] = buf
[17];
199 bpdu
.bridge_id
.addr
[2] = buf
[18];
200 bpdu
.bridge_id
.addr
[3] = buf
[19];
201 bpdu
.bridge_id
.addr
[4] = buf
[20];
202 bpdu
.bridge_id
.addr
[5] = buf
[21];
203 bpdu
.port_id
= (buf
[22] << 8) | buf
[23];
205 bpdu
.message_age
= br_get_ticks(buf
+24);
206 bpdu
.max_age
= br_get_ticks(buf
+26);
207 bpdu
.hello_time
= br_get_ticks(buf
+28);
208 bpdu
.forward_delay
= br_get_ticks(buf
+30);
210 br_received_config_bpdu(p
, &bpdu
);
213 else if (buf
[0] == BPDU_TYPE_TCN
) {
214 br_received_tcn_bpdu(p
);
217 spin_unlock(&br
->lock
);