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