?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
udp: fix IP_CHECKSUM handling
[linux/fpc-iii.git] / net / tipc / bearer.c
blob65b1bbf133bde535088f10b134b372aaa6f252c2
1 /*
2 * net/tipc/bearer.c: TIPC bearer code
3 *
4 * Copyright (c) 1996-2006, 2013-2016, Ericsson AB
5 * Copyright (c) 2004-2006, 2010-2013, Wind River Systems
6 * All rights reserved.
7 *
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions are met:
10 *
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.
19 *
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.
23 *
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.
35 */
36
37 #include <net/sock.h>
38 #include "core.h"
39 #include "bearer.h"
40 #include "link.h"
41 #include "discover.h"
42 #include "monitor.h"
43 #include "bcast.h"
44 #include "netlink.h"
45
46 #define MAX_ADDR_STR 60
47
48 static struct tipc_media * const media_info_array[] = {
49 &eth_media_info,
50 #ifdef CONFIG_TIPC_MEDIA_IB
51 &ib_media_info,
52 #endif
53 #ifdef CONFIG_TIPC_MEDIA_UDP
54 &udp_media_info,
55 #endif
56 NULL
57 };
58
59 static void bearer_disable(struct net *net, struct tipc_bearer *b);
60
61 /**
62 * tipc_media_find - locates specified media object by name
63 */
64 struct tipc_media *tipc_media_find(const char *name)
65 {
66 u32 i;
67
68 for (i = 0; media_info_array[i] != NULL; i++) {
69 if (!strcmp(media_info_array[i]->name, name))
70 break;
71 }
72 return media_info_array[i];
73 }
74
75 /**
76 * media_find_id - locates specified media object by type identifier
77 */
78 static struct tipc_media *media_find_id(u8 type)
79 {
80 u32 i;
81
82 for (i = 0; media_info_array[i] != NULL; i++) {
83 if (media_info_array[i]->type_id == type)
84 break;
85 }
86 return media_info_array[i];
87 }
88
89 /**
90 * tipc_media_addr_printf - record media address in print buffer
91 */
92 void tipc_media_addr_printf(char *buf, int len, struct tipc_media_addr *a)
93 {
94 char addr_str[MAX_ADDR_STR];
95 struct tipc_media *m;
96 int ret;
97
98 m = media_find_id(a->media_id);
99
100 if (m && !m->addr2str(a, addr_str, sizeof(addr_str)))
101 ret = scnprintf(buf, len, "%s(%s)", m->name, addr_str);
102 else {
103 u32 i;
104
105 ret = scnprintf(buf, len, "UNKNOWN(%u)", a->media_id);
106 for (i = 0; i < sizeof(a->value); i++)
107 ret += scnprintf(buf - ret, len + ret,
108 "-%02x", a->value[i]);
109 }
110 }
111
112 /**
113 * bearer_name_validate - validate & (optionally) deconstruct bearer name
114 * @name: ptr to bearer name string
115 * @name_parts: ptr to area for bearer name components (or NULL if not needed)
116 *
117 * Returns 1 if bearer name is valid, otherwise 0.
118 */
119 static int bearer_name_validate(const char *name,
120 struct tipc_bearer_names *name_parts)
121 {
122 char name_copy[TIPC_MAX_BEARER_NAME];
123 char *media_name;
124 char *if_name;
125 u32 media_len;
126 u32 if_len;
127
128 /* copy bearer name & ensure length is OK */
129 name_copy[TIPC_MAX_BEARER_NAME - 1] = 0;
130 /* need above in case non-Posix strncpy() doesn't pad with nulls */
131 strncpy(name_copy, name, TIPC_MAX_BEARER_NAME);
132 if (name_copy[TIPC_MAX_BEARER_NAME - 1] != 0)
133 return 0;
134
135 /* ensure all component parts of bearer name are present */
136 media_name = name_copy;
137 if_name = strchr(media_name, ':');
138 if (if_name == NULL)
139 return 0;
140 *(if_name++) = 0;
141 media_len = if_name - media_name;
142 if_len = strlen(if_name) + 1;
143
144 /* validate component parts of bearer name */
145 if ((media_len <= 1) || (media_len > TIPC_MAX_MEDIA_NAME) ||
146 (if_len <= 1) || (if_len > TIPC_MAX_IF_NAME))
147 return 0;
148
149 /* return bearer name components, if necessary */
150 if (name_parts) {
151 strcpy(name_parts->media_name, media_name);
152 strcpy(name_parts->if_name, if_name);
153 }
154 return 1;
155 }
156
157 /**
158 * tipc_bearer_find - locates bearer object with matching bearer name
159 */
160 struct tipc_bearer *tipc_bearer_find(struct net *net, const char *name)
161 {
162 struct tipc_net *tn = net_generic(net, tipc_net_id);
163 struct tipc_bearer *b;
164 u32 i;
165
166 for (i = 0; i < MAX_BEARERS; i++) {
167 b = rtnl_dereference(tn->bearer_list[i]);
168 if (b && (!strcmp(b->name, name)))
169 return b;
170 }
171 return NULL;
172 }
173
174 /* tipc_bearer_get_name - get the bearer name from its id.
175 * @net: network namespace
176 * @name: a pointer to the buffer where the name will be stored.
177 * @bearer_id: the id to get the name from.
178 */
179 int tipc_bearer_get_name(struct net *net, char *name, u32 bearer_id)
180 {
181 struct tipc_net *tn = tipc_net(net);
182 struct tipc_bearer *b;
183
184 if (bearer_id >= MAX_BEARERS)
185 return -EINVAL;
186
187 b = rtnl_dereference(tn->bearer_list[bearer_id]);
188 if (!b)
189 return -EINVAL;
190
191 strcpy(name, b->name);
192 return 0;
193 }
194
195 void tipc_bearer_add_dest(struct net *net, u32 bearer_id, u32 dest)
196 {
197 struct tipc_net *tn = net_generic(net, tipc_net_id);
198 struct tipc_bearer *b;
199
200 rcu_read_lock();
201 b = rcu_dereference_rtnl(tn->bearer_list[bearer_id]);
202 if (b)
203 tipc_disc_add_dest(b->link_req);
204 rcu_read_unlock();
205 }
206
207 void tipc_bearer_remove_dest(struct net *net, u32 bearer_id, u32 dest)
208 {
209 struct tipc_net *tn = net_generic(net, tipc_net_id);
210 struct tipc_bearer *b;
211
212 rcu_read_lock();
213 b = rcu_dereference_rtnl(tn->bearer_list[bearer_id]);
214 if (b)
215 tipc_disc_remove_dest(b->link_req);
216 rcu_read_unlock();
217 }
218
219 /**
220 * tipc_enable_bearer - enable bearer with the given name
221 */
222 static int tipc_enable_bearer(struct net *net, const char *name,
223 u32 disc_domain, u32 priority,
224 struct nlattr *attr[])
225 {
226 struct tipc_net *tn = net_generic(net, tipc_net_id);
227 struct tipc_bearer *b;
228 struct tipc_media *m;
229 struct tipc_bearer_names b_names;
230 struct sk_buff *skb;
231 char addr_string[16];
232 u32 bearer_id;
233 u32 with_this_prio;
234 u32 i;
235 int res = -EINVAL;
236
237 if (!tn->own_addr) {
238 pr_warn("Bearer <%s> rejected, not supported in standalone mode\n",
239 name);
240 return -ENOPROTOOPT;
241 }
242 if (!bearer_name_validate(name, &b_names)) {
243 pr_warn("Bearer <%s> rejected, illegal name\n", name);
244 return -EINVAL;
245 }
246 if (tipc_addr_domain_valid(disc_domain) &&
247 (disc_domain != tn->own_addr)) {
248 if (tipc_in_scope(disc_domain, tn->own_addr)) {
249 disc_domain = tn->own_addr & TIPC_ZONE_CLUSTER_MASK;
250 res = 0; /* accept any node in own cluster */
251 } else if (in_own_cluster_exact(net, disc_domain))
252 res = 0; /* accept specified node in own cluster */
253 }
254 if (res) {
255 pr_warn("Bearer <%s> rejected, illegal discovery domain\n",
256 name);
257 return -EINVAL;
258 }
259 if ((priority > TIPC_MAX_LINK_PRI) &&
260 (priority != TIPC_MEDIA_LINK_PRI)) {
261 pr_warn("Bearer <%s> rejected, illegal priority\n", name);
262 return -EINVAL;
263 }
264
265 m = tipc_media_find(b_names.media_name);
266 if (!m) {
267 pr_warn("Bearer <%s> rejected, media <%s> not registered\n",
268 name, b_names.media_name);
269 return -EINVAL;
270 }
271
272 if (priority == TIPC_MEDIA_LINK_PRI)
273 priority = m->priority;
274
275 restart:
276 bearer_id = MAX_BEARERS;
277 with_this_prio = 1;
278 for (i = MAX_BEARERS; i-- != 0; ) {
279 b = rtnl_dereference(tn->bearer_list[i]);
280 if (!b) {
281 bearer_id = i;
282 continue;
283 }
284 if (!strcmp(name, b->name)) {
285 pr_warn("Bearer <%s> rejected, already enabled\n",
286 name);
287 return -EINVAL;
288 }
289 if ((b->priority == priority) &&
290 (++with_this_prio > 2)) {
291 if (priority-- == 0) {
292 pr_warn("Bearer <%s> rejected, duplicate priority\n",
293 name);
294 return -EINVAL;
295 }
296 pr_warn("Bearer <%s> priority adjustment required %u->%u\n",
297 name, priority + 1, priority);
298 goto restart;
299 }
300 }
301 if (bearer_id >= MAX_BEARERS) {
302 pr_warn("Bearer <%s> rejected, bearer limit reached (%u)\n",
303 name, MAX_BEARERS);
304 return -EINVAL;
305 }
306
307 b = kzalloc(sizeof(*b), GFP_ATOMIC);
308 if (!b)
309 return -ENOMEM;
310
311 strcpy(b->name, name);
312 b->media = m;
313 res = m->enable_media(net, b, attr);
314 if (res) {
315 pr_warn("Bearer <%s> rejected, enable failure (%d)\n",
316 name, -res);
317 return -EINVAL;
318 }
319
320 b->identity = bearer_id;
321 b->tolerance = m->tolerance;
322 b->window = m->window;
323 b->domain = disc_domain;
324 b->net_plane = bearer_id + 'A';
325 b->priority = priority;
326
327 res = tipc_disc_create(net, b, &b->bcast_addr, &skb);
328 if (res) {
329 bearer_disable(net, b);
330 pr_warn("Bearer <%s> rejected, discovery object creation failed\n",
331 name);
332 return -EINVAL;
333 }
334
335 rcu_assign_pointer(tn->bearer_list[bearer_id], b);
336 if (skb)
337 tipc_bearer_xmit_skb(net, bearer_id, skb, &b->bcast_addr);
338
339 if (tipc_mon_create(net, bearer_id))
340 return -ENOMEM;
341
342 pr_info("Enabled bearer <%s>, discovery domain %s, priority %u\n",
343 name,
344 tipc_addr_string_fill(addr_string, disc_domain), priority);
345 return res;
346 }
347
348 /**
349 * tipc_reset_bearer - Reset all links established over this bearer
350 */
351 static int tipc_reset_bearer(struct net *net, struct tipc_bearer *b)
352 {
353 pr_info("Resetting bearer <%s>\n", b->name);
354 tipc_node_delete_links(net, b->identity);
355 tipc_disc_reset(net, b);
356 return 0;
357 }
358
359 /* tipc_bearer_reset_all - reset all links on all bearers
360 */
361 void tipc_bearer_reset_all(struct net *net)
362 {
363 struct tipc_net *tn = tipc_net(net);
364 struct tipc_bearer *b;
365 int i;
366
367 for (i = 0; i < MAX_BEARERS; i++) {
368 b = rcu_dereference_rtnl(tn->bearer_list[i]);
369 if (b)
370 tipc_reset_bearer(net, b);
371 }
372 }
373
374 /**
375 * bearer_disable
376 *
377 * Note: This routine assumes caller holds RTNL lock.
378 */
379 static void bearer_disable(struct net *net, struct tipc_bearer *b)
380 {
381 struct tipc_net *tn = tipc_net(net);
382 int bearer_id = b->identity;
383
384 pr_info("Disabling bearer <%s>\n", b->name);
385 b->media->disable_media(b);
386 tipc_node_delete_links(net, bearer_id);
387 RCU_INIT_POINTER(b->media_ptr, NULL);
388 if (b->link_req)
389 tipc_disc_delete(b->link_req);
390 RCU_INIT_POINTER(tn->bearer_list[bearer_id], NULL);
391 kfree_rcu(b, rcu);
392 tipc_mon_delete(net, bearer_id);
393 }
394
395 int tipc_enable_l2_media(struct net *net, struct tipc_bearer *b,
396 struct nlattr *attr[])
397 {
398 struct net_device *dev;
399 char *driver_name = strchr((const char *)b->name, ':') + 1;
400
401 /* Find device with specified name */
402 dev = dev_get_by_name(net, driver_name);
403 if (!dev)
404 return -ENODEV;
405
406 /* Associate TIPC bearer with L2 bearer */
407 rcu_assign_pointer(b->media_ptr, dev);
408 memset(&b->bcast_addr, 0, sizeof(b->bcast_addr));
409 memcpy(b->bcast_addr.value, dev->broadcast, b->media->hwaddr_len);
410 b->bcast_addr.media_id = b->media->type_id;
411 b->bcast_addr.broadcast = 1;
412 b->mtu = dev->mtu;
413 b->media->raw2addr(b, &b->addr, (char *)dev->dev_addr);
414 rcu_assign_pointer(dev->tipc_ptr, b);
415 return 0;
416 }
417
418 /* tipc_disable_l2_media - detach TIPC bearer from an L2 interface
419 *
420 * Mark L2 bearer as inactive so that incoming buffers are thrown away
421 */
422 void tipc_disable_l2_media(struct tipc_bearer *b)
423 {
424 struct net_device *dev;
425
426 dev = (struct net_device *)rtnl_dereference(b->media_ptr);
427 RCU_INIT_POINTER(dev->tipc_ptr, NULL);
428 synchronize_net();
429 dev_put(dev);
430 }
431
432 /**
433 * tipc_l2_send_msg - send a TIPC packet out over an L2 interface
434 * @skb: the packet to be sent
435 * @b: the bearer through which the packet is to be sent
436 * @dest: peer destination address
437 */
438 int tipc_l2_send_msg(struct net *net, struct sk_buff *skb,
439 struct tipc_bearer *b, struct tipc_media_addr *dest)
440 {
441 struct net_device *dev;
442 int delta;
443 void *tipc_ptr;
444
445 dev = (struct net_device *)rcu_dereference_rtnl(b->media_ptr);
446 if (!dev)
447 return 0;
448
449 /* Send RESET message even if bearer is detached from device */
450 tipc_ptr = rcu_dereference_rtnl(dev->tipc_ptr);
451 if (unlikely(!tipc_ptr && !msg_is_reset(buf_msg(skb))))
452 goto drop;
453
454 delta = dev->hard_header_len - skb_headroom(skb);
455 if ((delta > 0) &&
456 pskb_expand_head(skb, SKB_DATA_ALIGN(delta), 0, GFP_ATOMIC))
457 goto drop;
458
459 skb_reset_network_header(skb);
460 skb->dev = dev;
461 skb->protocol = htons(ETH_P_TIPC);
462 dev_hard_header(skb, dev, ETH_P_TIPC, dest->value,
463 dev->dev_addr, skb->len);
464 dev_queue_xmit(skb);
465 return 0;
466 drop:
467 kfree_skb(skb);
468 return 0;
469 }
470
471 int tipc_bearer_mtu(struct net *net, u32 bearer_id)
472 {
473 int mtu = 0;
474 struct tipc_bearer *b;
475
476 rcu_read_lock();
477 b = rcu_dereference_rtnl(tipc_net(net)->bearer_list[bearer_id]);
478 if (b)
479 mtu = b->mtu;
480 rcu_read_unlock();
481 return mtu;
482 }
483
484 /* tipc_bearer_xmit_skb - sends buffer to destination over bearer
485 */
486 void tipc_bearer_xmit_skb(struct net *net, u32 bearer_id,
487 struct sk_buff *skb,
488 struct tipc_media_addr *dest)
489 {
490 struct tipc_net *tn = tipc_net(net);
491 struct tipc_bearer *b;
492
493 rcu_read_lock();
494 b = rcu_dereference_rtnl(tn->bearer_list[bearer_id]);
495 if (likely(b))
496 b->media->send_msg(net, skb, b, dest);
497 else
498 kfree_skb(skb);
499 rcu_read_unlock();
500 }
501
502 /* tipc_bearer_xmit() -send buffer to destination over bearer
503 */
504 void tipc_bearer_xmit(struct net *net, u32 bearer_id,
505 struct sk_buff_head *xmitq,
506 struct tipc_media_addr *dst)
507 {
508 struct tipc_net *tn = net_generic(net, tipc_net_id);
509 struct tipc_bearer *b;
510 struct sk_buff *skb, *tmp;
511
512 if (skb_queue_empty(xmitq))
513 return;
514
515 rcu_read_lock();
516 b = rcu_dereference_rtnl(tn->bearer_list[bearer_id]);
517 if (unlikely(!b))
518 __skb_queue_purge(xmitq);
519 skb_queue_walk_safe(xmitq, skb, tmp) {
520 __skb_dequeue(xmitq);
521 b->media->send_msg(net, skb, b, dst);
522 }
523 rcu_read_unlock();
524 }
525
526 /* tipc_bearer_bc_xmit() - broadcast buffers to all destinations
527 */
528 void tipc_bearer_bc_xmit(struct net *net, u32 bearer_id,
529 struct sk_buff_head *xmitq)
530 {
531 struct tipc_net *tn = tipc_net(net);
532 int net_id = tn->net_id;
533 struct tipc_bearer *b;
534 struct sk_buff *skb, *tmp;
535 struct tipc_msg *hdr;
536
537 rcu_read_lock();
538 b = rcu_dereference_rtnl(tn->bearer_list[bearer_id]);
539 if (unlikely(!b))
540 __skb_queue_purge(xmitq);
541 skb_queue_walk_safe(xmitq, skb, tmp) {
542 hdr = buf_msg(skb);
543 msg_set_non_seq(hdr, 1);
544 msg_set_mc_netid(hdr, net_id);
545 __skb_dequeue(xmitq);
546 b->media->send_msg(net, skb, b, &b->bcast_addr);
547 }
548 rcu_read_unlock();
549 }
550
551 /**
552 * tipc_l2_rcv_msg - handle incoming TIPC message from an interface
553 * @buf: the received packet
554 * @dev: the net device that the packet was received on
555 * @pt: the packet_type structure which was used to register this handler
556 * @orig_dev: the original receive net device in case the device is a bond
557 *
558 * Accept only packets explicitly sent to this node, or broadcast packets;
559 * ignores packets sent using interface multicast, and traffic sent to other
560 * nodes (which can happen if interface is running in promiscuous mode).
561 */
562 static int tipc_l2_rcv_msg(struct sk_buff *skb, struct net_device *dev,
563 struct packet_type *pt, struct net_device *orig_dev)
564 {
565 struct tipc_bearer *b;
566
567 rcu_read_lock();
568 b = rcu_dereference_rtnl(dev->tipc_ptr);
569 if (likely(b && (skb->pkt_type <= PACKET_BROADCAST))) {
570 skb->next = NULL;
571 tipc_rcv(dev_net(dev), skb, b);
572 rcu_read_unlock();
573 return NET_RX_SUCCESS;
574 }
575 rcu_read_unlock();
576 kfree_skb(skb);
577 return NET_RX_DROP;
578 }
579
580 /**
581 * tipc_l2_device_event - handle device events from network device
582 * @nb: the context of the notification
583 * @evt: the type of event
584 * @ptr: the net device that the event was on
585 *
586 * This function is called by the Ethernet driver in case of link
587 * change event.
588 */
589 static int tipc_l2_device_event(struct notifier_block *nb, unsigned long evt,
590 void *ptr)
591 {
592 struct net_device *dev = netdev_notifier_info_to_dev(ptr);
593 struct net *net = dev_net(dev);
594 struct tipc_net *tn = tipc_net(net);
595 struct tipc_bearer *b;
596 int i;
597
598 b = rtnl_dereference(dev->tipc_ptr);
599 if (!b) {
600 for (i = 0; i < MAX_BEARERS; b = NULL, i++) {
601 b = rtnl_dereference(tn->bearer_list[i]);
602 if (b && (b->media_ptr == dev))
603 break;
604 }
605 }
606 if (!b)
607 return NOTIFY_DONE;
608
609 b->mtu = dev->mtu;
610
611 switch (evt) {
612 case NETDEV_CHANGE:
613 if (netif_carrier_ok(dev))
614 break;
615 case NETDEV_UP:
616 rcu_assign_pointer(dev->tipc_ptr, b);
617 break;
618 case NETDEV_GOING_DOWN:
619 RCU_INIT_POINTER(dev->tipc_ptr, NULL);
620 synchronize_net();
621 tipc_reset_bearer(net, b);
622 break;
623 case NETDEV_CHANGEMTU:
624 tipc_reset_bearer(net, b);
625 break;
626 case NETDEV_CHANGEADDR:
627 b->media->raw2addr(b, &b->addr,
628 (char *)dev->dev_addr);
629 tipc_reset_bearer(net, b);
630 break;
631 case NETDEV_UNREGISTER:
632 case NETDEV_CHANGENAME:
633 bearer_disable(dev_net(dev), b);
634 break;
635 }
636 return NOTIFY_OK;
637 }
638
639 static struct packet_type tipc_packet_type __read_mostly = {
640 .type = htons(ETH_P_TIPC),
641 .func = tipc_l2_rcv_msg,
642 };
643
644 static struct notifier_block notifier = {
645 .notifier_call = tipc_l2_device_event,
646 .priority = 0,
647 };
648
649 int tipc_bearer_setup(void)
650 {
651 int err;
652
653 err = register_netdevice_notifier(&notifier);
654 if (err)
655 return err;
656 dev_add_pack(&tipc_packet_type);
657 return 0;
658 }
659
660 void tipc_bearer_cleanup(void)
661 {
662 unregister_netdevice_notifier(&notifier);
663 dev_remove_pack(&tipc_packet_type);
664 }
665
666 void tipc_bearer_stop(struct net *net)
667 {
668 struct tipc_net *tn = net_generic(net, tipc_net_id);
669 struct tipc_bearer *b;
670 u32 i;
671
672 for (i = 0; i < MAX_BEARERS; i++) {
673 b = rtnl_dereference(tn->bearer_list[i]);
674 if (b) {
675 bearer_disable(net, b);
676 tn->bearer_list[i] = NULL;
677 }
678 }
679 }
680
681 /* Caller should hold rtnl_lock to protect the bearer */
682 static int __tipc_nl_add_bearer(struct tipc_nl_msg *msg,
683 struct tipc_bearer *bearer, int nlflags)
684 {
685 void *hdr;
686 struct nlattr *attrs;
687 struct nlattr *prop;
688
689 hdr = genlmsg_put(msg->skb, msg->portid, msg->seq, &tipc_genl_family,
690 nlflags, TIPC_NL_BEARER_GET);
691 if (!hdr)
692 return -EMSGSIZE;
693
694 attrs = nla_nest_start(msg->skb, TIPC_NLA_BEARER);
695 if (!attrs)
696 goto msg_full;
697
698 if (nla_put_string(msg->skb, TIPC_NLA_BEARER_NAME, bearer->name))
699 goto attr_msg_full;
700
701 prop = nla_nest_start(msg->skb, TIPC_NLA_BEARER_PROP);
702 if (!prop)
703 goto prop_msg_full;
704 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_PRIO, bearer->priority))
705 goto prop_msg_full;
706 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_TOL, bearer->tolerance))
707 goto prop_msg_full;
708 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_WIN, bearer->window))
709 goto prop_msg_full;
710
711 nla_nest_end(msg->skb, prop);
712 nla_nest_end(msg->skb, attrs);
713 genlmsg_end(msg->skb, hdr);
714
715 return 0;
716
717 prop_msg_full:
718 nla_nest_cancel(msg->skb, prop);
719 attr_msg_full:
720 nla_nest_cancel(msg->skb, attrs);
721 msg_full:
722 genlmsg_cancel(msg->skb, hdr);
723
724 return -EMSGSIZE;
725 }
726
727 int tipc_nl_bearer_dump(struct sk_buff *skb, struct netlink_callback *cb)
728 {
729 int err;
730 int i = cb->args[0];
731 struct tipc_bearer *bearer;
732 struct tipc_nl_msg msg;
733 struct net *net = sock_net(skb->sk);
734 struct tipc_net *tn = net_generic(net, tipc_net_id);
735
736 if (i == MAX_BEARERS)
737 return 0;
738
739 msg.skb = skb;
740 msg.portid = NETLINK_CB(cb->skb).portid;
741 msg.seq = cb->nlh->nlmsg_seq;
742
743 rtnl_lock();
744 for (i = 0; i < MAX_BEARERS; i++) {
745 bearer = rtnl_dereference(tn->bearer_list[i]);
746 if (!bearer)
747 continue;
748
749 err = __tipc_nl_add_bearer(&msg, bearer, NLM_F_MULTI);
750 if (err)
751 break;
752 }
753 rtnl_unlock();
754
755 cb->args[0] = i;
756 return skb->len;
757 }
758
759 int tipc_nl_bearer_get(struct sk_buff *skb, struct genl_info *info)
760 {
761 int err;
762 char *name;
763 struct sk_buff *rep;
764 struct tipc_bearer *bearer;
765 struct tipc_nl_msg msg;
766 struct nlattr *attrs[TIPC_NLA_BEARER_MAX + 1];
767 struct net *net = genl_info_net(info);
768
769 if (!info->attrs[TIPC_NLA_BEARER])
770 return -EINVAL;
771
772 err = nla_parse_nested(attrs, TIPC_NLA_BEARER_MAX,
773 info->attrs[TIPC_NLA_BEARER],
774 tipc_nl_bearer_policy);
775 if (err)
776 return err;
777
778 if (!attrs[TIPC_NLA_BEARER_NAME])
779 return -EINVAL;
780 name = nla_data(attrs[TIPC_NLA_BEARER_NAME]);
781
782 rep = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
783 if (!rep)
784 return -ENOMEM;
785
786 msg.skb = rep;
787 msg.portid = info->snd_portid;
788 msg.seq = info->snd_seq;
789
790 rtnl_lock();
791 bearer = tipc_bearer_find(net, name);
792 if (!bearer) {
793 err = -EINVAL;
794 goto err_out;
795 }
796
797 err = __tipc_nl_add_bearer(&msg, bearer, 0);
798 if (err)
799 goto err_out;
800 rtnl_unlock();
801
802 return genlmsg_reply(rep, info);
803 err_out:
804 rtnl_unlock();
805 nlmsg_free(rep);
806
807 return err;
808 }
809
810 int tipc_nl_bearer_disable(struct sk_buff *skb, struct genl_info *info)
811 {
812 int err;
813 char *name;
814 struct tipc_bearer *bearer;
815 struct nlattr *attrs[TIPC_NLA_BEARER_MAX + 1];
816 struct net *net = sock_net(skb->sk);
817
818 if (!info->attrs[TIPC_NLA_BEARER])
819 return -EINVAL;
820
821 err = nla_parse_nested(attrs, TIPC_NLA_BEARER_MAX,
822 info->attrs[TIPC_NLA_BEARER],
823 tipc_nl_bearer_policy);
824 if (err)
825 return err;
826
827 if (!attrs[TIPC_NLA_BEARER_NAME])
828 return -EINVAL;
829
830 name = nla_data(attrs[TIPC_NLA_BEARER_NAME]);
831
832 rtnl_lock();
833 bearer = tipc_bearer_find(net, name);
834 if (!bearer) {
835 rtnl_unlock();
836 return -EINVAL;
837 }
838
839 bearer_disable(net, bearer);
840 rtnl_unlock();
841
842 return 0;
843 }
844
845 int tipc_nl_bearer_enable(struct sk_buff *skb, struct genl_info *info)
846 {
847 int err;
848 char *bearer;
849 struct nlattr *attrs[TIPC_NLA_BEARER_MAX + 1];
850 struct net *net = sock_net(skb->sk);
851 struct tipc_net *tn = net_generic(net, tipc_net_id);
852 u32 domain;
853 u32 prio;
854
855 prio = TIPC_MEDIA_LINK_PRI;
856 domain = tn->own_addr & TIPC_ZONE_CLUSTER_MASK;
857
858 if (!info->attrs[TIPC_NLA_BEARER])
859 return -EINVAL;
860
861 err = nla_parse_nested(attrs, TIPC_NLA_BEARER_MAX,
862 info->attrs[TIPC_NLA_BEARER],
863 tipc_nl_bearer_policy);
864 if (err)
865 return err;
866
867 if (!attrs[TIPC_NLA_BEARER_NAME])
868 return -EINVAL;
869
870 bearer = nla_data(attrs[TIPC_NLA_BEARER_NAME]);
871
872 if (attrs[TIPC_NLA_BEARER_DOMAIN])
873 domain = nla_get_u32(attrs[TIPC_NLA_BEARER_DOMAIN]);
874
875 if (attrs[TIPC_NLA_BEARER_PROP]) {
876 struct nlattr *props[TIPC_NLA_PROP_MAX + 1];
877
878 err = tipc_nl_parse_link_prop(attrs[TIPC_NLA_BEARER_PROP],
879 props);
880 if (err)
881 return err;
882
883 if (props[TIPC_NLA_PROP_PRIO])
884 prio = nla_get_u32(props[TIPC_NLA_PROP_PRIO]);
885 }
886
887 rtnl_lock();
888 err = tipc_enable_bearer(net, bearer, domain, prio, attrs);
889 if (err) {
890 rtnl_unlock();
891 return err;
892 }
893 rtnl_unlock();
894
895 return 0;
896 }
897
898 int tipc_nl_bearer_set(struct sk_buff *skb, struct genl_info *info)
899 {
900 int err;
901 char *name;
902 struct tipc_bearer *b;
903 struct nlattr *attrs[TIPC_NLA_BEARER_MAX + 1];
904 struct net *net = sock_net(skb->sk);
905
906 if (!info->attrs[TIPC_NLA_BEARER])
907 return -EINVAL;
908
909 err = nla_parse_nested(attrs, TIPC_NLA_BEARER_MAX,
910 info->attrs[TIPC_NLA_BEARER],
911 tipc_nl_bearer_policy);
912 if (err)
913 return err;
914
915 if (!attrs[TIPC_NLA_BEARER_NAME])
916 return -EINVAL;
917 name = nla_data(attrs[TIPC_NLA_BEARER_NAME]);
918
919 rtnl_lock();
920 b = tipc_bearer_find(net, name);
921 if (!b) {
922 rtnl_unlock();
923 return -EINVAL;
924 }
925
926 if (attrs[TIPC_NLA_BEARER_PROP]) {
927 struct nlattr *props[TIPC_NLA_PROP_MAX + 1];
928
929 err = tipc_nl_parse_link_prop(attrs[TIPC_NLA_BEARER_PROP],
930 props);
931 if (err) {
932 rtnl_unlock();
933 return err;
934 }
935
936 if (props[TIPC_NLA_PROP_TOL])
937 b->tolerance = nla_get_u32(props[TIPC_NLA_PROP_TOL]);
938 if (props[TIPC_NLA_PROP_PRIO])
939 b->priority = nla_get_u32(props[TIPC_NLA_PROP_PRIO]);
940 if (props[TIPC_NLA_PROP_WIN])
941 b->window = nla_get_u32(props[TIPC_NLA_PROP_WIN]);
942 }
943 rtnl_unlock();
944
945 return 0;
946 }
947
948 static int __tipc_nl_add_media(struct tipc_nl_msg *msg,
949 struct tipc_media *media, int nlflags)
950 {
951 void *hdr;
952 struct nlattr *attrs;
953 struct nlattr *prop;
954
955 hdr = genlmsg_put(msg->skb, msg->portid, msg->seq, &tipc_genl_family,
956 nlflags, TIPC_NL_MEDIA_GET);
957 if (!hdr)
958 return -EMSGSIZE;
959
960 attrs = nla_nest_start(msg->skb, TIPC_NLA_MEDIA);
961 if (!attrs)
962 goto msg_full;
963
964 if (nla_put_string(msg->skb, TIPC_NLA_MEDIA_NAME, media->name))
965 goto attr_msg_full;
966
967 prop = nla_nest_start(msg->skb, TIPC_NLA_MEDIA_PROP);
968 if (!prop)
969 goto prop_msg_full;
970 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_PRIO, media->priority))
971 goto prop_msg_full;
972 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_TOL, media->tolerance))
973 goto prop_msg_full;
974 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_WIN, media->window))
975 goto prop_msg_full;
976
977 nla_nest_end(msg->skb, prop);
978 nla_nest_end(msg->skb, attrs);
979 genlmsg_end(msg->skb, hdr);
980
981 return 0;
982
983 prop_msg_full:
984 nla_nest_cancel(msg->skb, prop);
985 attr_msg_full:
986 nla_nest_cancel(msg->skb, attrs);
987 msg_full:
988 genlmsg_cancel(msg->skb, hdr);
989
990 return -EMSGSIZE;
991 }
992
993 int tipc_nl_media_dump(struct sk_buff *skb, struct netlink_callback *cb)
994 {
995 int err;
996 int i = cb->args[0];
997 struct tipc_nl_msg msg;
998
999 if (i == MAX_MEDIA)
1000 return 0;
1001
1002 msg.skb = skb;
1003 msg.portid = NETLINK_CB(cb->skb).portid;
1004 msg.seq = cb->nlh->nlmsg_seq;
1005
1006 rtnl_lock();
1007 for (; media_info_array[i] != NULL; i++) {
1008 err = __tipc_nl_add_media(&msg, media_info_array[i],
1009 NLM_F_MULTI);
1010 if (err)
1011 break;
1012 }
1013 rtnl_unlock();
1014
1015 cb->args[0] = i;
1016 return skb->len;
1017 }
1018
1019 int tipc_nl_media_get(struct sk_buff *skb, struct genl_info *info)
1020 {
1021 int err;
1022 char *name;
1023 struct tipc_nl_msg msg;
1024 struct tipc_media *media;
1025 struct sk_buff *rep;
1026 struct nlattr *attrs[TIPC_NLA_BEARER_MAX + 1];
1027
1028 if (!info->attrs[TIPC_NLA_MEDIA])
1029 return -EINVAL;
1030
1031 err = nla_parse_nested(attrs, TIPC_NLA_MEDIA_MAX,
1032 info->attrs[TIPC_NLA_MEDIA],
1033 tipc_nl_media_policy);
1034 if (err)
1035 return err;
1036
1037 if (!attrs[TIPC_NLA_MEDIA_NAME])
1038 return -EINVAL;
1039 name = nla_data(attrs[TIPC_NLA_MEDIA_NAME]);
1040
1041 rep = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
1042 if (!rep)
1043 return -ENOMEM;
1044
1045 msg.skb = rep;
1046 msg.portid = info->snd_portid;
1047 msg.seq = info->snd_seq;
1048
1049 rtnl_lock();
1050 media = tipc_media_find(name);
1051 if (!media) {
1052 err = -EINVAL;
1053 goto err_out;
1054 }
1055
1056 err = __tipc_nl_add_media(&msg, media, 0);
1057 if (err)
1058 goto err_out;
1059 rtnl_unlock();
1060
1061 return genlmsg_reply(rep, info);
1062 err_out:
1063 rtnl_unlock();
1064 nlmsg_free(rep);
1065
1066 return err;
1067 }
1068
1069 int tipc_nl_media_set(struct sk_buff *skb, struct genl_info *info)
1070 {
1071 int err;
1072 char *name;
1073 struct tipc_media *m;
1074 struct nlattr *attrs[TIPC_NLA_BEARER_MAX + 1];
1075
1076 if (!info->attrs[TIPC_NLA_MEDIA])
1077 return -EINVAL;
1078
1079 err = nla_parse_nested(attrs, TIPC_NLA_MEDIA_MAX,
1080 info->attrs[TIPC_NLA_MEDIA],
1081 tipc_nl_media_policy);
1082
1083 if (!attrs[TIPC_NLA_MEDIA_NAME])
1084 return -EINVAL;
1085 name = nla_data(attrs[TIPC_NLA_MEDIA_NAME]);
1086
1087 rtnl_lock();
1088 m = tipc_media_find(name);
1089 if (!m) {
1090 rtnl_unlock();
1091 return -EINVAL;
1092 }
1093
1094 if (attrs[TIPC_NLA_MEDIA_PROP]) {
1095 struct nlattr *props[TIPC_NLA_PROP_MAX + 1];
1096
1097 err = tipc_nl_parse_link_prop(attrs[TIPC_NLA_MEDIA_PROP],
1098 props);
1099 if (err) {
1100 rtnl_unlock();
1101 return err;
1102 }
1103
1104 if (props[TIPC_NLA_PROP_TOL])
1105 m->tolerance = nla_get_u32(props[TIPC_NLA_PROP_TOL]);
1106 if (props[TIPC_NLA_PROP_PRIO])
1107 m->priority = nla_get_u32(props[TIPC_NLA_PROP_PRIO]);
1108 if (props[TIPC_NLA_PROP_WIN])
1109 m->window = nla_get_u32(props[TIPC_NLA_PROP_WIN]);
1110 }
1111 rtnl_unlock();
1112
1113 return 0;
1114 }
Linux with added FPC-III support