| /* AF_RXRPC local endpoint management | |
| * | |
| * Copyright (C) 2007 Red Hat, Inc. All Rights Reserved. | |
| * Written by David Howells (dhowells@redhat.com) | |
| * | |
| * This program is free software; you can redistribute it and/or | |
| * modify it under the terms of the GNU General Public License | |
| * as published by the Free Software Foundation; either version | |
| * 2 of the License, or (at your option) any later version. | |
| */ | |
| #include <linux/module.h> | |
| #include <linux/net.h> | |
| #include <linux/skbuff.h> | |
| #include <linux/slab.h> | |
| #include <net/sock.h> | |
| #include <net/af_rxrpc.h> | |
| #include "ar-internal.h" | |
| static LIST_HEAD(rxrpc_locals); | |
| DEFINE_RWLOCK(rxrpc_local_lock); | |
| static DECLARE_RWSEM(rxrpc_local_sem); | |
| static DECLARE_WAIT_QUEUE_HEAD(rxrpc_local_wq); | |
| static void rxrpc_destroy_local(struct work_struct *work); | |
| /* | |
| * allocate a new local | |
| */ | |
| static | |
| struct rxrpc_local *rxrpc_alloc_local(struct sockaddr_rxrpc *srx) | |
| { | |
| struct rxrpc_local *local; | |
| local = kzalloc(sizeof(struct rxrpc_local), GFP_KERNEL); | |
| if (local) { | |
| INIT_WORK(&local->destroyer, &rxrpc_destroy_local); | |
| INIT_WORK(&local->acceptor, &rxrpc_accept_incoming_calls); | |
| INIT_WORK(&local->rejecter, &rxrpc_reject_packets); | |
| INIT_LIST_HEAD(&local->services); | |
| INIT_LIST_HEAD(&local->link); | |
| init_rwsem(&local->defrag_sem); | |
| skb_queue_head_init(&local->accept_queue); | |
| skb_queue_head_init(&local->reject_queue); | |
| spin_lock_init(&local->lock); | |
| rwlock_init(&local->services_lock); | |
| atomic_set(&local->usage, 1); | |
| local->debug_id = atomic_inc_return(&rxrpc_debug_id); | |
| memcpy(&local->srx, srx, sizeof(*srx)); | |
| } | |
| _leave(" = %p", local); | |
| return local; | |
| } | |
| /* | |
| * create the local socket | |
| * - must be called with rxrpc_local_sem writelocked | |
| */ | |
| static int rxrpc_create_local(struct rxrpc_local *local) | |
| { | |
| struct sock *sock; | |
| int ret, opt; | |
| _enter("%p{%d}", local, local->srx.transport_type); | |
| /* create a socket to represent the local endpoint */ | |
| ret = sock_create_kern(PF_INET, local->srx.transport_type, IPPROTO_UDP, | |
| &local->socket); | |
| if (ret < 0) { | |
| _leave(" = %d [socket]", ret); | |
| return ret; | |
| } | |
| /* if a local address was supplied then bind it */ | |
| if (local->srx.transport_len > sizeof(sa_family_t)) { | |
| _debug("bind"); | |
| ret = kernel_bind(local->socket, | |
| (struct sockaddr *) &local->srx.transport, | |
| local->srx.transport_len); | |
| if (ret < 0) { | |
| _debug("bind failed"); | |
| goto error; | |
| } | |
| } | |
| /* we want to receive ICMP errors */ | |
| opt = 1; | |
| ret = kernel_setsockopt(local->socket, SOL_IP, IP_RECVERR, | |
| (char *) &opt, sizeof(opt)); | |
| if (ret < 0) { | |
| _debug("setsockopt failed"); | |
| goto error; | |
| } | |
| /* we want to set the don't fragment bit */ | |
| opt = IP_PMTUDISC_DO; | |
| ret = kernel_setsockopt(local->socket, SOL_IP, IP_MTU_DISCOVER, | |
| (char *) &opt, sizeof(opt)); | |
| if (ret < 0) { | |
| _debug("setsockopt failed"); | |
| goto error; | |
| } | |
| write_lock_bh(&rxrpc_local_lock); | |
| list_add(&local->link, &rxrpc_locals); | |
| write_unlock_bh(&rxrpc_local_lock); | |
| /* set the socket up */ | |
| sock = local->socket->sk; | |
| sock->sk_user_data = local; | |
| sock->sk_data_ready = rxrpc_data_ready; | |
| sock->sk_error_report = rxrpc_UDP_error_report; | |
| _leave(" = 0"); | |
| return 0; | |
| error: | |
| kernel_sock_shutdown(local->socket, SHUT_RDWR); | |
| local->socket->sk->sk_user_data = NULL; | |
| sock_release(local->socket); | |
| local->socket = NULL; | |
| _leave(" = %d", ret); | |
| return ret; | |
| } | |
| /* | |
| * create a new local endpoint using the specified UDP address | |
| */ | |
| struct rxrpc_local *rxrpc_lookup_local(struct sockaddr_rxrpc *srx) | |
| { | |
| struct rxrpc_local *local; | |
| int ret; | |
| _enter("{%d,%u,%pI4+%hu}", | |
| srx->transport_type, | |
| srx->transport.family, | |
| &srx->transport.sin.sin_addr, | |
| ntohs(srx->transport.sin.sin_port)); | |
| down_write(&rxrpc_local_sem); | |
| /* see if we have a suitable local local endpoint already */ | |
| read_lock_bh(&rxrpc_local_lock); | |
| list_for_each_entry(local, &rxrpc_locals, link) { | |
| _debug("CMP {%d,%u,%pI4+%hu}", | |
| local->srx.transport_type, | |
| local->srx.transport.family, | |
| &local->srx.transport.sin.sin_addr, | |
| ntohs(local->srx.transport.sin.sin_port)); | |
| if (local->srx.transport_type != srx->transport_type || | |
| local->srx.transport.family != srx->transport.family) | |
| continue; | |
| switch (srx->transport.family) { | |
| case AF_INET: | |
| if (local->srx.transport.sin.sin_port != | |
| srx->transport.sin.sin_port) | |
| continue; | |
| if (memcmp(&local->srx.transport.sin.sin_addr, | |
| &srx->transport.sin.sin_addr, | |
| sizeof(struct in_addr)) != 0) | |
| continue; | |
| goto found_local; | |
| default: | |
| BUG(); | |
| } | |
| } | |
| read_unlock_bh(&rxrpc_local_lock); | |
| /* we didn't find one, so we need to create one */ | |
| local = rxrpc_alloc_local(srx); | |
| if (!local) { | |
| up_write(&rxrpc_local_sem); | |
| return ERR_PTR(-ENOMEM); | |
| } | |
| ret = rxrpc_create_local(local); | |
| if (ret < 0) { | |
| up_write(&rxrpc_local_sem); | |
| kfree(local); | |
| _leave(" = %d", ret); | |
| return ERR_PTR(ret); | |
| } | |
| up_write(&rxrpc_local_sem); | |
| _net("LOCAL new %d {%d,%u,%pI4+%hu}", | |
| local->debug_id, | |
| local->srx.transport_type, | |
| local->srx.transport.family, | |
| &local->srx.transport.sin.sin_addr, | |
| ntohs(local->srx.transport.sin.sin_port)); | |
| _leave(" = %p [new]", local); | |
| return local; | |
| found_local: | |
| rxrpc_get_local(local); | |
| read_unlock_bh(&rxrpc_local_lock); | |
| up_write(&rxrpc_local_sem); | |
| _net("LOCAL old %d {%d,%u,%pI4+%hu}", | |
| local->debug_id, | |
| local->srx.transport_type, | |
| local->srx.transport.family, | |
| &local->srx.transport.sin.sin_addr, | |
| ntohs(local->srx.transport.sin.sin_port)); | |
| _leave(" = %p [reuse]", local); | |
| return local; | |
| } | |
| /* | |
| * release a local endpoint | |
| */ | |
| void rxrpc_put_local(struct rxrpc_local *local) | |
| { | |
| _enter("%p{u=%d}", local, atomic_read(&local->usage)); | |
| ASSERTCMP(atomic_read(&local->usage), >, 0); | |
| /* to prevent a race, the decrement and the dequeue must be effectively | |
| * atomic */ | |
| write_lock_bh(&rxrpc_local_lock); | |
| if (unlikely(atomic_dec_and_test(&local->usage))) { | |
| _debug("destroy local"); | |
| rxrpc_queue_work(&local->destroyer); | |
| } | |
| write_unlock_bh(&rxrpc_local_lock); | |
| _leave(""); | |
| } | |
| /* | |
| * destroy a local endpoint | |
| */ | |
| static void rxrpc_destroy_local(struct work_struct *work) | |
| { | |
| struct rxrpc_local *local = | |
| container_of(work, struct rxrpc_local, destroyer); | |
| _enter("%p{%d}", local, atomic_read(&local->usage)); | |
| down_write(&rxrpc_local_sem); | |
| write_lock_bh(&rxrpc_local_lock); | |
| if (atomic_read(&local->usage) > 0) { | |
| write_unlock_bh(&rxrpc_local_lock); | |
| up_read(&rxrpc_local_sem); | |
| _leave(" [resurrected]"); | |
| return; | |
| } | |
| list_del(&local->link); | |
| local->socket->sk->sk_user_data = NULL; | |
| write_unlock_bh(&rxrpc_local_lock); | |
| downgrade_write(&rxrpc_local_sem); | |
| ASSERT(list_empty(&local->services)); | |
| ASSERT(!work_pending(&local->acceptor)); | |
| ASSERT(!work_pending(&local->rejecter)); | |
| /* finish cleaning up the local descriptor */ | |
| rxrpc_purge_queue(&local->accept_queue); | |
| rxrpc_purge_queue(&local->reject_queue); | |
| kernel_sock_shutdown(local->socket, SHUT_RDWR); | |
| sock_release(local->socket); | |
| up_read(&rxrpc_local_sem); | |
| _net("DESTROY LOCAL %d", local->debug_id); | |
| kfree(local); | |
| if (list_empty(&rxrpc_locals)) | |
| wake_up_all(&rxrpc_local_wq); | |
| _leave(""); | |
| } | |
| /* | |
| * preemptively destroy all local local endpoint rather than waiting for | |
| * them to be destroyed | |
| */ | |
| void __exit rxrpc_destroy_all_locals(void) | |
| { | |
| DECLARE_WAITQUEUE(myself,current); | |
| _enter(""); | |
| /* we simply have to wait for them to go away */ | |
| if (!list_empty(&rxrpc_locals)) { | |
| set_current_state(TASK_UNINTERRUPTIBLE); | |
| add_wait_queue(&rxrpc_local_wq, &myself); | |
| while (!list_empty(&rxrpc_locals)) { | |
| schedule(); | |
| set_current_state(TASK_UNINTERRUPTIBLE); | |
| } | |
| remove_wait_queue(&rxrpc_local_wq, &myself); | |
| set_current_state(TASK_RUNNING); | |
| } | |
| _leave(""); | |
| } |