16ed7257bSPatrick Caulfield /****************************************************************************** 26ed7257bSPatrick Caulfield ******************************************************************************* 36ed7257bSPatrick Caulfield ** 46ed7257bSPatrick Caulfield ** Copyright (C) Sistina Software, Inc. 1997-2003 All rights reserved. 55e9ccc37SChristine Caulfield ** Copyright (C) 2004-2009 Red Hat, Inc. All rights reserved. 66ed7257bSPatrick Caulfield ** 76ed7257bSPatrick Caulfield ** This copyrighted material is made available to anyone wishing to use, 86ed7257bSPatrick Caulfield ** modify, copy, or redistribute it subject to the terms and conditions 96ed7257bSPatrick Caulfield ** of the GNU General Public License v.2. 106ed7257bSPatrick Caulfield ** 116ed7257bSPatrick Caulfield ******************************************************************************* 126ed7257bSPatrick Caulfield ******************************************************************************/ 136ed7257bSPatrick Caulfield 146ed7257bSPatrick Caulfield /* 156ed7257bSPatrick Caulfield * lowcomms.c 166ed7257bSPatrick Caulfield * 176ed7257bSPatrick Caulfield * This is the "low-level" comms layer. 186ed7257bSPatrick Caulfield * 196ed7257bSPatrick Caulfield * It is responsible for sending/receiving messages 206ed7257bSPatrick Caulfield * from other nodes in the cluster. 216ed7257bSPatrick Caulfield * 226ed7257bSPatrick Caulfield * Cluster nodes are referred to by their nodeids. nodeids are 236ed7257bSPatrick Caulfield * simply 32 bit numbers to the locking module - if they need to 242cf12c0bSJoe Perches * be expanded for the cluster infrastructure then that is its 256ed7257bSPatrick Caulfield * responsibility. It is this layer's 266ed7257bSPatrick Caulfield * responsibility to resolve these into IP address or 276ed7257bSPatrick Caulfield * whatever it needs for inter-node communication. 286ed7257bSPatrick Caulfield * 296ed7257bSPatrick Caulfield * The comms level is two kernel threads that deal mainly with 306ed7257bSPatrick Caulfield * the receiving of messages from other nodes and passing them 316ed7257bSPatrick Caulfield * up to the mid-level comms layer (which understands the 326ed7257bSPatrick Caulfield * message format) for execution by the locking core, and 336ed7257bSPatrick Caulfield * a send thread which does all the setting up of connections 346ed7257bSPatrick Caulfield * to remote nodes and the sending of data. Threads are not allowed 356ed7257bSPatrick Caulfield * to send their own data because it may cause them to wait in times 366ed7257bSPatrick Caulfield * of high load. Also, this way, the sending thread can collect together 376ed7257bSPatrick Caulfield * messages bound for one node and send them in one block. 386ed7257bSPatrick Caulfield * 392cf12c0bSJoe Perches * lowcomms will choose to use either TCP or SCTP as its transport layer 406ed7257bSPatrick Caulfield * depending on the configuration variable 'protocol'. This should be set 416ed7257bSPatrick Caulfield * to 0 (default) for TCP or 1 for SCTP. It should be configured using a 426ed7257bSPatrick Caulfield * cluster-wide mechanism as it must be the same on all nodes of the cluster 436ed7257bSPatrick Caulfield * for the DLM to function. 446ed7257bSPatrick Caulfield * 456ed7257bSPatrick Caulfield */ 466ed7257bSPatrick Caulfield 476ed7257bSPatrick Caulfield #include <asm/ioctls.h> 486ed7257bSPatrick Caulfield #include <net/sock.h> 496ed7257bSPatrick Caulfield #include <net/tcp.h> 506ed7257bSPatrick Caulfield #include <linux/pagemap.h> 516ed7257bSPatrick Caulfield #include <linux/file.h> 527a936ce7SMatthias Kaehlcke #include <linux/mutex.h> 536ed7257bSPatrick Caulfield #include <linux/sctp.h> 545a0e3ad6STejun Heo #include <linux/slab.h> 556ed7257bSPatrick Caulfield #include <net/sctp/user.h> 5644ad532bSJoe Perches #include <net/ipv6.h> 576ed7257bSPatrick Caulfield 586ed7257bSPatrick Caulfield #include "dlm_internal.h" 596ed7257bSPatrick Caulfield #include "lowcomms.h" 606ed7257bSPatrick Caulfield #include "midcomms.h" 616ed7257bSPatrick Caulfield #include "config.h" 626ed7257bSPatrick Caulfield 636ed7257bSPatrick Caulfield #define NEEDED_RMEM (4*1024*1024) 645e9ccc37SChristine Caulfield #define CONN_HASH_SIZE 32 656ed7257bSPatrick Caulfield 666ed7257bSPatrick Caulfield struct cbuf { 676ed7257bSPatrick Caulfield unsigned int base; 686ed7257bSPatrick Caulfield unsigned int len; 696ed7257bSPatrick Caulfield unsigned int mask; 706ed7257bSPatrick Caulfield }; 716ed7257bSPatrick Caulfield 726ed7257bSPatrick Caulfield static void cbuf_add(struct cbuf *cb, int n) 736ed7257bSPatrick Caulfield { 746ed7257bSPatrick Caulfield cb->len += n; 756ed7257bSPatrick Caulfield } 766ed7257bSPatrick Caulfield 776ed7257bSPatrick Caulfield static int cbuf_data(struct cbuf *cb) 786ed7257bSPatrick Caulfield { 796ed7257bSPatrick Caulfield return ((cb->base + cb->len) & cb->mask); 806ed7257bSPatrick Caulfield } 816ed7257bSPatrick Caulfield 826ed7257bSPatrick Caulfield static void cbuf_init(struct cbuf *cb, int size) 836ed7257bSPatrick Caulfield { 846ed7257bSPatrick Caulfield cb->base = cb->len = 0; 856ed7257bSPatrick Caulfield cb->mask = size-1; 866ed7257bSPatrick Caulfield } 876ed7257bSPatrick Caulfield 886ed7257bSPatrick Caulfield static void cbuf_eat(struct cbuf *cb, int n) 896ed7257bSPatrick Caulfield { 906ed7257bSPatrick Caulfield cb->len -= n; 916ed7257bSPatrick Caulfield cb->base += n; 926ed7257bSPatrick Caulfield cb->base &= cb->mask; 936ed7257bSPatrick Caulfield } 946ed7257bSPatrick Caulfield 956ed7257bSPatrick Caulfield static bool cbuf_empty(struct cbuf *cb) 966ed7257bSPatrick Caulfield { 976ed7257bSPatrick Caulfield return cb->len == 0; 986ed7257bSPatrick Caulfield } 996ed7257bSPatrick Caulfield 1006ed7257bSPatrick Caulfield struct connection { 1016ed7257bSPatrick Caulfield struct socket *sock; /* NULL if not connected */ 1026ed7257bSPatrick Caulfield uint32_t nodeid; /* So we know who we are in the list */ 1036ed7257bSPatrick Caulfield struct mutex sock_mutex; 1046ed7257bSPatrick Caulfield unsigned long flags; 1056ed7257bSPatrick Caulfield #define CF_READ_PENDING 1 1066ed7257bSPatrick Caulfield #define CF_WRITE_PENDING 2 1076ed7257bSPatrick Caulfield #define CF_CONNECT_PENDING 3 1086ed7257bSPatrick Caulfield #define CF_INIT_PENDING 4 1096ed7257bSPatrick Caulfield #define CF_IS_OTHERCON 5 110063c4c99SLars Marowsky-Bree #define CF_CLOSE 6 111b36930ddSDavid Miller #define CF_APP_LIMITED 7 1126ed7257bSPatrick Caulfield struct list_head writequeue; /* List of outgoing writequeue_entries */ 1136ed7257bSPatrick Caulfield spinlock_t writequeue_lock; 1146ed7257bSPatrick Caulfield int (*rx_action) (struct connection *); /* What to do when active */ 1156ed7257bSPatrick Caulfield void (*connect_action) (struct connection *); /* What to do to connect */ 1166ed7257bSPatrick Caulfield struct page *rx_page; 1176ed7257bSPatrick Caulfield struct cbuf cb; 1186ed7257bSPatrick Caulfield int retries; 1196ed7257bSPatrick Caulfield #define MAX_CONNECT_RETRIES 3 1206ed7257bSPatrick Caulfield int sctp_assoc; 1215e9ccc37SChristine Caulfield struct hlist_node list; 1226ed7257bSPatrick Caulfield struct connection *othercon; 1236ed7257bSPatrick Caulfield struct work_struct rwork; /* Receive workqueue */ 1246ed7257bSPatrick Caulfield struct work_struct swork; /* Send workqueue */ 1256ed7257bSPatrick Caulfield }; 1266ed7257bSPatrick Caulfield #define sock2con(x) ((struct connection *)(x)->sk_user_data) 1276ed7257bSPatrick Caulfield 1286ed7257bSPatrick Caulfield /* An entry waiting to be sent */ 1296ed7257bSPatrick Caulfield struct writequeue_entry { 1306ed7257bSPatrick Caulfield struct list_head list; 1316ed7257bSPatrick Caulfield struct page *page; 1326ed7257bSPatrick Caulfield int offset; 1336ed7257bSPatrick Caulfield int len; 1346ed7257bSPatrick Caulfield int end; 1356ed7257bSPatrick Caulfield int users; 1366ed7257bSPatrick Caulfield struct connection *con; 1376ed7257bSPatrick Caulfield }; 1386ed7257bSPatrick Caulfield 1396ed7257bSPatrick Caulfield static struct sockaddr_storage *dlm_local_addr[DLM_MAX_ADDR_COUNT]; 1406ed7257bSPatrick Caulfield static int dlm_local_count; 1416ed7257bSPatrick Caulfield 1426ed7257bSPatrick Caulfield /* Work queues */ 1436ed7257bSPatrick Caulfield static struct workqueue_struct *recv_workqueue; 1446ed7257bSPatrick Caulfield static struct workqueue_struct *send_workqueue; 1456ed7257bSPatrick Caulfield 1465e9ccc37SChristine Caulfield static struct hlist_head connection_hash[CONN_HASH_SIZE]; 1477a936ce7SMatthias Kaehlcke static DEFINE_MUTEX(connections_lock); 1486ed7257bSPatrick Caulfield static struct kmem_cache *con_cache; 1496ed7257bSPatrick Caulfield 1506ed7257bSPatrick Caulfield static void process_recv_sockets(struct work_struct *work); 1516ed7257bSPatrick Caulfield static void process_send_sockets(struct work_struct *work); 1526ed7257bSPatrick Caulfield 1535e9ccc37SChristine Caulfield 1545e9ccc37SChristine Caulfield /* This is deliberately very simple because most clusters have simple 1555e9ccc37SChristine Caulfield sequential nodeids, so we should be able to go straight to a connection 1565e9ccc37SChristine Caulfield struct in the array */ 1575e9ccc37SChristine Caulfield static inline int nodeid_hash(int nodeid) 1585e9ccc37SChristine Caulfield { 1595e9ccc37SChristine Caulfield return nodeid & (CONN_HASH_SIZE-1); 1605e9ccc37SChristine Caulfield } 1615e9ccc37SChristine Caulfield 1625e9ccc37SChristine Caulfield static struct connection *__find_con(int nodeid) 1635e9ccc37SChristine Caulfield { 1645e9ccc37SChristine Caulfield int r; 1655e9ccc37SChristine Caulfield struct hlist_node *h; 1665e9ccc37SChristine Caulfield struct connection *con; 1675e9ccc37SChristine Caulfield 1685e9ccc37SChristine Caulfield r = nodeid_hash(nodeid); 1695e9ccc37SChristine Caulfield 1705e9ccc37SChristine Caulfield hlist_for_each_entry(con, h, &connection_hash[r], list) { 1715e9ccc37SChristine Caulfield if (con->nodeid == nodeid) 1725e9ccc37SChristine Caulfield return con; 1735e9ccc37SChristine Caulfield } 1745e9ccc37SChristine Caulfield return NULL; 1755e9ccc37SChristine Caulfield } 1765e9ccc37SChristine Caulfield 1776ed7257bSPatrick Caulfield /* 1786ed7257bSPatrick Caulfield * If 'allocation' is zero then we don't attempt to create a new 1796ed7257bSPatrick Caulfield * connection structure for this node. 1806ed7257bSPatrick Caulfield */ 1816ed7257bSPatrick Caulfield static struct connection *__nodeid2con(int nodeid, gfp_t alloc) 1826ed7257bSPatrick Caulfield { 1836ed7257bSPatrick Caulfield struct connection *con = NULL; 1846ed7257bSPatrick Caulfield int r; 1856ed7257bSPatrick Caulfield 1865e9ccc37SChristine Caulfield con = __find_con(nodeid); 1876ed7257bSPatrick Caulfield if (con || !alloc) 1886ed7257bSPatrick Caulfield return con; 1896ed7257bSPatrick Caulfield 1906ed7257bSPatrick Caulfield con = kmem_cache_zalloc(con_cache, alloc); 1916ed7257bSPatrick Caulfield if (!con) 1926ed7257bSPatrick Caulfield return NULL; 1936ed7257bSPatrick Caulfield 1945e9ccc37SChristine Caulfield r = nodeid_hash(nodeid); 1955e9ccc37SChristine Caulfield hlist_add_head(&con->list, &connection_hash[r]); 1966ed7257bSPatrick Caulfield 1976ed7257bSPatrick Caulfield con->nodeid = nodeid; 1986ed7257bSPatrick Caulfield mutex_init(&con->sock_mutex); 1996ed7257bSPatrick Caulfield INIT_LIST_HEAD(&con->writequeue); 2006ed7257bSPatrick Caulfield spin_lock_init(&con->writequeue_lock); 2016ed7257bSPatrick Caulfield INIT_WORK(&con->swork, process_send_sockets); 2026ed7257bSPatrick Caulfield INIT_WORK(&con->rwork, process_recv_sockets); 2036ed7257bSPatrick Caulfield 2046ed7257bSPatrick Caulfield /* Setup action pointers for child sockets */ 2056ed7257bSPatrick Caulfield if (con->nodeid) { 2065e9ccc37SChristine Caulfield struct connection *zerocon = __find_con(0); 2076ed7257bSPatrick Caulfield 2086ed7257bSPatrick Caulfield con->connect_action = zerocon->connect_action; 2096ed7257bSPatrick Caulfield if (!con->rx_action) 2106ed7257bSPatrick Caulfield con->rx_action = zerocon->rx_action; 2116ed7257bSPatrick Caulfield } 2126ed7257bSPatrick Caulfield 2136ed7257bSPatrick Caulfield return con; 2146ed7257bSPatrick Caulfield } 2156ed7257bSPatrick Caulfield 2165e9ccc37SChristine Caulfield /* Loop round all connections */ 2175e9ccc37SChristine Caulfield static void foreach_conn(void (*conn_func)(struct connection *c)) 2185e9ccc37SChristine Caulfield { 2195e9ccc37SChristine Caulfield int i; 2205e9ccc37SChristine Caulfield struct hlist_node *h, *n; 2215e9ccc37SChristine Caulfield struct connection *con; 2225e9ccc37SChristine Caulfield 2235e9ccc37SChristine Caulfield for (i = 0; i < CONN_HASH_SIZE; i++) { 2245e9ccc37SChristine Caulfield hlist_for_each_entry_safe(con, h, n, &connection_hash[i], list){ 2255e9ccc37SChristine Caulfield conn_func(con); 2265e9ccc37SChristine Caulfield } 2275e9ccc37SChristine Caulfield } 2285e9ccc37SChristine Caulfield } 2295e9ccc37SChristine Caulfield 2306ed7257bSPatrick Caulfield static struct connection *nodeid2con(int nodeid, gfp_t allocation) 2316ed7257bSPatrick Caulfield { 2326ed7257bSPatrick Caulfield struct connection *con; 2336ed7257bSPatrick Caulfield 2347a936ce7SMatthias Kaehlcke mutex_lock(&connections_lock); 2356ed7257bSPatrick Caulfield con = __nodeid2con(nodeid, allocation); 2367a936ce7SMatthias Kaehlcke mutex_unlock(&connections_lock); 2376ed7257bSPatrick Caulfield 2386ed7257bSPatrick Caulfield return con; 2396ed7257bSPatrick Caulfield } 2406ed7257bSPatrick Caulfield 2416ed7257bSPatrick Caulfield /* This is a bit drastic, but only called when things go wrong */ 2426ed7257bSPatrick Caulfield static struct connection *assoc2con(int assoc_id) 2436ed7257bSPatrick Caulfield { 2446ed7257bSPatrick Caulfield int i; 2455e9ccc37SChristine Caulfield struct hlist_node *h; 2466ed7257bSPatrick Caulfield struct connection *con; 2476ed7257bSPatrick Caulfield 2487a936ce7SMatthias Kaehlcke mutex_lock(&connections_lock); 2495e9ccc37SChristine Caulfield 2505e9ccc37SChristine Caulfield for (i = 0 ; i < CONN_HASH_SIZE; i++) { 2515e9ccc37SChristine Caulfield hlist_for_each_entry(con, h, &connection_hash[i], list) { 252f70cb33bSJulia Lawall if (con->sctp_assoc == assoc_id) { 2537a936ce7SMatthias Kaehlcke mutex_unlock(&connections_lock); 2546ed7257bSPatrick Caulfield return con; 2556ed7257bSPatrick Caulfield } 2566ed7257bSPatrick Caulfield } 2575e9ccc37SChristine Caulfield } 2587a936ce7SMatthias Kaehlcke mutex_unlock(&connections_lock); 2596ed7257bSPatrick Caulfield return NULL; 2606ed7257bSPatrick Caulfield } 2616ed7257bSPatrick Caulfield 2626ed7257bSPatrick Caulfield static int nodeid_to_addr(int nodeid, struct sockaddr *retaddr) 2636ed7257bSPatrick Caulfield { 2646ed7257bSPatrick Caulfield struct sockaddr_storage addr; 2656ed7257bSPatrick Caulfield int error; 2666ed7257bSPatrick Caulfield 2676ed7257bSPatrick Caulfield if (!dlm_local_count) 2686ed7257bSPatrick Caulfield return -1; 2696ed7257bSPatrick Caulfield 2706ed7257bSPatrick Caulfield error = dlm_nodeid_to_addr(nodeid, &addr); 2716ed7257bSPatrick Caulfield if (error) 2726ed7257bSPatrick Caulfield return error; 2736ed7257bSPatrick Caulfield 2746ed7257bSPatrick Caulfield if (dlm_local_addr[0]->ss_family == AF_INET) { 2756ed7257bSPatrick Caulfield struct sockaddr_in *in4 = (struct sockaddr_in *) &addr; 2766ed7257bSPatrick Caulfield struct sockaddr_in *ret4 = (struct sockaddr_in *) retaddr; 2776ed7257bSPatrick Caulfield ret4->sin_addr.s_addr = in4->sin_addr.s_addr; 2786ed7257bSPatrick Caulfield } else { 2796ed7257bSPatrick Caulfield struct sockaddr_in6 *in6 = (struct sockaddr_in6 *) &addr; 2806ed7257bSPatrick Caulfield struct sockaddr_in6 *ret6 = (struct sockaddr_in6 *) retaddr; 28144ad532bSJoe Perches ipv6_addr_copy(&ret6->sin6_addr, &in6->sin6_addr); 2826ed7257bSPatrick Caulfield } 2836ed7257bSPatrick Caulfield 2846ed7257bSPatrick Caulfield return 0; 2856ed7257bSPatrick Caulfield } 2866ed7257bSPatrick Caulfield 2876ed7257bSPatrick Caulfield /* Data available on socket or listen socket received a connect */ 2886ed7257bSPatrick Caulfield static void lowcomms_data_ready(struct sock *sk, int count_unused) 2896ed7257bSPatrick Caulfield { 2906ed7257bSPatrick Caulfield struct connection *con = sock2con(sk); 291afb853fbSPatrick Caulfield if (con && !test_and_set_bit(CF_READ_PENDING, &con->flags)) 2926ed7257bSPatrick Caulfield queue_work(recv_workqueue, &con->rwork); 2936ed7257bSPatrick Caulfield } 2946ed7257bSPatrick Caulfield 2956ed7257bSPatrick Caulfield static void lowcomms_write_space(struct sock *sk) 2966ed7257bSPatrick Caulfield { 2976ed7257bSPatrick Caulfield struct connection *con = sock2con(sk); 2986ed7257bSPatrick Caulfield 299b36930ddSDavid Miller if (!con) 300b36930ddSDavid Miller return; 301b36930ddSDavid Miller 302b36930ddSDavid Miller clear_bit(SOCK_NOSPACE, &con->sock->flags); 303b36930ddSDavid Miller 304b36930ddSDavid Miller if (test_and_clear_bit(CF_APP_LIMITED, &con->flags)) { 305b36930ddSDavid Miller con->sock->sk->sk_write_pending--; 306b36930ddSDavid Miller clear_bit(SOCK_ASYNC_NOSPACE, &con->sock->flags); 307b36930ddSDavid Miller } 308b36930ddSDavid Miller 309b36930ddSDavid Miller if (!test_and_set_bit(CF_WRITE_PENDING, &con->flags)) 3106ed7257bSPatrick Caulfield queue_work(send_workqueue, &con->swork); 3116ed7257bSPatrick Caulfield } 3126ed7257bSPatrick Caulfield 3136ed7257bSPatrick Caulfield static inline void lowcomms_connect_sock(struct connection *con) 3146ed7257bSPatrick Caulfield { 315063c4c99SLars Marowsky-Bree if (test_bit(CF_CLOSE, &con->flags)) 316063c4c99SLars Marowsky-Bree return; 3176ed7257bSPatrick Caulfield if (!test_and_set_bit(CF_CONNECT_PENDING, &con->flags)) 3186ed7257bSPatrick Caulfield queue_work(send_workqueue, &con->swork); 3196ed7257bSPatrick Caulfield } 3206ed7257bSPatrick Caulfield 3216ed7257bSPatrick Caulfield static void lowcomms_state_change(struct sock *sk) 3226ed7257bSPatrick Caulfield { 3236ed7257bSPatrick Caulfield if (sk->sk_state == TCP_ESTABLISHED) 3246ed7257bSPatrick Caulfield lowcomms_write_space(sk); 3256ed7257bSPatrick Caulfield } 3266ed7257bSPatrick Caulfield 327391fbdc5SChristine Caulfield int dlm_lowcomms_connect_node(int nodeid) 328391fbdc5SChristine Caulfield { 329391fbdc5SChristine Caulfield struct connection *con; 330391fbdc5SChristine Caulfield 33104bedd79SDavid Teigland /* with sctp there's no connecting without sending */ 33204bedd79SDavid Teigland if (dlm_config.ci_protocol != 0) 33304bedd79SDavid Teigland return 0; 33404bedd79SDavid Teigland 335391fbdc5SChristine Caulfield if (nodeid == dlm_our_nodeid()) 336391fbdc5SChristine Caulfield return 0; 337391fbdc5SChristine Caulfield 338391fbdc5SChristine Caulfield con = nodeid2con(nodeid, GFP_NOFS); 339391fbdc5SChristine Caulfield if (!con) 340391fbdc5SChristine Caulfield return -ENOMEM; 341391fbdc5SChristine Caulfield lowcomms_connect_sock(con); 342391fbdc5SChristine Caulfield return 0; 343391fbdc5SChristine Caulfield } 344391fbdc5SChristine Caulfield 3456ed7257bSPatrick Caulfield /* Make a socket active */ 3466ed7257bSPatrick Caulfield static int add_sock(struct socket *sock, struct connection *con) 3476ed7257bSPatrick Caulfield { 3486ed7257bSPatrick Caulfield con->sock = sock; 3496ed7257bSPatrick Caulfield 3506ed7257bSPatrick Caulfield /* Install a data_ready callback */ 3516ed7257bSPatrick Caulfield con->sock->sk->sk_data_ready = lowcomms_data_ready; 3526ed7257bSPatrick Caulfield con->sock->sk->sk_write_space = lowcomms_write_space; 3536ed7257bSPatrick Caulfield con->sock->sk->sk_state_change = lowcomms_state_change; 3546ed7257bSPatrick Caulfield con->sock->sk->sk_user_data = con; 355d6d7b702SSteven Whitehouse con->sock->sk->sk_allocation = GFP_NOFS; 3566ed7257bSPatrick Caulfield return 0; 3576ed7257bSPatrick Caulfield } 3586ed7257bSPatrick Caulfield 3596ed7257bSPatrick Caulfield /* Add the port number to an IPv6 or 4 sockaddr and return the address 3606ed7257bSPatrick Caulfield length */ 3616ed7257bSPatrick Caulfield static void make_sockaddr(struct sockaddr_storage *saddr, uint16_t port, 3626ed7257bSPatrick Caulfield int *addr_len) 3636ed7257bSPatrick Caulfield { 3646ed7257bSPatrick Caulfield saddr->ss_family = dlm_local_addr[0]->ss_family; 3656ed7257bSPatrick Caulfield if (saddr->ss_family == AF_INET) { 3666ed7257bSPatrick Caulfield struct sockaddr_in *in4_addr = (struct sockaddr_in *)saddr; 3676ed7257bSPatrick Caulfield in4_addr->sin_port = cpu_to_be16(port); 3686ed7257bSPatrick Caulfield *addr_len = sizeof(struct sockaddr_in); 3696ed7257bSPatrick Caulfield memset(&in4_addr->sin_zero, 0, sizeof(in4_addr->sin_zero)); 3706ed7257bSPatrick Caulfield } else { 3716ed7257bSPatrick Caulfield struct sockaddr_in6 *in6_addr = (struct sockaddr_in6 *)saddr; 3726ed7257bSPatrick Caulfield in6_addr->sin6_port = cpu_to_be16(port); 3736ed7257bSPatrick Caulfield *addr_len = sizeof(struct sockaddr_in6); 3746ed7257bSPatrick Caulfield } 37501c8cab2SPatrick Caulfield memset((char *)saddr + *addr_len, 0, sizeof(struct sockaddr_storage) - *addr_len); 3766ed7257bSPatrick Caulfield } 3776ed7257bSPatrick Caulfield 3786ed7257bSPatrick Caulfield /* Close a remote connection and tidy up */ 3796ed7257bSPatrick Caulfield static void close_connection(struct connection *con, bool and_other) 3806ed7257bSPatrick Caulfield { 3816ed7257bSPatrick Caulfield mutex_lock(&con->sock_mutex); 3826ed7257bSPatrick Caulfield 3836ed7257bSPatrick Caulfield if (con->sock) { 3846ed7257bSPatrick Caulfield sock_release(con->sock); 3856ed7257bSPatrick Caulfield con->sock = NULL; 3866ed7257bSPatrick Caulfield } 3876ed7257bSPatrick Caulfield if (con->othercon && and_other) { 3886ed7257bSPatrick Caulfield /* Will only re-enter once. */ 3896ed7257bSPatrick Caulfield close_connection(con->othercon, false); 3906ed7257bSPatrick Caulfield } 3916ed7257bSPatrick Caulfield if (con->rx_page) { 3926ed7257bSPatrick Caulfield __free_page(con->rx_page); 3936ed7257bSPatrick Caulfield con->rx_page = NULL; 3946ed7257bSPatrick Caulfield } 3959e5f2825SPatrick Caulfield 3966ed7257bSPatrick Caulfield con->retries = 0; 3976ed7257bSPatrick Caulfield mutex_unlock(&con->sock_mutex); 3986ed7257bSPatrick Caulfield } 3996ed7257bSPatrick Caulfield 4006ed7257bSPatrick Caulfield /* We only send shutdown messages to nodes that are not part of the cluster */ 4016ed7257bSPatrick Caulfield static void sctp_send_shutdown(sctp_assoc_t associd) 4026ed7257bSPatrick Caulfield { 4036ed7257bSPatrick Caulfield static char outcmsg[CMSG_SPACE(sizeof(struct sctp_sndrcvinfo))]; 4046ed7257bSPatrick Caulfield struct msghdr outmessage; 4056ed7257bSPatrick Caulfield struct cmsghdr *cmsg; 4066ed7257bSPatrick Caulfield struct sctp_sndrcvinfo *sinfo; 4076ed7257bSPatrick Caulfield int ret; 4086ed7257bSPatrick Caulfield struct connection *con; 4096ed7257bSPatrick Caulfield 4106ed7257bSPatrick Caulfield con = nodeid2con(0,0); 4116ed7257bSPatrick Caulfield BUG_ON(con == NULL); 4126ed7257bSPatrick Caulfield 4136ed7257bSPatrick Caulfield outmessage.msg_name = NULL; 4146ed7257bSPatrick Caulfield outmessage.msg_namelen = 0; 4156ed7257bSPatrick Caulfield outmessage.msg_control = outcmsg; 4166ed7257bSPatrick Caulfield outmessage.msg_controllen = sizeof(outcmsg); 4176ed7257bSPatrick Caulfield outmessage.msg_flags = MSG_EOR; 4186ed7257bSPatrick Caulfield 4196ed7257bSPatrick Caulfield cmsg = CMSG_FIRSTHDR(&outmessage); 4206ed7257bSPatrick Caulfield cmsg->cmsg_level = IPPROTO_SCTP; 4216ed7257bSPatrick Caulfield cmsg->cmsg_type = SCTP_SNDRCV; 4226ed7257bSPatrick Caulfield cmsg->cmsg_len = CMSG_LEN(sizeof(struct sctp_sndrcvinfo)); 4236ed7257bSPatrick Caulfield outmessage.msg_controllen = cmsg->cmsg_len; 4246ed7257bSPatrick Caulfield sinfo = CMSG_DATA(cmsg); 4256ed7257bSPatrick Caulfield memset(sinfo, 0x00, sizeof(struct sctp_sndrcvinfo)); 4266ed7257bSPatrick Caulfield 4276ed7257bSPatrick Caulfield sinfo->sinfo_flags |= MSG_EOF; 4286ed7257bSPatrick Caulfield sinfo->sinfo_assoc_id = associd; 4296ed7257bSPatrick Caulfield 4306ed7257bSPatrick Caulfield ret = kernel_sendmsg(con->sock, &outmessage, NULL, 0, 0); 4316ed7257bSPatrick Caulfield 4326ed7257bSPatrick Caulfield if (ret != 0) 4336ed7257bSPatrick Caulfield log_print("send EOF to node failed: %d", ret); 4346ed7257bSPatrick Caulfield } 4356ed7257bSPatrick Caulfield 4365e9ccc37SChristine Caulfield static void sctp_init_failed_foreach(struct connection *con) 4375e9ccc37SChristine Caulfield { 4385e9ccc37SChristine Caulfield con->sctp_assoc = 0; 4395e9ccc37SChristine Caulfield if (test_and_clear_bit(CF_CONNECT_PENDING, &con->flags)) { 4405e9ccc37SChristine Caulfield if (!test_and_set_bit(CF_WRITE_PENDING, &con->flags)) 4415e9ccc37SChristine Caulfield queue_work(send_workqueue, &con->swork); 4425e9ccc37SChristine Caulfield } 4435e9ccc37SChristine Caulfield } 4445e9ccc37SChristine Caulfield 4456ed7257bSPatrick Caulfield /* INIT failed but we don't know which node... 4466ed7257bSPatrick Caulfield restart INIT on all pending nodes */ 4476ed7257bSPatrick Caulfield static void sctp_init_failed(void) 4486ed7257bSPatrick Caulfield { 4497a936ce7SMatthias Kaehlcke mutex_lock(&connections_lock); 4505e9ccc37SChristine Caulfield 4515e9ccc37SChristine Caulfield foreach_conn(sctp_init_failed_foreach); 4525e9ccc37SChristine Caulfield 4537a936ce7SMatthias Kaehlcke mutex_unlock(&connections_lock); 4546ed7257bSPatrick Caulfield } 4556ed7257bSPatrick Caulfield 4566ed7257bSPatrick Caulfield /* Something happened to an association */ 457617e82e1SDavid Teigland static void process_sctp_notification(struct connection *con, 458617e82e1SDavid Teigland struct msghdr *msg, char *buf) 4596ed7257bSPatrick Caulfield { 4606ed7257bSPatrick Caulfield union sctp_notification *sn = (union sctp_notification *)buf; 4616ed7257bSPatrick Caulfield 4626ed7257bSPatrick Caulfield if (sn->sn_header.sn_type == SCTP_ASSOC_CHANGE) { 4636ed7257bSPatrick Caulfield switch (sn->sn_assoc_change.sac_state) { 4646ed7257bSPatrick Caulfield 4656ed7257bSPatrick Caulfield case SCTP_COMM_UP: 4666ed7257bSPatrick Caulfield case SCTP_RESTART: 4676ed7257bSPatrick Caulfield { 4686ed7257bSPatrick Caulfield /* Check that the new node is in the lockspace */ 4696ed7257bSPatrick Caulfield struct sctp_prim prim; 4706ed7257bSPatrick Caulfield int nodeid; 4716ed7257bSPatrick Caulfield int prim_len, ret; 4726ed7257bSPatrick Caulfield int addr_len; 4736ed7257bSPatrick Caulfield struct connection *new_con; 4746ed7257bSPatrick Caulfield sctp_peeloff_arg_t parg; 4756ed7257bSPatrick Caulfield int parglen = sizeof(parg); 4766861f350SDavid Teigland int err; 4776ed7257bSPatrick Caulfield 4786ed7257bSPatrick Caulfield /* 4796ed7257bSPatrick Caulfield * We get this before any data for an association. 4806ed7257bSPatrick Caulfield * We verify that the node is in the cluster and 4816ed7257bSPatrick Caulfield * then peel off a socket for it. 4826ed7257bSPatrick Caulfield */ 4836ed7257bSPatrick Caulfield if ((int)sn->sn_assoc_change.sac_assoc_id <= 0) { 4846ed7257bSPatrick Caulfield log_print("COMM_UP for invalid assoc ID %d", 4856ed7257bSPatrick Caulfield (int)sn->sn_assoc_change.sac_assoc_id); 4866ed7257bSPatrick Caulfield sctp_init_failed(); 4876ed7257bSPatrick Caulfield return; 4886ed7257bSPatrick Caulfield } 4896ed7257bSPatrick Caulfield memset(&prim, 0, sizeof(struct sctp_prim)); 4906ed7257bSPatrick Caulfield prim_len = sizeof(struct sctp_prim); 4916ed7257bSPatrick Caulfield prim.ssp_assoc_id = sn->sn_assoc_change.sac_assoc_id; 4926ed7257bSPatrick Caulfield 4936ed7257bSPatrick Caulfield ret = kernel_getsockopt(con->sock, 4946ed7257bSPatrick Caulfield IPPROTO_SCTP, 4956ed7257bSPatrick Caulfield SCTP_PRIMARY_ADDR, 4966ed7257bSPatrick Caulfield (char*)&prim, 4976ed7257bSPatrick Caulfield &prim_len); 4986ed7257bSPatrick Caulfield if (ret < 0) { 4996ed7257bSPatrick Caulfield log_print("getsockopt/sctp_primary_addr on " 5006ed7257bSPatrick Caulfield "new assoc %d failed : %d", 5016ed7257bSPatrick Caulfield (int)sn->sn_assoc_change.sac_assoc_id, 5026ed7257bSPatrick Caulfield ret); 5036ed7257bSPatrick Caulfield 5046ed7257bSPatrick Caulfield /* Retry INIT later */ 5056ed7257bSPatrick Caulfield new_con = assoc2con(sn->sn_assoc_change.sac_assoc_id); 5066ed7257bSPatrick Caulfield if (new_con) 5076ed7257bSPatrick Caulfield clear_bit(CF_CONNECT_PENDING, &con->flags); 5086ed7257bSPatrick Caulfield return; 5096ed7257bSPatrick Caulfield } 5106ed7257bSPatrick Caulfield make_sockaddr(&prim.ssp_addr, 0, &addr_len); 5116ed7257bSPatrick Caulfield if (dlm_addr_to_nodeid(&prim.ssp_addr, &nodeid)) { 5126ed7257bSPatrick Caulfield int i; 5136ed7257bSPatrick Caulfield unsigned char *b=(unsigned char *)&prim.ssp_addr; 5146ed7257bSPatrick Caulfield log_print("reject connect from unknown addr"); 5156ed7257bSPatrick Caulfield for (i=0; i<sizeof(struct sockaddr_storage);i++) 5166ed7257bSPatrick Caulfield printk("%02x ", b[i]); 5176ed7257bSPatrick Caulfield printk("\n"); 5186ed7257bSPatrick Caulfield sctp_send_shutdown(prim.ssp_assoc_id); 5196ed7257bSPatrick Caulfield return; 5206ed7257bSPatrick Caulfield } 5216ed7257bSPatrick Caulfield 522748285ccSDavid Teigland new_con = nodeid2con(nodeid, GFP_NOFS); 5236ed7257bSPatrick Caulfield if (!new_con) 5246ed7257bSPatrick Caulfield return; 5256ed7257bSPatrick Caulfield 5266ed7257bSPatrick Caulfield /* Peel off a new sock */ 5276ed7257bSPatrick Caulfield parg.associd = sn->sn_assoc_change.sac_assoc_id; 528617e82e1SDavid Teigland ret = kernel_getsockopt(con->sock, IPPROTO_SCTP, 529617e82e1SDavid Teigland SCTP_SOCKOPT_PEELOFF, 5306ed7257bSPatrick Caulfield (void *)&parg, &parglen); 5316861f350SDavid Teigland if (ret < 0) { 532617e82e1SDavid Teigland log_print("Can't peel off a socket for " 5336861f350SDavid Teigland "connection %d to node %d: err=%d", 5346ed7257bSPatrick Caulfield parg.associd, nodeid, ret); 5356861f350SDavid Teigland return; 5366ed7257bSPatrick Caulfield } 5376861f350SDavid Teigland new_con->sock = sockfd_lookup(parg.sd, &err); 5386861f350SDavid Teigland if (!new_con->sock) { 5396861f350SDavid Teigland log_print("sockfd_lookup error %d", err); 5406861f350SDavid Teigland return; 5416861f350SDavid Teigland } 5426ed7257bSPatrick Caulfield add_sock(new_con->sock, new_con); 5436861f350SDavid Teigland sockfd_put(new_con->sock); 5446ed7257bSPatrick Caulfield 5456861f350SDavid Teigland log_print("connecting to %d sctp association %d", 5466861f350SDavid Teigland nodeid, (int)sn->sn_assoc_change.sac_assoc_id); 5476ed7257bSPatrick Caulfield 5486ed7257bSPatrick Caulfield /* Send any pending writes */ 5496ed7257bSPatrick Caulfield clear_bit(CF_CONNECT_PENDING, &new_con->flags); 5506ed7257bSPatrick Caulfield clear_bit(CF_INIT_PENDING, &con->flags); 5516ed7257bSPatrick Caulfield if (!test_and_set_bit(CF_WRITE_PENDING, &new_con->flags)) { 5526ed7257bSPatrick Caulfield queue_work(send_workqueue, &new_con->swork); 5536ed7257bSPatrick Caulfield } 5546ed7257bSPatrick Caulfield if (!test_and_set_bit(CF_READ_PENDING, &new_con->flags)) 5556ed7257bSPatrick Caulfield queue_work(recv_workqueue, &new_con->rwork); 5566ed7257bSPatrick Caulfield } 5576ed7257bSPatrick Caulfield break; 5586ed7257bSPatrick Caulfield 5596ed7257bSPatrick Caulfield case SCTP_COMM_LOST: 5606ed7257bSPatrick Caulfield case SCTP_SHUTDOWN_COMP: 5616ed7257bSPatrick Caulfield { 5626ed7257bSPatrick Caulfield con = assoc2con(sn->sn_assoc_change.sac_assoc_id); 5636ed7257bSPatrick Caulfield if (con) { 5646ed7257bSPatrick Caulfield con->sctp_assoc = 0; 5656ed7257bSPatrick Caulfield } 5666ed7257bSPatrick Caulfield } 5676ed7257bSPatrick Caulfield break; 5686ed7257bSPatrick Caulfield 5696ed7257bSPatrick Caulfield /* We don't know which INIT failed, so clear the PENDING flags 5706ed7257bSPatrick Caulfield * on them all. if assoc_id is zero then it will then try 5716ed7257bSPatrick Caulfield * again */ 5726ed7257bSPatrick Caulfield 5736ed7257bSPatrick Caulfield case SCTP_CANT_STR_ASSOC: 5746ed7257bSPatrick Caulfield { 5756ed7257bSPatrick Caulfield log_print("Can't start SCTP association - retrying"); 5766ed7257bSPatrick Caulfield sctp_init_failed(); 5776ed7257bSPatrick Caulfield } 5786ed7257bSPatrick Caulfield break; 5796ed7257bSPatrick Caulfield 5806ed7257bSPatrick Caulfield default: 5816ed7257bSPatrick Caulfield log_print("unexpected SCTP assoc change id=%d state=%d", 5826ed7257bSPatrick Caulfield (int)sn->sn_assoc_change.sac_assoc_id, 5836ed7257bSPatrick Caulfield sn->sn_assoc_change.sac_state); 5846ed7257bSPatrick Caulfield } 5856ed7257bSPatrick Caulfield } 5866ed7257bSPatrick Caulfield } 5876ed7257bSPatrick Caulfield 5886ed7257bSPatrick Caulfield /* Data received from remote end */ 5896ed7257bSPatrick Caulfield static int receive_from_sock(struct connection *con) 5906ed7257bSPatrick Caulfield { 5916ed7257bSPatrick Caulfield int ret = 0; 5926ed7257bSPatrick Caulfield struct msghdr msg = {}; 5936ed7257bSPatrick Caulfield struct kvec iov[2]; 5946ed7257bSPatrick Caulfield unsigned len; 5956ed7257bSPatrick Caulfield int r; 5966ed7257bSPatrick Caulfield int call_again_soon = 0; 5976ed7257bSPatrick Caulfield int nvec; 5986ed7257bSPatrick Caulfield char incmsg[CMSG_SPACE(sizeof(struct sctp_sndrcvinfo))]; 5996ed7257bSPatrick Caulfield 6006ed7257bSPatrick Caulfield mutex_lock(&con->sock_mutex); 6016ed7257bSPatrick Caulfield 6026ed7257bSPatrick Caulfield if (con->sock == NULL) { 6036ed7257bSPatrick Caulfield ret = -EAGAIN; 6046ed7257bSPatrick Caulfield goto out_close; 6056ed7257bSPatrick Caulfield } 6066ed7257bSPatrick Caulfield 6076ed7257bSPatrick Caulfield if (con->rx_page == NULL) { 6086ed7257bSPatrick Caulfield /* 6096ed7257bSPatrick Caulfield * This doesn't need to be atomic, but I think it should 6106ed7257bSPatrick Caulfield * improve performance if it is. 6116ed7257bSPatrick Caulfield */ 6126ed7257bSPatrick Caulfield con->rx_page = alloc_page(GFP_ATOMIC); 6136ed7257bSPatrick Caulfield if (con->rx_page == NULL) 6146ed7257bSPatrick Caulfield goto out_resched; 6156ed7257bSPatrick Caulfield cbuf_init(&con->cb, PAGE_CACHE_SIZE); 6166ed7257bSPatrick Caulfield } 6176ed7257bSPatrick Caulfield 6186ed7257bSPatrick Caulfield /* Only SCTP needs these really */ 6196ed7257bSPatrick Caulfield memset(&incmsg, 0, sizeof(incmsg)); 6206ed7257bSPatrick Caulfield msg.msg_control = incmsg; 6216ed7257bSPatrick Caulfield msg.msg_controllen = sizeof(incmsg); 6226ed7257bSPatrick Caulfield 6236ed7257bSPatrick Caulfield /* 6246ed7257bSPatrick Caulfield * iov[0] is the bit of the circular buffer between the current end 6256ed7257bSPatrick Caulfield * point (cb.base + cb.len) and the end of the buffer. 6266ed7257bSPatrick Caulfield */ 6276ed7257bSPatrick Caulfield iov[0].iov_len = con->cb.base - cbuf_data(&con->cb); 6286ed7257bSPatrick Caulfield iov[0].iov_base = page_address(con->rx_page) + cbuf_data(&con->cb); 6296ed7257bSPatrick Caulfield iov[1].iov_len = 0; 6306ed7257bSPatrick Caulfield nvec = 1; 6316ed7257bSPatrick Caulfield 6326ed7257bSPatrick Caulfield /* 6336ed7257bSPatrick Caulfield * iov[1] is the bit of the circular buffer between the start of the 6346ed7257bSPatrick Caulfield * buffer and the start of the currently used section (cb.base) 6356ed7257bSPatrick Caulfield */ 6366ed7257bSPatrick Caulfield if (cbuf_data(&con->cb) >= con->cb.base) { 6376ed7257bSPatrick Caulfield iov[0].iov_len = PAGE_CACHE_SIZE - cbuf_data(&con->cb); 6386ed7257bSPatrick Caulfield iov[1].iov_len = con->cb.base; 6396ed7257bSPatrick Caulfield iov[1].iov_base = page_address(con->rx_page); 6406ed7257bSPatrick Caulfield nvec = 2; 6416ed7257bSPatrick Caulfield } 6426ed7257bSPatrick Caulfield len = iov[0].iov_len + iov[1].iov_len; 6436ed7257bSPatrick Caulfield 6446ed7257bSPatrick Caulfield r = ret = kernel_recvmsg(con->sock, &msg, iov, nvec, len, 6456ed7257bSPatrick Caulfield MSG_DONTWAIT | MSG_NOSIGNAL); 6466ed7257bSPatrick Caulfield if (ret <= 0) 6476ed7257bSPatrick Caulfield goto out_close; 6486ed7257bSPatrick Caulfield 6496ed7257bSPatrick Caulfield /* Process SCTP notifications */ 6506ed7257bSPatrick Caulfield if (msg.msg_flags & MSG_NOTIFICATION) { 6516ed7257bSPatrick Caulfield msg.msg_control = incmsg; 6526ed7257bSPatrick Caulfield msg.msg_controllen = sizeof(incmsg); 6536ed7257bSPatrick Caulfield 6546ed7257bSPatrick Caulfield process_sctp_notification(con, &msg, 6556ed7257bSPatrick Caulfield page_address(con->rx_page) + con->cb.base); 6566ed7257bSPatrick Caulfield mutex_unlock(&con->sock_mutex); 6576ed7257bSPatrick Caulfield return 0; 6586ed7257bSPatrick Caulfield } 6596ed7257bSPatrick Caulfield BUG_ON(con->nodeid == 0); 6606ed7257bSPatrick Caulfield 6616ed7257bSPatrick Caulfield if (ret == len) 6626ed7257bSPatrick Caulfield call_again_soon = 1; 6636ed7257bSPatrick Caulfield cbuf_add(&con->cb, ret); 6646ed7257bSPatrick Caulfield ret = dlm_process_incoming_buffer(con->nodeid, 6656ed7257bSPatrick Caulfield page_address(con->rx_page), 6666ed7257bSPatrick Caulfield con->cb.base, con->cb.len, 6676ed7257bSPatrick Caulfield PAGE_CACHE_SIZE); 6686ed7257bSPatrick Caulfield if (ret == -EBADMSG) { 669617e82e1SDavid Teigland log_print("lowcomms: addr=%p, base=%u, len=%u, " 670617e82e1SDavid Teigland "iov_len=%u, iov_base[0]=%p, read=%d", 6716ed7257bSPatrick Caulfield page_address(con->rx_page), con->cb.base, con->cb.len, 6726ed7257bSPatrick Caulfield len, iov[0].iov_base, r); 6736ed7257bSPatrick Caulfield } 6746ed7257bSPatrick Caulfield if (ret < 0) 6756ed7257bSPatrick Caulfield goto out_close; 6766ed7257bSPatrick Caulfield cbuf_eat(&con->cb, ret); 6776ed7257bSPatrick Caulfield 6786ed7257bSPatrick Caulfield if (cbuf_empty(&con->cb) && !call_again_soon) { 6796ed7257bSPatrick Caulfield __free_page(con->rx_page); 6806ed7257bSPatrick Caulfield con->rx_page = NULL; 6816ed7257bSPatrick Caulfield } 6826ed7257bSPatrick Caulfield 6836ed7257bSPatrick Caulfield if (call_again_soon) 6846ed7257bSPatrick Caulfield goto out_resched; 6856ed7257bSPatrick Caulfield mutex_unlock(&con->sock_mutex); 6866ed7257bSPatrick Caulfield return 0; 6876ed7257bSPatrick Caulfield 6886ed7257bSPatrick Caulfield out_resched: 6896ed7257bSPatrick Caulfield if (!test_and_set_bit(CF_READ_PENDING, &con->flags)) 6906ed7257bSPatrick Caulfield queue_work(recv_workqueue, &con->rwork); 6916ed7257bSPatrick Caulfield mutex_unlock(&con->sock_mutex); 6926ed7257bSPatrick Caulfield return -EAGAIN; 6936ed7257bSPatrick Caulfield 6946ed7257bSPatrick Caulfield out_close: 6956ed7257bSPatrick Caulfield mutex_unlock(&con->sock_mutex); 6969e5f2825SPatrick Caulfield if (ret != -EAGAIN) { 6976ed7257bSPatrick Caulfield close_connection(con, false); 6986ed7257bSPatrick Caulfield /* Reconnect when there is something to send */ 6996ed7257bSPatrick Caulfield } 7006ed7257bSPatrick Caulfield /* Don't return success if we really got EOF */ 7016ed7257bSPatrick Caulfield if (ret == 0) 7026ed7257bSPatrick Caulfield ret = -EAGAIN; 7036ed7257bSPatrick Caulfield 7046ed7257bSPatrick Caulfield return ret; 7056ed7257bSPatrick Caulfield } 7066ed7257bSPatrick Caulfield 7076ed7257bSPatrick Caulfield /* Listening socket is busy, accept a connection */ 7086ed7257bSPatrick Caulfield static int tcp_accept_from_sock(struct connection *con) 7096ed7257bSPatrick Caulfield { 7106ed7257bSPatrick Caulfield int result; 7116ed7257bSPatrick Caulfield struct sockaddr_storage peeraddr; 7126ed7257bSPatrick Caulfield struct socket *newsock; 7136ed7257bSPatrick Caulfield int len; 7146ed7257bSPatrick Caulfield int nodeid; 7156ed7257bSPatrick Caulfield struct connection *newcon; 7166ed7257bSPatrick Caulfield struct connection *addcon; 7176ed7257bSPatrick Caulfield 7186ed7257bSPatrick Caulfield memset(&peeraddr, 0, sizeof(peeraddr)); 7196ed7257bSPatrick Caulfield result = sock_create_kern(dlm_local_addr[0]->ss_family, SOCK_STREAM, 7206ed7257bSPatrick Caulfield IPPROTO_TCP, &newsock); 7216ed7257bSPatrick Caulfield if (result < 0) 7226ed7257bSPatrick Caulfield return -ENOMEM; 7236ed7257bSPatrick Caulfield 7246ed7257bSPatrick Caulfield mutex_lock_nested(&con->sock_mutex, 0); 7256ed7257bSPatrick Caulfield 7266ed7257bSPatrick Caulfield result = -ENOTCONN; 7276ed7257bSPatrick Caulfield if (con->sock == NULL) 7286ed7257bSPatrick Caulfield goto accept_err; 7296ed7257bSPatrick Caulfield 7306ed7257bSPatrick Caulfield newsock->type = con->sock->type; 7316ed7257bSPatrick Caulfield newsock->ops = con->sock->ops; 7326ed7257bSPatrick Caulfield 7336ed7257bSPatrick Caulfield result = con->sock->ops->accept(con->sock, newsock, O_NONBLOCK); 7346ed7257bSPatrick Caulfield if (result < 0) 7356ed7257bSPatrick Caulfield goto accept_err; 7366ed7257bSPatrick Caulfield 7376ed7257bSPatrick Caulfield /* Get the connected socket's peer */ 7386ed7257bSPatrick Caulfield memset(&peeraddr, 0, sizeof(peeraddr)); 7396ed7257bSPatrick Caulfield if (newsock->ops->getname(newsock, (struct sockaddr *)&peeraddr, 7406ed7257bSPatrick Caulfield &len, 2)) { 7416ed7257bSPatrick Caulfield result = -ECONNABORTED; 7426ed7257bSPatrick Caulfield goto accept_err; 7436ed7257bSPatrick Caulfield } 7446ed7257bSPatrick Caulfield 7456ed7257bSPatrick Caulfield /* Get the new node's NODEID */ 7466ed7257bSPatrick Caulfield make_sockaddr(&peeraddr, 0, &len); 7476ed7257bSPatrick Caulfield if (dlm_addr_to_nodeid(&peeraddr, &nodeid)) { 748617e82e1SDavid Teigland log_print("connect from non cluster node"); 7496ed7257bSPatrick Caulfield sock_release(newsock); 7506ed7257bSPatrick Caulfield mutex_unlock(&con->sock_mutex); 7516ed7257bSPatrick Caulfield return -1; 7526ed7257bSPatrick Caulfield } 7536ed7257bSPatrick Caulfield 7546ed7257bSPatrick Caulfield log_print("got connection from %d", nodeid); 7556ed7257bSPatrick Caulfield 7566ed7257bSPatrick Caulfield /* Check to see if we already have a connection to this node. This 7576ed7257bSPatrick Caulfield * could happen if the two nodes initiate a connection at roughly 7586ed7257bSPatrick Caulfield * the same time and the connections cross on the wire. 7596ed7257bSPatrick Caulfield * In this case we store the incoming one in "othercon" 7606ed7257bSPatrick Caulfield */ 761748285ccSDavid Teigland newcon = nodeid2con(nodeid, GFP_NOFS); 7626ed7257bSPatrick Caulfield if (!newcon) { 7636ed7257bSPatrick Caulfield result = -ENOMEM; 7646ed7257bSPatrick Caulfield goto accept_err; 7656ed7257bSPatrick Caulfield } 7666ed7257bSPatrick Caulfield mutex_lock_nested(&newcon->sock_mutex, 1); 7676ed7257bSPatrick Caulfield if (newcon->sock) { 7686ed7257bSPatrick Caulfield struct connection *othercon = newcon->othercon; 7696ed7257bSPatrick Caulfield 7706ed7257bSPatrick Caulfield if (!othercon) { 771748285ccSDavid Teigland othercon = kmem_cache_zalloc(con_cache, GFP_NOFS); 7726ed7257bSPatrick Caulfield if (!othercon) { 773617e82e1SDavid Teigland log_print("failed to allocate incoming socket"); 7746ed7257bSPatrick Caulfield mutex_unlock(&newcon->sock_mutex); 7756ed7257bSPatrick Caulfield result = -ENOMEM; 7766ed7257bSPatrick Caulfield goto accept_err; 7776ed7257bSPatrick Caulfield } 7786ed7257bSPatrick Caulfield othercon->nodeid = nodeid; 7796ed7257bSPatrick Caulfield othercon->rx_action = receive_from_sock; 7806ed7257bSPatrick Caulfield mutex_init(&othercon->sock_mutex); 7816ed7257bSPatrick Caulfield INIT_WORK(&othercon->swork, process_send_sockets); 7826ed7257bSPatrick Caulfield INIT_WORK(&othercon->rwork, process_recv_sockets); 7836ed7257bSPatrick Caulfield set_bit(CF_IS_OTHERCON, &othercon->flags); 78461d96be0SPatrick Caulfield } 78561d96be0SPatrick Caulfield if (!othercon->sock) { 7866ed7257bSPatrick Caulfield newcon->othercon = othercon; 7876ed7257bSPatrick Caulfield othercon->sock = newsock; 7886ed7257bSPatrick Caulfield newsock->sk->sk_user_data = othercon; 7896ed7257bSPatrick Caulfield add_sock(newsock, othercon); 7906ed7257bSPatrick Caulfield addcon = othercon; 7916ed7257bSPatrick Caulfield } 7926ed7257bSPatrick Caulfield else { 79397d84836SPatrick Caulfield printk("Extra connection from node %d attempted\n", nodeid); 79497d84836SPatrick Caulfield result = -EAGAIN; 795f4fadb23Sakpm@linux-foundation.org mutex_unlock(&newcon->sock_mutex); 79697d84836SPatrick Caulfield goto accept_err; 79797d84836SPatrick Caulfield } 79897d84836SPatrick Caulfield } 79997d84836SPatrick Caulfield else { 8006ed7257bSPatrick Caulfield newsock->sk->sk_user_data = newcon; 8016ed7257bSPatrick Caulfield newcon->rx_action = receive_from_sock; 8026ed7257bSPatrick Caulfield add_sock(newsock, newcon); 8036ed7257bSPatrick Caulfield addcon = newcon; 8046ed7257bSPatrick Caulfield } 8056ed7257bSPatrick Caulfield 8066ed7257bSPatrick Caulfield mutex_unlock(&newcon->sock_mutex); 8076ed7257bSPatrick Caulfield 8086ed7257bSPatrick Caulfield /* 8096ed7257bSPatrick Caulfield * Add it to the active queue in case we got data 8106ed7257bSPatrick Caulfield * beween processing the accept adding the socket 8116ed7257bSPatrick Caulfield * to the read_sockets list 8126ed7257bSPatrick Caulfield */ 8136ed7257bSPatrick Caulfield if (!test_and_set_bit(CF_READ_PENDING, &addcon->flags)) 8146ed7257bSPatrick Caulfield queue_work(recv_workqueue, &addcon->rwork); 8156ed7257bSPatrick Caulfield mutex_unlock(&con->sock_mutex); 8166ed7257bSPatrick Caulfield 8176ed7257bSPatrick Caulfield return 0; 8186ed7257bSPatrick Caulfield 8196ed7257bSPatrick Caulfield accept_err: 8206ed7257bSPatrick Caulfield mutex_unlock(&con->sock_mutex); 8216ed7257bSPatrick Caulfield sock_release(newsock); 8226ed7257bSPatrick Caulfield 8236ed7257bSPatrick Caulfield if (result != -EAGAIN) 824617e82e1SDavid Teigland log_print("error accepting connection from node: %d", result); 8256ed7257bSPatrick Caulfield return result; 8266ed7257bSPatrick Caulfield } 8276ed7257bSPatrick Caulfield 8286ed7257bSPatrick Caulfield static void free_entry(struct writequeue_entry *e) 8296ed7257bSPatrick Caulfield { 8306ed7257bSPatrick Caulfield __free_page(e->page); 8316ed7257bSPatrick Caulfield kfree(e); 8326ed7257bSPatrick Caulfield } 8336ed7257bSPatrick Caulfield 8346ed7257bSPatrick Caulfield /* Initiate an SCTP association. 8356ed7257bSPatrick Caulfield This is a special case of send_to_sock() in that we don't yet have a 8366ed7257bSPatrick Caulfield peeled-off socket for this association, so we use the listening socket 8376ed7257bSPatrick Caulfield and add the primary IP address of the remote node. 8386ed7257bSPatrick Caulfield */ 8396ed7257bSPatrick Caulfield static void sctp_init_assoc(struct connection *con) 8406ed7257bSPatrick Caulfield { 8416ed7257bSPatrick Caulfield struct sockaddr_storage rem_addr; 8426ed7257bSPatrick Caulfield char outcmsg[CMSG_SPACE(sizeof(struct sctp_sndrcvinfo))]; 8436ed7257bSPatrick Caulfield struct msghdr outmessage; 8446ed7257bSPatrick Caulfield struct cmsghdr *cmsg; 8456ed7257bSPatrick Caulfield struct sctp_sndrcvinfo *sinfo; 8466ed7257bSPatrick Caulfield struct connection *base_con; 8476ed7257bSPatrick Caulfield struct writequeue_entry *e; 8486ed7257bSPatrick Caulfield int len, offset; 8496ed7257bSPatrick Caulfield int ret; 8506ed7257bSPatrick Caulfield int addrlen; 8516ed7257bSPatrick Caulfield struct kvec iov[1]; 8526ed7257bSPatrick Caulfield 8536ed7257bSPatrick Caulfield if (test_and_set_bit(CF_INIT_PENDING, &con->flags)) 8546ed7257bSPatrick Caulfield return; 8556ed7257bSPatrick Caulfield 8566ed7257bSPatrick Caulfield if (con->retries++ > MAX_CONNECT_RETRIES) 8576ed7257bSPatrick Caulfield return; 8586ed7257bSPatrick Caulfield 8596ed7257bSPatrick Caulfield if (nodeid_to_addr(con->nodeid, (struct sockaddr *)&rem_addr)) { 8606ed7257bSPatrick Caulfield log_print("no address for nodeid %d", con->nodeid); 8616ed7257bSPatrick Caulfield return; 8626ed7257bSPatrick Caulfield } 8636ed7257bSPatrick Caulfield base_con = nodeid2con(0, 0); 8646ed7257bSPatrick Caulfield BUG_ON(base_con == NULL); 8656ed7257bSPatrick Caulfield 8666ed7257bSPatrick Caulfield make_sockaddr(&rem_addr, dlm_config.ci_tcp_port, &addrlen); 8676ed7257bSPatrick Caulfield 8686ed7257bSPatrick Caulfield outmessage.msg_name = &rem_addr; 8696ed7257bSPatrick Caulfield outmessage.msg_namelen = addrlen; 8706ed7257bSPatrick Caulfield outmessage.msg_control = outcmsg; 8716ed7257bSPatrick Caulfield outmessage.msg_controllen = sizeof(outcmsg); 8726ed7257bSPatrick Caulfield outmessage.msg_flags = MSG_EOR; 8736ed7257bSPatrick Caulfield 8746ed7257bSPatrick Caulfield spin_lock(&con->writequeue_lock); 8756ed7257bSPatrick Caulfield 87604bedd79SDavid Teigland if (list_empty(&con->writequeue)) { 87704bedd79SDavid Teigland spin_unlock(&con->writequeue_lock); 87804bedd79SDavid Teigland log_print("writequeue empty for nodeid %d", con->nodeid); 87904bedd79SDavid Teigland return; 88004bedd79SDavid Teigland } 8816ed7257bSPatrick Caulfield 88204bedd79SDavid Teigland e = list_first_entry(&con->writequeue, struct writequeue_entry, list); 8836ed7257bSPatrick Caulfield len = e->len; 8846ed7257bSPatrick Caulfield offset = e->offset; 8856ed7257bSPatrick Caulfield spin_unlock(&con->writequeue_lock); 8866ed7257bSPatrick Caulfield 8876ed7257bSPatrick Caulfield /* Send the first block off the write queue */ 8886ed7257bSPatrick Caulfield iov[0].iov_base = page_address(e->page)+offset; 8896ed7257bSPatrick Caulfield iov[0].iov_len = len; 8906ed7257bSPatrick Caulfield 8916ed7257bSPatrick Caulfield cmsg = CMSG_FIRSTHDR(&outmessage); 8926ed7257bSPatrick Caulfield cmsg->cmsg_level = IPPROTO_SCTP; 8936ed7257bSPatrick Caulfield cmsg->cmsg_type = SCTP_SNDRCV; 8946ed7257bSPatrick Caulfield cmsg->cmsg_len = CMSG_LEN(sizeof(struct sctp_sndrcvinfo)); 8956ed7257bSPatrick Caulfield sinfo = CMSG_DATA(cmsg); 8966ed7257bSPatrick Caulfield memset(sinfo, 0x00, sizeof(struct sctp_sndrcvinfo)); 8976ed7257bSPatrick Caulfield sinfo->sinfo_ppid = cpu_to_le32(dlm_our_nodeid()); 8986ed7257bSPatrick Caulfield outmessage.msg_controllen = cmsg->cmsg_len; 8996ed7257bSPatrick Caulfield 9006ed7257bSPatrick Caulfield ret = kernel_sendmsg(base_con->sock, &outmessage, iov, 1, len); 9016ed7257bSPatrick Caulfield if (ret < 0) { 902617e82e1SDavid Teigland log_print("Send first packet to node %d failed: %d", 903617e82e1SDavid Teigland con->nodeid, ret); 9046ed7257bSPatrick Caulfield 9056ed7257bSPatrick Caulfield /* Try again later */ 9066ed7257bSPatrick Caulfield clear_bit(CF_CONNECT_PENDING, &con->flags); 9076ed7257bSPatrick Caulfield clear_bit(CF_INIT_PENDING, &con->flags); 9086ed7257bSPatrick Caulfield } 9096ed7257bSPatrick Caulfield else { 9106ed7257bSPatrick Caulfield spin_lock(&con->writequeue_lock); 9116ed7257bSPatrick Caulfield e->offset += ret; 9126ed7257bSPatrick Caulfield e->len -= ret; 9136ed7257bSPatrick Caulfield 9146ed7257bSPatrick Caulfield if (e->len == 0 && e->users == 0) { 9156ed7257bSPatrick Caulfield list_del(&e->list); 9166ed7257bSPatrick Caulfield free_entry(e); 9176ed7257bSPatrick Caulfield } 9186ed7257bSPatrick Caulfield spin_unlock(&con->writequeue_lock); 9196ed7257bSPatrick Caulfield } 9206ed7257bSPatrick Caulfield } 9216ed7257bSPatrick Caulfield 9226ed7257bSPatrick Caulfield /* Connect a new socket to its peer */ 9236ed7257bSPatrick Caulfield static void tcp_connect_to_sock(struct connection *con) 9246ed7257bSPatrick Caulfield { 9256ed7257bSPatrick Caulfield int result = -EHOSTUNREACH; 9266bd8fedaSLon Hohberger struct sockaddr_storage saddr, src_addr; 9276ed7257bSPatrick Caulfield int addr_len; 928a89d63a1SCasey Dahlin struct socket *sock = NULL; 929cb2d45daSDavid Teigland int one = 1; 9306ed7257bSPatrick Caulfield 9316ed7257bSPatrick Caulfield if (con->nodeid == 0) { 9326ed7257bSPatrick Caulfield log_print("attempt to connect sock 0 foiled"); 9336ed7257bSPatrick Caulfield return; 9346ed7257bSPatrick Caulfield } 9356ed7257bSPatrick Caulfield 9366ed7257bSPatrick Caulfield mutex_lock(&con->sock_mutex); 9376ed7257bSPatrick Caulfield if (con->retries++ > MAX_CONNECT_RETRIES) 9386ed7257bSPatrick Caulfield goto out; 9396ed7257bSPatrick Caulfield 9406ed7257bSPatrick Caulfield /* Some odd races can cause double-connects, ignore them */ 9416ed7257bSPatrick Caulfield if (con->sock) { 9426ed7257bSPatrick Caulfield result = 0; 9436ed7257bSPatrick Caulfield goto out; 9446ed7257bSPatrick Caulfield } 9456ed7257bSPatrick Caulfield 9466ed7257bSPatrick Caulfield /* Create a socket to communicate with */ 9476ed7257bSPatrick Caulfield result = sock_create_kern(dlm_local_addr[0]->ss_family, SOCK_STREAM, 9486ed7257bSPatrick Caulfield IPPROTO_TCP, &sock); 9496ed7257bSPatrick Caulfield if (result < 0) 9506ed7257bSPatrick Caulfield goto out_err; 9516ed7257bSPatrick Caulfield 9526ed7257bSPatrick Caulfield memset(&saddr, 0, sizeof(saddr)); 953b5711b8eSCasey Dahlin if (dlm_nodeid_to_addr(con->nodeid, &saddr)) 9546ed7257bSPatrick Caulfield goto out_err; 9556ed7257bSPatrick Caulfield 9566ed7257bSPatrick Caulfield sock->sk->sk_user_data = con; 9576ed7257bSPatrick Caulfield con->rx_action = receive_from_sock; 9586ed7257bSPatrick Caulfield con->connect_action = tcp_connect_to_sock; 9596ed7257bSPatrick Caulfield add_sock(sock, con); 9606ed7257bSPatrick Caulfield 9616bd8fedaSLon Hohberger /* Bind to our cluster-known address connecting to avoid 9626bd8fedaSLon Hohberger routing problems */ 9636bd8fedaSLon Hohberger memcpy(&src_addr, dlm_local_addr[0], sizeof(src_addr)); 9646bd8fedaSLon Hohberger make_sockaddr(&src_addr, 0, &addr_len); 9656bd8fedaSLon Hohberger result = sock->ops->bind(sock, (struct sockaddr *) &src_addr, 9666bd8fedaSLon Hohberger addr_len); 9676bd8fedaSLon Hohberger if (result < 0) { 9686bd8fedaSLon Hohberger log_print("could not bind for connect: %d", result); 9696bd8fedaSLon Hohberger /* This *may* not indicate a critical error */ 9706bd8fedaSLon Hohberger } 9716bd8fedaSLon Hohberger 9726ed7257bSPatrick Caulfield make_sockaddr(&saddr, dlm_config.ci_tcp_port, &addr_len); 9736ed7257bSPatrick Caulfield 9746ed7257bSPatrick Caulfield log_print("connecting to %d", con->nodeid); 975cb2d45daSDavid Teigland 976cb2d45daSDavid Teigland /* Turn off Nagle's algorithm */ 977cb2d45daSDavid Teigland kernel_setsockopt(sock, SOL_TCP, TCP_NODELAY, (char *)&one, 978cb2d45daSDavid Teigland sizeof(one)); 979cb2d45daSDavid Teigland 9806ed7257bSPatrick Caulfield result = 9816ed7257bSPatrick Caulfield sock->ops->connect(sock, (struct sockaddr *)&saddr, addr_len, 9826ed7257bSPatrick Caulfield O_NONBLOCK); 9836ed7257bSPatrick Caulfield if (result == -EINPROGRESS) 9846ed7257bSPatrick Caulfield result = 0; 9856ed7257bSPatrick Caulfield if (result == 0) 9866ed7257bSPatrick Caulfield goto out; 9876ed7257bSPatrick Caulfield 9886ed7257bSPatrick Caulfield out_err: 9896ed7257bSPatrick Caulfield if (con->sock) { 9906ed7257bSPatrick Caulfield sock_release(con->sock); 9916ed7257bSPatrick Caulfield con->sock = NULL; 992a89d63a1SCasey Dahlin } else if (sock) { 993a89d63a1SCasey Dahlin sock_release(sock); 9946ed7257bSPatrick Caulfield } 9956ed7257bSPatrick Caulfield /* 9966ed7257bSPatrick Caulfield * Some errors are fatal and this list might need adjusting. For other 9976ed7257bSPatrick Caulfield * errors we try again until the max number of retries is reached. 9986ed7257bSPatrick Caulfield */ 9996ed7257bSPatrick Caulfield if (result != -EHOSTUNREACH && result != -ENETUNREACH && 10000035a4b1SMarcin Slusarz result != -ENETDOWN && result != -EINVAL 10016ed7257bSPatrick Caulfield && result != -EPROTONOSUPPORT) { 10026ed7257bSPatrick Caulfield lowcomms_connect_sock(con); 10036ed7257bSPatrick Caulfield result = 0; 10046ed7257bSPatrick Caulfield } 10056ed7257bSPatrick Caulfield out: 10066ed7257bSPatrick Caulfield mutex_unlock(&con->sock_mutex); 10076ed7257bSPatrick Caulfield return; 10086ed7257bSPatrick Caulfield } 10096ed7257bSPatrick Caulfield 10106ed7257bSPatrick Caulfield static struct socket *tcp_create_listen_sock(struct connection *con, 10116ed7257bSPatrick Caulfield struct sockaddr_storage *saddr) 10126ed7257bSPatrick Caulfield { 10136ed7257bSPatrick Caulfield struct socket *sock = NULL; 10146ed7257bSPatrick Caulfield int result = 0; 10156ed7257bSPatrick Caulfield int one = 1; 10166ed7257bSPatrick Caulfield int addr_len; 10176ed7257bSPatrick Caulfield 10186ed7257bSPatrick Caulfield if (dlm_local_addr[0]->ss_family == AF_INET) 10196ed7257bSPatrick Caulfield addr_len = sizeof(struct sockaddr_in); 10206ed7257bSPatrick Caulfield else 10216ed7257bSPatrick Caulfield addr_len = sizeof(struct sockaddr_in6); 10226ed7257bSPatrick Caulfield 10236ed7257bSPatrick Caulfield /* Create a socket to communicate with */ 1024617e82e1SDavid Teigland result = sock_create_kern(dlm_local_addr[0]->ss_family, SOCK_STREAM, 1025617e82e1SDavid Teigland IPPROTO_TCP, &sock); 10266ed7257bSPatrick Caulfield if (result < 0) { 1027617e82e1SDavid Teigland log_print("Can't create listening comms socket"); 10286ed7257bSPatrick Caulfield goto create_out; 10296ed7257bSPatrick Caulfield } 10306ed7257bSPatrick Caulfield 1031cb2d45daSDavid Teigland /* Turn off Nagle's algorithm */ 1032cb2d45daSDavid Teigland kernel_setsockopt(sock, SOL_TCP, TCP_NODELAY, (char *)&one, 1033cb2d45daSDavid Teigland sizeof(one)); 1034cb2d45daSDavid Teigland 10356ed7257bSPatrick Caulfield result = kernel_setsockopt(sock, SOL_SOCKET, SO_REUSEADDR, 10366ed7257bSPatrick Caulfield (char *)&one, sizeof(one)); 10376ed7257bSPatrick Caulfield 10386ed7257bSPatrick Caulfield if (result < 0) { 1039617e82e1SDavid Teigland log_print("Failed to set SO_REUSEADDR on socket: %d", result); 10406ed7257bSPatrick Caulfield } 10416ed7257bSPatrick Caulfield sock->sk->sk_user_data = con; 10426ed7257bSPatrick Caulfield con->rx_action = tcp_accept_from_sock; 10436ed7257bSPatrick Caulfield con->connect_action = tcp_connect_to_sock; 10446ed7257bSPatrick Caulfield con->sock = sock; 10456ed7257bSPatrick Caulfield 10466ed7257bSPatrick Caulfield /* Bind to our port */ 10476ed7257bSPatrick Caulfield make_sockaddr(saddr, dlm_config.ci_tcp_port, &addr_len); 10486ed7257bSPatrick Caulfield result = sock->ops->bind(sock, (struct sockaddr *) saddr, addr_len); 10496ed7257bSPatrick Caulfield if (result < 0) { 1050617e82e1SDavid Teigland log_print("Can't bind to port %d", dlm_config.ci_tcp_port); 10516ed7257bSPatrick Caulfield sock_release(sock); 10526ed7257bSPatrick Caulfield sock = NULL; 10536ed7257bSPatrick Caulfield con->sock = NULL; 10546ed7257bSPatrick Caulfield goto create_out; 10556ed7257bSPatrick Caulfield } 10566ed7257bSPatrick Caulfield result = kernel_setsockopt(sock, SOL_SOCKET, SO_KEEPALIVE, 10576ed7257bSPatrick Caulfield (char *)&one, sizeof(one)); 10586ed7257bSPatrick Caulfield if (result < 0) { 1059617e82e1SDavid Teigland log_print("Set keepalive failed: %d", result); 10606ed7257bSPatrick Caulfield } 10616ed7257bSPatrick Caulfield 10626ed7257bSPatrick Caulfield result = sock->ops->listen(sock, 5); 10636ed7257bSPatrick Caulfield if (result < 0) { 1064617e82e1SDavid Teigland log_print("Can't listen on port %d", dlm_config.ci_tcp_port); 10656ed7257bSPatrick Caulfield sock_release(sock); 10666ed7257bSPatrick Caulfield sock = NULL; 10676ed7257bSPatrick Caulfield goto create_out; 10686ed7257bSPatrick Caulfield } 10696ed7257bSPatrick Caulfield 10706ed7257bSPatrick Caulfield create_out: 10716ed7257bSPatrick Caulfield return sock; 10726ed7257bSPatrick Caulfield } 10736ed7257bSPatrick Caulfield 10746ed7257bSPatrick Caulfield /* Get local addresses */ 10756ed7257bSPatrick Caulfield static void init_local(void) 10766ed7257bSPatrick Caulfield { 10776ed7257bSPatrick Caulfield struct sockaddr_storage sas, *addr; 10786ed7257bSPatrick Caulfield int i; 10796ed7257bSPatrick Caulfield 108030d3a237SPatrick Caulfield dlm_local_count = 0; 10816ed7257bSPatrick Caulfield for (i = 0; i < DLM_MAX_ADDR_COUNT - 1; i++) { 10826ed7257bSPatrick Caulfield if (dlm_our_addr(&sas, i)) 10836ed7257bSPatrick Caulfield break; 10846ed7257bSPatrick Caulfield 1085573c24c4SDavid Teigland addr = kmalloc(sizeof(*addr), GFP_NOFS); 10866ed7257bSPatrick Caulfield if (!addr) 10876ed7257bSPatrick Caulfield break; 10886ed7257bSPatrick Caulfield memcpy(addr, &sas, sizeof(*addr)); 10896ed7257bSPatrick Caulfield dlm_local_addr[dlm_local_count++] = addr; 10906ed7257bSPatrick Caulfield } 10916ed7257bSPatrick Caulfield } 10926ed7257bSPatrick Caulfield 1093617e82e1SDavid Teigland /* Bind to an IP address. SCTP allows multiple address so it can do 1094617e82e1SDavid Teigland multi-homing */ 1095617e82e1SDavid Teigland static int add_sctp_bind_addr(struct connection *sctp_con, 1096617e82e1SDavid Teigland struct sockaddr_storage *addr, 1097617e82e1SDavid Teigland int addr_len, int num) 10986ed7257bSPatrick Caulfield { 10996ed7257bSPatrick Caulfield int result = 0; 11006ed7257bSPatrick Caulfield 11016ed7257bSPatrick Caulfield if (num == 1) 11026ed7257bSPatrick Caulfield result = kernel_bind(sctp_con->sock, 11036ed7257bSPatrick Caulfield (struct sockaddr *) addr, 11046ed7257bSPatrick Caulfield addr_len); 11056ed7257bSPatrick Caulfield else 11066ed7257bSPatrick Caulfield result = kernel_setsockopt(sctp_con->sock, SOL_SCTP, 11076ed7257bSPatrick Caulfield SCTP_SOCKOPT_BINDX_ADD, 11086ed7257bSPatrick Caulfield (char *)addr, addr_len); 11096ed7257bSPatrick Caulfield 11106ed7257bSPatrick Caulfield if (result < 0) 11116ed7257bSPatrick Caulfield log_print("Can't bind to port %d addr number %d", 11126ed7257bSPatrick Caulfield dlm_config.ci_tcp_port, num); 11136ed7257bSPatrick Caulfield 11146ed7257bSPatrick Caulfield return result; 11156ed7257bSPatrick Caulfield } 11166ed7257bSPatrick Caulfield 11176ed7257bSPatrick Caulfield /* Initialise SCTP socket and bind to all interfaces */ 11186ed7257bSPatrick Caulfield static int sctp_listen_for_all(void) 11196ed7257bSPatrick Caulfield { 11206ed7257bSPatrick Caulfield struct socket *sock = NULL; 11216ed7257bSPatrick Caulfield struct sockaddr_storage localaddr; 11226ed7257bSPatrick Caulfield struct sctp_event_subscribe subscribe; 11236ed7257bSPatrick Caulfield int result = -EINVAL, num = 1, i, addr_len; 1124573c24c4SDavid Teigland struct connection *con = nodeid2con(0, GFP_NOFS); 11256ed7257bSPatrick Caulfield int bufsize = NEEDED_RMEM; 11266ed7257bSPatrick Caulfield 11276ed7257bSPatrick Caulfield if (!con) 11286ed7257bSPatrick Caulfield return -ENOMEM; 11296ed7257bSPatrick Caulfield 11306ed7257bSPatrick Caulfield log_print("Using SCTP for communications"); 11316ed7257bSPatrick Caulfield 11326ed7257bSPatrick Caulfield result = sock_create_kern(dlm_local_addr[0]->ss_family, SOCK_SEQPACKET, 11336ed7257bSPatrick Caulfield IPPROTO_SCTP, &sock); 11346ed7257bSPatrick Caulfield if (result < 0) { 11356ed7257bSPatrick Caulfield log_print("Can't create comms socket, check SCTP is loaded"); 11366ed7257bSPatrick Caulfield goto out; 11376ed7257bSPatrick Caulfield } 11386ed7257bSPatrick Caulfield 11396ed7257bSPatrick Caulfield /* Listen for events */ 11406ed7257bSPatrick Caulfield memset(&subscribe, 0, sizeof(subscribe)); 11416ed7257bSPatrick Caulfield subscribe.sctp_data_io_event = 1; 11426ed7257bSPatrick Caulfield subscribe.sctp_association_event = 1; 11436ed7257bSPatrick Caulfield subscribe.sctp_send_failure_event = 1; 11446ed7257bSPatrick Caulfield subscribe.sctp_shutdown_event = 1; 11456ed7257bSPatrick Caulfield subscribe.sctp_partial_delivery_event = 1; 11466ed7257bSPatrick Caulfield 1147df61c952SDavid S. Miller result = kernel_setsockopt(sock, SOL_SOCKET, SO_RCVBUFFORCE, 11486ed7257bSPatrick Caulfield (char *)&bufsize, sizeof(bufsize)); 11496ed7257bSPatrick Caulfield if (result) 1150617e82e1SDavid Teigland log_print("Error increasing buffer space on socket %d", result); 11516ed7257bSPatrick Caulfield 11526ed7257bSPatrick Caulfield result = kernel_setsockopt(sock, SOL_SCTP, SCTP_EVENTS, 11536ed7257bSPatrick Caulfield (char *)&subscribe, sizeof(subscribe)); 11546ed7257bSPatrick Caulfield if (result < 0) { 11556ed7257bSPatrick Caulfield log_print("Failed to set SCTP_EVENTS on socket: result=%d", 11566ed7257bSPatrick Caulfield result); 11576ed7257bSPatrick Caulfield goto create_delsock; 11586ed7257bSPatrick Caulfield } 11596ed7257bSPatrick Caulfield 11606ed7257bSPatrick Caulfield /* Init con struct */ 11616ed7257bSPatrick Caulfield sock->sk->sk_user_data = con; 11626ed7257bSPatrick Caulfield con->sock = sock; 11636ed7257bSPatrick Caulfield con->sock->sk->sk_data_ready = lowcomms_data_ready; 11646ed7257bSPatrick Caulfield con->rx_action = receive_from_sock; 11656ed7257bSPatrick Caulfield con->connect_action = sctp_init_assoc; 11666ed7257bSPatrick Caulfield 11676ed7257bSPatrick Caulfield /* Bind to all interfaces. */ 11686ed7257bSPatrick Caulfield for (i = 0; i < dlm_local_count; i++) { 11696ed7257bSPatrick Caulfield memcpy(&localaddr, dlm_local_addr[i], sizeof(localaddr)); 11706ed7257bSPatrick Caulfield make_sockaddr(&localaddr, dlm_config.ci_tcp_port, &addr_len); 11716ed7257bSPatrick Caulfield 11726ed7257bSPatrick Caulfield result = add_sctp_bind_addr(con, &localaddr, addr_len, num); 11736ed7257bSPatrick Caulfield if (result) 11746ed7257bSPatrick Caulfield goto create_delsock; 11756ed7257bSPatrick Caulfield ++num; 11766ed7257bSPatrick Caulfield } 11776ed7257bSPatrick Caulfield 11786ed7257bSPatrick Caulfield result = sock->ops->listen(sock, 5); 11796ed7257bSPatrick Caulfield if (result < 0) { 11806ed7257bSPatrick Caulfield log_print("Can't set socket listening"); 11816ed7257bSPatrick Caulfield goto create_delsock; 11826ed7257bSPatrick Caulfield } 11836ed7257bSPatrick Caulfield 11846ed7257bSPatrick Caulfield return 0; 11856ed7257bSPatrick Caulfield 11866ed7257bSPatrick Caulfield create_delsock: 11876ed7257bSPatrick Caulfield sock_release(sock); 11886ed7257bSPatrick Caulfield con->sock = NULL; 11896ed7257bSPatrick Caulfield out: 11906ed7257bSPatrick Caulfield return result; 11916ed7257bSPatrick Caulfield } 11926ed7257bSPatrick Caulfield 11936ed7257bSPatrick Caulfield static int tcp_listen_for_all(void) 11946ed7257bSPatrick Caulfield { 11956ed7257bSPatrick Caulfield struct socket *sock = NULL; 1196573c24c4SDavid Teigland struct connection *con = nodeid2con(0, GFP_NOFS); 11976ed7257bSPatrick Caulfield int result = -EINVAL; 11986ed7257bSPatrick Caulfield 11996ed7257bSPatrick Caulfield if (!con) 12006ed7257bSPatrick Caulfield return -ENOMEM; 12016ed7257bSPatrick Caulfield 12026ed7257bSPatrick Caulfield /* We don't support multi-homed hosts */ 12036ed7257bSPatrick Caulfield if (dlm_local_addr[1] != NULL) { 1204617e82e1SDavid Teigland log_print("TCP protocol can't handle multi-homed hosts, " 1205617e82e1SDavid Teigland "try SCTP"); 12066ed7257bSPatrick Caulfield return -EINVAL; 12076ed7257bSPatrick Caulfield } 12086ed7257bSPatrick Caulfield 12096ed7257bSPatrick Caulfield log_print("Using TCP for communications"); 12106ed7257bSPatrick Caulfield 12116ed7257bSPatrick Caulfield sock = tcp_create_listen_sock(con, dlm_local_addr[0]); 12126ed7257bSPatrick Caulfield if (sock) { 12136ed7257bSPatrick Caulfield add_sock(sock, con); 12146ed7257bSPatrick Caulfield result = 0; 12156ed7257bSPatrick Caulfield } 12166ed7257bSPatrick Caulfield else { 12176ed7257bSPatrick Caulfield result = -EADDRINUSE; 12186ed7257bSPatrick Caulfield } 12196ed7257bSPatrick Caulfield 12206ed7257bSPatrick Caulfield return result; 12216ed7257bSPatrick Caulfield } 12226ed7257bSPatrick Caulfield 12236ed7257bSPatrick Caulfield 12246ed7257bSPatrick Caulfield 12256ed7257bSPatrick Caulfield static struct writequeue_entry *new_writequeue_entry(struct connection *con, 12266ed7257bSPatrick Caulfield gfp_t allocation) 12276ed7257bSPatrick Caulfield { 12286ed7257bSPatrick Caulfield struct writequeue_entry *entry; 12296ed7257bSPatrick Caulfield 12306ed7257bSPatrick Caulfield entry = kmalloc(sizeof(struct writequeue_entry), allocation); 12316ed7257bSPatrick Caulfield if (!entry) 12326ed7257bSPatrick Caulfield return NULL; 12336ed7257bSPatrick Caulfield 12346ed7257bSPatrick Caulfield entry->page = alloc_page(allocation); 12356ed7257bSPatrick Caulfield if (!entry->page) { 12366ed7257bSPatrick Caulfield kfree(entry); 12376ed7257bSPatrick Caulfield return NULL; 12386ed7257bSPatrick Caulfield } 12396ed7257bSPatrick Caulfield 12406ed7257bSPatrick Caulfield entry->offset = 0; 12416ed7257bSPatrick Caulfield entry->len = 0; 12426ed7257bSPatrick Caulfield entry->end = 0; 12436ed7257bSPatrick Caulfield entry->users = 0; 12446ed7257bSPatrick Caulfield entry->con = con; 12456ed7257bSPatrick Caulfield 12466ed7257bSPatrick Caulfield return entry; 12476ed7257bSPatrick Caulfield } 12486ed7257bSPatrick Caulfield 1249617e82e1SDavid Teigland void *dlm_lowcomms_get_buffer(int nodeid, int len, gfp_t allocation, char **ppc) 12506ed7257bSPatrick Caulfield { 12516ed7257bSPatrick Caulfield struct connection *con; 12526ed7257bSPatrick Caulfield struct writequeue_entry *e; 12536ed7257bSPatrick Caulfield int offset = 0; 12546ed7257bSPatrick Caulfield int users = 0; 12556ed7257bSPatrick Caulfield 12566ed7257bSPatrick Caulfield con = nodeid2con(nodeid, allocation); 12576ed7257bSPatrick Caulfield if (!con) 12586ed7257bSPatrick Caulfield return NULL; 12596ed7257bSPatrick Caulfield 12606ed7257bSPatrick Caulfield spin_lock(&con->writequeue_lock); 12616ed7257bSPatrick Caulfield e = list_entry(con->writequeue.prev, struct writequeue_entry, list); 12626ed7257bSPatrick Caulfield if ((&e->list == &con->writequeue) || 12636ed7257bSPatrick Caulfield (PAGE_CACHE_SIZE - e->end < len)) { 12646ed7257bSPatrick Caulfield e = NULL; 12656ed7257bSPatrick Caulfield } else { 12666ed7257bSPatrick Caulfield offset = e->end; 12676ed7257bSPatrick Caulfield e->end += len; 12686ed7257bSPatrick Caulfield users = e->users++; 12696ed7257bSPatrick Caulfield } 12706ed7257bSPatrick Caulfield spin_unlock(&con->writequeue_lock); 12716ed7257bSPatrick Caulfield 12726ed7257bSPatrick Caulfield if (e) { 12736ed7257bSPatrick Caulfield got_one: 12746ed7257bSPatrick Caulfield *ppc = page_address(e->page) + offset; 12756ed7257bSPatrick Caulfield return e; 12766ed7257bSPatrick Caulfield } 12776ed7257bSPatrick Caulfield 12786ed7257bSPatrick Caulfield e = new_writequeue_entry(con, allocation); 12796ed7257bSPatrick Caulfield if (e) { 12806ed7257bSPatrick Caulfield spin_lock(&con->writequeue_lock); 12816ed7257bSPatrick Caulfield offset = e->end; 12826ed7257bSPatrick Caulfield e->end += len; 12836ed7257bSPatrick Caulfield users = e->users++; 12846ed7257bSPatrick Caulfield list_add_tail(&e->list, &con->writequeue); 12856ed7257bSPatrick Caulfield spin_unlock(&con->writequeue_lock); 12866ed7257bSPatrick Caulfield goto got_one; 12876ed7257bSPatrick Caulfield } 12886ed7257bSPatrick Caulfield return NULL; 12896ed7257bSPatrick Caulfield } 12906ed7257bSPatrick Caulfield 12916ed7257bSPatrick Caulfield void dlm_lowcomms_commit_buffer(void *mh) 12926ed7257bSPatrick Caulfield { 12936ed7257bSPatrick Caulfield struct writequeue_entry *e = (struct writequeue_entry *)mh; 12946ed7257bSPatrick Caulfield struct connection *con = e->con; 12956ed7257bSPatrick Caulfield int users; 12966ed7257bSPatrick Caulfield 12976ed7257bSPatrick Caulfield spin_lock(&con->writequeue_lock); 12986ed7257bSPatrick Caulfield users = --e->users; 12996ed7257bSPatrick Caulfield if (users) 13006ed7257bSPatrick Caulfield goto out; 13016ed7257bSPatrick Caulfield e->len = e->end - e->offset; 13026ed7257bSPatrick Caulfield spin_unlock(&con->writequeue_lock); 13036ed7257bSPatrick Caulfield 13046ed7257bSPatrick Caulfield if (!test_and_set_bit(CF_WRITE_PENDING, &con->flags)) { 13056ed7257bSPatrick Caulfield queue_work(send_workqueue, &con->swork); 13066ed7257bSPatrick Caulfield } 13076ed7257bSPatrick Caulfield return; 13086ed7257bSPatrick Caulfield 13096ed7257bSPatrick Caulfield out: 13106ed7257bSPatrick Caulfield spin_unlock(&con->writequeue_lock); 13116ed7257bSPatrick Caulfield return; 13126ed7257bSPatrick Caulfield } 13136ed7257bSPatrick Caulfield 13146ed7257bSPatrick Caulfield /* Send a message */ 13156ed7257bSPatrick Caulfield static void send_to_sock(struct connection *con) 13166ed7257bSPatrick Caulfield { 13176ed7257bSPatrick Caulfield int ret = 0; 13186ed7257bSPatrick Caulfield const int msg_flags = MSG_DONTWAIT | MSG_NOSIGNAL; 13196ed7257bSPatrick Caulfield struct writequeue_entry *e; 13206ed7257bSPatrick Caulfield int len, offset; 13216ed7257bSPatrick Caulfield 13226ed7257bSPatrick Caulfield mutex_lock(&con->sock_mutex); 13236ed7257bSPatrick Caulfield if (con->sock == NULL) 13246ed7257bSPatrick Caulfield goto out_connect; 13256ed7257bSPatrick Caulfield 13266ed7257bSPatrick Caulfield spin_lock(&con->writequeue_lock); 13276ed7257bSPatrick Caulfield for (;;) { 13286ed7257bSPatrick Caulfield e = list_entry(con->writequeue.next, struct writequeue_entry, 13296ed7257bSPatrick Caulfield list); 13306ed7257bSPatrick Caulfield if ((struct list_head *) e == &con->writequeue) 13316ed7257bSPatrick Caulfield break; 13326ed7257bSPatrick Caulfield 13336ed7257bSPatrick Caulfield len = e->len; 13346ed7257bSPatrick Caulfield offset = e->offset; 13356ed7257bSPatrick Caulfield BUG_ON(len == 0 && e->users == 0); 13366ed7257bSPatrick Caulfield spin_unlock(&con->writequeue_lock); 13376ed7257bSPatrick Caulfield 13386ed7257bSPatrick Caulfield ret = 0; 13396ed7257bSPatrick Caulfield if (len) { 13401329e3f2SPaolo Bonzini ret = kernel_sendpage(con->sock, e->page, offset, len, 13416ed7257bSPatrick Caulfield msg_flags); 1342d66f8277SPatrick Caulfield if (ret == -EAGAIN || ret == 0) { 1343b36930ddSDavid Miller if (ret == -EAGAIN && 1344b36930ddSDavid Miller test_bit(SOCK_ASYNC_NOSPACE, &con->sock->flags) && 1345b36930ddSDavid Miller !test_and_set_bit(CF_APP_LIMITED, &con->flags)) { 1346b36930ddSDavid Miller /* Notify TCP that we're limited by the 1347b36930ddSDavid Miller * application window size. 1348b36930ddSDavid Miller */ 1349b36930ddSDavid Miller set_bit(SOCK_NOSPACE, &con->sock->flags); 1350b36930ddSDavid Miller con->sock->sk->sk_write_pending++; 1351b36930ddSDavid Miller } 1352d66f8277SPatrick Caulfield cond_resched(); 13536ed7257bSPatrick Caulfield goto out; 1354d66f8277SPatrick Caulfield } 13556ed7257bSPatrick Caulfield if (ret <= 0) 13566ed7257bSPatrick Caulfield goto send_error; 1357d66f8277SPatrick Caulfield } 13586ed7257bSPatrick Caulfield /* Don't starve people filling buffers */ 13596ed7257bSPatrick Caulfield cond_resched(); 13606ed7257bSPatrick Caulfield 13616ed7257bSPatrick Caulfield spin_lock(&con->writequeue_lock); 13626ed7257bSPatrick Caulfield e->offset += ret; 13636ed7257bSPatrick Caulfield e->len -= ret; 13646ed7257bSPatrick Caulfield 13656ed7257bSPatrick Caulfield if (e->len == 0 && e->users == 0) { 13666ed7257bSPatrick Caulfield list_del(&e->list); 13676ed7257bSPatrick Caulfield free_entry(e); 13686ed7257bSPatrick Caulfield continue; 13696ed7257bSPatrick Caulfield } 13706ed7257bSPatrick Caulfield } 13716ed7257bSPatrick Caulfield spin_unlock(&con->writequeue_lock); 13726ed7257bSPatrick Caulfield out: 13736ed7257bSPatrick Caulfield mutex_unlock(&con->sock_mutex); 13746ed7257bSPatrick Caulfield return; 13756ed7257bSPatrick Caulfield 13766ed7257bSPatrick Caulfield send_error: 13776ed7257bSPatrick Caulfield mutex_unlock(&con->sock_mutex); 13786ed7257bSPatrick Caulfield close_connection(con, false); 13796ed7257bSPatrick Caulfield lowcomms_connect_sock(con); 13806ed7257bSPatrick Caulfield return; 13816ed7257bSPatrick Caulfield 13826ed7257bSPatrick Caulfield out_connect: 13836ed7257bSPatrick Caulfield mutex_unlock(&con->sock_mutex); 13846ed7257bSPatrick Caulfield if (!test_bit(CF_INIT_PENDING, &con->flags)) 13856ed7257bSPatrick Caulfield lowcomms_connect_sock(con); 13866ed7257bSPatrick Caulfield return; 13876ed7257bSPatrick Caulfield } 13886ed7257bSPatrick Caulfield 13896ed7257bSPatrick Caulfield static void clean_one_writequeue(struct connection *con) 13906ed7257bSPatrick Caulfield { 13915e9ccc37SChristine Caulfield struct writequeue_entry *e, *safe; 13926ed7257bSPatrick Caulfield 13936ed7257bSPatrick Caulfield spin_lock(&con->writequeue_lock); 13945e9ccc37SChristine Caulfield list_for_each_entry_safe(e, safe, &con->writequeue, list) { 13956ed7257bSPatrick Caulfield list_del(&e->list); 13966ed7257bSPatrick Caulfield free_entry(e); 13976ed7257bSPatrick Caulfield } 13986ed7257bSPatrick Caulfield spin_unlock(&con->writequeue_lock); 13996ed7257bSPatrick Caulfield } 14006ed7257bSPatrick Caulfield 14016ed7257bSPatrick Caulfield /* Called from recovery when it knows that a node has 14026ed7257bSPatrick Caulfield left the cluster */ 14036ed7257bSPatrick Caulfield int dlm_lowcomms_close(int nodeid) 14046ed7257bSPatrick Caulfield { 14056ed7257bSPatrick Caulfield struct connection *con; 14066ed7257bSPatrick Caulfield 14076ed7257bSPatrick Caulfield log_print("closing connection to node %d", nodeid); 14086ed7257bSPatrick Caulfield con = nodeid2con(nodeid, 0); 14096ed7257bSPatrick Caulfield if (con) { 1410063c4c99SLars Marowsky-Bree clear_bit(CF_CONNECT_PENDING, &con->flags); 1411063c4c99SLars Marowsky-Bree clear_bit(CF_WRITE_PENDING, &con->flags); 1412063c4c99SLars Marowsky-Bree set_bit(CF_CLOSE, &con->flags); 1413063c4c99SLars Marowsky-Bree if (cancel_work_sync(&con->swork)) 1414063c4c99SLars Marowsky-Bree log_print("canceled swork for node %d", nodeid); 1415063c4c99SLars Marowsky-Bree if (cancel_work_sync(&con->rwork)) 1416063c4c99SLars Marowsky-Bree log_print("canceled rwork for node %d", nodeid); 14176ed7257bSPatrick Caulfield clean_one_writequeue(con); 14186ed7257bSPatrick Caulfield close_connection(con, true); 14196ed7257bSPatrick Caulfield } 14206ed7257bSPatrick Caulfield return 0; 14216ed7257bSPatrick Caulfield } 14226ed7257bSPatrick Caulfield 14236ed7257bSPatrick Caulfield /* Receive workqueue function */ 14246ed7257bSPatrick Caulfield static void process_recv_sockets(struct work_struct *work) 14256ed7257bSPatrick Caulfield { 14266ed7257bSPatrick Caulfield struct connection *con = container_of(work, struct connection, rwork); 14276ed7257bSPatrick Caulfield int err; 14286ed7257bSPatrick Caulfield 14296ed7257bSPatrick Caulfield clear_bit(CF_READ_PENDING, &con->flags); 14306ed7257bSPatrick Caulfield do { 14316ed7257bSPatrick Caulfield err = con->rx_action(con); 14326ed7257bSPatrick Caulfield } while (!err); 14336ed7257bSPatrick Caulfield } 14346ed7257bSPatrick Caulfield 14356ed7257bSPatrick Caulfield /* Send workqueue function */ 14366ed7257bSPatrick Caulfield static void process_send_sockets(struct work_struct *work) 14376ed7257bSPatrick Caulfield { 14386ed7257bSPatrick Caulfield struct connection *con = container_of(work, struct connection, swork); 14396ed7257bSPatrick Caulfield 14406ed7257bSPatrick Caulfield if (test_and_clear_bit(CF_CONNECT_PENDING, &con->flags)) { 14416ed7257bSPatrick Caulfield con->connect_action(con); 1442063c4c99SLars Marowsky-Bree set_bit(CF_WRITE_PENDING, &con->flags); 14436ed7257bSPatrick Caulfield } 1444063c4c99SLars Marowsky-Bree if (test_and_clear_bit(CF_WRITE_PENDING, &con->flags)) 14456ed7257bSPatrick Caulfield send_to_sock(con); 14466ed7257bSPatrick Caulfield } 14476ed7257bSPatrick Caulfield 14486ed7257bSPatrick Caulfield 14496ed7257bSPatrick Caulfield /* Discard all entries on the write queues */ 14506ed7257bSPatrick Caulfield static void clean_writequeues(void) 14516ed7257bSPatrick Caulfield { 14525e9ccc37SChristine Caulfield foreach_conn(clean_one_writequeue); 14536ed7257bSPatrick Caulfield } 14546ed7257bSPatrick Caulfield 14556ed7257bSPatrick Caulfield static void work_stop(void) 14566ed7257bSPatrick Caulfield { 14576ed7257bSPatrick Caulfield destroy_workqueue(recv_workqueue); 14586ed7257bSPatrick Caulfield destroy_workqueue(send_workqueue); 14596ed7257bSPatrick Caulfield } 14606ed7257bSPatrick Caulfield 14616ed7257bSPatrick Caulfield static int work_start(void) 14626ed7257bSPatrick Caulfield { 14636ed7257bSPatrick Caulfield int error; 1464dcce240eSSteven Whitehouse recv_workqueue = alloc_workqueue("dlm_recv", WQ_MEM_RECLAIM | 1465dcce240eSSteven Whitehouse WQ_HIGHPRI | WQ_FREEZEABLE, 0); 14666ed7257bSPatrick Caulfield error = IS_ERR(recv_workqueue); 14676ed7257bSPatrick Caulfield if (error) { 14686ed7257bSPatrick Caulfield log_print("can't start dlm_recv %d", error); 14696ed7257bSPatrick Caulfield return error; 14706ed7257bSPatrick Caulfield } 14716ed7257bSPatrick Caulfield 1472dcce240eSSteven Whitehouse send_workqueue = alloc_workqueue("dlm_send", WQ_MEM_RECLAIM | 1473dcce240eSSteven Whitehouse WQ_HIGHPRI | WQ_FREEZEABLE, 0); 14746ed7257bSPatrick Caulfield error = IS_ERR(send_workqueue); 14756ed7257bSPatrick Caulfield if (error) { 14766ed7257bSPatrick Caulfield log_print("can't start dlm_send %d", error); 14776ed7257bSPatrick Caulfield destroy_workqueue(recv_workqueue); 14786ed7257bSPatrick Caulfield return error; 14796ed7257bSPatrick Caulfield } 14806ed7257bSPatrick Caulfield 14816ed7257bSPatrick Caulfield return 0; 14826ed7257bSPatrick Caulfield } 14836ed7257bSPatrick Caulfield 14845e9ccc37SChristine Caulfield static void stop_conn(struct connection *con) 14856ed7257bSPatrick Caulfield { 14869e5f2825SPatrick Caulfield con->flags |= 0x0F; 1487391fbdc5SChristine Caulfield if (con->sock && con->sock->sk) 1488afb853fbSPatrick Caulfield con->sock->sk->sk_user_data = NULL; 1489afb853fbSPatrick Caulfield } 14905e9ccc37SChristine Caulfield 14915e9ccc37SChristine Caulfield static void free_conn(struct connection *con) 14925e9ccc37SChristine Caulfield { 14935e9ccc37SChristine Caulfield close_connection(con, true); 14945e9ccc37SChristine Caulfield if (con->othercon) 14955e9ccc37SChristine Caulfield kmem_cache_free(con_cache, con->othercon); 14965e9ccc37SChristine Caulfield hlist_del(&con->list); 14975e9ccc37SChristine Caulfield kmem_cache_free(con_cache, con); 14986ed7257bSPatrick Caulfield } 14995e9ccc37SChristine Caulfield 15005e9ccc37SChristine Caulfield void dlm_lowcomms_stop(void) 15015e9ccc37SChristine Caulfield { 15025e9ccc37SChristine Caulfield /* Set all the flags to prevent any 15035e9ccc37SChristine Caulfield socket activity. 15045e9ccc37SChristine Caulfield */ 15055e9ccc37SChristine Caulfield mutex_lock(&connections_lock); 15065e9ccc37SChristine Caulfield foreach_conn(stop_conn); 15077a936ce7SMatthias Kaehlcke mutex_unlock(&connections_lock); 15086ed7257bSPatrick Caulfield 15096ed7257bSPatrick Caulfield work_stop(); 15106ed7257bSPatrick Caulfield 15117a936ce7SMatthias Kaehlcke mutex_lock(&connections_lock); 15126ed7257bSPatrick Caulfield clean_writequeues(); 15136ed7257bSPatrick Caulfield 15145e9ccc37SChristine Caulfield foreach_conn(free_conn); 15155e9ccc37SChristine Caulfield 15167a936ce7SMatthias Kaehlcke mutex_unlock(&connections_lock); 15176ed7257bSPatrick Caulfield kmem_cache_destroy(con_cache); 15186ed7257bSPatrick Caulfield } 15196ed7257bSPatrick Caulfield 15206ed7257bSPatrick Caulfield int dlm_lowcomms_start(void) 15216ed7257bSPatrick Caulfield { 15226ed7257bSPatrick Caulfield int error = -EINVAL; 15236ed7257bSPatrick Caulfield struct connection *con; 15245e9ccc37SChristine Caulfield int i; 15255e9ccc37SChristine Caulfield 15265e9ccc37SChristine Caulfield for (i = 0; i < CONN_HASH_SIZE; i++) 15275e9ccc37SChristine Caulfield INIT_HLIST_HEAD(&connection_hash[i]); 15286ed7257bSPatrick Caulfield 15296ed7257bSPatrick Caulfield init_local(); 15306ed7257bSPatrick Caulfield if (!dlm_local_count) { 1531617e82e1SDavid Teigland error = -ENOTCONN; 15326ed7257bSPatrick Caulfield log_print("no local IP address has been set"); 15336ed7257bSPatrick Caulfield goto out; 15346ed7257bSPatrick Caulfield } 15356ed7257bSPatrick Caulfield 15366ed7257bSPatrick Caulfield error = -ENOMEM; 15376ed7257bSPatrick Caulfield con_cache = kmem_cache_create("dlm_conn", sizeof(struct connection), 15386ed7257bSPatrick Caulfield __alignof__(struct connection), 0, 153920c2df83SPaul Mundt NULL); 15406ed7257bSPatrick Caulfield if (!con_cache) 15416ed7257bSPatrick Caulfield goto out; 15426ed7257bSPatrick Caulfield 15436ed7257bSPatrick Caulfield /* Start listening */ 15446ed7257bSPatrick Caulfield if (dlm_config.ci_protocol == 0) 15456ed7257bSPatrick Caulfield error = tcp_listen_for_all(); 15466ed7257bSPatrick Caulfield else 15476ed7257bSPatrick Caulfield error = sctp_listen_for_all(); 15486ed7257bSPatrick Caulfield if (error) 15496ed7257bSPatrick Caulfield goto fail_unlisten; 15506ed7257bSPatrick Caulfield 15516ed7257bSPatrick Caulfield error = work_start(); 15526ed7257bSPatrick Caulfield if (error) 15536ed7257bSPatrick Caulfield goto fail_unlisten; 15546ed7257bSPatrick Caulfield 15556ed7257bSPatrick Caulfield return 0; 15566ed7257bSPatrick Caulfield 15576ed7257bSPatrick Caulfield fail_unlisten: 15586ed7257bSPatrick Caulfield con = nodeid2con(0,0); 15596ed7257bSPatrick Caulfield if (con) { 15606ed7257bSPatrick Caulfield close_connection(con, false); 15616ed7257bSPatrick Caulfield kmem_cache_free(con_cache, con); 15626ed7257bSPatrick Caulfield } 15636ed7257bSPatrick Caulfield kmem_cache_destroy(con_cache); 15646ed7257bSPatrick Caulfield 15656ed7257bSPatrick Caulfield out: 15666ed7257bSPatrick Caulfield return error; 15676ed7257bSPatrick Caulfield } 1568