2 * net/tipc/eth_media.c: Ethernet bearer support for TIPC
4 * Copyright (c) 2001-2007, Ericsson AB
5 * Copyright (c) 2005-2008, 2011, Wind River Systems
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions are met:
11 * 1. Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the distribution.
16 * 3. Neither the names of the copyright holders nor the names of its
17 * contributors may be used to endorse or promote products derived from
18 * this software without specific prior written permission.
20 * Alternatively, this software may be distributed under the terms of the
21 * GNU General Public License ("GPL") version 2 as published by the Free
22 * Software Foundation.
24 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
25 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
26 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
27 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
28 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
29 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
30 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
31 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
32 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
33 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
34 * POSSIBILITY OF SUCH DAMAGE.
40 #define MAX_ETH_BEARERS MAX_BEARERS
42 #define ETH_ADDR_OFFSET 4 /* message header offset of MAC address */
45 * struct eth_bearer - Ethernet bearer data structure
46 * @bearer: ptr to associated "generic" bearer structure
47 * @dev: ptr to associated Ethernet network device
48 * @tipc_packet_type: used in binding TIPC to Ethernet driver
52 struct tipc_bearer
*bearer
;
53 struct net_device
*dev
;
54 struct packet_type tipc_packet_type
;
57 static struct media eth_media_info
;
58 static struct eth_bearer eth_bearers
[MAX_ETH_BEARERS
];
59 static int eth_started
;
60 static struct notifier_block notifier
;
63 * eth_media_addr_set - initialize Ethernet media address structure
65 * Media-dependent "value" field stores MAC address in first 6 bytes
66 * and zeroes out the remaining bytes.
69 static void eth_media_addr_set(struct tipc_media_addr
*a
, char *mac
)
71 memcpy(a
->value
, mac
, ETH_ALEN
);
72 memset(a
->value
+ ETH_ALEN
, 0, sizeof(a
->value
) - ETH_ALEN
);
73 a
->media_id
= TIPC_MEDIA_TYPE_ETH
;
74 a
->broadcast
= !memcmp(mac
, eth_media_info
.bcast_addr
.value
, ETH_ALEN
);
78 * send_msg - send a TIPC message out over an Ethernet interface
81 static int send_msg(struct sk_buff
*buf
, struct tipc_bearer
*tb_ptr
,
82 struct tipc_media_addr
*dest
)
84 struct sk_buff
*clone
;
85 struct net_device
*dev
;
88 clone
= skb_clone(buf
, GFP_ATOMIC
);
92 dev
= ((struct eth_bearer
*)(tb_ptr
->usr_handle
))->dev
;
93 delta
= dev
->hard_header_len
- skb_headroom(buf
);
96 pskb_expand_head(clone
, SKB_DATA_ALIGN(delta
), 0, GFP_ATOMIC
)) {
101 skb_reset_network_header(clone
);
103 dev_hard_header(clone
, dev
, ETH_P_TIPC
, dest
->value
,
104 dev
->dev_addr
, clone
->len
);
105 dev_queue_xmit(clone
);
110 * recv_msg - handle incoming TIPC message from an Ethernet interface
112 * Accept only packets explicitly sent to this node, or broadcast packets;
113 * ignores packets sent using Ethernet multicast, and traffic sent to other
114 * nodes (which can happen if interface is running in promiscuous mode).
117 static int recv_msg(struct sk_buff
*buf
, struct net_device
*dev
,
118 struct packet_type
*pt
, struct net_device
*orig_dev
)
120 struct eth_bearer
*eb_ptr
= (struct eth_bearer
*)pt
->af_packet_priv
;
122 if (!net_eq(dev_net(dev
), &init_net
)) {
127 if (likely(eb_ptr
->bearer
)) {
128 if (likely(buf
->pkt_type
<= PACKET_BROADCAST
)) {
130 tipc_recv_msg(buf
, eb_ptr
->bearer
);
139 * enable_bearer - attach TIPC bearer to an Ethernet interface
142 static int enable_bearer(struct tipc_bearer
*tb_ptr
)
144 struct net_device
*dev
= NULL
;
145 struct net_device
*pdev
= NULL
;
146 struct eth_bearer
*eb_ptr
= ð_bearers
[0];
147 struct eth_bearer
*stop
= ð_bearers
[MAX_ETH_BEARERS
];
148 char *driver_name
= strchr((const char *)tb_ptr
->name
, ':') + 1;
151 /* Find unused Ethernet bearer structure */
153 while (eb_ptr
->dev
) {
156 if (++eb_ptr
== stop
)
157 return pending_dev
? -EAGAIN
: -EDQUOT
;
160 /* Find device with specified name */
162 read_lock(&dev_base_lock
);
163 for_each_netdev(&init_net
, pdev
) {
164 if (!strncmp(pdev
->name
, driver_name
, IFNAMSIZ
)) {
170 read_unlock(&dev_base_lock
);
174 /* Create Ethernet bearer for device */
177 eb_ptr
->tipc_packet_type
.type
= htons(ETH_P_TIPC
);
178 eb_ptr
->tipc_packet_type
.dev
= dev
;
179 eb_ptr
->tipc_packet_type
.func
= recv_msg
;
180 eb_ptr
->tipc_packet_type
.af_packet_priv
= eb_ptr
;
181 INIT_LIST_HEAD(&(eb_ptr
->tipc_packet_type
.list
));
182 dev_add_pack(&eb_ptr
->tipc_packet_type
);
184 /* Associate TIPC bearer with Ethernet bearer */
186 eb_ptr
->bearer
= tb_ptr
;
187 tb_ptr
->usr_handle
= (void *)eb_ptr
;
188 tb_ptr
->mtu
= dev
->mtu
;
190 eth_media_addr_set(&tb_ptr
->addr
, (char *)dev
->dev_addr
);
195 * disable_bearer - detach TIPC bearer from an Ethernet interface
197 * We really should do dev_remove_pack() here, but this function can not be
198 * called at tasklet level. => Use eth_bearer->bearer as a flag to throw away
199 * incoming buffers, & postpone dev_remove_pack() to eth_media_stop() on exit.
202 static void disable_bearer(struct tipc_bearer
*tb_ptr
)
204 ((struct eth_bearer
*)tb_ptr
->usr_handle
)->bearer
= NULL
;
208 * recv_notification - handle device updates from OS
210 * Change the state of the Ethernet bearer (if any) associated with the
214 static int recv_notification(struct notifier_block
*nb
, unsigned long evt
,
217 struct net_device
*dev
= (struct net_device
*)dv
;
218 struct eth_bearer
*eb_ptr
= ð_bearers
[0];
219 struct eth_bearer
*stop
= ð_bearers
[MAX_ETH_BEARERS
];
221 if (!net_eq(dev_net(dev
), &init_net
))
224 while ((eb_ptr
->dev
!= dev
)) {
225 if (++eb_ptr
== stop
)
226 return NOTIFY_DONE
; /* couldn't find device */
229 return NOTIFY_DONE
; /* bearer had been disabled */
231 eb_ptr
->bearer
->mtu
= dev
->mtu
;
235 if (netif_carrier_ok(dev
))
236 tipc_continue(eb_ptr
->bearer
);
238 tipc_block_bearer(eb_ptr
->bearer
->name
);
241 tipc_continue(eb_ptr
->bearer
);
244 tipc_block_bearer(eb_ptr
->bearer
->name
);
246 case NETDEV_CHANGEMTU
:
247 case NETDEV_CHANGEADDR
:
248 tipc_block_bearer(eb_ptr
->bearer
->name
);
249 tipc_continue(eb_ptr
->bearer
);
251 case NETDEV_UNREGISTER
:
252 case NETDEV_CHANGENAME
:
253 tipc_disable_bearer(eb_ptr
->bearer
->name
);
260 * eth_addr2str - convert Ethernet address to string
263 static int eth_addr2str(struct tipc_media_addr
*a
, char *str_buf
, int str_size
)
265 if (str_size
< 18) /* 18 = strlen("aa:bb:cc:dd:ee:ff\0") */
268 sprintf(str_buf
, "%pM", a
->value
);
273 * eth_str2addr - convert string to Ethernet address
276 static int eth_str2addr(struct tipc_media_addr
*a
, char *str_buf
)
281 r
= sscanf(str_buf
, "%02x:%02x:%02x:%02x:%02x:%02x",
282 (u32
*)&mac
[0], (u32
*)&mac
[1], (u32
*)&mac
[2],
283 (u32
*)&mac
[3], (u32
*)&mac
[4], (u32
*)&mac
[5]);
288 eth_media_addr_set(a
, mac
);
293 * eth_str2addr - convert Ethernet address format to message header format
296 static int eth_addr2msg(struct tipc_media_addr
*a
, char *msg_area
)
298 memset(msg_area
, 0, TIPC_MEDIA_ADDR_SIZE
);
299 msg_area
[TIPC_MEDIA_TYPE_OFFSET
] = TIPC_MEDIA_TYPE_ETH
;
300 memcpy(msg_area
+ ETH_ADDR_OFFSET
, a
->value
, ETH_ALEN
);
305 * eth_str2addr - convert message header address format to Ethernet format
308 static int eth_msg2addr(struct tipc_media_addr
*a
, char *msg_area
)
310 if (msg_area
[TIPC_MEDIA_TYPE_OFFSET
] != TIPC_MEDIA_TYPE_ETH
)
313 eth_media_addr_set(a
, msg_area
+ ETH_ADDR_OFFSET
);
318 * Ethernet media registration info
321 static struct media eth_media_info
= {
322 .send_msg
= send_msg
,
323 .enable_bearer
= enable_bearer
,
324 .disable_bearer
= disable_bearer
,
325 .addr2str
= eth_addr2str
,
326 .str2addr
= eth_str2addr
,
327 .addr2msg
= eth_addr2msg
,
328 .msg2addr
= eth_msg2addr
,
329 .bcast_addr
= { { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff },
330 TIPC_MEDIA_TYPE_ETH
, 1 },
331 .priority
= TIPC_DEF_LINK_PRI
,
332 .tolerance
= TIPC_DEF_LINK_TOL
,
333 .window
= TIPC_DEF_LINK_WIN
,
334 .type_id
= TIPC_MEDIA_TYPE_ETH
,
339 * tipc_eth_media_start - activate Ethernet bearer support
341 * Register Ethernet media type with TIPC bearer code. Also register
342 * with OS for notifications about device state changes.
345 int tipc_eth_media_start(void)
352 memset(eth_bearers
, 0, sizeof(eth_bearers
));
354 res
= tipc_register_media(ð_media_info
);
358 notifier
.notifier_call
= &recv_notification
;
359 notifier
.priority
= 0;
360 res
= register_netdevice_notifier(¬ifier
);
367 * tipc_eth_media_stop - deactivate Ethernet bearer support
370 void tipc_eth_media_stop(void)
377 unregister_netdevice_notifier(¬ifier
);
378 for (i
= 0; i
< MAX_ETH_BEARERS
; i
++) {
379 if (eth_bearers
[i
].bearer
) {
380 eth_bearers
[i
].bearer
->blocked
= 1;
381 eth_bearers
[i
].bearer
= NULL
;
383 if (eth_bearers
[i
].dev
) {
384 dev_remove_pack(ð_bearers
[i
].tipc_packet_type
);
385 dev_put(eth_bearers
[i
].dev
);
388 memset(ð_bearers
, 0, sizeof(eth_bearers
));