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 */ 66 struct 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 */ 92 struct 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 */ 107 struct outqueue_entry { 108 bool inactive; 109 struct tipc_event evt; 110 struct list_head list; 111 }; 112 113 static void tipc_conn_recv_work(struct work_struct *work); 114 static void tipc_conn_send_work(struct work_struct *work); 115 static void tipc_topsrv_kern_evt(struct net *net, struct tipc_event *evt); 116 static void tipc_conn_delete_sub(struct tipc_conn *con, struct tipc_subscr *s); 117 118 static bool connected(struct tipc_conn *con) 119 { 120 return con && test_bit(CF_CONNECTED, &con->flags); 121 } 122 123 static 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 145 static void conn_put(struct tipc_conn *con) 146 { 147 kref_put(&con->kref, tipc_conn_kref_release); 148 } 149 150 static void conn_get(struct tipc_conn *con) 151 { 152 kref_get(&con->kref); 153 } 154 155 static 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 179 static 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 215 static 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 */ 230 static 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 248 static 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 300 static 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 */ 313 void 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; 338 err: 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 */ 346 static 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 360 static 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 387 static 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 417 static 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 */ 438 static 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 452 static 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 */ 495 static 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 506 static 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; 563 err: 564 sock_release(lsock); 565 return -EINVAL; 566 } 567 568 bool 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 595 void 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 609 static 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 628 static 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 646 static void tipc_topsrv_work_stop(struct tipc_topsrv *s) 647 { 648 destroy_workqueue(s->rcv_wq); 649 destroy_workqueue(s->send_wq); 650 } 651 652 static 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 684 err_create: 685 tipc_topsrv_work_stop(srv); 686 err_start: 687 kfree(srv); 688 return ret; 689 } 690 691 static 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 718 int __net_init tipc_topsrv_init_net(struct net *net) 719 { 720 return tipc_topsrv_start(net); 721 } 722 723 void __net_exit tipc_topsrv_exit_net(struct net *net) 724 { 725 tipc_topsrv_stop(net); 726 } 727