tipc: add the ability to get UDP options via netlink
[cascardo/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 }