Loading...
1/*
2 * net/tipc/server.c: TIPC server infrastructure
3 *
4 * Copyright (c) 2012-2013, Wind River Systems
5 * Copyright (c) 2017-2018, Ericsson AB
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 "subscr.h"
38#include "topsrv.h"
39#include "core.h"
40#include "socket.h"
41#include "addr.h"
42#include "msg.h"
43#include "bearer.h"
44#include <net/sock.h>
45#include <linux/module.h>
46
47/* Number of messages to send before rescheduling */
48#define MAX_SEND_MSG_COUNT 25
49#define MAX_RECV_MSG_COUNT 25
50#define CF_CONNECTED 1
51
52#define TIPC_SERVER_NAME_LEN 32
53
54/**
55 * struct tipc_topsrv - TIPC server structure
56 * @conn_idr: identifier set of connection
57 * @idr_lock: protect the connection identifier set
58 * @idr_in_use: amount of allocated identifier entry
59 * @net: network namspace instance
60 * @awork: accept work item
61 * @rcv_wq: receive workqueue
62 * @send_wq: send workqueue
63 * @listener: topsrv listener socket
64 * @name: server name
65 */
66struct tipc_topsrv {
67 struct idr conn_idr;
68 spinlock_t idr_lock; /* for idr list */
69 int idr_in_use;
70 struct net *net;
71 struct work_struct awork;
72 struct workqueue_struct *rcv_wq;
73 struct workqueue_struct *send_wq;
74 struct socket *listener;
75 char name[TIPC_SERVER_NAME_LEN];
76};
77
78/**
79 * struct tipc_conn - TIPC connection structure
80 * @kref: reference counter to connection object
81 * @conid: connection identifier
82 * @sock: socket handler associated with connection
83 * @flags: indicates connection state
84 * @server: pointer to connected server
85 * @sub_list: lsit to all pertaing subscriptions
86 * @sub_lock: lock protecting the subscription list
87 * @rwork: receive work item
88 * @outqueue: pointer to first outbound message in queue
89 * @outqueue_lock: control access to the outqueue
90 * @swork: send work item
91 */
92struct tipc_conn {
93 struct kref kref;
94 int conid;
95 struct socket *sock;
96 unsigned long flags;
97 struct tipc_topsrv *server;
98 struct list_head sub_list;
99 spinlock_t sub_lock; /* for subscription list */
100 struct work_struct rwork;
101 struct list_head outqueue;
102 spinlock_t outqueue_lock; /* for outqueue */
103 struct work_struct swork;
104};
105
106/* An entry waiting to be sent */
107struct outqueue_entry {
108 bool inactive;
109 struct tipc_event evt;
110 struct list_head list;
111};
112
113static void tipc_conn_recv_work(struct work_struct *work);
114static void tipc_conn_send_work(struct work_struct *work);
115static void tipc_topsrv_kern_evt(struct net *net, struct tipc_event *evt);
116static void tipc_conn_delete_sub(struct tipc_conn *con, struct tipc_subscr *s);
117
118static bool connected(struct tipc_conn *con)
119{
120 return con && test_bit(CF_CONNECTED, &con->flags);
121}
122
123static void tipc_conn_kref_release(struct kref *kref)
124{
125 struct tipc_conn *con = container_of(kref, struct tipc_conn, kref);
126 struct tipc_topsrv *s = con->server;
127 struct outqueue_entry *e, *safe;
128
129 spin_lock_bh(&s->idr_lock);
130 idr_remove(&s->conn_idr, con->conid);
131 s->idr_in_use--;
132 spin_unlock_bh(&s->idr_lock);
133 if (con->sock)
134 sock_release(con->sock);
135
136 spin_lock_bh(&con->outqueue_lock);
137 list_for_each_entry_safe(e, safe, &con->outqueue, list) {
138 list_del(&e->list);
139 kfree(e);
140 }
141 spin_unlock_bh(&con->outqueue_lock);
142 kfree(con);
143}
144
145static void conn_put(struct tipc_conn *con)
146{
147 kref_put(&con->kref, tipc_conn_kref_release);
148}
149
150static void conn_get(struct tipc_conn *con)
151{
152 kref_get(&con->kref);
153}
154
155static void tipc_conn_close(struct tipc_conn *con)
156{
157 struct sock *sk = con->sock->sk;
158 bool disconnect = false;
159
160 write_lock_bh(&sk->sk_callback_lock);
161 disconnect = test_and_clear_bit(CF_CONNECTED, &con->flags);
162
163 if (disconnect) {
164 sk->sk_user_data = NULL;
165 tipc_conn_delete_sub(con, NULL);
166 }
167 write_unlock_bh(&sk->sk_callback_lock);
168
169 /* Handle concurrent calls from sending and receiving threads */
170 if (!disconnect)
171 return;
172
173 /* Don't flush pending works, -just let them expire */
174 kernel_sock_shutdown(con->sock, SHUT_RDWR);
175
176 conn_put(con);
177}
178
179static struct tipc_conn *tipc_conn_alloc(struct tipc_topsrv *s, struct socket *sock)
180{
181 struct tipc_conn *con;
182 int ret;
183
184 con = kzalloc(sizeof(*con), GFP_ATOMIC);
185 if (!con)
186 return ERR_PTR(-ENOMEM);
187
188 kref_init(&con->kref);
189 INIT_LIST_HEAD(&con->outqueue);
190 INIT_LIST_HEAD(&con->sub_list);
191 spin_lock_init(&con->outqueue_lock);
192 spin_lock_init(&con->sub_lock);
193 INIT_WORK(&con->swork, tipc_conn_send_work);
194 INIT_WORK(&con->rwork, tipc_conn_recv_work);
195
196 spin_lock_bh(&s->idr_lock);
197 ret = idr_alloc(&s->conn_idr, con, 0, 0, GFP_ATOMIC);
198 if (ret < 0) {
199 kfree(con);
200 spin_unlock_bh(&s->idr_lock);
201 return ERR_PTR(-ENOMEM);
202 }
203 con->conid = ret;
204 s->idr_in_use++;
205
206 set_bit(CF_CONNECTED, &con->flags);
207 con->server = s;
208 con->sock = sock;
209 conn_get(con);
210 spin_unlock_bh(&s->idr_lock);
211
212 return con;
213}
214
215static struct tipc_conn *tipc_conn_lookup(struct tipc_topsrv *s, int conid)
216{
217 struct tipc_conn *con;
218
219 spin_lock_bh(&s->idr_lock);
220 con = idr_find(&s->conn_idr, conid);
221 if (!connected(con) || !kref_get_unless_zero(&con->kref))
222 con = NULL;
223 spin_unlock_bh(&s->idr_lock);
224 return con;
225}
226
227/* tipc_conn_delete_sub - delete a specific or all subscriptions
228 * for a given subscriber
229 */
230static void tipc_conn_delete_sub(struct tipc_conn *con, struct tipc_subscr *s)
231{
232 struct tipc_net *tn = tipc_net(con->server->net);
233 struct list_head *sub_list = &con->sub_list;
234 struct tipc_subscription *sub, *tmp;
235
236 spin_lock_bh(&con->sub_lock);
237 list_for_each_entry_safe(sub, tmp, sub_list, sub_list) {
238 if (!s || !memcmp(s, &sub->evt.s, sizeof(*s))) {
239 tipc_sub_unsubscribe(sub);
240 atomic_dec(&tn->subscription_count);
241 if (s)
242 break;
243 }
244 }
245 spin_unlock_bh(&con->sub_lock);
246}
247
248static void tipc_conn_send_to_sock(struct tipc_conn *con)
249{
250 struct list_head *queue = &con->outqueue;
251 struct tipc_topsrv *srv = con->server;
252 struct outqueue_entry *e;
253 struct tipc_event *evt;
254 struct msghdr msg;
255 struct kvec iov;
256 int count = 0;
257 int ret;
258
259 spin_lock_bh(&con->outqueue_lock);
260
261 while (!list_empty(queue)) {
262 e = list_first_entry(queue, struct outqueue_entry, list);
263 evt = &e->evt;
264 spin_unlock_bh(&con->outqueue_lock);
265
266 if (e->inactive)
267 tipc_conn_delete_sub(con, &evt->s);
268
269 memset(&msg, 0, sizeof(msg));
270 msg.msg_flags = MSG_DONTWAIT;
271 iov.iov_base = evt;
272 iov.iov_len = sizeof(*evt);
273 msg.msg_name = NULL;
274
275 if (con->sock) {
276 ret = kernel_sendmsg(con->sock, &msg, &iov,
277 1, sizeof(*evt));
278 if (ret == -EWOULDBLOCK || ret == 0) {
279 cond_resched();
280 return;
281 } else if (ret < 0) {
282 return tipc_conn_close(con);
283 }
284 } else {
285 tipc_topsrv_kern_evt(srv->net, evt);
286 }
287
288 /* Don't starve users filling buffers */
289 if (++count >= MAX_SEND_MSG_COUNT) {
290 cond_resched();
291 count = 0;
292 }
293 spin_lock_bh(&con->outqueue_lock);
294 list_del(&e->list);
295 kfree(e);
296 }
297 spin_unlock_bh(&con->outqueue_lock);
298}
299
300static void tipc_conn_send_work(struct work_struct *work)
301{
302 struct tipc_conn *con = container_of(work, struct tipc_conn, swork);
303
304 if (connected(con))
305 tipc_conn_send_to_sock(con);
306
307 conn_put(con);
308}
309
310/* tipc_topsrv_queue_evt() - interrupt level call from a subscription instance
311 * The queued work is launched into tipc_conn_send_work()->tipc_conn_send_to_sock()
312 */
313void tipc_topsrv_queue_evt(struct net *net, int conid,
314 u32 event, struct tipc_event *evt)
315{
316 struct tipc_topsrv *srv = tipc_topsrv(net);
317 struct outqueue_entry *e;
318 struct tipc_conn *con;
319
320 con = tipc_conn_lookup(srv, conid);
321 if (!con)
322 return;
323
324 if (!connected(con))
325 goto err;
326
327 e = kmalloc(sizeof(*e), GFP_ATOMIC);
328 if (!e)
329 goto err;
330 e->inactive = (event == TIPC_SUBSCR_TIMEOUT);
331 memcpy(&e->evt, evt, sizeof(*evt));
332 spin_lock_bh(&con->outqueue_lock);
333 list_add_tail(&e->list, &con->outqueue);
334 spin_unlock_bh(&con->outqueue_lock);
335
336 if (queue_work(srv->send_wq, &con->swork))
337 return;
338err:
339 conn_put(con);
340}
341
342/* tipc_conn_write_space - interrupt callback after a sendmsg EAGAIN
343 * Indicates that there now is more space in the send buffer
344 * The queued work is launched into tipc_send_work()->tipc_conn_send_to_sock()
345 */
346static void tipc_conn_write_space(struct sock *sk)
347{
348 struct tipc_conn *con;
349
350 read_lock_bh(&sk->sk_callback_lock);
351 con = sk->sk_user_data;
352 if (connected(con)) {
353 conn_get(con);
354 if (!queue_work(con->server->send_wq, &con->swork))
355 conn_put(con);
356 }
357 read_unlock_bh(&sk->sk_callback_lock);
358}
359
360static int tipc_conn_rcv_sub(struct tipc_topsrv *srv,
361 struct tipc_conn *con,
362 struct tipc_subscr *s)
363{
364 struct tipc_net *tn = tipc_net(srv->net);
365 struct tipc_subscription *sub;
366 u32 s_filter = tipc_sub_read(s, filter);
367
368 if (s_filter & TIPC_SUB_CANCEL) {
369 tipc_sub_write(s, filter, s_filter & ~TIPC_SUB_CANCEL);
370 tipc_conn_delete_sub(con, s);
371 return 0;
372 }
373 if (atomic_read(&tn->subscription_count) >= TIPC_MAX_SUBSCR) {
374 pr_warn("Subscription rejected, max (%u)\n", TIPC_MAX_SUBSCR);
375 return -1;
376 }
377 sub = tipc_sub_subscribe(srv->net, s, con->conid);
378 if (!sub)
379 return -1;
380 atomic_inc(&tn->subscription_count);
381 spin_lock_bh(&con->sub_lock);
382 list_add(&sub->sub_list, &con->sub_list);
383 spin_unlock_bh(&con->sub_lock);
384 return 0;
385}
386
387static int tipc_conn_rcv_from_sock(struct tipc_conn *con)
388{
389 struct tipc_topsrv *srv = con->server;
390 struct sock *sk = con->sock->sk;
391 struct msghdr msg = {};
392 struct tipc_subscr s;
393 struct kvec iov;
394 int ret;
395
396 iov.iov_base = &s;
397 iov.iov_len = sizeof(s);
398 msg.msg_name = NULL;
399 iov_iter_kvec(&msg.msg_iter, ITER_DEST, &iov, 1, iov.iov_len);
400 ret = sock_recvmsg(con->sock, &msg, MSG_DONTWAIT);
401 if (ret == -EWOULDBLOCK)
402 return -EWOULDBLOCK;
403 if (ret == sizeof(s)) {
404 read_lock_bh(&sk->sk_callback_lock);
405 /* RACE: the connection can be closed in the meantime */
406 if (likely(connected(con)))
407 ret = tipc_conn_rcv_sub(srv, con, &s);
408 read_unlock_bh(&sk->sk_callback_lock);
409 if (!ret)
410 return 0;
411 }
412
413 tipc_conn_close(con);
414 return ret;
415}
416
417static void tipc_conn_recv_work(struct work_struct *work)
418{
419 struct tipc_conn *con = container_of(work, struct tipc_conn, rwork);
420 int count = 0;
421
422 while (connected(con)) {
423 if (tipc_conn_rcv_from_sock(con))
424 break;
425
426 /* Don't flood Rx machine */
427 if (++count >= MAX_RECV_MSG_COUNT) {
428 cond_resched();
429 count = 0;
430 }
431 }
432 conn_put(con);
433}
434
435/* tipc_conn_data_ready - interrupt callback indicating the socket has data
436 * The queued work is launched into tipc_recv_work()->tipc_conn_rcv_from_sock()
437 */
438static void tipc_conn_data_ready(struct sock *sk)
439{
440 struct tipc_conn *con;
441
442 read_lock_bh(&sk->sk_callback_lock);
443 con = sk->sk_user_data;
444 if (connected(con)) {
445 conn_get(con);
446 if (!queue_work(con->server->rcv_wq, &con->rwork))
447 conn_put(con);
448 }
449 read_unlock_bh(&sk->sk_callback_lock);
450}
451
452static void tipc_topsrv_accept(struct work_struct *work)
453{
454 struct tipc_topsrv *srv = container_of(work, struct tipc_topsrv, awork);
455 struct socket *newsock, *lsock;
456 struct tipc_conn *con;
457 struct sock *newsk;
458 int ret;
459
460 spin_lock_bh(&srv->idr_lock);
461 if (!srv->listener) {
462 spin_unlock_bh(&srv->idr_lock);
463 return;
464 }
465 lsock = srv->listener;
466 spin_unlock_bh(&srv->idr_lock);
467
468 while (1) {
469 ret = kernel_accept(lsock, &newsock, O_NONBLOCK);
470 if (ret < 0)
471 return;
472 con = tipc_conn_alloc(srv, newsock);
473 if (IS_ERR(con)) {
474 ret = PTR_ERR(con);
475 sock_release(newsock);
476 return;
477 }
478 /* Register callbacks */
479 newsk = newsock->sk;
480 write_lock_bh(&newsk->sk_callback_lock);
481 newsk->sk_data_ready = tipc_conn_data_ready;
482 newsk->sk_write_space = tipc_conn_write_space;
483 newsk->sk_user_data = con;
484 write_unlock_bh(&newsk->sk_callback_lock);
485
486 /* Wake up receive process in case of 'SYN+' message */
487 newsk->sk_data_ready(newsk);
488 conn_put(con);
489 }
490}
491
492/* tipc_topsrv_listener_data_ready - interrupt callback with connection request
493 * The queued job is launched into tipc_topsrv_accept()
494 */
495static void tipc_topsrv_listener_data_ready(struct sock *sk)
496{
497 struct tipc_topsrv *srv;
498
499 read_lock_bh(&sk->sk_callback_lock);
500 srv = sk->sk_user_data;
501 if (srv)
502 queue_work(srv->rcv_wq, &srv->awork);
503 read_unlock_bh(&sk->sk_callback_lock);
504}
505
506static int tipc_topsrv_create_listener(struct tipc_topsrv *srv)
507{
508 struct socket *lsock = NULL;
509 struct sockaddr_tipc saddr;
510 struct sock *sk;
511 int rc;
512
513 rc = sock_create_kern(srv->net, AF_TIPC, SOCK_SEQPACKET, 0, &lsock);
514 if (rc < 0)
515 return rc;
516
517 srv->listener = lsock;
518 sk = lsock->sk;
519 write_lock_bh(&sk->sk_callback_lock);
520 sk->sk_data_ready = tipc_topsrv_listener_data_ready;
521 sk->sk_user_data = srv;
522 write_unlock_bh(&sk->sk_callback_lock);
523
524 lock_sock(sk);
525 rc = tsk_set_importance(sk, TIPC_CRITICAL_IMPORTANCE);
526 release_sock(sk);
527 if (rc < 0)
528 goto err;
529
530 saddr.family = AF_TIPC;
531 saddr.addrtype = TIPC_SERVICE_RANGE;
532 saddr.addr.nameseq.type = TIPC_TOP_SRV;
533 saddr.addr.nameseq.lower = TIPC_TOP_SRV;
534 saddr.addr.nameseq.upper = TIPC_TOP_SRV;
535 saddr.scope = TIPC_NODE_SCOPE;
536
537 rc = tipc_sk_bind(lsock, (struct sockaddr *)&saddr, sizeof(saddr));
538 if (rc < 0)
539 goto err;
540 rc = kernel_listen(lsock, 0);
541 if (rc < 0)
542 goto err;
543
544 /* As server's listening socket owner and creator is the same module,
545 * we have to decrease TIPC module reference count to guarantee that
546 * it remains zero after the server socket is created, otherwise,
547 * executing "rmmod" command is unable to make TIPC module deleted
548 * after TIPC module is inserted successfully.
549 *
550 * However, the reference count is ever increased twice in
551 * sock_create_kern(): one is to increase the reference count of owner
552 * of TIPC socket's proto_ops struct; another is to increment the
553 * reference count of owner of TIPC proto struct. Therefore, we must
554 * decrement the module reference count twice to ensure that it keeps
555 * zero after server's listening socket is created. Of course, we
556 * must bump the module reference count twice as well before the socket
557 * is closed.
558 */
559 module_put(lsock->ops->owner);
560 module_put(sk->sk_prot_creator->owner);
561
562 return 0;
563err:
564 sock_release(lsock);
565 return -EINVAL;
566}
567
568bool tipc_topsrv_kern_subscr(struct net *net, u32 port, u32 type, u32 lower,
569 u32 upper, u32 filter, int *conid)
570{
571 struct tipc_subscr sub;
572 struct tipc_conn *con;
573 int rc;
574
575 sub.seq.type = type;
576 sub.seq.lower = lower;
577 sub.seq.upper = upper;
578 sub.timeout = TIPC_WAIT_FOREVER;
579 sub.filter = filter;
580 *(u64 *)&sub.usr_handle = (u64)port;
581
582 con = tipc_conn_alloc(tipc_topsrv(net), NULL);
583 if (IS_ERR(con))
584 return false;
585
586 *conid = con->conid;
587 rc = tipc_conn_rcv_sub(tipc_topsrv(net), con, &sub);
588 if (rc)
589 conn_put(con);
590
591 conn_put(con);
592 return !rc;
593}
594
595void tipc_topsrv_kern_unsubscr(struct net *net, int conid)
596{
597 struct tipc_conn *con;
598
599 con = tipc_conn_lookup(tipc_topsrv(net), conid);
600 if (!con)
601 return;
602
603 test_and_clear_bit(CF_CONNECTED, &con->flags);
604 tipc_conn_delete_sub(con, NULL);
605 conn_put(con);
606 conn_put(con);
607}
608
609static void tipc_topsrv_kern_evt(struct net *net, struct tipc_event *evt)
610{
611 u32 port = *(u32 *)&evt->s.usr_handle;
612 u32 self = tipc_own_addr(net);
613 struct sk_buff_head evtq;
614 struct sk_buff *skb;
615
616 skb = tipc_msg_create(TOP_SRV, 0, INT_H_SIZE, sizeof(*evt),
617 self, self, port, port, 0);
618 if (!skb)
619 return;
620 msg_set_dest_droppable(buf_msg(skb), true);
621 memcpy(msg_data(buf_msg(skb)), evt, sizeof(*evt));
622 skb_queue_head_init(&evtq);
623 __skb_queue_tail(&evtq, skb);
624 tipc_loopback_trace(net, &evtq);
625 tipc_sk_rcv(net, &evtq);
626}
627
628static int tipc_topsrv_work_start(struct tipc_topsrv *s)
629{
630 s->rcv_wq = alloc_ordered_workqueue("tipc_rcv", 0);
631 if (!s->rcv_wq) {
632 pr_err("can't start tipc receive workqueue\n");
633 return -ENOMEM;
634 }
635
636 s->send_wq = alloc_ordered_workqueue("tipc_send", 0);
637 if (!s->send_wq) {
638 pr_err("can't start tipc send workqueue\n");
639 destroy_workqueue(s->rcv_wq);
640 return -ENOMEM;
641 }
642
643 return 0;
644}
645
646static void tipc_topsrv_work_stop(struct tipc_topsrv *s)
647{
648 destroy_workqueue(s->rcv_wq);
649 destroy_workqueue(s->send_wq);
650}
651
652static int tipc_topsrv_start(struct net *net)
653{
654 struct tipc_net *tn = tipc_net(net);
655 const char name[] = "topology_server";
656 struct tipc_topsrv *srv;
657 int ret;
658
659 srv = kzalloc(sizeof(*srv), GFP_ATOMIC);
660 if (!srv)
661 return -ENOMEM;
662
663 srv->net = net;
664 INIT_WORK(&srv->awork, tipc_topsrv_accept);
665
666 strscpy(srv->name, name, sizeof(srv->name));
667 tn->topsrv = srv;
668 atomic_set(&tn->subscription_count, 0);
669
670 spin_lock_init(&srv->idr_lock);
671 idr_init(&srv->conn_idr);
672 srv->idr_in_use = 0;
673
674 ret = tipc_topsrv_work_start(srv);
675 if (ret < 0)
676 goto err_start;
677
678 ret = tipc_topsrv_create_listener(srv);
679 if (ret < 0)
680 goto err_create;
681
682 return 0;
683
684err_create:
685 tipc_topsrv_work_stop(srv);
686err_start:
687 kfree(srv);
688 return ret;
689}
690
691static void tipc_topsrv_stop(struct net *net)
692{
693 struct tipc_topsrv *srv = tipc_topsrv(net);
694 struct socket *lsock = srv->listener;
695 struct tipc_conn *con;
696 int id;
697
698 spin_lock_bh(&srv->idr_lock);
699 for (id = 0; srv->idr_in_use; id++) {
700 con = idr_find(&srv->conn_idr, id);
701 if (con) {
702 spin_unlock_bh(&srv->idr_lock);
703 tipc_conn_close(con);
704 spin_lock_bh(&srv->idr_lock);
705 }
706 }
707 __module_get(lsock->ops->owner);
708 __module_get(lsock->sk->sk_prot_creator->owner);
709 srv->listener = NULL;
710 spin_unlock_bh(&srv->idr_lock);
711
712 tipc_topsrv_work_stop(srv);
713 sock_release(lsock);
714 idr_destroy(&srv->conn_idr);
715 kfree(srv);
716}
717
718int __net_init tipc_topsrv_init_net(struct net *net)
719{
720 return tipc_topsrv_start(net);
721}
722
723void __net_exit tipc_topsrv_exit_net(struct net *net)
724{
725 tipc_topsrv_stop(net);
726}
1/*
2 * net/tipc/server.c: TIPC server infrastructure
3 *
4 * Copyright (c) 2012-2013, Wind River Systems
5 * Copyright (c) 2017-2018, Ericsson AB
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 "subscr.h"
38#include "topsrv.h"
39#include "core.h"
40#include "socket.h"
41#include "addr.h"
42#include "msg.h"
43#include "bearer.h"
44#include <net/sock.h>
45#include <linux/module.h>
46
47/* Number of messages to send before rescheduling */
48#define MAX_SEND_MSG_COUNT 25
49#define MAX_RECV_MSG_COUNT 25
50#define CF_CONNECTED 1
51#define CF_SERVER 2
52
53#define TIPC_SERVER_NAME_LEN 32
54
55/**
56 * struct tipc_topsrv - TIPC server structure
57 * @conn_idr: identifier set of connection
58 * @idr_lock: protect the connection identifier set
59 * @idr_in_use: amount of allocated identifier entry
60 * @net: network namspace instance
61 * @awork: accept work item
62 * @rcv_wq: receive workqueue
63 * @send_wq: send workqueue
64 * @listener: topsrv listener socket
65 * @name: server name
66 */
67struct tipc_topsrv {
68 struct idr conn_idr;
69 spinlock_t idr_lock; /* for idr list */
70 int idr_in_use;
71 struct net *net;
72 struct work_struct awork;
73 struct workqueue_struct *rcv_wq;
74 struct workqueue_struct *send_wq;
75 struct socket *listener;
76 char name[TIPC_SERVER_NAME_LEN];
77};
78
79/**
80 * struct tipc_conn - TIPC connection structure
81 * @kref: reference counter to connection object
82 * @conid: connection identifier
83 * @sock: socket handler associated with connection
84 * @flags: indicates connection state
85 * @server: pointer to connected server
86 * @sub_list: lsit to all pertaing subscriptions
87 * @sub_lock: lock protecting the subscription list
88 * @rwork: receive work item
89 * @outqueue: pointer to first outbound message in queue
90 * @outqueue_lock: control access to the outqueue
91 * @swork: send work item
92 */
93struct tipc_conn {
94 struct kref kref;
95 int conid;
96 struct socket *sock;
97 unsigned long flags;
98 struct tipc_topsrv *server;
99 struct list_head sub_list;
100 spinlock_t sub_lock; /* for subscription list */
101 struct work_struct rwork;
102 struct list_head outqueue;
103 spinlock_t outqueue_lock; /* for outqueue */
104 struct work_struct swork;
105};
106
107/* An entry waiting to be sent */
108struct outqueue_entry {
109 bool inactive;
110 struct tipc_event evt;
111 struct list_head list;
112};
113
114static void tipc_conn_recv_work(struct work_struct *work);
115static void tipc_conn_send_work(struct work_struct *work);
116static void tipc_topsrv_kern_evt(struct net *net, struct tipc_event *evt);
117static void tipc_conn_delete_sub(struct tipc_conn *con, struct tipc_subscr *s);
118
119static bool connected(struct tipc_conn *con)
120{
121 return con && test_bit(CF_CONNECTED, &con->flags);
122}
123
124static void tipc_conn_kref_release(struct kref *kref)
125{
126 struct tipc_conn *con = container_of(kref, struct tipc_conn, kref);
127 struct tipc_topsrv *s = con->server;
128 struct outqueue_entry *e, *safe;
129
130 spin_lock_bh(&s->idr_lock);
131 idr_remove(&s->conn_idr, con->conid);
132 s->idr_in_use--;
133 spin_unlock_bh(&s->idr_lock);
134 if (con->sock)
135 sock_release(con->sock);
136
137 spin_lock_bh(&con->outqueue_lock);
138 list_for_each_entry_safe(e, safe, &con->outqueue, list) {
139 list_del(&e->list);
140 kfree(e);
141 }
142 spin_unlock_bh(&con->outqueue_lock);
143 kfree(con);
144}
145
146static void conn_put(struct tipc_conn *con)
147{
148 kref_put(&con->kref, tipc_conn_kref_release);
149}
150
151static void conn_get(struct tipc_conn *con)
152{
153 kref_get(&con->kref);
154}
155
156static void tipc_conn_close(struct tipc_conn *con)
157{
158 struct sock *sk = con->sock->sk;
159 bool disconnect = false;
160
161 write_lock_bh(&sk->sk_callback_lock);
162 disconnect = test_and_clear_bit(CF_CONNECTED, &con->flags);
163
164 if (disconnect) {
165 sk->sk_user_data = NULL;
166 tipc_conn_delete_sub(con, NULL);
167 }
168 write_unlock_bh(&sk->sk_callback_lock);
169
170 /* Handle concurrent calls from sending and receiving threads */
171 if (!disconnect)
172 return;
173
174 /* Don't flush pending works, -just let them expire */
175 kernel_sock_shutdown(con->sock, SHUT_RDWR);
176
177 conn_put(con);
178}
179
180static struct tipc_conn *tipc_conn_alloc(struct tipc_topsrv *s)
181{
182 struct tipc_conn *con;
183 int ret;
184
185 con = kzalloc(sizeof(*con), GFP_ATOMIC);
186 if (!con)
187 return ERR_PTR(-ENOMEM);
188
189 kref_init(&con->kref);
190 INIT_LIST_HEAD(&con->outqueue);
191 INIT_LIST_HEAD(&con->sub_list);
192 spin_lock_init(&con->outqueue_lock);
193 spin_lock_init(&con->sub_lock);
194 INIT_WORK(&con->swork, tipc_conn_send_work);
195 INIT_WORK(&con->rwork, tipc_conn_recv_work);
196
197 spin_lock_bh(&s->idr_lock);
198 ret = idr_alloc(&s->conn_idr, con, 0, 0, GFP_ATOMIC);
199 if (ret < 0) {
200 kfree(con);
201 spin_unlock_bh(&s->idr_lock);
202 return ERR_PTR(-ENOMEM);
203 }
204 con->conid = ret;
205 s->idr_in_use++;
206 spin_unlock_bh(&s->idr_lock);
207
208 set_bit(CF_CONNECTED, &con->flags);
209 con->server = s;
210
211 return con;
212}
213
214static struct tipc_conn *tipc_conn_lookup(struct tipc_topsrv *s, int conid)
215{
216 struct tipc_conn *con;
217
218 spin_lock_bh(&s->idr_lock);
219 con = idr_find(&s->conn_idr, conid);
220 if (!connected(con) || !kref_get_unless_zero(&con->kref))
221 con = NULL;
222 spin_unlock_bh(&s->idr_lock);
223 return con;
224}
225
226/* tipc_conn_delete_sub - delete a specific or all subscriptions
227 * for a given subscriber
228 */
229static void tipc_conn_delete_sub(struct tipc_conn *con, struct tipc_subscr *s)
230{
231 struct tipc_net *tn = tipc_net(con->server->net);
232 struct list_head *sub_list = &con->sub_list;
233 struct tipc_subscription *sub, *tmp;
234
235 spin_lock_bh(&con->sub_lock);
236 list_for_each_entry_safe(sub, tmp, sub_list, sub_list) {
237 if (!s || !memcmp(s, &sub->evt.s, sizeof(*s))) {
238 tipc_sub_unsubscribe(sub);
239 atomic_dec(&tn->subscription_count);
240 if (s)
241 break;
242 }
243 }
244 spin_unlock_bh(&con->sub_lock);
245}
246
247static void tipc_conn_send_to_sock(struct tipc_conn *con)
248{
249 struct list_head *queue = &con->outqueue;
250 struct tipc_topsrv *srv = con->server;
251 struct outqueue_entry *e;
252 struct tipc_event *evt;
253 struct msghdr msg;
254 struct kvec iov;
255 int count = 0;
256 int ret;
257
258 spin_lock_bh(&con->outqueue_lock);
259
260 while (!list_empty(queue)) {
261 e = list_first_entry(queue, struct outqueue_entry, list);
262 evt = &e->evt;
263 spin_unlock_bh(&con->outqueue_lock);
264
265 if (e->inactive)
266 tipc_conn_delete_sub(con, &evt->s);
267
268 memset(&msg, 0, sizeof(msg));
269 msg.msg_flags = MSG_DONTWAIT;
270 iov.iov_base = evt;
271 iov.iov_len = sizeof(*evt);
272 msg.msg_name = NULL;
273
274 if (con->sock) {
275 ret = kernel_sendmsg(con->sock, &msg, &iov,
276 1, sizeof(*evt));
277 if (ret == -EWOULDBLOCK || ret == 0) {
278 cond_resched();
279 return;
280 } else if (ret < 0) {
281 return tipc_conn_close(con);
282 }
283 } else {
284 tipc_topsrv_kern_evt(srv->net, evt);
285 }
286
287 /* Don't starve users filling buffers */
288 if (++count >= MAX_SEND_MSG_COUNT) {
289 cond_resched();
290 count = 0;
291 }
292 spin_lock_bh(&con->outqueue_lock);
293 list_del(&e->list);
294 kfree(e);
295 }
296 spin_unlock_bh(&con->outqueue_lock);
297}
298
299static void tipc_conn_send_work(struct work_struct *work)
300{
301 struct tipc_conn *con = container_of(work, struct tipc_conn, swork);
302
303 if (connected(con))
304 tipc_conn_send_to_sock(con);
305
306 conn_put(con);
307}
308
309/* tipc_topsrv_queue_evt() - interrupt level call from a subscription instance
310 * The queued work is launched into tipc_conn_send_work()->tipc_conn_send_to_sock()
311 */
312void tipc_topsrv_queue_evt(struct net *net, int conid,
313 u32 event, struct tipc_event *evt)
314{
315 struct tipc_topsrv *srv = tipc_topsrv(net);
316 struct outqueue_entry *e;
317 struct tipc_conn *con;
318
319 con = tipc_conn_lookup(srv, conid);
320 if (!con)
321 return;
322
323 if (!connected(con))
324 goto err;
325
326 e = kmalloc(sizeof(*e), GFP_ATOMIC);
327 if (!e)
328 goto err;
329 e->inactive = (event == TIPC_SUBSCR_TIMEOUT);
330 memcpy(&e->evt, evt, sizeof(*evt));
331 spin_lock_bh(&con->outqueue_lock);
332 list_add_tail(&e->list, &con->outqueue);
333 spin_unlock_bh(&con->outqueue_lock);
334
335 if (queue_work(srv->send_wq, &con->swork))
336 return;
337err:
338 conn_put(con);
339}
340
341/* tipc_conn_write_space - interrupt callback after a sendmsg EAGAIN
342 * Indicates that there now is more space in the send buffer
343 * The queued work is launched into tipc_send_work()->tipc_conn_send_to_sock()
344 */
345static void tipc_conn_write_space(struct sock *sk)
346{
347 struct tipc_conn *con;
348
349 read_lock_bh(&sk->sk_callback_lock);
350 con = sk->sk_user_data;
351 if (connected(con)) {
352 conn_get(con);
353 if (!queue_work(con->server->send_wq, &con->swork))
354 conn_put(con);
355 }
356 read_unlock_bh(&sk->sk_callback_lock);
357}
358
359static int tipc_conn_rcv_sub(struct tipc_topsrv *srv,
360 struct tipc_conn *con,
361 struct tipc_subscr *s)
362{
363 struct tipc_net *tn = tipc_net(srv->net);
364 struct tipc_subscription *sub;
365 u32 s_filter = tipc_sub_read(s, filter);
366
367 if (s_filter & TIPC_SUB_CANCEL) {
368 tipc_sub_write(s, filter, s_filter & ~TIPC_SUB_CANCEL);
369 tipc_conn_delete_sub(con, s);
370 return 0;
371 }
372 if (atomic_read(&tn->subscription_count) >= TIPC_MAX_SUBSCR) {
373 pr_warn("Subscription rejected, max (%u)\n", TIPC_MAX_SUBSCR);
374 return -1;
375 }
376 sub = tipc_sub_subscribe(srv->net, s, con->conid);
377 if (!sub)
378 return -1;
379 atomic_inc(&tn->subscription_count);
380 spin_lock_bh(&con->sub_lock);
381 list_add(&sub->sub_list, &con->sub_list);
382 spin_unlock_bh(&con->sub_lock);
383 return 0;
384}
385
386static int tipc_conn_rcv_from_sock(struct tipc_conn *con)
387{
388 struct tipc_topsrv *srv = con->server;
389 struct sock *sk = con->sock->sk;
390 struct msghdr msg = {};
391 struct tipc_subscr s;
392 struct kvec iov;
393 int ret;
394
395 iov.iov_base = &s;
396 iov.iov_len = sizeof(s);
397 msg.msg_name = NULL;
398 iov_iter_kvec(&msg.msg_iter, READ, &iov, 1, iov.iov_len);
399 ret = sock_recvmsg(con->sock, &msg, MSG_DONTWAIT);
400 if (ret == -EWOULDBLOCK)
401 return -EWOULDBLOCK;
402 if (ret == sizeof(s)) {
403 read_lock_bh(&sk->sk_callback_lock);
404 /* RACE: the connection can be closed in the meantime */
405 if (likely(connected(con)))
406 ret = tipc_conn_rcv_sub(srv, con, &s);
407 read_unlock_bh(&sk->sk_callback_lock);
408 if (!ret)
409 return 0;
410 }
411
412 tipc_conn_close(con);
413 return ret;
414}
415
416static void tipc_conn_recv_work(struct work_struct *work)
417{
418 struct tipc_conn *con = container_of(work, struct tipc_conn, rwork);
419 int count = 0;
420
421 while (connected(con)) {
422 if (tipc_conn_rcv_from_sock(con))
423 break;
424
425 /* Don't flood Rx machine */
426 if (++count >= MAX_RECV_MSG_COUNT) {
427 cond_resched();
428 count = 0;
429 }
430 }
431 conn_put(con);
432}
433
434/* tipc_conn_data_ready - interrupt callback indicating the socket has data
435 * The queued work is launched into tipc_recv_work()->tipc_conn_rcv_from_sock()
436 */
437static void tipc_conn_data_ready(struct sock *sk)
438{
439 struct tipc_conn *con;
440
441 read_lock_bh(&sk->sk_callback_lock);
442 con = sk->sk_user_data;
443 if (connected(con)) {
444 conn_get(con);
445 if (!queue_work(con->server->rcv_wq, &con->rwork))
446 conn_put(con);
447 }
448 read_unlock_bh(&sk->sk_callback_lock);
449}
450
451static void tipc_topsrv_accept(struct work_struct *work)
452{
453 struct tipc_topsrv *srv = container_of(work, struct tipc_topsrv, awork);
454 struct socket *lsock = srv->listener;
455 struct socket *newsock;
456 struct tipc_conn *con;
457 struct sock *newsk;
458 int ret;
459
460 while (1) {
461 ret = kernel_accept(lsock, &newsock, O_NONBLOCK);
462 if (ret < 0)
463 return;
464 con = tipc_conn_alloc(srv);
465 if (IS_ERR(con)) {
466 ret = PTR_ERR(con);
467 sock_release(newsock);
468 return;
469 }
470 /* Register callbacks */
471 newsk = newsock->sk;
472 write_lock_bh(&newsk->sk_callback_lock);
473 newsk->sk_data_ready = tipc_conn_data_ready;
474 newsk->sk_write_space = tipc_conn_write_space;
475 newsk->sk_user_data = con;
476 con->sock = newsock;
477 write_unlock_bh(&newsk->sk_callback_lock);
478
479 /* Wake up receive process in case of 'SYN+' message */
480 newsk->sk_data_ready(newsk);
481 }
482}
483
484/* tipc_topsrv_listener_data_ready - interrupt callback with connection request
485 * The queued job is launched into tipc_topsrv_accept()
486 */
487static void tipc_topsrv_listener_data_ready(struct sock *sk)
488{
489 struct tipc_topsrv *srv;
490
491 read_lock_bh(&sk->sk_callback_lock);
492 srv = sk->sk_user_data;
493 if (srv->listener)
494 queue_work(srv->rcv_wq, &srv->awork);
495 read_unlock_bh(&sk->sk_callback_lock);
496}
497
498static int tipc_topsrv_create_listener(struct tipc_topsrv *srv)
499{
500 struct socket *lsock = NULL;
501 struct sockaddr_tipc saddr;
502 struct sock *sk;
503 int rc;
504
505 rc = sock_create_kern(srv->net, AF_TIPC, SOCK_SEQPACKET, 0, &lsock);
506 if (rc < 0)
507 return rc;
508
509 srv->listener = lsock;
510 sk = lsock->sk;
511 write_lock_bh(&sk->sk_callback_lock);
512 sk->sk_data_ready = tipc_topsrv_listener_data_ready;
513 sk->sk_user_data = srv;
514 write_unlock_bh(&sk->sk_callback_lock);
515
516 lock_sock(sk);
517 rc = tsk_set_importance(sk, TIPC_CRITICAL_IMPORTANCE);
518 release_sock(sk);
519 if (rc < 0)
520 goto err;
521
522 saddr.family = AF_TIPC;
523 saddr.addrtype = TIPC_ADDR_NAMESEQ;
524 saddr.addr.nameseq.type = TIPC_TOP_SRV;
525 saddr.addr.nameseq.lower = TIPC_TOP_SRV;
526 saddr.addr.nameseq.upper = TIPC_TOP_SRV;
527 saddr.scope = TIPC_NODE_SCOPE;
528
529 rc = kernel_bind(lsock, (struct sockaddr *)&saddr, sizeof(saddr));
530 if (rc < 0)
531 goto err;
532 rc = kernel_listen(lsock, 0);
533 if (rc < 0)
534 goto err;
535
536 /* As server's listening socket owner and creator is the same module,
537 * we have to decrease TIPC module reference count to guarantee that
538 * it remains zero after the server socket is created, otherwise,
539 * executing "rmmod" command is unable to make TIPC module deleted
540 * after TIPC module is inserted successfully.
541 *
542 * However, the reference count is ever increased twice in
543 * sock_create_kern(): one is to increase the reference count of owner
544 * of TIPC socket's proto_ops struct; another is to increment the
545 * reference count of owner of TIPC proto struct. Therefore, we must
546 * decrement the module reference count twice to ensure that it keeps
547 * zero after server's listening socket is created. Of course, we
548 * must bump the module reference count twice as well before the socket
549 * is closed.
550 */
551 module_put(lsock->ops->owner);
552 module_put(sk->sk_prot_creator->owner);
553
554 return 0;
555err:
556 sock_release(lsock);
557 return -EINVAL;
558}
559
560bool tipc_topsrv_kern_subscr(struct net *net, u32 port, u32 type, u32 lower,
561 u32 upper, u32 filter, int *conid)
562{
563 struct tipc_subscr sub;
564 struct tipc_conn *con;
565 int rc;
566
567 sub.seq.type = type;
568 sub.seq.lower = lower;
569 sub.seq.upper = upper;
570 sub.timeout = TIPC_WAIT_FOREVER;
571 sub.filter = filter;
572 *(u32 *)&sub.usr_handle = port;
573
574 con = tipc_conn_alloc(tipc_topsrv(net));
575 if (IS_ERR(con))
576 return false;
577
578 *conid = con->conid;
579 con->sock = NULL;
580 rc = tipc_conn_rcv_sub(tipc_topsrv(net), con, &sub);
581 if (rc >= 0)
582 return true;
583 conn_put(con);
584 return false;
585}
586
587void tipc_topsrv_kern_unsubscr(struct net *net, int conid)
588{
589 struct tipc_conn *con;
590
591 con = tipc_conn_lookup(tipc_topsrv(net), conid);
592 if (!con)
593 return;
594
595 test_and_clear_bit(CF_CONNECTED, &con->flags);
596 tipc_conn_delete_sub(con, NULL);
597 conn_put(con);
598 conn_put(con);
599}
600
601static void tipc_topsrv_kern_evt(struct net *net, struct tipc_event *evt)
602{
603 u32 port = *(u32 *)&evt->s.usr_handle;
604 u32 self = tipc_own_addr(net);
605 struct sk_buff_head evtq;
606 struct sk_buff *skb;
607
608 skb = tipc_msg_create(TOP_SRV, 0, INT_H_SIZE, sizeof(*evt),
609 self, self, port, port, 0);
610 if (!skb)
611 return;
612 msg_set_dest_droppable(buf_msg(skb), true);
613 memcpy(msg_data(buf_msg(skb)), evt, sizeof(*evt));
614 skb_queue_head_init(&evtq);
615 __skb_queue_tail(&evtq, skb);
616 tipc_loopback_trace(net, &evtq);
617 tipc_sk_rcv(net, &evtq);
618}
619
620static int tipc_topsrv_work_start(struct tipc_topsrv *s)
621{
622 s->rcv_wq = alloc_ordered_workqueue("tipc_rcv", 0);
623 if (!s->rcv_wq) {
624 pr_err("can't start tipc receive workqueue\n");
625 return -ENOMEM;
626 }
627
628 s->send_wq = alloc_ordered_workqueue("tipc_send", 0);
629 if (!s->send_wq) {
630 pr_err("can't start tipc send workqueue\n");
631 destroy_workqueue(s->rcv_wq);
632 return -ENOMEM;
633 }
634
635 return 0;
636}
637
638static void tipc_topsrv_work_stop(struct tipc_topsrv *s)
639{
640 destroy_workqueue(s->rcv_wq);
641 destroy_workqueue(s->send_wq);
642}
643
644static int tipc_topsrv_start(struct net *net)
645{
646 struct tipc_net *tn = tipc_net(net);
647 const char name[] = "topology_server";
648 struct tipc_topsrv *srv;
649 int ret;
650
651 srv = kzalloc(sizeof(*srv), GFP_ATOMIC);
652 if (!srv)
653 return -ENOMEM;
654
655 srv->net = net;
656 INIT_WORK(&srv->awork, tipc_topsrv_accept);
657
658 strscpy(srv->name, name, sizeof(srv->name));
659 tn->topsrv = srv;
660 atomic_set(&tn->subscription_count, 0);
661
662 spin_lock_init(&srv->idr_lock);
663 idr_init(&srv->conn_idr);
664 srv->idr_in_use = 0;
665
666 ret = tipc_topsrv_work_start(srv);
667 if (ret < 0)
668 return ret;
669
670 ret = tipc_topsrv_create_listener(srv);
671 if (ret < 0)
672 tipc_topsrv_work_stop(srv);
673
674 return ret;
675}
676
677static void tipc_topsrv_stop(struct net *net)
678{
679 struct tipc_topsrv *srv = tipc_topsrv(net);
680 struct socket *lsock = srv->listener;
681 struct tipc_conn *con;
682 int id;
683
684 spin_lock_bh(&srv->idr_lock);
685 for (id = 0; srv->idr_in_use; id++) {
686 con = idr_find(&srv->conn_idr, id);
687 if (con) {
688 spin_unlock_bh(&srv->idr_lock);
689 tipc_conn_close(con);
690 spin_lock_bh(&srv->idr_lock);
691 }
692 }
693 __module_get(lsock->ops->owner);
694 __module_get(lsock->sk->sk_prot_creator->owner);
695 srv->listener = NULL;
696 spin_unlock_bh(&srv->idr_lock);
697 sock_release(lsock);
698 tipc_topsrv_work_stop(srv);
699 idr_destroy(&srv->conn_idr);
700 kfree(srv);
701}
702
703int __net_init tipc_topsrv_init_net(struct net *net)
704{
705 return tipc_topsrv_start(net);
706}
707
708void __net_exit tipc_topsrv_exit_net(struct net *net)
709{
710 tipc_topsrv_stop(net);
711}