1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37#include "core.h"
38#include "bearer.h"
39
40#define MAX_ETH_BEARERS MAX_BEARERS
41
42#define ETH_ADDR_OFFSET 4
43
44
45
46
47
48
49
50
51struct eth_bearer {
52 struct tipc_bearer *bearer;
53 struct net_device *dev;
54 struct packet_type tipc_packet_type;
55 struct work_struct cleanup;
56};
57
58static struct tipc_media eth_media_info;
59static struct eth_bearer eth_bearers[MAX_ETH_BEARERS];
60static int eth_started;
61static struct notifier_block notifier;
62
63
64
65
66
67
68
69static void eth_media_addr_set(struct tipc_media_addr *a, char *mac)
70{
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);
75}
76
77
78
79
80static int send_msg(struct sk_buff *buf, struct tipc_bearer *tb_ptr,
81 struct tipc_media_addr *dest)
82{
83 struct sk_buff *clone;
84 struct net_device *dev;
85 int delta;
86
87 clone = skb_clone(buf, GFP_ATOMIC);
88 if (!clone)
89 return 0;
90
91 dev = ((struct eth_bearer *)(tb_ptr->usr_handle))->dev;
92 delta = dev->hard_header_len - skb_headroom(buf);
93
94 if ((delta > 0) &&
95 pskb_expand_head(clone, SKB_DATA_ALIGN(delta), 0, GFP_ATOMIC)) {
96 kfree_skb(clone);
97 return 0;
98 }
99
100 skb_reset_network_header(clone);
101 clone->dev = dev;
102 dev_hard_header(clone, dev, ETH_P_TIPC, dest->value,
103 dev->dev_addr, clone->len);
104 dev_queue_xmit(clone);
105 return 0;
106}
107
108
109
110
111
112
113
114
115static int recv_msg(struct sk_buff *buf, struct net_device *dev,
116 struct packet_type *pt, struct net_device *orig_dev)
117{
118 struct eth_bearer *eb_ptr = (struct eth_bearer *)pt->af_packet_priv;
119
120 if (!net_eq(dev_net(dev), &init_net)) {
121 kfree_skb(buf);
122 return 0;
123 }
124
125 if (likely(eb_ptr->bearer)) {
126 if (likely(buf->pkt_type <= PACKET_BROADCAST)) {
127 buf->next = NULL;
128 tipc_recv_msg(buf, eb_ptr->bearer);
129 return 0;
130 }
131 }
132 kfree_skb(buf);
133 return 0;
134}
135
136
137
138
139static int enable_bearer(struct tipc_bearer *tb_ptr)
140{
141 struct net_device *dev = NULL;
142 struct net_device *pdev = NULL;
143 struct eth_bearer *eb_ptr = ð_bearers[0];
144 struct eth_bearer *stop = ð_bearers[MAX_ETH_BEARERS];
145 char *driver_name = strchr((const char *)tb_ptr->name, ':') + 1;
146 int pending_dev = 0;
147
148
149 while (eb_ptr->dev) {
150 if (!eb_ptr->bearer)
151 pending_dev++;
152 if (++eb_ptr == stop)
153 return pending_dev ? -EAGAIN : -EDQUOT;
154 }
155
156
157 read_lock(&dev_base_lock);
158 for_each_netdev(&init_net, pdev) {
159 if (!strncmp(pdev->name, driver_name, IFNAMSIZ)) {
160 dev = pdev;
161 dev_hold(dev);
162 break;
163 }
164 }
165 read_unlock(&dev_base_lock);
166 if (!dev)
167 return -ENODEV;
168
169
170 eb_ptr->dev = dev;
171 eb_ptr->tipc_packet_type.type = htons(ETH_P_TIPC);
172 eb_ptr->tipc_packet_type.dev = dev;
173 eb_ptr->tipc_packet_type.func = recv_msg;
174 eb_ptr->tipc_packet_type.af_packet_priv = eb_ptr;
175 INIT_LIST_HEAD(&(eb_ptr->tipc_packet_type.list));
176 dev_add_pack(&eb_ptr->tipc_packet_type);
177
178
179 eb_ptr->bearer = tb_ptr;
180 tb_ptr->usr_handle = (void *)eb_ptr;
181 tb_ptr->mtu = dev->mtu;
182 tb_ptr->blocked = 0;
183 eth_media_addr_set(&tb_ptr->addr, (char *)dev->dev_addr);
184 return 0;
185}
186
187
188
189
190
191
192static void cleanup_bearer(struct work_struct *work)
193{
194 struct eth_bearer *eb_ptr =
195 container_of(work, struct eth_bearer, cleanup);
196
197 dev_remove_pack(&eb_ptr->tipc_packet_type);
198 dev_put(eb_ptr->dev);
199 eb_ptr->dev = NULL;
200}
201
202
203
204
205
206
207
208
209static void disable_bearer(struct tipc_bearer *tb_ptr)
210{
211 struct eth_bearer *eb_ptr = (struct eth_bearer *)tb_ptr->usr_handle;
212
213 eb_ptr->bearer = NULL;
214 INIT_WORK(&eb_ptr->cleanup, cleanup_bearer);
215 schedule_work(&eb_ptr->cleanup);
216}
217
218
219
220
221
222
223
224static int recv_notification(struct notifier_block *nb, unsigned long evt,
225 void *dv)
226{
227 struct net_device *dev = (struct net_device *)dv;
228 struct eth_bearer *eb_ptr = ð_bearers[0];
229 struct eth_bearer *stop = ð_bearers[MAX_ETH_BEARERS];
230
231 if (!net_eq(dev_net(dev), &init_net))
232 return NOTIFY_DONE;
233
234 while ((eb_ptr->dev != dev)) {
235 if (++eb_ptr == stop)
236 return NOTIFY_DONE;
237 }
238 if (!eb_ptr->bearer)
239 return NOTIFY_DONE;
240
241 eb_ptr->bearer->mtu = dev->mtu;
242
243 switch (evt) {
244 case NETDEV_CHANGE:
245 if (netif_carrier_ok(dev))
246 tipc_continue(eb_ptr->bearer);
247 else
248 tipc_block_bearer(eb_ptr->bearer->name);
249 break;
250 case NETDEV_UP:
251 tipc_continue(eb_ptr->bearer);
252 break;
253 case NETDEV_DOWN:
254 tipc_block_bearer(eb_ptr->bearer->name);
255 break;
256 case NETDEV_CHANGEMTU:
257 case NETDEV_CHANGEADDR:
258 tipc_block_bearer(eb_ptr->bearer->name);
259 tipc_continue(eb_ptr->bearer);
260 break;
261 case NETDEV_UNREGISTER:
262 case NETDEV_CHANGENAME:
263 tipc_disable_bearer(eb_ptr->bearer->name);
264 break;
265 }
266 return NOTIFY_OK;
267}
268
269
270
271
272static int eth_addr2str(struct tipc_media_addr *a, char *str_buf, int str_size)
273{
274 if (str_size < 18)
275 return 1;
276
277 sprintf(str_buf, "%pM", a->value);
278 return 0;
279}
280
281
282
283
284static int eth_str2addr(struct tipc_media_addr *a, char *str_buf)
285{
286 char mac[ETH_ALEN];
287 int r;
288
289 r = sscanf(str_buf, "%02x:%02x:%02x:%02x:%02x:%02x",
290 (u32 *)&mac[0], (u32 *)&mac[1], (u32 *)&mac[2],
291 (u32 *)&mac[3], (u32 *)&mac[4], (u32 *)&mac[5]);
292
293 if (r != ETH_ALEN)
294 return 1;
295
296 eth_media_addr_set(a, mac);
297 return 0;
298}
299
300
301
302
303static int eth_addr2msg(struct tipc_media_addr *a, char *msg_area)
304{
305 memset(msg_area, 0, TIPC_MEDIA_ADDR_SIZE);
306 msg_area[TIPC_MEDIA_TYPE_OFFSET] = TIPC_MEDIA_TYPE_ETH;
307 memcpy(msg_area + ETH_ADDR_OFFSET, a->value, ETH_ALEN);
308 return 0;
309}
310
311
312
313
314static int eth_msg2addr(struct tipc_media_addr *a, char *msg_area)
315{
316 if (msg_area[TIPC_MEDIA_TYPE_OFFSET] != TIPC_MEDIA_TYPE_ETH)
317 return 1;
318
319 eth_media_addr_set(a, msg_area + ETH_ADDR_OFFSET);
320 return 0;
321}
322
323
324
325
326static struct tipc_media eth_media_info = {
327 .send_msg = send_msg,
328 .enable_bearer = enable_bearer,
329 .disable_bearer = disable_bearer,
330 .addr2str = eth_addr2str,
331 .str2addr = eth_str2addr,
332 .addr2msg = eth_addr2msg,
333 .msg2addr = eth_msg2addr,
334 .bcast_addr = { { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff },
335 TIPC_MEDIA_TYPE_ETH, 1 },
336 .priority = TIPC_DEF_LINK_PRI,
337 .tolerance = TIPC_DEF_LINK_TOL,
338 .window = TIPC_DEF_LINK_WIN,
339 .type_id = TIPC_MEDIA_TYPE_ETH,
340 .name = "eth"
341};
342
343
344
345
346
347
348
349int tipc_eth_media_start(void)
350{
351 int res;
352
353 if (eth_started)
354 return -EINVAL;
355
356 res = tipc_register_media(ð_media_info);
357 if (res)
358 return res;
359
360 notifier.notifier_call = &recv_notification;
361 notifier.priority = 0;
362 res = register_netdevice_notifier(¬ifier);
363 if (!res)
364 eth_started = 1;
365 return res;
366}
367
368
369
370
371void tipc_eth_media_stop(void)
372{
373 if (!eth_started)
374 return;
375
376 flush_scheduled_work();
377 unregister_netdevice_notifier(¬ifier);
378 eth_started = 0;
379}
380