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