xref: /openbmc/linux/fs/dlm/lowcomms.c (revision 055923bf)
12522fe45SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
26ed7257bSPatrick Caulfield /******************************************************************************
36ed7257bSPatrick Caulfield *******************************************************************************
46ed7257bSPatrick Caulfield **
56ed7257bSPatrick Caulfield **  Copyright (C) Sistina Software, Inc.  1997-2003  All rights reserved.
65e9ccc37SChristine Caulfield **  Copyright (C) 2004-2009 Red Hat, Inc.  All rights reserved.
76ed7257bSPatrick Caulfield **
86ed7257bSPatrick Caulfield **
96ed7257bSPatrick Caulfield *******************************************************************************
106ed7257bSPatrick Caulfield ******************************************************************************/
116ed7257bSPatrick Caulfield 
126ed7257bSPatrick Caulfield /*
136ed7257bSPatrick Caulfield  * lowcomms.c
146ed7257bSPatrick Caulfield  *
156ed7257bSPatrick Caulfield  * This is the "low-level" comms layer.
166ed7257bSPatrick Caulfield  *
176ed7257bSPatrick Caulfield  * It is responsible for sending/receiving messages
186ed7257bSPatrick Caulfield  * from other nodes in the cluster.
196ed7257bSPatrick Caulfield  *
206ed7257bSPatrick Caulfield  * Cluster nodes are referred to by their nodeids. nodeids are
216ed7257bSPatrick Caulfield  * simply 32 bit numbers to the locking module - if they need to
222cf12c0bSJoe Perches  * be expanded for the cluster infrastructure then that is its
236ed7257bSPatrick Caulfield  * responsibility. It is this layer's
246ed7257bSPatrick Caulfield  * responsibility to resolve these into IP address or
256ed7257bSPatrick Caulfield  * whatever it needs for inter-node communication.
266ed7257bSPatrick Caulfield  *
276ed7257bSPatrick Caulfield  * The comms level is two kernel threads that deal mainly with
286ed7257bSPatrick Caulfield  * the receiving of messages from other nodes and passing them
296ed7257bSPatrick Caulfield  * up to the mid-level comms layer (which understands the
306ed7257bSPatrick Caulfield  * message format) for execution by the locking core, and
316ed7257bSPatrick Caulfield  * a send thread which does all the setting up of connections
326ed7257bSPatrick Caulfield  * to remote nodes and the sending of data. Threads are not allowed
336ed7257bSPatrick Caulfield  * to send their own data because it may cause them to wait in times
346ed7257bSPatrick Caulfield  * of high load. Also, this way, the sending thread can collect together
356ed7257bSPatrick Caulfield  * messages bound for one node and send them in one block.
366ed7257bSPatrick Caulfield  *
372cf12c0bSJoe Perches  * lowcomms will choose to use either TCP or SCTP as its transport layer
386ed7257bSPatrick Caulfield  * depending on the configuration variable 'protocol'. This should be set
396ed7257bSPatrick Caulfield  * to 0 (default) for TCP or 1 for SCTP. It should be configured using a
406ed7257bSPatrick Caulfield  * cluster-wide mechanism as it must be the same on all nodes of the cluster
416ed7257bSPatrick Caulfield  * for the DLM to function.
426ed7257bSPatrick Caulfield  *
436ed7257bSPatrick Caulfield  */
446ed7257bSPatrick Caulfield 
456ed7257bSPatrick Caulfield #include <asm/ioctls.h>
466ed7257bSPatrick Caulfield #include <net/sock.h>
476ed7257bSPatrick Caulfield #include <net/tcp.h>
486ed7257bSPatrick Caulfield #include <linux/pagemap.h>
496ed7257bSPatrick Caulfield #include <linux/file.h>
507a936ce7SMatthias Kaehlcke #include <linux/mutex.h>
516ed7257bSPatrick Caulfield #include <linux/sctp.h>
525a0e3ad6STejun Heo #include <linux/slab.h>
532f2d76ccSBenjamin Poirier #include <net/sctp/sctp.h>
5444ad532bSJoe Perches #include <net/ipv6.h>
556ed7257bSPatrick Caulfield 
566ed7257bSPatrick Caulfield #include "dlm_internal.h"
576ed7257bSPatrick Caulfield #include "lowcomms.h"
586ed7257bSPatrick Caulfield #include "midcomms.h"
596ed7257bSPatrick Caulfield #include "config.h"
606ed7257bSPatrick Caulfield 
616ed7257bSPatrick Caulfield #define NEEDED_RMEM (4*1024*1024)
625e9ccc37SChristine Caulfield #define CONN_HASH_SIZE 32
636ed7257bSPatrick Caulfield 
64f92c8dd7SBob Peterson /* Number of messages to send before rescheduling */
65f92c8dd7SBob Peterson #define MAX_SEND_MSG_COUNT 25
66055923bfSAlexander Aring #define DLM_SHUTDOWN_WAIT_TIMEOUT msecs_to_jiffies(10000)
67f92c8dd7SBob Peterson 
686ed7257bSPatrick Caulfield struct cbuf {
696ed7257bSPatrick Caulfield 	unsigned int base;
706ed7257bSPatrick Caulfield 	unsigned int len;
716ed7257bSPatrick Caulfield 	unsigned int mask;
726ed7257bSPatrick Caulfield };
736ed7257bSPatrick Caulfield 
746ed7257bSPatrick Caulfield static void cbuf_add(struct cbuf *cb, int n)
756ed7257bSPatrick Caulfield {
766ed7257bSPatrick Caulfield 	cb->len += n;
776ed7257bSPatrick Caulfield }
786ed7257bSPatrick Caulfield 
796ed7257bSPatrick Caulfield static int cbuf_data(struct cbuf *cb)
806ed7257bSPatrick Caulfield {
816ed7257bSPatrick Caulfield 	return ((cb->base + cb->len) & cb->mask);
826ed7257bSPatrick Caulfield }
836ed7257bSPatrick Caulfield 
846ed7257bSPatrick Caulfield static void cbuf_init(struct cbuf *cb, int size)
856ed7257bSPatrick Caulfield {
866ed7257bSPatrick Caulfield 	cb->base = cb->len = 0;
876ed7257bSPatrick Caulfield 	cb->mask = size-1;
886ed7257bSPatrick Caulfield }
896ed7257bSPatrick Caulfield 
906ed7257bSPatrick Caulfield static void cbuf_eat(struct cbuf *cb, int n)
916ed7257bSPatrick Caulfield {
926ed7257bSPatrick Caulfield 	cb->len  -= n;
936ed7257bSPatrick Caulfield 	cb->base += n;
946ed7257bSPatrick Caulfield 	cb->base &= cb->mask;
956ed7257bSPatrick Caulfield }
966ed7257bSPatrick Caulfield 
976ed7257bSPatrick Caulfield static bool cbuf_empty(struct cbuf *cb)
986ed7257bSPatrick Caulfield {
996ed7257bSPatrick Caulfield 	return cb->len == 0;
1006ed7257bSPatrick Caulfield }
1016ed7257bSPatrick Caulfield 
1026ed7257bSPatrick Caulfield struct connection {
1036ed7257bSPatrick Caulfield 	struct socket *sock;	/* NULL if not connected */
1046ed7257bSPatrick Caulfield 	uint32_t nodeid;	/* So we know who we are in the list */
1056ed7257bSPatrick Caulfield 	struct mutex sock_mutex;
1066ed7257bSPatrick Caulfield 	unsigned long flags;
1076ed7257bSPatrick Caulfield #define CF_READ_PENDING 1
1088a4abb08Stsutomu.owa@toshiba.co.jp #define CF_WRITE_PENDING 2
1096ed7257bSPatrick Caulfield #define CF_INIT_PENDING 4
1106ed7257bSPatrick Caulfield #define CF_IS_OTHERCON 5
111063c4c99SLars Marowsky-Bree #define CF_CLOSE 6
112b36930ddSDavid Miller #define CF_APP_LIMITED 7
113b2a66629Stsutomu.owa@toshiba.co.jp #define CF_CLOSING 8
114055923bfSAlexander Aring #define CF_SHUTDOWN 9
1156ed7257bSPatrick Caulfield 	struct list_head writequeue;  /* List of outgoing writequeue_entries */
1166ed7257bSPatrick Caulfield 	spinlock_t writequeue_lock;
1176ed7257bSPatrick Caulfield 	int (*rx_action) (struct connection *);	/* What to do when active */
1186ed7257bSPatrick Caulfield 	void (*connect_action) (struct connection *);	/* What to do to connect */
119055923bfSAlexander Aring 	void (*shutdown_action)(struct connection *con); /* What to do to shutdown */
1206ed7257bSPatrick Caulfield 	struct page *rx_page;
1216ed7257bSPatrick Caulfield 	struct cbuf cb;
1226ed7257bSPatrick Caulfield 	int retries;
1236ed7257bSPatrick Caulfield #define MAX_CONNECT_RETRIES 3
1245e9ccc37SChristine Caulfield 	struct hlist_node list;
1256ed7257bSPatrick Caulfield 	struct connection *othercon;
1266ed7257bSPatrick Caulfield 	struct work_struct rwork; /* Receive workqueue */
1276ed7257bSPatrick Caulfield 	struct work_struct swork; /* Send workqueue */
128055923bfSAlexander Aring 	wait_queue_head_t shutdown_wait; /* wait for graceful shutdown */
1296ed7257bSPatrick Caulfield };
1306ed7257bSPatrick Caulfield #define sock2con(x) ((struct connection *)(x)->sk_user_data)
1316ed7257bSPatrick Caulfield 
1326ed7257bSPatrick Caulfield /* An entry waiting to be sent */
1336ed7257bSPatrick Caulfield struct writequeue_entry {
1346ed7257bSPatrick Caulfield 	struct list_head list;
1356ed7257bSPatrick Caulfield 	struct page *page;
1366ed7257bSPatrick Caulfield 	int offset;
1376ed7257bSPatrick Caulfield 	int len;
1386ed7257bSPatrick Caulfield 	int end;
1396ed7257bSPatrick Caulfield 	int users;
1406ed7257bSPatrick Caulfield 	struct connection *con;
1416ed7257bSPatrick Caulfield };
1426ed7257bSPatrick Caulfield 
14336b71a8bSDavid Teigland struct dlm_node_addr {
14436b71a8bSDavid Teigland 	struct list_head list;
14536b71a8bSDavid Teigland 	int nodeid;
14636b71a8bSDavid Teigland 	int addr_count;
14798e1b60eSMike Christie 	int curr_addr_index;
14836b71a8bSDavid Teigland 	struct sockaddr_storage *addr[DLM_MAX_ADDR_COUNT];
14936b71a8bSDavid Teigland };
15036b71a8bSDavid Teigland 
151cc661fc9SBob Peterson static struct listen_sock_callbacks {
152cc661fc9SBob Peterson 	void (*sk_error_report)(struct sock *);
153cc661fc9SBob Peterson 	void (*sk_data_ready)(struct sock *);
154cc661fc9SBob Peterson 	void (*sk_state_change)(struct sock *);
155cc661fc9SBob Peterson 	void (*sk_write_space)(struct sock *);
156cc661fc9SBob Peterson } listen_sock;
157cc661fc9SBob Peterson 
15836b71a8bSDavid Teigland static LIST_HEAD(dlm_node_addrs);
15936b71a8bSDavid Teigland static DEFINE_SPINLOCK(dlm_node_addrs_spin);
16036b71a8bSDavid Teigland 
1616ed7257bSPatrick Caulfield static struct sockaddr_storage *dlm_local_addr[DLM_MAX_ADDR_COUNT];
1626ed7257bSPatrick Caulfield static int dlm_local_count;
163513ef596SDavid Teigland static int dlm_allow_conn;
1646ed7257bSPatrick Caulfield 
1656ed7257bSPatrick Caulfield /* Work queues */
1666ed7257bSPatrick Caulfield static struct workqueue_struct *recv_workqueue;
1676ed7257bSPatrick Caulfield static struct workqueue_struct *send_workqueue;
1686ed7257bSPatrick Caulfield 
1695e9ccc37SChristine Caulfield static struct hlist_head connection_hash[CONN_HASH_SIZE];
1707a936ce7SMatthias Kaehlcke static DEFINE_MUTEX(connections_lock);
1716ed7257bSPatrick Caulfield static struct kmem_cache *con_cache;
1726ed7257bSPatrick Caulfield 
1736ed7257bSPatrick Caulfield static void process_recv_sockets(struct work_struct *work);
1746ed7257bSPatrick Caulfield static void process_send_sockets(struct work_struct *work);
1756ed7257bSPatrick Caulfield 
1765e9ccc37SChristine Caulfield 
1775e9ccc37SChristine Caulfield /* This is deliberately very simple because most clusters have simple
1785e9ccc37SChristine Caulfield    sequential nodeids, so we should be able to go straight to a connection
1795e9ccc37SChristine Caulfield    struct in the array */
1805e9ccc37SChristine Caulfield static inline int nodeid_hash(int nodeid)
1815e9ccc37SChristine Caulfield {
1825e9ccc37SChristine Caulfield 	return nodeid & (CONN_HASH_SIZE-1);
1835e9ccc37SChristine Caulfield }
1845e9ccc37SChristine Caulfield 
1855e9ccc37SChristine Caulfield static struct connection *__find_con(int nodeid)
1865e9ccc37SChristine Caulfield {
1875e9ccc37SChristine Caulfield 	int r;
1885e9ccc37SChristine Caulfield 	struct connection *con;
1895e9ccc37SChristine Caulfield 
1905e9ccc37SChristine Caulfield 	r = nodeid_hash(nodeid);
1915e9ccc37SChristine Caulfield 
192b67bfe0dSSasha Levin 	hlist_for_each_entry(con, &connection_hash[r], list) {
1935e9ccc37SChristine Caulfield 		if (con->nodeid == nodeid)
1945e9ccc37SChristine Caulfield 			return con;
1955e9ccc37SChristine Caulfield 	}
1965e9ccc37SChristine Caulfield 	return NULL;
1975e9ccc37SChristine Caulfield }
1985e9ccc37SChristine Caulfield 
1996ed7257bSPatrick Caulfield /*
2006ed7257bSPatrick Caulfield  * If 'allocation' is zero then we don't attempt to create a new
2016ed7257bSPatrick Caulfield  * connection structure for this node.
2026ed7257bSPatrick Caulfield  */
2036ed7257bSPatrick Caulfield static struct connection *__nodeid2con(int nodeid, gfp_t alloc)
2046ed7257bSPatrick Caulfield {
2056ed7257bSPatrick Caulfield 	struct connection *con = NULL;
2066ed7257bSPatrick Caulfield 	int r;
2076ed7257bSPatrick Caulfield 
2085e9ccc37SChristine Caulfield 	con = __find_con(nodeid);
2096ed7257bSPatrick Caulfield 	if (con || !alloc)
2106ed7257bSPatrick Caulfield 		return con;
2116ed7257bSPatrick Caulfield 
2126ed7257bSPatrick Caulfield 	con = kmem_cache_zalloc(con_cache, alloc);
2136ed7257bSPatrick Caulfield 	if (!con)
2146ed7257bSPatrick Caulfield 		return NULL;
2156ed7257bSPatrick Caulfield 
2165e9ccc37SChristine Caulfield 	r = nodeid_hash(nodeid);
2175e9ccc37SChristine Caulfield 	hlist_add_head(&con->list, &connection_hash[r]);
2186ed7257bSPatrick Caulfield 
2196ed7257bSPatrick Caulfield 	con->nodeid = nodeid;
2206ed7257bSPatrick Caulfield 	mutex_init(&con->sock_mutex);
2216ed7257bSPatrick Caulfield 	INIT_LIST_HEAD(&con->writequeue);
2226ed7257bSPatrick Caulfield 	spin_lock_init(&con->writequeue_lock);
2236ed7257bSPatrick Caulfield 	INIT_WORK(&con->swork, process_send_sockets);
2246ed7257bSPatrick Caulfield 	INIT_WORK(&con->rwork, process_recv_sockets);
225055923bfSAlexander Aring 	init_waitqueue_head(&con->shutdown_wait);
2266ed7257bSPatrick Caulfield 
2276ed7257bSPatrick Caulfield 	/* Setup action pointers for child sockets */
2286ed7257bSPatrick Caulfield 	if (con->nodeid) {
2295e9ccc37SChristine Caulfield 		struct connection *zerocon = __find_con(0);
2306ed7257bSPatrick Caulfield 
2316ed7257bSPatrick Caulfield 		con->connect_action = zerocon->connect_action;
2326ed7257bSPatrick Caulfield 		if (!con->rx_action)
2336ed7257bSPatrick Caulfield 			con->rx_action = zerocon->rx_action;
2346ed7257bSPatrick Caulfield 	}
2356ed7257bSPatrick Caulfield 
2366ed7257bSPatrick Caulfield 	return con;
2376ed7257bSPatrick Caulfield }
2386ed7257bSPatrick Caulfield 
2395e9ccc37SChristine Caulfield /* Loop round all connections */
2405e9ccc37SChristine Caulfield static void foreach_conn(void (*conn_func)(struct connection *c))
2415e9ccc37SChristine Caulfield {
2425e9ccc37SChristine Caulfield 	int i;
243b67bfe0dSSasha Levin 	struct hlist_node *n;
2445e9ccc37SChristine Caulfield 	struct connection *con;
2455e9ccc37SChristine Caulfield 
2465e9ccc37SChristine Caulfield 	for (i = 0; i < CONN_HASH_SIZE; i++) {
247b67bfe0dSSasha Levin 		hlist_for_each_entry_safe(con, n, &connection_hash[i], list)
2485e9ccc37SChristine Caulfield 			conn_func(con);
2495e9ccc37SChristine Caulfield 	}
2505e9ccc37SChristine Caulfield }
2515e9ccc37SChristine Caulfield 
2526ed7257bSPatrick Caulfield static struct connection *nodeid2con(int nodeid, gfp_t allocation)
2536ed7257bSPatrick Caulfield {
2546ed7257bSPatrick Caulfield 	struct connection *con;
2556ed7257bSPatrick Caulfield 
2567a936ce7SMatthias Kaehlcke 	mutex_lock(&connections_lock);
2576ed7257bSPatrick Caulfield 	con = __nodeid2con(nodeid, allocation);
2587a936ce7SMatthias Kaehlcke 	mutex_unlock(&connections_lock);
2596ed7257bSPatrick Caulfield 
2606ed7257bSPatrick Caulfield 	return con;
2616ed7257bSPatrick Caulfield }
2626ed7257bSPatrick Caulfield 
26336b71a8bSDavid Teigland static struct dlm_node_addr *find_node_addr(int nodeid)
2646ed7257bSPatrick Caulfield {
26536b71a8bSDavid Teigland 	struct dlm_node_addr *na;
26636b71a8bSDavid Teigland 
26736b71a8bSDavid Teigland 	list_for_each_entry(na, &dlm_node_addrs, list) {
26836b71a8bSDavid Teigland 		if (na->nodeid == nodeid)
26936b71a8bSDavid Teigland 			return na;
27036b71a8bSDavid Teigland 	}
27136b71a8bSDavid Teigland 	return NULL;
27236b71a8bSDavid Teigland }
27336b71a8bSDavid Teigland 
27436b71a8bSDavid Teigland static int addr_compare(struct sockaddr_storage *x, struct sockaddr_storage *y)
27536b71a8bSDavid Teigland {
27636b71a8bSDavid Teigland 	switch (x->ss_family) {
27736b71a8bSDavid Teigland 	case AF_INET: {
27836b71a8bSDavid Teigland 		struct sockaddr_in *sinx = (struct sockaddr_in *)x;
27936b71a8bSDavid Teigland 		struct sockaddr_in *siny = (struct sockaddr_in *)y;
28036b71a8bSDavid Teigland 		if (sinx->sin_addr.s_addr != siny->sin_addr.s_addr)
28136b71a8bSDavid Teigland 			return 0;
28236b71a8bSDavid Teigland 		if (sinx->sin_port != siny->sin_port)
28336b71a8bSDavid Teigland 			return 0;
28436b71a8bSDavid Teigland 		break;
28536b71a8bSDavid Teigland 	}
28636b71a8bSDavid Teigland 	case AF_INET6: {
28736b71a8bSDavid Teigland 		struct sockaddr_in6 *sinx = (struct sockaddr_in6 *)x;
28836b71a8bSDavid Teigland 		struct sockaddr_in6 *siny = (struct sockaddr_in6 *)y;
28936b71a8bSDavid Teigland 		if (!ipv6_addr_equal(&sinx->sin6_addr, &siny->sin6_addr))
29036b71a8bSDavid Teigland 			return 0;
29136b71a8bSDavid Teigland 		if (sinx->sin6_port != siny->sin6_port)
29236b71a8bSDavid Teigland 			return 0;
29336b71a8bSDavid Teigland 		break;
29436b71a8bSDavid Teigland 	}
29536b71a8bSDavid Teigland 	default:
29636b71a8bSDavid Teigland 		return 0;
29736b71a8bSDavid Teigland 	}
29836b71a8bSDavid Teigland 	return 1;
29936b71a8bSDavid Teigland }
30036b71a8bSDavid Teigland 
30136b71a8bSDavid Teigland static int nodeid_to_addr(int nodeid, struct sockaddr_storage *sas_out,
30298e1b60eSMike Christie 			  struct sockaddr *sa_out, bool try_new_addr)
30336b71a8bSDavid Teigland {
30436b71a8bSDavid Teigland 	struct sockaddr_storage sas;
30536b71a8bSDavid Teigland 	struct dlm_node_addr *na;
3066ed7257bSPatrick Caulfield 
3076ed7257bSPatrick Caulfield 	if (!dlm_local_count)
3086ed7257bSPatrick Caulfield 		return -1;
3096ed7257bSPatrick Caulfield 
31036b71a8bSDavid Teigland 	spin_lock(&dlm_node_addrs_spin);
31136b71a8bSDavid Teigland 	na = find_node_addr(nodeid);
31298e1b60eSMike Christie 	if (na && na->addr_count) {
313ee44b4bcSMarcelo Ricardo Leitner 		memcpy(&sas, na->addr[na->curr_addr_index],
314ee44b4bcSMarcelo Ricardo Leitner 		       sizeof(struct sockaddr_storage));
315ee44b4bcSMarcelo Ricardo Leitner 
31698e1b60eSMike Christie 		if (try_new_addr) {
31798e1b60eSMike Christie 			na->curr_addr_index++;
31898e1b60eSMike Christie 			if (na->curr_addr_index == na->addr_count)
31998e1b60eSMike Christie 				na->curr_addr_index = 0;
32098e1b60eSMike Christie 		}
32198e1b60eSMike Christie 	}
32236b71a8bSDavid Teigland 	spin_unlock(&dlm_node_addrs_spin);
32336b71a8bSDavid Teigland 
32436b71a8bSDavid Teigland 	if (!na)
32536b71a8bSDavid Teigland 		return -EEXIST;
32636b71a8bSDavid Teigland 
32736b71a8bSDavid Teigland 	if (!na->addr_count)
32836b71a8bSDavid Teigland 		return -ENOENT;
32936b71a8bSDavid Teigland 
33036b71a8bSDavid Teigland 	if (sas_out)
33136b71a8bSDavid Teigland 		memcpy(sas_out, &sas, sizeof(struct sockaddr_storage));
33236b71a8bSDavid Teigland 
33336b71a8bSDavid Teigland 	if (!sa_out)
33436b71a8bSDavid Teigland 		return 0;
3356ed7257bSPatrick Caulfield 
3366ed7257bSPatrick Caulfield 	if (dlm_local_addr[0]->ss_family == AF_INET) {
33736b71a8bSDavid Teigland 		struct sockaddr_in *in4  = (struct sockaddr_in *) &sas;
33836b71a8bSDavid Teigland 		struct sockaddr_in *ret4 = (struct sockaddr_in *) sa_out;
3396ed7257bSPatrick Caulfield 		ret4->sin_addr.s_addr = in4->sin_addr.s_addr;
3406ed7257bSPatrick Caulfield 	} else {
34136b71a8bSDavid Teigland 		struct sockaddr_in6 *in6  = (struct sockaddr_in6 *) &sas;
34236b71a8bSDavid Teigland 		struct sockaddr_in6 *ret6 = (struct sockaddr_in6 *) sa_out;
3434e3fd7a0SAlexey Dobriyan 		ret6->sin6_addr = in6->sin6_addr;
3446ed7257bSPatrick Caulfield 	}
3456ed7257bSPatrick Caulfield 
3466ed7257bSPatrick Caulfield 	return 0;
3476ed7257bSPatrick Caulfield }
3486ed7257bSPatrick Caulfield 
34936b71a8bSDavid Teigland static int addr_to_nodeid(struct sockaddr_storage *addr, int *nodeid)
35036b71a8bSDavid Teigland {
35136b71a8bSDavid Teigland 	struct dlm_node_addr *na;
35236b71a8bSDavid Teigland 	int rv = -EEXIST;
35398e1b60eSMike Christie 	int addr_i;
35436b71a8bSDavid Teigland 
35536b71a8bSDavid Teigland 	spin_lock(&dlm_node_addrs_spin);
35636b71a8bSDavid Teigland 	list_for_each_entry(na, &dlm_node_addrs, list) {
35736b71a8bSDavid Teigland 		if (!na->addr_count)
35836b71a8bSDavid Teigland 			continue;
35936b71a8bSDavid Teigland 
36098e1b60eSMike Christie 		for (addr_i = 0; addr_i < na->addr_count; addr_i++) {
36198e1b60eSMike Christie 			if (addr_compare(na->addr[addr_i], addr)) {
36236b71a8bSDavid Teigland 				*nodeid = na->nodeid;
36336b71a8bSDavid Teigland 				rv = 0;
36498e1b60eSMike Christie 				goto unlock;
36536b71a8bSDavid Teigland 			}
36698e1b60eSMike Christie 		}
36798e1b60eSMike Christie 	}
36898e1b60eSMike Christie unlock:
36936b71a8bSDavid Teigland 	spin_unlock(&dlm_node_addrs_spin);
37036b71a8bSDavid Teigland 	return rv;
37136b71a8bSDavid Teigland }
37236b71a8bSDavid Teigland 
37336b71a8bSDavid Teigland int dlm_lowcomms_addr(int nodeid, struct sockaddr_storage *addr, int len)
37436b71a8bSDavid Teigland {
37536b71a8bSDavid Teigland 	struct sockaddr_storage *new_addr;
37636b71a8bSDavid Teigland 	struct dlm_node_addr *new_node, *na;
37736b71a8bSDavid Teigland 
37836b71a8bSDavid Teigland 	new_node = kzalloc(sizeof(struct dlm_node_addr), GFP_NOFS);
37936b71a8bSDavid Teigland 	if (!new_node)
38036b71a8bSDavid Teigland 		return -ENOMEM;
38136b71a8bSDavid Teigland 
38236b71a8bSDavid Teigland 	new_addr = kzalloc(sizeof(struct sockaddr_storage), GFP_NOFS);
38336b71a8bSDavid Teigland 	if (!new_addr) {
38436b71a8bSDavid Teigland 		kfree(new_node);
38536b71a8bSDavid Teigland 		return -ENOMEM;
38636b71a8bSDavid Teigland 	}
38736b71a8bSDavid Teigland 
38836b71a8bSDavid Teigland 	memcpy(new_addr, addr, len);
38936b71a8bSDavid Teigland 
39036b71a8bSDavid Teigland 	spin_lock(&dlm_node_addrs_spin);
39136b71a8bSDavid Teigland 	na = find_node_addr(nodeid);
39236b71a8bSDavid Teigland 	if (!na) {
39336b71a8bSDavid Teigland 		new_node->nodeid = nodeid;
39436b71a8bSDavid Teigland 		new_node->addr[0] = new_addr;
39536b71a8bSDavid Teigland 		new_node->addr_count = 1;
39636b71a8bSDavid Teigland 		list_add(&new_node->list, &dlm_node_addrs);
39736b71a8bSDavid Teigland 		spin_unlock(&dlm_node_addrs_spin);
39836b71a8bSDavid Teigland 		return 0;
39936b71a8bSDavid Teigland 	}
40036b71a8bSDavid Teigland 
40136b71a8bSDavid Teigland 	if (na->addr_count >= DLM_MAX_ADDR_COUNT) {
40236b71a8bSDavid Teigland 		spin_unlock(&dlm_node_addrs_spin);
40336b71a8bSDavid Teigland 		kfree(new_addr);
40436b71a8bSDavid Teigland 		kfree(new_node);
40536b71a8bSDavid Teigland 		return -ENOSPC;
40636b71a8bSDavid Teigland 	}
40736b71a8bSDavid Teigland 
40836b71a8bSDavid Teigland 	na->addr[na->addr_count++] = new_addr;
40936b71a8bSDavid Teigland 	spin_unlock(&dlm_node_addrs_spin);
41036b71a8bSDavid Teigland 	kfree(new_node);
41136b71a8bSDavid Teigland 	return 0;
41236b71a8bSDavid Teigland }
41336b71a8bSDavid Teigland 
4146ed7257bSPatrick Caulfield /* Data available on socket or listen socket received a connect */
415676d2369SDavid S. Miller static void lowcomms_data_ready(struct sock *sk)
4166ed7257bSPatrick Caulfield {
41793eaadebStsutomu.owa@toshiba.co.jp 	struct connection *con;
41893eaadebStsutomu.owa@toshiba.co.jp 
41993eaadebStsutomu.owa@toshiba.co.jp 	read_lock_bh(&sk->sk_callback_lock);
42093eaadebStsutomu.owa@toshiba.co.jp 	con = sock2con(sk);
421afb853fbSPatrick Caulfield 	if (con && !test_and_set_bit(CF_READ_PENDING, &con->flags))
4226ed7257bSPatrick Caulfield 		queue_work(recv_workqueue, &con->rwork);
42393eaadebStsutomu.owa@toshiba.co.jp 	read_unlock_bh(&sk->sk_callback_lock);
4246ed7257bSPatrick Caulfield }
4256ed7257bSPatrick Caulfield 
4266ed7257bSPatrick Caulfield static void lowcomms_write_space(struct sock *sk)
4276ed7257bSPatrick Caulfield {
42893eaadebStsutomu.owa@toshiba.co.jp 	struct connection *con;
4296ed7257bSPatrick Caulfield 
43093eaadebStsutomu.owa@toshiba.co.jp 	read_lock_bh(&sk->sk_callback_lock);
43193eaadebStsutomu.owa@toshiba.co.jp 	con = sock2con(sk);
432b36930ddSDavid Miller 	if (!con)
43393eaadebStsutomu.owa@toshiba.co.jp 		goto out;
434b36930ddSDavid Miller 
435b36930ddSDavid Miller 	clear_bit(SOCK_NOSPACE, &con->sock->flags);
436b36930ddSDavid Miller 
437b36930ddSDavid Miller 	if (test_and_clear_bit(CF_APP_LIMITED, &con->flags)) {
438b36930ddSDavid Miller 		con->sock->sk->sk_write_pending--;
4399cd3e072SEric Dumazet 		clear_bit(SOCKWQ_ASYNC_NOSPACE, &con->sock->flags);
440b36930ddSDavid Miller 	}
441b36930ddSDavid Miller 
4426ed7257bSPatrick Caulfield 	queue_work(send_workqueue, &con->swork);
44393eaadebStsutomu.owa@toshiba.co.jp out:
44493eaadebStsutomu.owa@toshiba.co.jp 	read_unlock_bh(&sk->sk_callback_lock);
4456ed7257bSPatrick Caulfield }
4466ed7257bSPatrick Caulfield 
4476ed7257bSPatrick Caulfield static inline void lowcomms_connect_sock(struct connection *con)
4486ed7257bSPatrick Caulfield {
449063c4c99SLars Marowsky-Bree 	if (test_bit(CF_CLOSE, &con->flags))
450063c4c99SLars Marowsky-Bree 		return;
4516ed7257bSPatrick Caulfield 	queue_work(send_workqueue, &con->swork);
45261d9102bSBob Peterson 	cond_resched();
4536ed7257bSPatrick Caulfield }
4546ed7257bSPatrick Caulfield 
4556ed7257bSPatrick Caulfield static void lowcomms_state_change(struct sock *sk)
4566ed7257bSPatrick Caulfield {
457ee44b4bcSMarcelo Ricardo Leitner 	/* SCTP layer is not calling sk_data_ready when the connection
458ee44b4bcSMarcelo Ricardo Leitner 	 * is done, so we catch the signal through here. Also, it
459ee44b4bcSMarcelo Ricardo Leitner 	 * doesn't switch socket state when entering shutdown, so we
460ee44b4bcSMarcelo Ricardo Leitner 	 * skip the write in that case.
461ee44b4bcSMarcelo Ricardo Leitner 	 */
462ee44b4bcSMarcelo Ricardo Leitner 	if (sk->sk_shutdown) {
463ee44b4bcSMarcelo Ricardo Leitner 		if (sk->sk_shutdown == RCV_SHUTDOWN)
464ee44b4bcSMarcelo Ricardo Leitner 			lowcomms_data_ready(sk);
465ee44b4bcSMarcelo Ricardo Leitner 	} else if (sk->sk_state == TCP_ESTABLISHED) {
4666ed7257bSPatrick Caulfield 		lowcomms_write_space(sk);
4676ed7257bSPatrick Caulfield 	}
468ee44b4bcSMarcelo Ricardo Leitner }
4696ed7257bSPatrick Caulfield 
470391fbdc5SChristine Caulfield int dlm_lowcomms_connect_node(int nodeid)
471391fbdc5SChristine Caulfield {
472391fbdc5SChristine Caulfield 	struct connection *con;
473391fbdc5SChristine Caulfield 
474391fbdc5SChristine Caulfield 	if (nodeid == dlm_our_nodeid())
475391fbdc5SChristine Caulfield 		return 0;
476391fbdc5SChristine Caulfield 
477391fbdc5SChristine Caulfield 	con = nodeid2con(nodeid, GFP_NOFS);
478391fbdc5SChristine Caulfield 	if (!con)
479391fbdc5SChristine Caulfield 		return -ENOMEM;
480391fbdc5SChristine Caulfield 	lowcomms_connect_sock(con);
481391fbdc5SChristine Caulfield 	return 0;
482391fbdc5SChristine Caulfield }
483391fbdc5SChristine Caulfield 
484b3a5bbfdSBob Peterson static void lowcomms_error_report(struct sock *sk)
485b3a5bbfdSBob Peterson {
486b81171cbSBob Peterson 	struct connection *con;
487b3a5bbfdSBob Peterson 	struct sockaddr_storage saddr;
488b81171cbSBob Peterson 	void (*orig_report)(struct sock *) = NULL;
489b3a5bbfdSBob Peterson 
490b81171cbSBob Peterson 	read_lock_bh(&sk->sk_callback_lock);
491b81171cbSBob Peterson 	con = sock2con(sk);
492b81171cbSBob Peterson 	if (con == NULL)
493b81171cbSBob Peterson 		goto out;
494b81171cbSBob Peterson 
495cc661fc9SBob Peterson 	orig_report = listen_sock.sk_error_report;
4961a31833dSBob Peterson 	if (con->sock == NULL ||
4979b2c45d4SDenys Vlasenko 	    kernel_getpeername(con->sock, (struct sockaddr *)&saddr) < 0) {
498b3a5bbfdSBob Peterson 		printk_ratelimited(KERN_ERR "dlm: node %d: socket error "
499b3a5bbfdSBob Peterson 				   "sending to node %d, port %d, "
500b3a5bbfdSBob Peterson 				   "sk_err=%d/%d\n", dlm_our_nodeid(),
501b3a5bbfdSBob Peterson 				   con->nodeid, dlm_config.ci_tcp_port,
502b3a5bbfdSBob Peterson 				   sk->sk_err, sk->sk_err_soft);
503b3a5bbfdSBob Peterson 	} else if (saddr.ss_family == AF_INET) {
504b3a5bbfdSBob Peterson 		struct sockaddr_in *sin4 = (struct sockaddr_in *)&saddr;
505b3a5bbfdSBob Peterson 
506b3a5bbfdSBob Peterson 		printk_ratelimited(KERN_ERR "dlm: node %d: socket error "
507b3a5bbfdSBob Peterson 				   "sending to node %d at %pI4, port %d, "
508b3a5bbfdSBob Peterson 				   "sk_err=%d/%d\n", dlm_our_nodeid(),
509b3a5bbfdSBob Peterson 				   con->nodeid, &sin4->sin_addr.s_addr,
510b3a5bbfdSBob Peterson 				   dlm_config.ci_tcp_port, sk->sk_err,
511b3a5bbfdSBob Peterson 				   sk->sk_err_soft);
512b3a5bbfdSBob Peterson 	} else {
513b3a5bbfdSBob Peterson 		struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)&saddr;
514b3a5bbfdSBob Peterson 
515b3a5bbfdSBob Peterson 		printk_ratelimited(KERN_ERR "dlm: node %d: socket error "
516b3a5bbfdSBob Peterson 				   "sending to node %d at %u.%u.%u.%u, "
517b3a5bbfdSBob Peterson 				   "port %d, sk_err=%d/%d\n", dlm_our_nodeid(),
518b3a5bbfdSBob Peterson 				   con->nodeid, sin6->sin6_addr.s6_addr32[0],
519b3a5bbfdSBob Peterson 				   sin6->sin6_addr.s6_addr32[1],
520b3a5bbfdSBob Peterson 				   sin6->sin6_addr.s6_addr32[2],
521b3a5bbfdSBob Peterson 				   sin6->sin6_addr.s6_addr32[3],
522b3a5bbfdSBob Peterson 				   dlm_config.ci_tcp_port, sk->sk_err,
523b3a5bbfdSBob Peterson 				   sk->sk_err_soft);
524b3a5bbfdSBob Peterson 	}
525b81171cbSBob Peterson out:
526b81171cbSBob Peterson 	read_unlock_bh(&sk->sk_callback_lock);
527b81171cbSBob Peterson 	if (orig_report)
528b81171cbSBob Peterson 		orig_report(sk);
529b81171cbSBob Peterson }
530b81171cbSBob Peterson 
531b81171cbSBob Peterson /* Note: sk_callback_lock must be locked before calling this function. */
532cc661fc9SBob Peterson static void save_listen_callbacks(struct socket *sock)
533b81171cbSBob Peterson {
534cc661fc9SBob Peterson 	struct sock *sk = sock->sk;
535cc661fc9SBob Peterson 
536cc661fc9SBob Peterson 	listen_sock.sk_data_ready = sk->sk_data_ready;
537cc661fc9SBob Peterson 	listen_sock.sk_state_change = sk->sk_state_change;
538cc661fc9SBob Peterson 	listen_sock.sk_write_space = sk->sk_write_space;
539cc661fc9SBob Peterson 	listen_sock.sk_error_report = sk->sk_error_report;
540b81171cbSBob Peterson }
541b81171cbSBob Peterson 
542cc661fc9SBob Peterson static void restore_callbacks(struct socket *sock)
543b81171cbSBob Peterson {
544cc661fc9SBob Peterson 	struct sock *sk = sock->sk;
545cc661fc9SBob Peterson 
546b81171cbSBob Peterson 	write_lock_bh(&sk->sk_callback_lock);
547b81171cbSBob Peterson 	sk->sk_user_data = NULL;
548cc661fc9SBob Peterson 	sk->sk_data_ready = listen_sock.sk_data_ready;
549cc661fc9SBob Peterson 	sk->sk_state_change = listen_sock.sk_state_change;
550cc661fc9SBob Peterson 	sk->sk_write_space = listen_sock.sk_write_space;
551cc661fc9SBob Peterson 	sk->sk_error_report = listen_sock.sk_error_report;
552b81171cbSBob Peterson 	write_unlock_bh(&sk->sk_callback_lock);
553b3a5bbfdSBob Peterson }
554b3a5bbfdSBob Peterson 
5556ed7257bSPatrick Caulfield /* Make a socket active */
556988419a9Stsutomu.owa@toshiba.co.jp static void add_sock(struct socket *sock, struct connection *con)
5576ed7257bSPatrick Caulfield {
558b81171cbSBob Peterson 	struct sock *sk = sock->sk;
559b81171cbSBob Peterson 
560b81171cbSBob Peterson 	write_lock_bh(&sk->sk_callback_lock);
5616ed7257bSPatrick Caulfield 	con->sock = sock;
5626ed7257bSPatrick Caulfield 
563b81171cbSBob Peterson 	sk->sk_user_data = con;
5646ed7257bSPatrick Caulfield 	/* Install a data_ready callback */
565b81171cbSBob Peterson 	sk->sk_data_ready = lowcomms_data_ready;
566b81171cbSBob Peterson 	sk->sk_write_space = lowcomms_write_space;
567b81171cbSBob Peterson 	sk->sk_state_change = lowcomms_state_change;
568b81171cbSBob Peterson 	sk->sk_allocation = GFP_NOFS;
569b81171cbSBob Peterson 	sk->sk_error_report = lowcomms_error_report;
570b81171cbSBob Peterson 	write_unlock_bh(&sk->sk_callback_lock);
5716ed7257bSPatrick Caulfield }
5726ed7257bSPatrick Caulfield 
5736ed7257bSPatrick Caulfield /* Add the port number to an IPv6 or 4 sockaddr and return the address
5746ed7257bSPatrick Caulfield    length */
5756ed7257bSPatrick Caulfield static void make_sockaddr(struct sockaddr_storage *saddr, uint16_t port,
5766ed7257bSPatrick Caulfield 			  int *addr_len)
5776ed7257bSPatrick Caulfield {
5786ed7257bSPatrick Caulfield 	saddr->ss_family =  dlm_local_addr[0]->ss_family;
5796ed7257bSPatrick Caulfield 	if (saddr->ss_family == AF_INET) {
5806ed7257bSPatrick Caulfield 		struct sockaddr_in *in4_addr = (struct sockaddr_in *)saddr;
5816ed7257bSPatrick Caulfield 		in4_addr->sin_port = cpu_to_be16(port);
5826ed7257bSPatrick Caulfield 		*addr_len = sizeof(struct sockaddr_in);
5836ed7257bSPatrick Caulfield 		memset(&in4_addr->sin_zero, 0, sizeof(in4_addr->sin_zero));
5846ed7257bSPatrick Caulfield 	} else {
5856ed7257bSPatrick Caulfield 		struct sockaddr_in6 *in6_addr = (struct sockaddr_in6 *)saddr;
5866ed7257bSPatrick Caulfield 		in6_addr->sin6_port = cpu_to_be16(port);
5876ed7257bSPatrick Caulfield 		*addr_len = sizeof(struct sockaddr_in6);
5886ed7257bSPatrick Caulfield 	}
58901c8cab2SPatrick Caulfield 	memset((char *)saddr + *addr_len, 0, sizeof(struct sockaddr_storage) - *addr_len);
5906ed7257bSPatrick Caulfield }
5916ed7257bSPatrick Caulfield 
5926ed7257bSPatrick Caulfield /* Close a remote connection and tidy up */
5930d737a8cSMarcelo Ricardo Leitner static void close_connection(struct connection *con, bool and_other,
5940d737a8cSMarcelo Ricardo Leitner 			     bool tx, bool rx)
5956ed7257bSPatrick Caulfield {
596b2a66629Stsutomu.owa@toshiba.co.jp 	bool closing = test_and_set_bit(CF_CLOSING, &con->flags);
597b2a66629Stsutomu.owa@toshiba.co.jp 
5980aa18464Stsutomu.owa@toshiba.co.jp 	if (tx && !closing && cancel_work_sync(&con->swork)) {
5990d737a8cSMarcelo Ricardo Leitner 		log_print("canceled swork for node %d", con->nodeid);
6000aa18464Stsutomu.owa@toshiba.co.jp 		clear_bit(CF_WRITE_PENDING, &con->flags);
6010aa18464Stsutomu.owa@toshiba.co.jp 	}
6020aa18464Stsutomu.owa@toshiba.co.jp 	if (rx && !closing && cancel_work_sync(&con->rwork)) {
6030d737a8cSMarcelo Ricardo Leitner 		log_print("canceled rwork for node %d", con->nodeid);
6040aa18464Stsutomu.owa@toshiba.co.jp 		clear_bit(CF_READ_PENDING, &con->flags);
6050aa18464Stsutomu.owa@toshiba.co.jp 	}
6066ed7257bSPatrick Caulfield 
6070d737a8cSMarcelo Ricardo Leitner 	mutex_lock(&con->sock_mutex);
6086ed7257bSPatrick Caulfield 	if (con->sock) {
609cc661fc9SBob Peterson 		restore_callbacks(con->sock);
6106ed7257bSPatrick Caulfield 		sock_release(con->sock);
6116ed7257bSPatrick Caulfield 		con->sock = NULL;
6126ed7257bSPatrick Caulfield 	}
6136ed7257bSPatrick Caulfield 	if (con->othercon && and_other) {
6146ed7257bSPatrick Caulfield 		/* Will only re-enter once. */
6150d737a8cSMarcelo Ricardo Leitner 		close_connection(con->othercon, false, true, true);
6166ed7257bSPatrick Caulfield 	}
6176ed7257bSPatrick Caulfield 	if (con->rx_page) {
6186ed7257bSPatrick Caulfield 		__free_page(con->rx_page);
6196ed7257bSPatrick Caulfield 		con->rx_page = NULL;
6206ed7257bSPatrick Caulfield 	}
6219e5f2825SPatrick Caulfield 
6226ed7257bSPatrick Caulfield 	con->retries = 0;
6236ed7257bSPatrick Caulfield 	mutex_unlock(&con->sock_mutex);
624b2a66629Stsutomu.owa@toshiba.co.jp 	clear_bit(CF_CLOSING, &con->flags);
6256ed7257bSPatrick Caulfield }
6266ed7257bSPatrick Caulfield 
627055923bfSAlexander Aring static void shutdown_connection(struct connection *con)
628055923bfSAlexander Aring {
629055923bfSAlexander Aring 	int ret;
630055923bfSAlexander Aring 
631055923bfSAlexander Aring 	if (cancel_work_sync(&con->swork)) {
632055923bfSAlexander Aring 		log_print("canceled swork for node %d", con->nodeid);
633055923bfSAlexander Aring 		clear_bit(CF_WRITE_PENDING, &con->flags);
634055923bfSAlexander Aring 	}
635055923bfSAlexander Aring 
636055923bfSAlexander Aring 	mutex_lock(&con->sock_mutex);
637055923bfSAlexander Aring 	/* nothing to shutdown */
638055923bfSAlexander Aring 	if (!con->sock) {
639055923bfSAlexander Aring 		mutex_unlock(&con->sock_mutex);
640055923bfSAlexander Aring 		return;
641055923bfSAlexander Aring 	}
642055923bfSAlexander Aring 
643055923bfSAlexander Aring 	set_bit(CF_SHUTDOWN, &con->flags);
644055923bfSAlexander Aring 	ret = kernel_sock_shutdown(con->sock, SHUT_WR);
645055923bfSAlexander Aring 	mutex_unlock(&con->sock_mutex);
646055923bfSAlexander Aring 	if (ret) {
647055923bfSAlexander Aring 		log_print("Connection %p failed to shutdown: %d will force close",
648055923bfSAlexander Aring 			  con, ret);
649055923bfSAlexander Aring 		goto force_close;
650055923bfSAlexander Aring 	} else {
651055923bfSAlexander Aring 		ret = wait_event_timeout(con->shutdown_wait,
652055923bfSAlexander Aring 					 !test_bit(CF_SHUTDOWN, &con->flags),
653055923bfSAlexander Aring 					 DLM_SHUTDOWN_WAIT_TIMEOUT);
654055923bfSAlexander Aring 		if (ret == 0) {
655055923bfSAlexander Aring 			log_print("Connection %p shutdown timed out, will force close",
656055923bfSAlexander Aring 				  con);
657055923bfSAlexander Aring 			goto force_close;
658055923bfSAlexander Aring 		}
659055923bfSAlexander Aring 	}
660055923bfSAlexander Aring 
661055923bfSAlexander Aring 	return;
662055923bfSAlexander Aring 
663055923bfSAlexander Aring force_close:
664055923bfSAlexander Aring 	clear_bit(CF_SHUTDOWN, &con->flags);
665055923bfSAlexander Aring 	close_connection(con, false, true, true);
666055923bfSAlexander Aring }
667055923bfSAlexander Aring 
668055923bfSAlexander Aring static void dlm_tcp_shutdown(struct connection *con)
669055923bfSAlexander Aring {
670055923bfSAlexander Aring 	if (con->othercon)
671055923bfSAlexander Aring 		shutdown_connection(con->othercon);
672055923bfSAlexander Aring 	shutdown_connection(con);
673055923bfSAlexander Aring }
674055923bfSAlexander Aring 
6756ed7257bSPatrick Caulfield /* Data received from remote end */
6766ed7257bSPatrick Caulfield static int receive_from_sock(struct connection *con)
6776ed7257bSPatrick Caulfield {
6786ed7257bSPatrick Caulfield 	int ret = 0;
6796ed7257bSPatrick Caulfield 	struct msghdr msg = {};
6806ed7257bSPatrick Caulfield 	struct kvec iov[2];
6816ed7257bSPatrick Caulfield 	unsigned len;
6826ed7257bSPatrick Caulfield 	int r;
6836ed7257bSPatrick Caulfield 	int call_again_soon = 0;
6846ed7257bSPatrick Caulfield 	int nvec;
6856ed7257bSPatrick Caulfield 
6866ed7257bSPatrick Caulfield 	mutex_lock(&con->sock_mutex);
6876ed7257bSPatrick Caulfield 
6886ed7257bSPatrick Caulfield 	if (con->sock == NULL) {
6896ed7257bSPatrick Caulfield 		ret = -EAGAIN;
6906ed7257bSPatrick Caulfield 		goto out_close;
6916ed7257bSPatrick Caulfield 	}
692acee4e52SMarcelo Ricardo Leitner 	if (con->nodeid == 0) {
693acee4e52SMarcelo Ricardo Leitner 		ret = -EINVAL;
694acee4e52SMarcelo Ricardo Leitner 		goto out_close;
695acee4e52SMarcelo Ricardo Leitner 	}
6966ed7257bSPatrick Caulfield 
6976ed7257bSPatrick Caulfield 	if (con->rx_page == NULL) {
6986ed7257bSPatrick Caulfield 		/*
6996ed7257bSPatrick Caulfield 		 * This doesn't need to be atomic, but I think it should
7006ed7257bSPatrick Caulfield 		 * improve performance if it is.
7016ed7257bSPatrick Caulfield 		 */
7026ed7257bSPatrick Caulfield 		con->rx_page = alloc_page(GFP_ATOMIC);
7036ed7257bSPatrick Caulfield 		if (con->rx_page == NULL)
7046ed7257bSPatrick Caulfield 			goto out_resched;
70509cbfeafSKirill A. Shutemov 		cbuf_init(&con->cb, PAGE_SIZE);
7066ed7257bSPatrick Caulfield 	}
7076ed7257bSPatrick Caulfield 
7086ed7257bSPatrick Caulfield 	/*
7096ed7257bSPatrick Caulfield 	 * iov[0] is the bit of the circular buffer between the current end
7106ed7257bSPatrick Caulfield 	 * point (cb.base + cb.len) and the end of the buffer.
7116ed7257bSPatrick Caulfield 	 */
7126ed7257bSPatrick Caulfield 	iov[0].iov_len = con->cb.base - cbuf_data(&con->cb);
7136ed7257bSPatrick Caulfield 	iov[0].iov_base = page_address(con->rx_page) + cbuf_data(&con->cb);
7146ed7257bSPatrick Caulfield 	iov[1].iov_len = 0;
7156ed7257bSPatrick Caulfield 	nvec = 1;
7166ed7257bSPatrick Caulfield 
7176ed7257bSPatrick Caulfield 	/*
7186ed7257bSPatrick Caulfield 	 * iov[1] is the bit of the circular buffer between the start of the
7196ed7257bSPatrick Caulfield 	 * buffer and the start of the currently used section (cb.base)
7206ed7257bSPatrick Caulfield 	 */
7216ed7257bSPatrick Caulfield 	if (cbuf_data(&con->cb) >= con->cb.base) {
72209cbfeafSKirill A. Shutemov 		iov[0].iov_len = PAGE_SIZE - cbuf_data(&con->cb);
7236ed7257bSPatrick Caulfield 		iov[1].iov_len = con->cb.base;
7246ed7257bSPatrick Caulfield 		iov[1].iov_base = page_address(con->rx_page);
7256ed7257bSPatrick Caulfield 		nvec = 2;
7266ed7257bSPatrick Caulfield 	}
7276ed7257bSPatrick Caulfield 	len = iov[0].iov_len + iov[1].iov_len;
728aa563d7bSDavid Howells 	iov_iter_kvec(&msg.msg_iter, READ, iov, nvec, len);
7296ed7257bSPatrick Caulfield 
730c8c7840eSAl Viro 	r = ret = sock_recvmsg(con->sock, &msg, MSG_DONTWAIT | MSG_NOSIGNAL);
7316ed7257bSPatrick Caulfield 	if (ret <= 0)
7326ed7257bSPatrick Caulfield 		goto out_close;
733ee44b4bcSMarcelo Ricardo Leitner 	else if (ret == len)
734ee44b4bcSMarcelo Ricardo Leitner 		call_again_soon = 1;
7356ed7257bSPatrick Caulfield 
7366ed7257bSPatrick Caulfield 	cbuf_add(&con->cb, ret);
7376ed7257bSPatrick Caulfield 	ret = dlm_process_incoming_buffer(con->nodeid,
7386ed7257bSPatrick Caulfield 					  page_address(con->rx_page),
7396ed7257bSPatrick Caulfield 					  con->cb.base, con->cb.len,
74009cbfeafSKirill A. Shutemov 					  PAGE_SIZE);
7410ea47e4dSAlexander Aring 	if (ret < 0) {
7420ea47e4dSAlexander Aring 		log_print("lowcomms err %d: addr=%p, base=%u, len=%u, read=%d",
7430ea47e4dSAlexander Aring 			  ret, page_address(con->rx_page), con->cb.base,
744ee44b4bcSMarcelo Ricardo Leitner 			  con->cb.len, r);
7450ea47e4dSAlexander Aring 		cbuf_eat(&con->cb, r);
7460ea47e4dSAlexander Aring 	} else {
7476ed7257bSPatrick Caulfield 		cbuf_eat(&con->cb, ret);
7480ea47e4dSAlexander Aring 	}
7496ed7257bSPatrick Caulfield 
7506ed7257bSPatrick Caulfield 	if (cbuf_empty(&con->cb) && !call_again_soon) {
7516ed7257bSPatrick Caulfield 		__free_page(con->rx_page);
7526ed7257bSPatrick Caulfield 		con->rx_page = NULL;
7536ed7257bSPatrick Caulfield 	}
7546ed7257bSPatrick Caulfield 
7556ed7257bSPatrick Caulfield 	if (call_again_soon)
7566ed7257bSPatrick Caulfield 		goto out_resched;
7576ed7257bSPatrick Caulfield 	mutex_unlock(&con->sock_mutex);
7586ed7257bSPatrick Caulfield 	return 0;
7596ed7257bSPatrick Caulfield 
7606ed7257bSPatrick Caulfield out_resched:
7616ed7257bSPatrick Caulfield 	if (!test_and_set_bit(CF_READ_PENDING, &con->flags))
7626ed7257bSPatrick Caulfield 		queue_work(recv_workqueue, &con->rwork);
7636ed7257bSPatrick Caulfield 	mutex_unlock(&con->sock_mutex);
7646ed7257bSPatrick Caulfield 	return -EAGAIN;
7656ed7257bSPatrick Caulfield 
7666ed7257bSPatrick Caulfield out_close:
7676ed7257bSPatrick Caulfield 	mutex_unlock(&con->sock_mutex);
7689e5f2825SPatrick Caulfield 	if (ret != -EAGAIN) {
7696ed7257bSPatrick Caulfield 		/* Reconnect when there is something to send */
770055923bfSAlexander Aring 		close_connection(con, false, true, false);
771055923bfSAlexander Aring 		if (ret == 0) {
772055923bfSAlexander Aring 			log_print("connection %p got EOF from %d",
773055923bfSAlexander Aring 				  con, con->nodeid);
774055923bfSAlexander Aring 			/* handling for tcp shutdown */
775055923bfSAlexander Aring 			clear_bit(CF_SHUTDOWN, &con->flags);
776055923bfSAlexander Aring 			wake_up(&con->shutdown_wait);
777055923bfSAlexander Aring 			/* signal to breaking receive worker */
778055923bfSAlexander Aring 			ret = -1;
7796ed7257bSPatrick Caulfield 		}
780055923bfSAlexander Aring 	}
7816ed7257bSPatrick Caulfield 	return ret;
7826ed7257bSPatrick Caulfield }
7836ed7257bSPatrick Caulfield 
7846ed7257bSPatrick Caulfield /* Listening socket is busy, accept a connection */
7850774dc76SChristoph Hellwig static int accept_from_sock(struct connection *con)
7866ed7257bSPatrick Caulfield {
7876ed7257bSPatrick Caulfield 	int result;
7886ed7257bSPatrick Caulfield 	struct sockaddr_storage peeraddr;
7896ed7257bSPatrick Caulfield 	struct socket *newsock;
7906ed7257bSPatrick Caulfield 	int len;
7916ed7257bSPatrick Caulfield 	int nodeid;
7926ed7257bSPatrick Caulfield 	struct connection *newcon;
7936ed7257bSPatrick Caulfield 	struct connection *addcon;
7946ed7257bSPatrick Caulfield 
795513ef596SDavid Teigland 	mutex_lock(&connections_lock);
796513ef596SDavid Teigland 	if (!dlm_allow_conn) {
797513ef596SDavid Teigland 		mutex_unlock(&connections_lock);
798513ef596SDavid Teigland 		return -1;
799513ef596SDavid Teigland 	}
800513ef596SDavid Teigland 	mutex_unlock(&connections_lock);
801513ef596SDavid Teigland 
8026ed7257bSPatrick Caulfield 	mutex_lock_nested(&con->sock_mutex, 0);
8036ed7257bSPatrick Caulfield 
8043421fb15Stsutomu.owa@toshiba.co.jp 	if (!con->sock) {
8053421fb15Stsutomu.owa@toshiba.co.jp 		mutex_unlock(&con->sock_mutex);
8063421fb15Stsutomu.owa@toshiba.co.jp 		return -ENOTCONN;
8073421fb15Stsutomu.owa@toshiba.co.jp 	}
8086ed7257bSPatrick Caulfield 
8093421fb15Stsutomu.owa@toshiba.co.jp 	result = kernel_accept(con->sock, &newsock, O_NONBLOCK);
8106ed7257bSPatrick Caulfield 	if (result < 0)
8116ed7257bSPatrick Caulfield 		goto accept_err;
8126ed7257bSPatrick Caulfield 
8136ed7257bSPatrick Caulfield 	/* Get the connected socket's peer */
8146ed7257bSPatrick Caulfield 	memset(&peeraddr, 0, sizeof(peeraddr));
8159b2c45d4SDenys Vlasenko 	len = newsock->ops->getname(newsock, (struct sockaddr *)&peeraddr, 2);
8169b2c45d4SDenys Vlasenko 	if (len < 0) {
8176ed7257bSPatrick Caulfield 		result = -ECONNABORTED;
8186ed7257bSPatrick Caulfield 		goto accept_err;
8196ed7257bSPatrick Caulfield 	}
8206ed7257bSPatrick Caulfield 
8216ed7257bSPatrick Caulfield 	/* Get the new node's NODEID */
8226ed7257bSPatrick Caulfield 	make_sockaddr(&peeraddr, 0, &len);
82336b71a8bSDavid Teigland 	if (addr_to_nodeid(&peeraddr, &nodeid)) {
824bcaadf5cSMasatake YAMATO 		unsigned char *b=(unsigned char *)&peeraddr;
825617e82e1SDavid Teigland 		log_print("connect from non cluster node");
826bcaadf5cSMasatake YAMATO 		print_hex_dump_bytes("ss: ", DUMP_PREFIX_NONE,
827bcaadf5cSMasatake YAMATO 				     b, sizeof(struct sockaddr_storage));
8286ed7257bSPatrick Caulfield 		sock_release(newsock);
8296ed7257bSPatrick Caulfield 		mutex_unlock(&con->sock_mutex);
8306ed7257bSPatrick Caulfield 		return -1;
8316ed7257bSPatrick Caulfield 	}
8326ed7257bSPatrick Caulfield 
8336ed7257bSPatrick Caulfield 	log_print("got connection from %d", nodeid);
8346ed7257bSPatrick Caulfield 
8356ed7257bSPatrick Caulfield 	/*  Check to see if we already have a connection to this node. This
8366ed7257bSPatrick Caulfield 	 *  could happen if the two nodes initiate a connection at roughly
8376ed7257bSPatrick Caulfield 	 *  the same time and the connections cross on the wire.
8386ed7257bSPatrick Caulfield 	 *  In this case we store the incoming one in "othercon"
8396ed7257bSPatrick Caulfield 	 */
840748285ccSDavid Teigland 	newcon = nodeid2con(nodeid, GFP_NOFS);
8416ed7257bSPatrick Caulfield 	if (!newcon) {
8426ed7257bSPatrick Caulfield 		result = -ENOMEM;
8436ed7257bSPatrick Caulfield 		goto accept_err;
8446ed7257bSPatrick Caulfield 	}
8456ed7257bSPatrick Caulfield 	mutex_lock_nested(&newcon->sock_mutex, 1);
8466ed7257bSPatrick Caulfield 	if (newcon->sock) {
8476ed7257bSPatrick Caulfield 		struct connection *othercon = newcon->othercon;
8486ed7257bSPatrick Caulfield 
8496ed7257bSPatrick Caulfield 		if (!othercon) {
850748285ccSDavid Teigland 			othercon = kmem_cache_zalloc(con_cache, GFP_NOFS);
8516ed7257bSPatrick Caulfield 			if (!othercon) {
852617e82e1SDavid Teigland 				log_print("failed to allocate incoming socket");
8536ed7257bSPatrick Caulfield 				mutex_unlock(&newcon->sock_mutex);
8546ed7257bSPatrick Caulfield 				result = -ENOMEM;
8556ed7257bSPatrick Caulfield 				goto accept_err;
8566ed7257bSPatrick Caulfield 			}
8576ed7257bSPatrick Caulfield 			othercon->nodeid = nodeid;
8586ed7257bSPatrick Caulfield 			othercon->rx_action = receive_from_sock;
8596ed7257bSPatrick Caulfield 			mutex_init(&othercon->sock_mutex);
86026b41099Stsutomu.owa@toshiba.co.jp 			INIT_LIST_HEAD(&othercon->writequeue);
86126b41099Stsutomu.owa@toshiba.co.jp 			spin_lock_init(&othercon->writequeue_lock);
8626ed7257bSPatrick Caulfield 			INIT_WORK(&othercon->swork, process_send_sockets);
8636ed7257bSPatrick Caulfield 			INIT_WORK(&othercon->rwork, process_recv_sockets);
864055923bfSAlexander Aring 			init_waitqueue_head(&othercon->shutdown_wait);
8656ed7257bSPatrick Caulfield 			set_bit(CF_IS_OTHERCON, &othercon->flags);
866ba3ab3caSAlexander Aring 		} else {
867ba3ab3caSAlexander Aring 			/* close other sock con if we have something new */
868ba3ab3caSAlexander Aring 			close_connection(othercon, false, true, false);
86961d96be0SPatrick Caulfield 		}
870ba3ab3caSAlexander Aring 
871c7355827Stsutomu.owa@toshiba.co.jp 		mutex_lock_nested(&othercon->sock_mutex, 2);
8726ed7257bSPatrick Caulfield 		newcon->othercon = othercon;
873988419a9Stsutomu.owa@toshiba.co.jp 		add_sock(newsock, othercon);
8746ed7257bSPatrick Caulfield 		addcon = othercon;
875c7355827Stsutomu.owa@toshiba.co.jp 		mutex_unlock(&othercon->sock_mutex);
8766ed7257bSPatrick Caulfield 	}
8776ed7257bSPatrick Caulfield 	else {
8786ed7257bSPatrick Caulfield 		newcon->rx_action = receive_from_sock;
8793735b4b9SBob Peterson 		/* accept copies the sk after we've saved the callbacks, so we
8803735b4b9SBob Peterson 		   don't want to save them a second time or comm errors will
8813735b4b9SBob Peterson 		   result in calling sk_error_report recursively. */
882988419a9Stsutomu.owa@toshiba.co.jp 		add_sock(newsock, newcon);
8836ed7257bSPatrick Caulfield 		addcon = newcon;
8846ed7257bSPatrick Caulfield 	}
8856ed7257bSPatrick Caulfield 
8866ed7257bSPatrick Caulfield 	mutex_unlock(&newcon->sock_mutex);
8876ed7257bSPatrick Caulfield 
8886ed7257bSPatrick Caulfield 	/*
8896ed7257bSPatrick Caulfield 	 * Add it to the active queue in case we got data
89025985edcSLucas De Marchi 	 * between processing the accept adding the socket
8916ed7257bSPatrick Caulfield 	 * to the read_sockets list
8926ed7257bSPatrick Caulfield 	 */
8936ed7257bSPatrick Caulfield 	if (!test_and_set_bit(CF_READ_PENDING, &addcon->flags))
8946ed7257bSPatrick Caulfield 		queue_work(recv_workqueue, &addcon->rwork);
8956ed7257bSPatrick Caulfield 	mutex_unlock(&con->sock_mutex);
8966ed7257bSPatrick Caulfield 
8976ed7257bSPatrick Caulfield 	return 0;
8986ed7257bSPatrick Caulfield 
8996ed7257bSPatrick Caulfield accept_err:
9006ed7257bSPatrick Caulfield 	mutex_unlock(&con->sock_mutex);
9013421fb15Stsutomu.owa@toshiba.co.jp 	if (newsock)
9026ed7257bSPatrick Caulfield 		sock_release(newsock);
9036ed7257bSPatrick Caulfield 
9046ed7257bSPatrick Caulfield 	if (result != -EAGAIN)
905617e82e1SDavid Teigland 		log_print("error accepting connection from node: %d", result);
9066ed7257bSPatrick Caulfield 	return result;
9076ed7257bSPatrick Caulfield }
9086ed7257bSPatrick Caulfield 
9096ed7257bSPatrick Caulfield static void free_entry(struct writequeue_entry *e)
9106ed7257bSPatrick Caulfield {
9116ed7257bSPatrick Caulfield 	__free_page(e->page);
9126ed7257bSPatrick Caulfield 	kfree(e);
9136ed7257bSPatrick Caulfield }
9146ed7257bSPatrick Caulfield 
9155d689871SMike Christie /*
9165d689871SMike Christie  * writequeue_entry_complete - try to delete and free write queue entry
9175d689871SMike Christie  * @e: write queue entry to try to delete
9185d689871SMike Christie  * @completed: bytes completed
9195d689871SMike Christie  *
9205d689871SMike Christie  * writequeue_lock must be held.
9215d689871SMike Christie  */
9225d689871SMike Christie static void writequeue_entry_complete(struct writequeue_entry *e, int completed)
9235d689871SMike Christie {
9245d689871SMike Christie 	e->offset += completed;
9255d689871SMike Christie 	e->len -= completed;
9265d689871SMike Christie 
9275d689871SMike Christie 	if (e->len == 0 && e->users == 0) {
9285d689871SMike Christie 		list_del(&e->list);
9295d689871SMike Christie 		free_entry(e);
9305d689871SMike Christie 	}
9315d689871SMike Christie }
9325d689871SMike Christie 
933ee44b4bcSMarcelo Ricardo Leitner /*
934ee44b4bcSMarcelo Ricardo Leitner  * sctp_bind_addrs - bind a SCTP socket to all our addresses
935ee44b4bcSMarcelo Ricardo Leitner  */
936ee44b4bcSMarcelo Ricardo Leitner static int sctp_bind_addrs(struct connection *con, uint16_t port)
937ee44b4bcSMarcelo Ricardo Leitner {
938ee44b4bcSMarcelo Ricardo Leitner 	struct sockaddr_storage localaddr;
939c0425a42SChristoph Hellwig 	struct sockaddr *addr = (struct sockaddr *)&localaddr;
940ee44b4bcSMarcelo Ricardo Leitner 	int i, addr_len, result = 0;
941ee44b4bcSMarcelo Ricardo Leitner 
942ee44b4bcSMarcelo Ricardo Leitner 	for (i = 0; i < dlm_local_count; i++) {
943ee44b4bcSMarcelo Ricardo Leitner 		memcpy(&localaddr, dlm_local_addr[i], sizeof(localaddr));
944ee44b4bcSMarcelo Ricardo Leitner 		make_sockaddr(&localaddr, port, &addr_len);
945ee44b4bcSMarcelo Ricardo Leitner 
946ee44b4bcSMarcelo Ricardo Leitner 		if (!i)
947c0425a42SChristoph Hellwig 			result = kernel_bind(con->sock, addr, addr_len);
948ee44b4bcSMarcelo Ricardo Leitner 		else
949c0425a42SChristoph Hellwig 			result = sock_bind_add(con->sock->sk, addr, addr_len);
950ee44b4bcSMarcelo Ricardo Leitner 
951ee44b4bcSMarcelo Ricardo Leitner 		if (result < 0) {
952ee44b4bcSMarcelo Ricardo Leitner 			log_print("Can't bind to %d addr number %d, %d.\n",
953ee44b4bcSMarcelo Ricardo Leitner 				  port, i + 1, result);
954ee44b4bcSMarcelo Ricardo Leitner 			break;
955ee44b4bcSMarcelo Ricardo Leitner 		}
956ee44b4bcSMarcelo Ricardo Leitner 	}
957ee44b4bcSMarcelo Ricardo Leitner 	return result;
958ee44b4bcSMarcelo Ricardo Leitner }
959ee44b4bcSMarcelo Ricardo Leitner 
9606ed7257bSPatrick Caulfield /* Initiate an SCTP association.
9616ed7257bSPatrick Caulfield    This is a special case of send_to_sock() in that we don't yet have a
9626ed7257bSPatrick Caulfield    peeled-off socket for this association, so we use the listening socket
9636ed7257bSPatrick Caulfield    and add the primary IP address of the remote node.
9646ed7257bSPatrick Caulfield  */
965ee44b4bcSMarcelo Ricardo Leitner static void sctp_connect_to_sock(struct connection *con)
9666ed7257bSPatrick Caulfield {
967ee44b4bcSMarcelo Ricardo Leitner 	struct sockaddr_storage daddr;
968ee44b4bcSMarcelo Ricardo Leitner 	int result;
969ee44b4bcSMarcelo Ricardo Leitner 	int addr_len;
970ee44b4bcSMarcelo Ricardo Leitner 	struct socket *sock;
9719c9f168fSAlexander Aring 	unsigned int mark;
972ee44b4bcSMarcelo Ricardo Leitner 
973ee44b4bcSMarcelo Ricardo Leitner 	if (con->nodeid == 0) {
974ee44b4bcSMarcelo Ricardo Leitner 		log_print("attempt to connect sock 0 foiled");
975ee44b4bcSMarcelo Ricardo Leitner 		return;
976ee44b4bcSMarcelo Ricardo Leitner 	}
9776ed7257bSPatrick Caulfield 
9785d689871SMike Christie 	mutex_lock(&con->sock_mutex);
9796ed7257bSPatrick Caulfield 
980ee44b4bcSMarcelo Ricardo Leitner 	/* Some odd races can cause double-connects, ignore them */
981ee44b4bcSMarcelo Ricardo Leitner 	if (con->retries++ > MAX_CONNECT_RETRIES)
982ee44b4bcSMarcelo Ricardo Leitner 		goto out;
983ee44b4bcSMarcelo Ricardo Leitner 
984ee44b4bcSMarcelo Ricardo Leitner 	if (con->sock) {
985ee44b4bcSMarcelo Ricardo Leitner 		log_print("node %d already connected.", con->nodeid);
986ee44b4bcSMarcelo Ricardo Leitner 		goto out;
987ee44b4bcSMarcelo Ricardo Leitner 	}
988ee44b4bcSMarcelo Ricardo Leitner 
989ee44b4bcSMarcelo Ricardo Leitner 	memset(&daddr, 0, sizeof(daddr));
990ee44b4bcSMarcelo Ricardo Leitner 	result = nodeid_to_addr(con->nodeid, &daddr, NULL, true);
991ee44b4bcSMarcelo Ricardo Leitner 	if (result < 0) {
9926ed7257bSPatrick Caulfield 		log_print("no address for nodeid %d", con->nodeid);
993ee44b4bcSMarcelo Ricardo Leitner 		goto out;
99404bedd79SDavid Teigland 	}
9956ed7257bSPatrick Caulfield 
996ee44b4bcSMarcelo Ricardo Leitner 	/* Create a socket to communicate with */
997ee44b4bcSMarcelo Ricardo Leitner 	result = sock_create_kern(&init_net, dlm_local_addr[0]->ss_family,
998ee44b4bcSMarcelo Ricardo Leitner 				  SOCK_STREAM, IPPROTO_SCTP, &sock);
999ee44b4bcSMarcelo Ricardo Leitner 	if (result < 0)
1000ee44b4bcSMarcelo Ricardo Leitner 		goto socket_err;
10016ed7257bSPatrick Caulfield 
10029c9f168fSAlexander Aring 	/* set skb mark */
10039c9f168fSAlexander Aring 	result = dlm_comm_mark(con->nodeid, &mark);
10049c9f168fSAlexander Aring 	if (result < 0)
10059c9f168fSAlexander Aring 		goto bind_err;
10069c9f168fSAlexander Aring 
10079c9f168fSAlexander Aring 	sock_set_mark(sock->sk, mark);
10089c9f168fSAlexander Aring 
1009ee44b4bcSMarcelo Ricardo Leitner 	con->rx_action = receive_from_sock;
1010ee44b4bcSMarcelo Ricardo Leitner 	con->connect_action = sctp_connect_to_sock;
1011988419a9Stsutomu.owa@toshiba.co.jp 	add_sock(sock, con);
10126ed7257bSPatrick Caulfield 
1013ee44b4bcSMarcelo Ricardo Leitner 	/* Bind to all addresses. */
1014ee44b4bcSMarcelo Ricardo Leitner 	if (sctp_bind_addrs(con, 0))
1015ee44b4bcSMarcelo Ricardo Leitner 		goto bind_err;
101698e1b60eSMike Christie 
1017ee44b4bcSMarcelo Ricardo Leitner 	make_sockaddr(&daddr, dlm_config.ci_tcp_port, &addr_len);
10186ed7257bSPatrick Caulfield 
1019ee44b4bcSMarcelo Ricardo Leitner 	log_print("connecting to %d", con->nodeid);
10206ed7257bSPatrick Caulfield 
1021ee44b4bcSMarcelo Ricardo Leitner 	/* Turn off Nagle's algorithm */
102240ef92c6SChristoph Hellwig 	sctp_sock_set_nodelay(sock->sk);
1023ee44b4bcSMarcelo Ricardo Leitner 
1024f706d830SGang He 	/*
1025f706d830SGang He 	 * Make sock->ops->connect() function return in specified time,
1026f706d830SGang He 	 * since O_NONBLOCK argument in connect() function does not work here,
1027f706d830SGang He 	 * then, we should restore the default value of this attribute.
1028f706d830SGang He 	 */
102976ee0785SChristoph Hellwig 	sock_set_sndtimeo(sock->sk, 5);
1030ee44b4bcSMarcelo Ricardo Leitner 	result = sock->ops->connect(sock, (struct sockaddr *)&daddr, addr_len,
1031da3627c3SGang He 				   0);
103276ee0785SChristoph Hellwig 	sock_set_sndtimeo(sock->sk, 0);
1033f706d830SGang He 
1034ee44b4bcSMarcelo Ricardo Leitner 	if (result == -EINPROGRESS)
1035ee44b4bcSMarcelo Ricardo Leitner 		result = 0;
1036ee44b4bcSMarcelo Ricardo Leitner 	if (result == 0)
1037ee44b4bcSMarcelo Ricardo Leitner 		goto out;
1038ee44b4bcSMarcelo Ricardo Leitner 
1039ee44b4bcSMarcelo Ricardo Leitner bind_err:
1040ee44b4bcSMarcelo Ricardo Leitner 	con->sock = NULL;
1041ee44b4bcSMarcelo Ricardo Leitner 	sock_release(sock);
1042ee44b4bcSMarcelo Ricardo Leitner 
1043ee44b4bcSMarcelo Ricardo Leitner socket_err:
1044ee44b4bcSMarcelo Ricardo Leitner 	/*
1045ee44b4bcSMarcelo Ricardo Leitner 	 * Some errors are fatal and this list might need adjusting. For other
1046ee44b4bcSMarcelo Ricardo Leitner 	 * errors we try again until the max number of retries is reached.
1047ee44b4bcSMarcelo Ricardo Leitner 	 */
1048ee44b4bcSMarcelo Ricardo Leitner 	if (result != -EHOSTUNREACH &&
1049ee44b4bcSMarcelo Ricardo Leitner 	    result != -ENETUNREACH &&
1050ee44b4bcSMarcelo Ricardo Leitner 	    result != -ENETDOWN &&
1051ee44b4bcSMarcelo Ricardo Leitner 	    result != -EINVAL &&
1052ee44b4bcSMarcelo Ricardo Leitner 	    result != -EPROTONOSUPPORT) {
1053ee44b4bcSMarcelo Ricardo Leitner 		log_print("connect %d try %d error %d", con->nodeid,
1054ee44b4bcSMarcelo Ricardo Leitner 			  con->retries, result);
1055ee44b4bcSMarcelo Ricardo Leitner 		mutex_unlock(&con->sock_mutex);
1056ee44b4bcSMarcelo Ricardo Leitner 		msleep(1000);
1057ee44b4bcSMarcelo Ricardo Leitner 		lowcomms_connect_sock(con);
1058ee44b4bcSMarcelo Ricardo Leitner 		return;
10596ed7257bSPatrick Caulfield 	}
10605d689871SMike Christie 
1061ee44b4bcSMarcelo Ricardo Leitner out:
10625d689871SMike Christie 	mutex_unlock(&con->sock_mutex);
10636ed7257bSPatrick Caulfield }
10646ed7257bSPatrick Caulfield 
10656ed7257bSPatrick Caulfield /* Connect a new socket to its peer */
10666ed7257bSPatrick Caulfield static void tcp_connect_to_sock(struct connection *con)
10676ed7257bSPatrick Caulfield {
10686bd8fedaSLon Hohberger 	struct sockaddr_storage saddr, src_addr;
10696ed7257bSPatrick Caulfield 	int addr_len;
1070a89d63a1SCasey Dahlin 	struct socket *sock = NULL;
10719c9f168fSAlexander Aring 	unsigned int mark;
107236b71a8bSDavid Teigland 	int result;
10736ed7257bSPatrick Caulfield 
10746ed7257bSPatrick Caulfield 	if (con->nodeid == 0) {
10756ed7257bSPatrick Caulfield 		log_print("attempt to connect sock 0 foiled");
10766ed7257bSPatrick Caulfield 		return;
10776ed7257bSPatrick Caulfield 	}
10786ed7257bSPatrick Caulfield 
10796ed7257bSPatrick Caulfield 	mutex_lock(&con->sock_mutex);
10806ed7257bSPatrick Caulfield 	if (con->retries++ > MAX_CONNECT_RETRIES)
10816ed7257bSPatrick Caulfield 		goto out;
10826ed7257bSPatrick Caulfield 
10836ed7257bSPatrick Caulfield 	/* Some odd races can cause double-connects, ignore them */
108436b71a8bSDavid Teigland 	if (con->sock)
10856ed7257bSPatrick Caulfield 		goto out;
10866ed7257bSPatrick Caulfield 
10876ed7257bSPatrick Caulfield 	/* Create a socket to communicate with */
1088eeb1bd5cSEric W. Biederman 	result = sock_create_kern(&init_net, dlm_local_addr[0]->ss_family,
1089eeb1bd5cSEric W. Biederman 				  SOCK_STREAM, IPPROTO_TCP, &sock);
10906ed7257bSPatrick Caulfield 	if (result < 0)
10916ed7257bSPatrick Caulfield 		goto out_err;
10926ed7257bSPatrick Caulfield 
10939c9f168fSAlexander Aring 	/* set skb mark */
10949c9f168fSAlexander Aring 	result = dlm_comm_mark(con->nodeid, &mark);
10959c9f168fSAlexander Aring 	if (result < 0)
10969c9f168fSAlexander Aring 		goto out_err;
10979c9f168fSAlexander Aring 
10989c9f168fSAlexander Aring 	sock_set_mark(sock->sk, mark);
10999c9f168fSAlexander Aring 
11006ed7257bSPatrick Caulfield 	memset(&saddr, 0, sizeof(saddr));
110198e1b60eSMike Christie 	result = nodeid_to_addr(con->nodeid, &saddr, NULL, false);
110236b71a8bSDavid Teigland 	if (result < 0) {
110336b71a8bSDavid Teigland 		log_print("no address for nodeid %d", con->nodeid);
11046ed7257bSPatrick Caulfield 		goto out_err;
110536b71a8bSDavid Teigland 	}
11066ed7257bSPatrick Caulfield 
11076ed7257bSPatrick Caulfield 	con->rx_action = receive_from_sock;
11086ed7257bSPatrick Caulfield 	con->connect_action = tcp_connect_to_sock;
1109055923bfSAlexander Aring 	con->shutdown_action = dlm_tcp_shutdown;
1110988419a9Stsutomu.owa@toshiba.co.jp 	add_sock(sock, con);
11116ed7257bSPatrick Caulfield 
11126bd8fedaSLon Hohberger 	/* Bind to our cluster-known address connecting to avoid
11136bd8fedaSLon Hohberger 	   routing problems */
11146bd8fedaSLon Hohberger 	memcpy(&src_addr, dlm_local_addr[0], sizeof(src_addr));
11156bd8fedaSLon Hohberger 	make_sockaddr(&src_addr, 0, &addr_len);
11166bd8fedaSLon Hohberger 	result = sock->ops->bind(sock, (struct sockaddr *) &src_addr,
11176bd8fedaSLon Hohberger 				 addr_len);
11186bd8fedaSLon Hohberger 	if (result < 0) {
11196bd8fedaSLon Hohberger 		log_print("could not bind for connect: %d", result);
11206bd8fedaSLon Hohberger 		/* This *may* not indicate a critical error */
11216bd8fedaSLon Hohberger 	}
11226bd8fedaSLon Hohberger 
11236ed7257bSPatrick Caulfield 	make_sockaddr(&saddr, dlm_config.ci_tcp_port, &addr_len);
11246ed7257bSPatrick Caulfield 
11256ed7257bSPatrick Caulfield 	log_print("connecting to %d", con->nodeid);
1126cb2d45daSDavid Teigland 
1127cb2d45daSDavid Teigland 	/* Turn off Nagle's algorithm */
112812abc5eeSChristoph Hellwig 	tcp_sock_set_nodelay(sock->sk);
1129cb2d45daSDavid Teigland 
113036b71a8bSDavid Teigland 	result = sock->ops->connect(sock, (struct sockaddr *)&saddr, addr_len,
11316ed7257bSPatrick Caulfield 				   O_NONBLOCK);
11326ed7257bSPatrick Caulfield 	if (result == -EINPROGRESS)
11336ed7257bSPatrick Caulfield 		result = 0;
11346ed7257bSPatrick Caulfield 	if (result == 0)
11356ed7257bSPatrick Caulfield 		goto out;
11366ed7257bSPatrick Caulfield 
11376ed7257bSPatrick Caulfield out_err:
11386ed7257bSPatrick Caulfield 	if (con->sock) {
11396ed7257bSPatrick Caulfield 		sock_release(con->sock);
11406ed7257bSPatrick Caulfield 		con->sock = NULL;
1141a89d63a1SCasey Dahlin 	} else if (sock) {
1142a89d63a1SCasey Dahlin 		sock_release(sock);
11436ed7257bSPatrick Caulfield 	}
11446ed7257bSPatrick Caulfield 	/*
11456ed7257bSPatrick Caulfield 	 * Some errors are fatal and this list might need adjusting. For other
11466ed7257bSPatrick Caulfield 	 * errors we try again until the max number of retries is reached.
11476ed7257bSPatrick Caulfield 	 */
114836b71a8bSDavid Teigland 	if (result != -EHOSTUNREACH &&
114936b71a8bSDavid Teigland 	    result != -ENETUNREACH &&
115036b71a8bSDavid Teigland 	    result != -ENETDOWN &&
115136b71a8bSDavid Teigland 	    result != -EINVAL &&
115236b71a8bSDavid Teigland 	    result != -EPROTONOSUPPORT) {
115336b71a8bSDavid Teigland 		log_print("connect %d try %d error %d", con->nodeid,
115436b71a8bSDavid Teigland 			  con->retries, result);
115536b71a8bSDavid Teigland 		mutex_unlock(&con->sock_mutex);
115636b71a8bSDavid Teigland 		msleep(1000);
11576ed7257bSPatrick Caulfield 		lowcomms_connect_sock(con);
115836b71a8bSDavid Teigland 		return;
11596ed7257bSPatrick Caulfield 	}
11606ed7257bSPatrick Caulfield out:
11616ed7257bSPatrick Caulfield 	mutex_unlock(&con->sock_mutex);
11626ed7257bSPatrick Caulfield 	return;
11636ed7257bSPatrick Caulfield }
11646ed7257bSPatrick Caulfield 
11656ed7257bSPatrick Caulfield static struct socket *tcp_create_listen_sock(struct connection *con,
11666ed7257bSPatrick Caulfield 					     struct sockaddr_storage *saddr)
11676ed7257bSPatrick Caulfield {
11686ed7257bSPatrick Caulfield 	struct socket *sock = NULL;
11696ed7257bSPatrick Caulfield 	int result = 0;
11706ed7257bSPatrick Caulfield 	int addr_len;
11716ed7257bSPatrick Caulfield 
11726ed7257bSPatrick Caulfield 	if (dlm_local_addr[0]->ss_family == AF_INET)
11736ed7257bSPatrick Caulfield 		addr_len = sizeof(struct sockaddr_in);
11746ed7257bSPatrick Caulfield 	else
11756ed7257bSPatrick Caulfield 		addr_len = sizeof(struct sockaddr_in6);
11766ed7257bSPatrick Caulfield 
11776ed7257bSPatrick Caulfield 	/* Create a socket to communicate with */
1178eeb1bd5cSEric W. Biederman 	result = sock_create_kern(&init_net, dlm_local_addr[0]->ss_family,
1179eeb1bd5cSEric W. Biederman 				  SOCK_STREAM, IPPROTO_TCP, &sock);
11806ed7257bSPatrick Caulfield 	if (result < 0) {
1181617e82e1SDavid Teigland 		log_print("Can't create listening comms socket");
11826ed7257bSPatrick Caulfield 		goto create_out;
11836ed7257bSPatrick Caulfield 	}
11846ed7257bSPatrick Caulfield 
1185a5b7ab63SAlexander Aring 	sock_set_mark(sock->sk, dlm_config.ci_mark);
1186a5b7ab63SAlexander Aring 
1187cb2d45daSDavid Teigland 	/* Turn off Nagle's algorithm */
118812abc5eeSChristoph Hellwig 	tcp_sock_set_nodelay(sock->sk);
1189cb2d45daSDavid Teigland 
1190b58f0e8fSChristoph Hellwig 	sock_set_reuseaddr(sock->sk);
11916ed7257bSPatrick Caulfield 
119293eaadebStsutomu.owa@toshiba.co.jp 	write_lock_bh(&sock->sk->sk_callback_lock);
1193b81171cbSBob Peterson 	sock->sk->sk_user_data = con;
1194cc661fc9SBob Peterson 	save_listen_callbacks(sock);
11950774dc76SChristoph Hellwig 	con->rx_action = accept_from_sock;
11966ed7257bSPatrick Caulfield 	con->connect_action = tcp_connect_to_sock;
119793eaadebStsutomu.owa@toshiba.co.jp 	write_unlock_bh(&sock->sk->sk_callback_lock);
11986ed7257bSPatrick Caulfield 
11996ed7257bSPatrick Caulfield 	/* Bind to our port */
12006ed7257bSPatrick Caulfield 	make_sockaddr(saddr, dlm_config.ci_tcp_port, &addr_len);
12016ed7257bSPatrick Caulfield 	result = sock->ops->bind(sock, (struct sockaddr *) saddr, addr_len);
12026ed7257bSPatrick Caulfield 	if (result < 0) {
1203617e82e1SDavid Teigland 		log_print("Can't bind to port %d", dlm_config.ci_tcp_port);
12046ed7257bSPatrick Caulfield 		sock_release(sock);
12056ed7257bSPatrick Caulfield 		sock = NULL;
12066ed7257bSPatrick Caulfield 		con->sock = NULL;
12076ed7257bSPatrick Caulfield 		goto create_out;
12086ed7257bSPatrick Caulfield 	}
1209ce3d9544SChristoph Hellwig 	sock_set_keepalive(sock->sk);
12106ed7257bSPatrick Caulfield 
12116ed7257bSPatrick Caulfield 	result = sock->ops->listen(sock, 5);
12126ed7257bSPatrick Caulfield 	if (result < 0) {
1213617e82e1SDavid Teigland 		log_print("Can't listen on port %d", dlm_config.ci_tcp_port);
12146ed7257bSPatrick Caulfield 		sock_release(sock);
12156ed7257bSPatrick Caulfield 		sock = NULL;
12166ed7257bSPatrick Caulfield 		goto create_out;
12176ed7257bSPatrick Caulfield 	}
12186ed7257bSPatrick Caulfield 
12196ed7257bSPatrick Caulfield create_out:
12206ed7257bSPatrick Caulfield 	return sock;
12216ed7257bSPatrick Caulfield }
12226ed7257bSPatrick Caulfield 
12236ed7257bSPatrick Caulfield /* Get local addresses */
12246ed7257bSPatrick Caulfield static void init_local(void)
12256ed7257bSPatrick Caulfield {
12266ed7257bSPatrick Caulfield 	struct sockaddr_storage sas, *addr;
12276ed7257bSPatrick Caulfield 	int i;
12286ed7257bSPatrick Caulfield 
122930d3a237SPatrick Caulfield 	dlm_local_count = 0;
12301b189b88SDavid Teigland 	for (i = 0; i < DLM_MAX_ADDR_COUNT; i++) {
12316ed7257bSPatrick Caulfield 		if (dlm_our_addr(&sas, i))
12326ed7257bSPatrick Caulfield 			break;
12336ed7257bSPatrick Caulfield 
12345c93f56fSAmitoj Kaur Chawla 		addr = kmemdup(&sas, sizeof(*addr), GFP_NOFS);
12356ed7257bSPatrick Caulfield 		if (!addr)
12366ed7257bSPatrick Caulfield 			break;
12376ed7257bSPatrick Caulfield 		dlm_local_addr[dlm_local_count++] = addr;
12386ed7257bSPatrick Caulfield 	}
12396ed7257bSPatrick Caulfield }
12406ed7257bSPatrick Caulfield 
12416ed7257bSPatrick Caulfield /* Initialise SCTP socket and bind to all interfaces */
12426ed7257bSPatrick Caulfield static int sctp_listen_for_all(void)
12436ed7257bSPatrick Caulfield {
12446ed7257bSPatrick Caulfield 	struct socket *sock = NULL;
1245ee44b4bcSMarcelo Ricardo Leitner 	int result = -EINVAL;
1246573c24c4SDavid Teigland 	struct connection *con = nodeid2con(0, GFP_NOFS);
12476ed7257bSPatrick Caulfield 
12486ed7257bSPatrick Caulfield 	if (!con)
12496ed7257bSPatrick Caulfield 		return -ENOMEM;
12506ed7257bSPatrick Caulfield 
12516ed7257bSPatrick Caulfield 	log_print("Using SCTP for communications");
12526ed7257bSPatrick Caulfield 
1253eeb1bd5cSEric W. Biederman 	result = sock_create_kern(&init_net, dlm_local_addr[0]->ss_family,
1254ee44b4bcSMarcelo Ricardo Leitner 				  SOCK_STREAM, IPPROTO_SCTP, &sock);
12556ed7257bSPatrick Caulfield 	if (result < 0) {
12566ed7257bSPatrick Caulfield 		log_print("Can't create comms socket, check SCTP is loaded");
12576ed7257bSPatrick Caulfield 		goto out;
12586ed7257bSPatrick Caulfield 	}
12596ed7257bSPatrick Caulfield 
126026cfabf9SChristoph Hellwig 	sock_set_rcvbuf(sock->sk, NEEDED_RMEM);
1261a5b7ab63SAlexander Aring 	sock_set_mark(sock->sk, dlm_config.ci_mark);
126240ef92c6SChristoph Hellwig 	sctp_sock_set_nodelay(sock->sk);
126386e92ad2SMike Christie 
1264b81171cbSBob Peterson 	write_lock_bh(&sock->sk->sk_callback_lock);
12656ed7257bSPatrick Caulfield 	/* Init con struct */
12666ed7257bSPatrick Caulfield 	sock->sk->sk_user_data = con;
1267cc661fc9SBob Peterson 	save_listen_callbacks(sock);
12686ed7257bSPatrick Caulfield 	con->sock = sock;
12696ed7257bSPatrick Caulfield 	con->sock->sk->sk_data_ready = lowcomms_data_ready;
12700774dc76SChristoph Hellwig 	con->rx_action = accept_from_sock;
1271ee44b4bcSMarcelo Ricardo Leitner 	con->connect_action = sctp_connect_to_sock;
12726ed7257bSPatrick Caulfield 
1273b81171cbSBob Peterson 	write_unlock_bh(&sock->sk->sk_callback_lock);
1274b81171cbSBob Peterson 
1275ee44b4bcSMarcelo Ricardo Leitner 	/* Bind to all addresses. */
1276ee44b4bcSMarcelo Ricardo Leitner 	if (sctp_bind_addrs(con, dlm_config.ci_tcp_port))
12776ed7257bSPatrick Caulfield 		goto create_delsock;
12786ed7257bSPatrick Caulfield 
12796ed7257bSPatrick Caulfield 	result = sock->ops->listen(sock, 5);
12806ed7257bSPatrick Caulfield 	if (result < 0) {
12816ed7257bSPatrick Caulfield 		log_print("Can't set socket listening");
12826ed7257bSPatrick Caulfield 		goto create_delsock;
12836ed7257bSPatrick Caulfield 	}
12846ed7257bSPatrick Caulfield 
12856ed7257bSPatrick Caulfield 	return 0;
12866ed7257bSPatrick Caulfield 
12876ed7257bSPatrick Caulfield create_delsock:
12886ed7257bSPatrick Caulfield 	sock_release(sock);
12896ed7257bSPatrick Caulfield 	con->sock = NULL;
12906ed7257bSPatrick Caulfield out:
12916ed7257bSPatrick Caulfield 	return result;
12926ed7257bSPatrick Caulfield }
12936ed7257bSPatrick Caulfield 
12946ed7257bSPatrick Caulfield static int tcp_listen_for_all(void)
12956ed7257bSPatrick Caulfield {
12966ed7257bSPatrick Caulfield 	struct socket *sock = NULL;
1297573c24c4SDavid Teigland 	struct connection *con = nodeid2con(0, GFP_NOFS);
12986ed7257bSPatrick Caulfield 	int result = -EINVAL;
12996ed7257bSPatrick Caulfield 
13006ed7257bSPatrick Caulfield 	if (!con)
13016ed7257bSPatrick Caulfield 		return -ENOMEM;
13026ed7257bSPatrick Caulfield 
13036ed7257bSPatrick Caulfield 	/* We don't support multi-homed hosts */
13046ed7257bSPatrick Caulfield 	if (dlm_local_addr[1] != NULL) {
1305617e82e1SDavid Teigland 		log_print("TCP protocol can't handle multi-homed hosts, "
1306617e82e1SDavid Teigland 			  "try SCTP");
13076ed7257bSPatrick Caulfield 		return -EINVAL;
13086ed7257bSPatrick Caulfield 	}
13096ed7257bSPatrick Caulfield 
13106ed7257bSPatrick Caulfield 	log_print("Using TCP for communications");
13116ed7257bSPatrick Caulfield 
13126ed7257bSPatrick Caulfield 	sock = tcp_create_listen_sock(con, dlm_local_addr[0]);
13136ed7257bSPatrick Caulfield 	if (sock) {
1314988419a9Stsutomu.owa@toshiba.co.jp 		add_sock(sock, con);
13156ed7257bSPatrick Caulfield 		result = 0;
13166ed7257bSPatrick Caulfield 	}
13176ed7257bSPatrick Caulfield 	else {
13186ed7257bSPatrick Caulfield 		result = -EADDRINUSE;
13196ed7257bSPatrick Caulfield 	}
13206ed7257bSPatrick Caulfield 
13216ed7257bSPatrick Caulfield 	return result;
13226ed7257bSPatrick Caulfield }
13236ed7257bSPatrick Caulfield 
13246ed7257bSPatrick Caulfield 
13256ed7257bSPatrick Caulfield 
13266ed7257bSPatrick Caulfield static struct writequeue_entry *new_writequeue_entry(struct connection *con,
13276ed7257bSPatrick Caulfield 						     gfp_t allocation)
13286ed7257bSPatrick Caulfield {
13296ed7257bSPatrick Caulfield 	struct writequeue_entry *entry;
13306ed7257bSPatrick Caulfield 
13316ed7257bSPatrick Caulfield 	entry = kmalloc(sizeof(struct writequeue_entry), allocation);
13326ed7257bSPatrick Caulfield 	if (!entry)
13336ed7257bSPatrick Caulfield 		return NULL;
13346ed7257bSPatrick Caulfield 
13356ed7257bSPatrick Caulfield 	entry->page = alloc_page(allocation);
13366ed7257bSPatrick Caulfield 	if (!entry->page) {
13376ed7257bSPatrick Caulfield 		kfree(entry);
13386ed7257bSPatrick Caulfield 		return NULL;
13396ed7257bSPatrick Caulfield 	}
13406ed7257bSPatrick Caulfield 
13416ed7257bSPatrick Caulfield 	entry->offset = 0;
13426ed7257bSPatrick Caulfield 	entry->len = 0;
13436ed7257bSPatrick Caulfield 	entry->end = 0;
13446ed7257bSPatrick Caulfield 	entry->users = 0;
13456ed7257bSPatrick Caulfield 	entry->con = con;
13466ed7257bSPatrick Caulfield 
13476ed7257bSPatrick Caulfield 	return entry;
13486ed7257bSPatrick Caulfield }
13496ed7257bSPatrick Caulfield 
1350617e82e1SDavid Teigland void *dlm_lowcomms_get_buffer(int nodeid, int len, gfp_t allocation, char **ppc)
13516ed7257bSPatrick Caulfield {
13526ed7257bSPatrick Caulfield 	struct connection *con;
13536ed7257bSPatrick Caulfield 	struct writequeue_entry *e;
13546ed7257bSPatrick Caulfield 	int offset = 0;
13556ed7257bSPatrick Caulfield 
13566ed7257bSPatrick Caulfield 	con = nodeid2con(nodeid, allocation);
13576ed7257bSPatrick Caulfield 	if (!con)
13586ed7257bSPatrick Caulfield 		return NULL;
13596ed7257bSPatrick Caulfield 
13606ed7257bSPatrick Caulfield 	spin_lock(&con->writequeue_lock);
13616ed7257bSPatrick Caulfield 	e = list_entry(con->writequeue.prev, struct writequeue_entry, list);
13626ed7257bSPatrick Caulfield 	if ((&e->list == &con->writequeue) ||
136309cbfeafSKirill A. Shutemov 	    (PAGE_SIZE - e->end < len)) {
13646ed7257bSPatrick Caulfield 		e = NULL;
13656ed7257bSPatrick Caulfield 	} else {
13666ed7257bSPatrick Caulfield 		offset = e->end;
13676ed7257bSPatrick Caulfield 		e->end += len;
1368eeee2b5fSWei Yongjun 		e->users++;
13696ed7257bSPatrick Caulfield 	}
13706ed7257bSPatrick Caulfield 	spin_unlock(&con->writequeue_lock);
13716ed7257bSPatrick Caulfield 
13726ed7257bSPatrick Caulfield 	if (e) {
13736ed7257bSPatrick Caulfield 	got_one:
13746ed7257bSPatrick Caulfield 		*ppc = page_address(e->page) + offset;
13756ed7257bSPatrick Caulfield 		return e;
13766ed7257bSPatrick Caulfield 	}
13776ed7257bSPatrick Caulfield 
13786ed7257bSPatrick Caulfield 	e = new_writequeue_entry(con, allocation);
13796ed7257bSPatrick Caulfield 	if (e) {
13806ed7257bSPatrick Caulfield 		spin_lock(&con->writequeue_lock);
13816ed7257bSPatrick Caulfield 		offset = e->end;
13826ed7257bSPatrick Caulfield 		e->end += len;
1383eeee2b5fSWei Yongjun 		e->users++;
13846ed7257bSPatrick Caulfield 		list_add_tail(&e->list, &con->writequeue);
13856ed7257bSPatrick Caulfield 		spin_unlock(&con->writequeue_lock);
13866ed7257bSPatrick Caulfield 		goto got_one;
13876ed7257bSPatrick Caulfield 	}
13886ed7257bSPatrick Caulfield 	return NULL;
13896ed7257bSPatrick Caulfield }
13906ed7257bSPatrick Caulfield 
13916ed7257bSPatrick Caulfield void dlm_lowcomms_commit_buffer(void *mh)
13926ed7257bSPatrick Caulfield {
13936ed7257bSPatrick Caulfield 	struct writequeue_entry *e = (struct writequeue_entry *)mh;
13946ed7257bSPatrick Caulfield 	struct connection *con = e->con;
13956ed7257bSPatrick Caulfield 	int users;
13966ed7257bSPatrick Caulfield 
13976ed7257bSPatrick Caulfield 	spin_lock(&con->writequeue_lock);
13986ed7257bSPatrick Caulfield 	users = --e->users;
13996ed7257bSPatrick Caulfield 	if (users)
14006ed7257bSPatrick Caulfield 		goto out;
14016ed7257bSPatrick Caulfield 	e->len = e->end - e->offset;
14026ed7257bSPatrick Caulfield 	spin_unlock(&con->writequeue_lock);
14036ed7257bSPatrick Caulfield 
14046ed7257bSPatrick Caulfield 	queue_work(send_workqueue, &con->swork);
14056ed7257bSPatrick Caulfield 	return;
14066ed7257bSPatrick Caulfield 
14076ed7257bSPatrick Caulfield out:
14086ed7257bSPatrick Caulfield 	spin_unlock(&con->writequeue_lock);
14096ed7257bSPatrick Caulfield 	return;
14106ed7257bSPatrick Caulfield }
14116ed7257bSPatrick Caulfield 
14126ed7257bSPatrick Caulfield /* Send a message */
14136ed7257bSPatrick Caulfield static void send_to_sock(struct connection *con)
14146ed7257bSPatrick Caulfield {
14156ed7257bSPatrick Caulfield 	int ret = 0;
14166ed7257bSPatrick Caulfield 	const int msg_flags = MSG_DONTWAIT | MSG_NOSIGNAL;
14176ed7257bSPatrick Caulfield 	struct writequeue_entry *e;
14186ed7257bSPatrick Caulfield 	int len, offset;
1419f92c8dd7SBob Peterson 	int count = 0;
14206ed7257bSPatrick Caulfield 
14216ed7257bSPatrick Caulfield 	mutex_lock(&con->sock_mutex);
14226ed7257bSPatrick Caulfield 	if (con->sock == NULL)
14236ed7257bSPatrick Caulfield 		goto out_connect;
14246ed7257bSPatrick Caulfield 
14256ed7257bSPatrick Caulfield 	spin_lock(&con->writequeue_lock);
14266ed7257bSPatrick Caulfield 	for (;;) {
14276ed7257bSPatrick Caulfield 		e = list_entry(con->writequeue.next, struct writequeue_entry,
14286ed7257bSPatrick Caulfield 			       list);
14296ed7257bSPatrick Caulfield 		if ((struct list_head *) e == &con->writequeue)
14306ed7257bSPatrick Caulfield 			break;
14316ed7257bSPatrick Caulfield 
14326ed7257bSPatrick Caulfield 		len = e->len;
14336ed7257bSPatrick Caulfield 		offset = e->offset;
14346ed7257bSPatrick Caulfield 		BUG_ON(len == 0 && e->users == 0);
14356ed7257bSPatrick Caulfield 		spin_unlock(&con->writequeue_lock);
14366ed7257bSPatrick Caulfield 
14376ed7257bSPatrick Caulfield 		ret = 0;
14386ed7257bSPatrick Caulfield 		if (len) {
14391329e3f2SPaolo Bonzini 			ret = kernel_sendpage(con->sock, e->page, offset, len,
14406ed7257bSPatrick Caulfield 					      msg_flags);
1441d66f8277SPatrick Caulfield 			if (ret == -EAGAIN || ret == 0) {
1442b36930ddSDavid Miller 				if (ret == -EAGAIN &&
14439cd3e072SEric Dumazet 				    test_bit(SOCKWQ_ASYNC_NOSPACE, &con->sock->flags) &&
1444b36930ddSDavid Miller 				    !test_and_set_bit(CF_APP_LIMITED, &con->flags)) {
1445b36930ddSDavid Miller 					/* Notify TCP that we're limited by the
1446b36930ddSDavid Miller 					 * application window size.
1447b36930ddSDavid Miller 					 */
1448b36930ddSDavid Miller 					set_bit(SOCK_NOSPACE, &con->sock->flags);
1449b36930ddSDavid Miller 					con->sock->sk->sk_write_pending++;
1450b36930ddSDavid Miller 				}
1451d66f8277SPatrick Caulfield 				cond_resched();
14526ed7257bSPatrick Caulfield 				goto out;
14539c5bef58SYing Xue 			} else if (ret < 0)
14546ed7257bSPatrick Caulfield 				goto send_error;
1455d66f8277SPatrick Caulfield 		}
1456f92c8dd7SBob Peterson 
14576ed7257bSPatrick Caulfield 		/* Don't starve people filling buffers */
1458f92c8dd7SBob Peterson 		if (++count >= MAX_SEND_MSG_COUNT) {
14596ed7257bSPatrick Caulfield 			cond_resched();
1460f92c8dd7SBob Peterson 			count = 0;
1461f92c8dd7SBob Peterson 		}
14626ed7257bSPatrick Caulfield 
14636ed7257bSPatrick Caulfield 		spin_lock(&con->writequeue_lock);
14645d689871SMike Christie 		writequeue_entry_complete(e, ret);
14656ed7257bSPatrick Caulfield 	}
14666ed7257bSPatrick Caulfield 	spin_unlock(&con->writequeue_lock);
14676ed7257bSPatrick Caulfield out:
14686ed7257bSPatrick Caulfield 	mutex_unlock(&con->sock_mutex);
14696ed7257bSPatrick Caulfield 	return;
14706ed7257bSPatrick Caulfield 
14716ed7257bSPatrick Caulfield send_error:
14726ed7257bSPatrick Caulfield 	mutex_unlock(&con->sock_mutex);
1473ba3ab3caSAlexander Aring 	close_connection(con, false, false, true);
147401da24d3SBob Peterson 	/* Requeue the send work. When the work daemon runs again, it will try
147501da24d3SBob Peterson 	   a new connection, then call this function again. */
147601da24d3SBob Peterson 	queue_work(send_workqueue, &con->swork);
14776ed7257bSPatrick Caulfield 	return;
14786ed7257bSPatrick Caulfield 
14796ed7257bSPatrick Caulfield out_connect:
14806ed7257bSPatrick Caulfield 	mutex_unlock(&con->sock_mutex);
148101da24d3SBob Peterson 	queue_work(send_workqueue, &con->swork);
148201da24d3SBob Peterson 	cond_resched();
14836ed7257bSPatrick Caulfield }
14846ed7257bSPatrick Caulfield 
14856ed7257bSPatrick Caulfield static void clean_one_writequeue(struct connection *con)
14866ed7257bSPatrick Caulfield {
14875e9ccc37SChristine Caulfield 	struct writequeue_entry *e, *safe;
14886ed7257bSPatrick Caulfield 
14896ed7257bSPatrick Caulfield 	spin_lock(&con->writequeue_lock);
14905e9ccc37SChristine Caulfield 	list_for_each_entry_safe(e, safe, &con->writequeue, list) {
14916ed7257bSPatrick Caulfield 		list_del(&e->list);
14926ed7257bSPatrick Caulfield 		free_entry(e);
14936ed7257bSPatrick Caulfield 	}
14946ed7257bSPatrick Caulfield 	spin_unlock(&con->writequeue_lock);
14956ed7257bSPatrick Caulfield }
14966ed7257bSPatrick Caulfield 
14976ed7257bSPatrick Caulfield /* Called from recovery when it knows that a node has
14986ed7257bSPatrick Caulfield    left the cluster */
14996ed7257bSPatrick Caulfield int dlm_lowcomms_close(int nodeid)
15006ed7257bSPatrick Caulfield {
15016ed7257bSPatrick Caulfield 	struct connection *con;
150236b71a8bSDavid Teigland 	struct dlm_node_addr *na;
15036ed7257bSPatrick Caulfield 
15046ed7257bSPatrick Caulfield 	log_print("closing connection to node %d", nodeid);
15056ed7257bSPatrick Caulfield 	con = nodeid2con(nodeid, 0);
15066ed7257bSPatrick Caulfield 	if (con) {
1507063c4c99SLars Marowsky-Bree 		set_bit(CF_CLOSE, &con->flags);
15080d737a8cSMarcelo Ricardo Leitner 		close_connection(con, true, true, true);
15096ed7257bSPatrick Caulfield 		clean_one_writequeue(con);
15106ed7257bSPatrick Caulfield 	}
151136b71a8bSDavid Teigland 
151236b71a8bSDavid Teigland 	spin_lock(&dlm_node_addrs_spin);
151336b71a8bSDavid Teigland 	na = find_node_addr(nodeid);
151436b71a8bSDavid Teigland 	if (na) {
151536b71a8bSDavid Teigland 		list_del(&na->list);
151636b71a8bSDavid Teigland 		while (na->addr_count--)
151736b71a8bSDavid Teigland 			kfree(na->addr[na->addr_count]);
151836b71a8bSDavid Teigland 		kfree(na);
151936b71a8bSDavid Teigland 	}
152036b71a8bSDavid Teigland 	spin_unlock(&dlm_node_addrs_spin);
152136b71a8bSDavid Teigland 
15226ed7257bSPatrick Caulfield 	return 0;
15236ed7257bSPatrick Caulfield }
15246ed7257bSPatrick Caulfield 
15256ed7257bSPatrick Caulfield /* Receive workqueue function */
15266ed7257bSPatrick Caulfield static void process_recv_sockets(struct work_struct *work)
15276ed7257bSPatrick Caulfield {
15286ed7257bSPatrick Caulfield 	struct connection *con = container_of(work, struct connection, rwork);
15296ed7257bSPatrick Caulfield 	int err;
15306ed7257bSPatrick Caulfield 
15316ed7257bSPatrick Caulfield 	clear_bit(CF_READ_PENDING, &con->flags);
15326ed7257bSPatrick Caulfield 	do {
15336ed7257bSPatrick Caulfield 		err = con->rx_action(con);
15346ed7257bSPatrick Caulfield 	} while (!err);
15356ed7257bSPatrick Caulfield }
15366ed7257bSPatrick Caulfield 
15376ed7257bSPatrick Caulfield /* Send workqueue function */
15386ed7257bSPatrick Caulfield static void process_send_sockets(struct work_struct *work)
15396ed7257bSPatrick Caulfield {
15406ed7257bSPatrick Caulfield 	struct connection *con = container_of(work, struct connection, swork);
15416ed7257bSPatrick Caulfield 
15428a4abb08Stsutomu.owa@toshiba.co.jp 	clear_bit(CF_WRITE_PENDING, &con->flags);
154361d9102bSBob Peterson 	if (con->sock == NULL) /* not mutex protected so check it inside too */
15446ed7257bSPatrick Caulfield 		con->connect_action(con);
154501da24d3SBob Peterson 	if (!list_empty(&con->writequeue))
15466ed7257bSPatrick Caulfield 		send_to_sock(con);
15476ed7257bSPatrick Caulfield }
15486ed7257bSPatrick Caulfield 
15496ed7257bSPatrick Caulfield 
15506ed7257bSPatrick Caulfield /* Discard all entries on the write queues */
15516ed7257bSPatrick Caulfield static void clean_writequeues(void)
15526ed7257bSPatrick Caulfield {
15535e9ccc37SChristine Caulfield 	foreach_conn(clean_one_writequeue);
15546ed7257bSPatrick Caulfield }
15556ed7257bSPatrick Caulfield 
15566ed7257bSPatrick Caulfield static void work_stop(void)
15576ed7257bSPatrick Caulfield {
1558b355516fSDavid Windsor 	if (recv_workqueue)
15596ed7257bSPatrick Caulfield 		destroy_workqueue(recv_workqueue);
1560b355516fSDavid Windsor 	if (send_workqueue)
15616ed7257bSPatrick Caulfield 		destroy_workqueue(send_workqueue);
15626ed7257bSPatrick Caulfield }
15636ed7257bSPatrick Caulfield 
15646ed7257bSPatrick Caulfield static int work_start(void)
15656ed7257bSPatrick Caulfield {
1566e43f055aSDavid Teigland 	recv_workqueue = alloc_workqueue("dlm_recv",
1567e43f055aSDavid Teigland 					 WQ_UNBOUND | WQ_MEM_RECLAIM, 1);
1568b9d41052SNamhyung Kim 	if (!recv_workqueue) {
1569b9d41052SNamhyung Kim 		log_print("can't start dlm_recv");
1570b9d41052SNamhyung Kim 		return -ENOMEM;
15716ed7257bSPatrick Caulfield 	}
15726ed7257bSPatrick Caulfield 
1573e43f055aSDavid Teigland 	send_workqueue = alloc_workqueue("dlm_send",
1574e43f055aSDavid Teigland 					 WQ_UNBOUND | WQ_MEM_RECLAIM, 1);
1575b9d41052SNamhyung Kim 	if (!send_workqueue) {
1576b9d41052SNamhyung Kim 		log_print("can't start dlm_send");
15776ed7257bSPatrick Caulfield 		destroy_workqueue(recv_workqueue);
1578b9d41052SNamhyung Kim 		return -ENOMEM;
15796ed7257bSPatrick Caulfield 	}
15806ed7257bSPatrick Caulfield 
15816ed7257bSPatrick Caulfield 	return 0;
15826ed7257bSPatrick Caulfield }
15836ed7257bSPatrick Caulfield 
1584f0fb83cbStsutomu.owa@toshiba.co.jp static void _stop_conn(struct connection *con, bool and_other)
15856ed7257bSPatrick Caulfield {
1586f0fb83cbStsutomu.owa@toshiba.co.jp 	mutex_lock(&con->sock_mutex);
1587173a31feStsutomu.owa@toshiba.co.jp 	set_bit(CF_CLOSE, &con->flags);
1588f0fb83cbStsutomu.owa@toshiba.co.jp 	set_bit(CF_READ_PENDING, &con->flags);
15898a4abb08Stsutomu.owa@toshiba.co.jp 	set_bit(CF_WRITE_PENDING, &con->flags);
159093eaadebStsutomu.owa@toshiba.co.jp 	if (con->sock && con->sock->sk) {
159193eaadebStsutomu.owa@toshiba.co.jp 		write_lock_bh(&con->sock->sk->sk_callback_lock);
1592afb853fbSPatrick Caulfield 		con->sock->sk->sk_user_data = NULL;
159393eaadebStsutomu.owa@toshiba.co.jp 		write_unlock_bh(&con->sock->sk->sk_callback_lock);
159493eaadebStsutomu.owa@toshiba.co.jp 	}
1595f0fb83cbStsutomu.owa@toshiba.co.jp 	if (con->othercon && and_other)
1596f0fb83cbStsutomu.owa@toshiba.co.jp 		_stop_conn(con->othercon, false);
1597f0fb83cbStsutomu.owa@toshiba.co.jp 	mutex_unlock(&con->sock_mutex);
1598f0fb83cbStsutomu.owa@toshiba.co.jp }
1599f0fb83cbStsutomu.owa@toshiba.co.jp 
1600f0fb83cbStsutomu.owa@toshiba.co.jp static void stop_conn(struct connection *con)
1601f0fb83cbStsutomu.owa@toshiba.co.jp {
1602f0fb83cbStsutomu.owa@toshiba.co.jp 	_stop_conn(con, true);
1603afb853fbSPatrick Caulfield }
16045e9ccc37SChristine Caulfield 
1605055923bfSAlexander Aring static void shutdown_conn(struct connection *con)
1606055923bfSAlexander Aring {
1607055923bfSAlexander Aring 	if (con->shutdown_action)
1608055923bfSAlexander Aring 		con->shutdown_action(con);
1609055923bfSAlexander Aring }
1610055923bfSAlexander Aring 
16115e9ccc37SChristine Caulfield static void free_conn(struct connection *con)
16125e9ccc37SChristine Caulfield {
16130d737a8cSMarcelo Ricardo Leitner 	close_connection(con, true, true, true);
16145e9ccc37SChristine Caulfield 	if (con->othercon)
16155e9ccc37SChristine Caulfield 		kmem_cache_free(con_cache, con->othercon);
16165e9ccc37SChristine Caulfield 	hlist_del(&con->list);
16175e9ccc37SChristine Caulfield 	kmem_cache_free(con_cache, con);
16186ed7257bSPatrick Caulfield }
16195e9ccc37SChristine Caulfield 
1620f0fb83cbStsutomu.owa@toshiba.co.jp static void work_flush(void)
1621f0fb83cbStsutomu.owa@toshiba.co.jp {
1622f0fb83cbStsutomu.owa@toshiba.co.jp 	int ok;
1623f0fb83cbStsutomu.owa@toshiba.co.jp 	int i;
1624f0fb83cbStsutomu.owa@toshiba.co.jp 	struct hlist_node *n;
1625f0fb83cbStsutomu.owa@toshiba.co.jp 	struct connection *con;
1626f0fb83cbStsutomu.owa@toshiba.co.jp 
1627b355516fSDavid Windsor 	if (recv_workqueue)
1628f0fb83cbStsutomu.owa@toshiba.co.jp 		flush_workqueue(recv_workqueue);
1629b355516fSDavid Windsor 	if (send_workqueue)
1630f0fb83cbStsutomu.owa@toshiba.co.jp 		flush_workqueue(send_workqueue);
1631f0fb83cbStsutomu.owa@toshiba.co.jp 	do {
1632f0fb83cbStsutomu.owa@toshiba.co.jp 		ok = 1;
1633f0fb83cbStsutomu.owa@toshiba.co.jp 		foreach_conn(stop_conn);
1634b355516fSDavid Windsor 		if (recv_workqueue)
1635f0fb83cbStsutomu.owa@toshiba.co.jp 			flush_workqueue(recv_workqueue);
1636b355516fSDavid Windsor 		if (send_workqueue)
1637f0fb83cbStsutomu.owa@toshiba.co.jp 			flush_workqueue(send_workqueue);
1638f0fb83cbStsutomu.owa@toshiba.co.jp 		for (i = 0; i < CONN_HASH_SIZE && ok; i++) {
1639f0fb83cbStsutomu.owa@toshiba.co.jp 			hlist_for_each_entry_safe(con, n,
1640f0fb83cbStsutomu.owa@toshiba.co.jp 						  &connection_hash[i], list) {
1641f0fb83cbStsutomu.owa@toshiba.co.jp 				ok &= test_bit(CF_READ_PENDING, &con->flags);
16428a4abb08Stsutomu.owa@toshiba.co.jp 				ok &= test_bit(CF_WRITE_PENDING, &con->flags);
16438a4abb08Stsutomu.owa@toshiba.co.jp 				if (con->othercon) {
1644f0fb83cbStsutomu.owa@toshiba.co.jp 					ok &= test_bit(CF_READ_PENDING,
1645f0fb83cbStsutomu.owa@toshiba.co.jp 						       &con->othercon->flags);
16468a4abb08Stsutomu.owa@toshiba.co.jp 					ok &= test_bit(CF_WRITE_PENDING,
16478a4abb08Stsutomu.owa@toshiba.co.jp 						       &con->othercon->flags);
16488a4abb08Stsutomu.owa@toshiba.co.jp 				}
1649f0fb83cbStsutomu.owa@toshiba.co.jp 			}
1650f0fb83cbStsutomu.owa@toshiba.co.jp 		}
1651f0fb83cbStsutomu.owa@toshiba.co.jp 	} while (!ok);
1652f0fb83cbStsutomu.owa@toshiba.co.jp }
1653f0fb83cbStsutomu.owa@toshiba.co.jp 
16545e9ccc37SChristine Caulfield void dlm_lowcomms_stop(void)
16555e9ccc37SChristine Caulfield {
16565e9ccc37SChristine Caulfield 	/* Set all the flags to prevent any
16575e9ccc37SChristine Caulfield 	   socket activity.
16585e9ccc37SChristine Caulfield 	*/
16595e9ccc37SChristine Caulfield 	mutex_lock(&connections_lock);
1660513ef596SDavid Teigland 	dlm_allow_conn = 0;
1661f0fb83cbStsutomu.owa@toshiba.co.jp 	mutex_unlock(&connections_lock);
1662055923bfSAlexander Aring 	foreach_conn(shutdown_conn);
1663f0fb83cbStsutomu.owa@toshiba.co.jp 	work_flush();
16643a8db798SMarcelo Ricardo Leitner 	clean_writequeues();
16653a8db798SMarcelo Ricardo Leitner 	foreach_conn(free_conn);
16666ed7257bSPatrick Caulfield 	work_stop();
16676ed7257bSPatrick Caulfield 
16686ed7257bSPatrick Caulfield 	kmem_cache_destroy(con_cache);
16696ed7257bSPatrick Caulfield }
16706ed7257bSPatrick Caulfield 
16716ed7257bSPatrick Caulfield int dlm_lowcomms_start(void)
16726ed7257bSPatrick Caulfield {
16736ed7257bSPatrick Caulfield 	int error = -EINVAL;
16746ed7257bSPatrick Caulfield 	struct connection *con;
16755e9ccc37SChristine Caulfield 	int i;
16765e9ccc37SChristine Caulfield 
16775e9ccc37SChristine Caulfield 	for (i = 0; i < CONN_HASH_SIZE; i++)
16785e9ccc37SChristine Caulfield 		INIT_HLIST_HEAD(&connection_hash[i]);
16796ed7257bSPatrick Caulfield 
16806ed7257bSPatrick Caulfield 	init_local();
16816ed7257bSPatrick Caulfield 	if (!dlm_local_count) {
1682617e82e1SDavid Teigland 		error = -ENOTCONN;
16836ed7257bSPatrick Caulfield 		log_print("no local IP address has been set");
1684513ef596SDavid Teigland 		goto fail;
16856ed7257bSPatrick Caulfield 	}
16866ed7257bSPatrick Caulfield 
16876ed7257bSPatrick Caulfield 	error = -ENOMEM;
16886ed7257bSPatrick Caulfield 	con_cache = kmem_cache_create("dlm_conn", sizeof(struct connection),
16896ed7257bSPatrick Caulfield 				      __alignof__(struct connection), 0,
169020c2df83SPaul Mundt 				      NULL);
16916ed7257bSPatrick Caulfield 	if (!con_cache)
1692513ef596SDavid Teigland 		goto fail;
1693513ef596SDavid Teigland 
1694513ef596SDavid Teigland 	error = work_start();
1695513ef596SDavid Teigland 	if (error)
1696513ef596SDavid Teigland 		goto fail_destroy;
1697513ef596SDavid Teigland 
1698513ef596SDavid Teigland 	dlm_allow_conn = 1;
16996ed7257bSPatrick Caulfield 
17006ed7257bSPatrick Caulfield 	/* Start listening */
17016ed7257bSPatrick Caulfield 	if (dlm_config.ci_protocol == 0)
17026ed7257bSPatrick Caulfield 		error = tcp_listen_for_all();
17036ed7257bSPatrick Caulfield 	else
17046ed7257bSPatrick Caulfield 		error = sctp_listen_for_all();
17056ed7257bSPatrick Caulfield 	if (error)
17066ed7257bSPatrick Caulfield 		goto fail_unlisten;
17076ed7257bSPatrick Caulfield 
17086ed7257bSPatrick Caulfield 	return 0;
17096ed7257bSPatrick Caulfield 
17106ed7257bSPatrick Caulfield fail_unlisten:
1711513ef596SDavid Teigland 	dlm_allow_conn = 0;
17126ed7257bSPatrick Caulfield 	con = nodeid2con(0,0);
17136ed7257bSPatrick Caulfield 	if (con) {
17140d737a8cSMarcelo Ricardo Leitner 		close_connection(con, false, true, true);
17156ed7257bSPatrick Caulfield 		kmem_cache_free(con_cache, con);
17166ed7257bSPatrick Caulfield 	}
1717513ef596SDavid Teigland fail_destroy:
17186ed7257bSPatrick Caulfield 	kmem_cache_destroy(con_cache);
1719513ef596SDavid Teigland fail:
17206ed7257bSPatrick Caulfield 	return error;
17216ed7257bSPatrick Caulfield }
172236b71a8bSDavid Teigland 
172336b71a8bSDavid Teigland void dlm_lowcomms_exit(void)
172436b71a8bSDavid Teigland {
172536b71a8bSDavid Teigland 	struct dlm_node_addr *na, *safe;
172636b71a8bSDavid Teigland 
172736b71a8bSDavid Teigland 	spin_lock(&dlm_node_addrs_spin);
172836b71a8bSDavid Teigland 	list_for_each_entry_safe(na, safe, &dlm_node_addrs, list) {
172936b71a8bSDavid Teigland 		list_del(&na->list);
173036b71a8bSDavid Teigland 		while (na->addr_count--)
173136b71a8bSDavid Teigland 			kfree(na->addr[na->addr_count]);
173236b71a8bSDavid Teigland 		kfree(na);
173336b71a8bSDavid Teigland 	}
173436b71a8bSDavid Teigland 	spin_unlock(&dlm_node_addrs_spin);
173536b71a8bSDavid Teigland }
1736