xref: /openbmc/linux/fs/dlm/lowcomms.c (revision 51746163)
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 connection {
696ed7257bSPatrick Caulfield 	struct socket *sock;	/* NULL if not connected */
706ed7257bSPatrick Caulfield 	uint32_t nodeid;	/* So we know who we are in the list */
716ed7257bSPatrick Caulfield 	struct mutex sock_mutex;
726ed7257bSPatrick Caulfield 	unsigned long flags;
736ed7257bSPatrick Caulfield #define CF_READ_PENDING 1
748a4abb08Stsutomu.owa@toshiba.co.jp #define CF_WRITE_PENDING 2
756ed7257bSPatrick Caulfield #define CF_INIT_PENDING 4
766ed7257bSPatrick Caulfield #define CF_IS_OTHERCON 5
77063c4c99SLars Marowsky-Bree #define CF_CLOSE 6
78b36930ddSDavid Miller #define CF_APP_LIMITED 7
79b2a66629Stsutomu.owa@toshiba.co.jp #define CF_CLOSING 8
80055923bfSAlexander Aring #define CF_SHUTDOWN 9
8119633c7eSAlexander Aring #define CF_CONNECTED 10
826ed7257bSPatrick Caulfield 	struct list_head writequeue;  /* List of outgoing writequeue_entries */
836ed7257bSPatrick Caulfield 	spinlock_t writequeue_lock;
846ed7257bSPatrick Caulfield 	void (*connect_action) (struct connection *);	/* What to do to connect */
85055923bfSAlexander Aring 	void (*shutdown_action)(struct connection *con); /* What to do to shutdown */
866ed7257bSPatrick Caulfield 	int retries;
876ed7257bSPatrick Caulfield #define MAX_CONNECT_RETRIES 3
885e9ccc37SChristine Caulfield 	struct hlist_node list;
896ed7257bSPatrick Caulfield 	struct connection *othercon;
906ed7257bSPatrick Caulfield 	struct work_struct rwork; /* Receive workqueue */
916ed7257bSPatrick Caulfield 	struct work_struct swork; /* Send workqueue */
92055923bfSAlexander Aring 	wait_queue_head_t shutdown_wait; /* wait for graceful shutdown */
934798cbbfSAlexander Aring 	unsigned char *rx_buf;
944798cbbfSAlexander Aring 	int rx_buflen;
954798cbbfSAlexander Aring 	int rx_leftover;
96a47666ebSAlexander Aring 	struct rcu_head rcu;
976ed7257bSPatrick Caulfield };
986ed7257bSPatrick Caulfield #define sock2con(x) ((struct connection *)(x)->sk_user_data)
996ed7257bSPatrick Caulfield 
100d11ccd45SAlexander Aring struct listen_connection {
101d11ccd45SAlexander Aring 	struct socket *sock;
102d11ccd45SAlexander Aring 	struct work_struct rwork;
103d11ccd45SAlexander Aring };
104d11ccd45SAlexander Aring 
1056ed7257bSPatrick Caulfield /* An entry waiting to be sent */
1066ed7257bSPatrick Caulfield struct writequeue_entry {
1076ed7257bSPatrick Caulfield 	struct list_head list;
1086ed7257bSPatrick Caulfield 	struct page *page;
1096ed7257bSPatrick Caulfield 	int offset;
1106ed7257bSPatrick Caulfield 	int len;
1116ed7257bSPatrick Caulfield 	int end;
1126ed7257bSPatrick Caulfield 	int users;
1136ed7257bSPatrick Caulfield 	struct connection *con;
1146ed7257bSPatrick Caulfield };
1156ed7257bSPatrick Caulfield 
11636b71a8bSDavid Teigland struct dlm_node_addr {
11736b71a8bSDavid Teigland 	struct list_head list;
11836b71a8bSDavid Teigland 	int nodeid;
119e125fbebSAlexander Aring 	int mark;
12036b71a8bSDavid Teigland 	int addr_count;
12198e1b60eSMike Christie 	int curr_addr_index;
12236b71a8bSDavid Teigland 	struct sockaddr_storage *addr[DLM_MAX_ADDR_COUNT];
12336b71a8bSDavid Teigland };
12436b71a8bSDavid Teigland 
125cc661fc9SBob Peterson static struct listen_sock_callbacks {
126cc661fc9SBob Peterson 	void (*sk_error_report)(struct sock *);
127cc661fc9SBob Peterson 	void (*sk_data_ready)(struct sock *);
128cc661fc9SBob Peterson 	void (*sk_state_change)(struct sock *);
129cc661fc9SBob Peterson 	void (*sk_write_space)(struct sock *);
130cc661fc9SBob Peterson } listen_sock;
131cc661fc9SBob Peterson 
13236b71a8bSDavid Teigland static LIST_HEAD(dlm_node_addrs);
13336b71a8bSDavid Teigland static DEFINE_SPINLOCK(dlm_node_addrs_spin);
13436b71a8bSDavid Teigland 
135d11ccd45SAlexander Aring static struct listen_connection listen_con;
1366ed7257bSPatrick Caulfield static struct sockaddr_storage *dlm_local_addr[DLM_MAX_ADDR_COUNT];
1376ed7257bSPatrick Caulfield static int dlm_local_count;
138*51746163SAlexander Aring int dlm_allow_conn;
1396ed7257bSPatrick Caulfield 
1406ed7257bSPatrick Caulfield /* Work queues */
1416ed7257bSPatrick Caulfield static struct workqueue_struct *recv_workqueue;
1426ed7257bSPatrick Caulfield static struct workqueue_struct *send_workqueue;
1436ed7257bSPatrick Caulfield 
1445e9ccc37SChristine Caulfield static struct hlist_head connection_hash[CONN_HASH_SIZE];
145a47666ebSAlexander Aring static DEFINE_SPINLOCK(connections_lock);
146a47666ebSAlexander Aring DEFINE_STATIC_SRCU(connections_srcu);
1476ed7257bSPatrick Caulfield 
1486ed7257bSPatrick Caulfield static void process_recv_sockets(struct work_struct *work);
1496ed7257bSPatrick Caulfield static void process_send_sockets(struct work_struct *work);
1506ed7257bSPatrick Caulfield 
1510672c3c2SAlexander Aring static void sctp_connect_to_sock(struct connection *con);
1520672c3c2SAlexander Aring static void tcp_connect_to_sock(struct connection *con);
15342873c90SAlexander Aring static void dlm_tcp_shutdown(struct connection *con);
1545e9ccc37SChristine Caulfield 
1555e9ccc37SChristine Caulfield /* This is deliberately very simple because most clusters have simple
1565e9ccc37SChristine Caulfield    sequential nodeids, so we should be able to go straight to a connection
1575e9ccc37SChristine Caulfield    struct in the array */
1585e9ccc37SChristine Caulfield static inline int nodeid_hash(int nodeid)
1595e9ccc37SChristine Caulfield {
1605e9ccc37SChristine Caulfield 	return nodeid & (CONN_HASH_SIZE-1);
1615e9ccc37SChristine Caulfield }
1625e9ccc37SChristine Caulfield 
1635e9ccc37SChristine Caulfield static struct connection *__find_con(int nodeid)
1645e9ccc37SChristine Caulfield {
165a47666ebSAlexander Aring 	int r, idx;
1665e9ccc37SChristine Caulfield 	struct connection *con;
1675e9ccc37SChristine Caulfield 
1685e9ccc37SChristine Caulfield 	r = nodeid_hash(nodeid);
1695e9ccc37SChristine Caulfield 
170a47666ebSAlexander Aring 	idx = srcu_read_lock(&connections_srcu);
171a47666ebSAlexander Aring 	hlist_for_each_entry_rcu(con, &connection_hash[r], list) {
172a47666ebSAlexander Aring 		if (con->nodeid == nodeid) {
173a47666ebSAlexander Aring 			srcu_read_unlock(&connections_srcu, idx);
1745e9ccc37SChristine Caulfield 			return con;
1755e9ccc37SChristine Caulfield 		}
176a47666ebSAlexander Aring 	}
177a47666ebSAlexander Aring 	srcu_read_unlock(&connections_srcu, idx);
178a47666ebSAlexander Aring 
1795e9ccc37SChristine Caulfield 	return NULL;
1805e9ccc37SChristine Caulfield }
1815e9ccc37SChristine Caulfield 
1826cde210aSAlexander Aring static int dlm_con_init(struct connection *con, int nodeid)
1836ed7257bSPatrick Caulfield {
1844798cbbfSAlexander Aring 	con->rx_buflen = dlm_config.ci_buffer_size;
1854798cbbfSAlexander Aring 	con->rx_buf = kmalloc(con->rx_buflen, GFP_NOFS);
1866cde210aSAlexander Aring 	if (!con->rx_buf)
1876cde210aSAlexander Aring 		return -ENOMEM;
1884798cbbfSAlexander Aring 
1896ed7257bSPatrick Caulfield 	con->nodeid = nodeid;
1906ed7257bSPatrick Caulfield 	mutex_init(&con->sock_mutex);
1916ed7257bSPatrick Caulfield 	INIT_LIST_HEAD(&con->writequeue);
1926ed7257bSPatrick Caulfield 	spin_lock_init(&con->writequeue_lock);
1936ed7257bSPatrick Caulfield 	INIT_WORK(&con->swork, process_send_sockets);
1946ed7257bSPatrick Caulfield 	INIT_WORK(&con->rwork, process_recv_sockets);
195055923bfSAlexander Aring 	init_waitqueue_head(&con->shutdown_wait);
1966ed7257bSPatrick Caulfield 
19742873c90SAlexander Aring 	if (dlm_config.ci_protocol == 0) {
1980672c3c2SAlexander Aring 		con->connect_action = tcp_connect_to_sock;
19942873c90SAlexander Aring 		con->shutdown_action = dlm_tcp_shutdown;
20042873c90SAlexander Aring 	} else {
2010672c3c2SAlexander Aring 		con->connect_action = sctp_connect_to_sock;
20242873c90SAlexander Aring 	}
2036ed7257bSPatrick Caulfield 
2046cde210aSAlexander Aring 	return 0;
2056cde210aSAlexander Aring }
2066cde210aSAlexander Aring 
2076cde210aSAlexander Aring /*
2086cde210aSAlexander Aring  * If 'allocation' is zero then we don't attempt to create a new
2096cde210aSAlexander Aring  * connection structure for this node.
2106cde210aSAlexander Aring  */
2116cde210aSAlexander Aring static struct connection *nodeid2con(int nodeid, gfp_t alloc)
2126cde210aSAlexander Aring {
2136cde210aSAlexander Aring 	struct connection *con, *tmp;
2146cde210aSAlexander Aring 	int r, ret;
2156cde210aSAlexander Aring 
2166cde210aSAlexander Aring 	con = __find_con(nodeid);
2176cde210aSAlexander Aring 	if (con || !alloc)
2186cde210aSAlexander Aring 		return con;
2196cde210aSAlexander Aring 
2206cde210aSAlexander Aring 	con = kzalloc(sizeof(*con), alloc);
2216cde210aSAlexander Aring 	if (!con)
2226cde210aSAlexander Aring 		return NULL;
2236cde210aSAlexander Aring 
2246cde210aSAlexander Aring 	ret = dlm_con_init(con, nodeid);
2256cde210aSAlexander Aring 	if (ret) {
2266cde210aSAlexander Aring 		kfree(con);
2276cde210aSAlexander Aring 		return NULL;
2286cde210aSAlexander Aring 	}
2296cde210aSAlexander Aring 
230a47666ebSAlexander Aring 	r = nodeid_hash(nodeid);
231a47666ebSAlexander Aring 
232a47666ebSAlexander Aring 	spin_lock(&connections_lock);
2334f2b30fdSAlexander Aring 	/* Because multiple workqueues/threads calls this function it can
2344f2b30fdSAlexander Aring 	 * race on multiple cpu's. Instead of locking hot path __find_con()
2354f2b30fdSAlexander Aring 	 * we just check in rare cases of recently added nodes again
2364f2b30fdSAlexander Aring 	 * under protection of connections_lock. If this is the case we
2374f2b30fdSAlexander Aring 	 * abort our connection creation and return the existing connection.
2384f2b30fdSAlexander Aring 	 */
2394f2b30fdSAlexander Aring 	tmp = __find_con(nodeid);
2404f2b30fdSAlexander Aring 	if (tmp) {
2414f2b30fdSAlexander Aring 		spin_unlock(&connections_lock);
2424f2b30fdSAlexander Aring 		kfree(con->rx_buf);
2434f2b30fdSAlexander Aring 		kfree(con);
2444f2b30fdSAlexander Aring 		return tmp;
2454f2b30fdSAlexander Aring 	}
2464f2b30fdSAlexander Aring 
247a47666ebSAlexander Aring 	hlist_add_head_rcu(&con->list, &connection_hash[r]);
248a47666ebSAlexander Aring 	spin_unlock(&connections_lock);
249a47666ebSAlexander Aring 
2506ed7257bSPatrick Caulfield 	return con;
2516ed7257bSPatrick Caulfield }
2526ed7257bSPatrick Caulfield 
2535e9ccc37SChristine Caulfield /* Loop round all connections */
2545e9ccc37SChristine Caulfield static void foreach_conn(void (*conn_func)(struct connection *c))
2555e9ccc37SChristine Caulfield {
256a47666ebSAlexander Aring 	int i, idx;
2575e9ccc37SChristine Caulfield 	struct connection *con;
2585e9ccc37SChristine Caulfield 
259a47666ebSAlexander Aring 	idx = srcu_read_lock(&connections_srcu);
2605e9ccc37SChristine Caulfield 	for (i = 0; i < CONN_HASH_SIZE; i++) {
261a47666ebSAlexander Aring 		hlist_for_each_entry_rcu(con, &connection_hash[i], list)
2625e9ccc37SChristine Caulfield 			conn_func(con);
2635e9ccc37SChristine Caulfield 	}
264a47666ebSAlexander Aring 	srcu_read_unlock(&connections_srcu, idx);
2656ed7257bSPatrick Caulfield }
2666ed7257bSPatrick Caulfield 
26736b71a8bSDavid Teigland static struct dlm_node_addr *find_node_addr(int nodeid)
2686ed7257bSPatrick Caulfield {
26936b71a8bSDavid Teigland 	struct dlm_node_addr *na;
27036b71a8bSDavid Teigland 
27136b71a8bSDavid Teigland 	list_for_each_entry(na, &dlm_node_addrs, list) {
27236b71a8bSDavid Teigland 		if (na->nodeid == nodeid)
27336b71a8bSDavid Teigland 			return na;
27436b71a8bSDavid Teigland 	}
27536b71a8bSDavid Teigland 	return NULL;
27636b71a8bSDavid Teigland }
27736b71a8bSDavid Teigland 
27840c6b83eSAlexander Aring static int addr_compare(const struct sockaddr_storage *x,
27940c6b83eSAlexander Aring 			const struct sockaddr_storage *y)
28036b71a8bSDavid Teigland {
28136b71a8bSDavid Teigland 	switch (x->ss_family) {
28236b71a8bSDavid Teigland 	case AF_INET: {
28336b71a8bSDavid Teigland 		struct sockaddr_in *sinx = (struct sockaddr_in *)x;
28436b71a8bSDavid Teigland 		struct sockaddr_in *siny = (struct sockaddr_in *)y;
28536b71a8bSDavid Teigland 		if (sinx->sin_addr.s_addr != siny->sin_addr.s_addr)
28636b71a8bSDavid Teigland 			return 0;
28736b71a8bSDavid Teigland 		if (sinx->sin_port != siny->sin_port)
28836b71a8bSDavid Teigland 			return 0;
28936b71a8bSDavid Teigland 		break;
29036b71a8bSDavid Teigland 	}
29136b71a8bSDavid Teigland 	case AF_INET6: {
29236b71a8bSDavid Teigland 		struct sockaddr_in6 *sinx = (struct sockaddr_in6 *)x;
29336b71a8bSDavid Teigland 		struct sockaddr_in6 *siny = (struct sockaddr_in6 *)y;
29436b71a8bSDavid Teigland 		if (!ipv6_addr_equal(&sinx->sin6_addr, &siny->sin6_addr))
29536b71a8bSDavid Teigland 			return 0;
29636b71a8bSDavid Teigland 		if (sinx->sin6_port != siny->sin6_port)
29736b71a8bSDavid Teigland 			return 0;
29836b71a8bSDavid Teigland 		break;
29936b71a8bSDavid Teigland 	}
30036b71a8bSDavid Teigland 	default:
30136b71a8bSDavid Teigland 		return 0;
30236b71a8bSDavid Teigland 	}
30336b71a8bSDavid Teigland 	return 1;
30436b71a8bSDavid Teigland }
30536b71a8bSDavid Teigland 
30636b71a8bSDavid Teigland static int nodeid_to_addr(int nodeid, struct sockaddr_storage *sas_out,
307e125fbebSAlexander Aring 			  struct sockaddr *sa_out, bool try_new_addr,
308e125fbebSAlexander Aring 			  unsigned int *mark)
30936b71a8bSDavid Teigland {
31036b71a8bSDavid Teigland 	struct sockaddr_storage sas;
31136b71a8bSDavid Teigland 	struct dlm_node_addr *na;
3126ed7257bSPatrick Caulfield 
3136ed7257bSPatrick Caulfield 	if (!dlm_local_count)
3146ed7257bSPatrick Caulfield 		return -1;
3156ed7257bSPatrick Caulfield 
31636b71a8bSDavid Teigland 	spin_lock(&dlm_node_addrs_spin);
31736b71a8bSDavid Teigland 	na = find_node_addr(nodeid);
31898e1b60eSMike Christie 	if (na && na->addr_count) {
319ee44b4bcSMarcelo Ricardo Leitner 		memcpy(&sas, na->addr[na->curr_addr_index],
320ee44b4bcSMarcelo Ricardo Leitner 		       sizeof(struct sockaddr_storage));
321ee44b4bcSMarcelo Ricardo Leitner 
32298e1b60eSMike Christie 		if (try_new_addr) {
32398e1b60eSMike Christie 			na->curr_addr_index++;
32498e1b60eSMike Christie 			if (na->curr_addr_index == na->addr_count)
32598e1b60eSMike Christie 				na->curr_addr_index = 0;
32698e1b60eSMike Christie 		}
32798e1b60eSMike Christie 	}
32836b71a8bSDavid Teigland 	spin_unlock(&dlm_node_addrs_spin);
32936b71a8bSDavid Teigland 
33036b71a8bSDavid Teigland 	if (!na)
33136b71a8bSDavid Teigland 		return -EEXIST;
33236b71a8bSDavid Teigland 
33336b71a8bSDavid Teigland 	if (!na->addr_count)
33436b71a8bSDavid Teigland 		return -ENOENT;
33536b71a8bSDavid Teigland 
336e125fbebSAlexander Aring 	*mark = na->mark;
337e125fbebSAlexander Aring 
33836b71a8bSDavid Teigland 	if (sas_out)
33936b71a8bSDavid Teigland 		memcpy(sas_out, &sas, sizeof(struct sockaddr_storage));
34036b71a8bSDavid Teigland 
34136b71a8bSDavid Teigland 	if (!sa_out)
34236b71a8bSDavid Teigland 		return 0;
3436ed7257bSPatrick Caulfield 
3446ed7257bSPatrick Caulfield 	if (dlm_local_addr[0]->ss_family == AF_INET) {
34536b71a8bSDavid Teigland 		struct sockaddr_in *in4  = (struct sockaddr_in *) &sas;
34636b71a8bSDavid Teigland 		struct sockaddr_in *ret4 = (struct sockaddr_in *) sa_out;
3476ed7257bSPatrick Caulfield 		ret4->sin_addr.s_addr = in4->sin_addr.s_addr;
3486ed7257bSPatrick Caulfield 	} else {
34936b71a8bSDavid Teigland 		struct sockaddr_in6 *in6  = (struct sockaddr_in6 *) &sas;
35036b71a8bSDavid Teigland 		struct sockaddr_in6 *ret6 = (struct sockaddr_in6 *) sa_out;
3514e3fd7a0SAlexey Dobriyan 		ret6->sin6_addr = in6->sin6_addr;
3526ed7257bSPatrick Caulfield 	}
3536ed7257bSPatrick Caulfield 
3546ed7257bSPatrick Caulfield 	return 0;
3556ed7257bSPatrick Caulfield }
3566ed7257bSPatrick Caulfield 
357e125fbebSAlexander Aring static int addr_to_nodeid(struct sockaddr_storage *addr, int *nodeid,
358e125fbebSAlexander Aring 			  unsigned int *mark)
35936b71a8bSDavid Teigland {
36036b71a8bSDavid Teigland 	struct dlm_node_addr *na;
36136b71a8bSDavid Teigland 	int rv = -EEXIST;
36298e1b60eSMike Christie 	int addr_i;
36336b71a8bSDavid Teigland 
36436b71a8bSDavid Teigland 	spin_lock(&dlm_node_addrs_spin);
36536b71a8bSDavid Teigland 	list_for_each_entry(na, &dlm_node_addrs, list) {
36636b71a8bSDavid Teigland 		if (!na->addr_count)
36736b71a8bSDavid Teigland 			continue;
36836b71a8bSDavid Teigland 
36998e1b60eSMike Christie 		for (addr_i = 0; addr_i < na->addr_count; addr_i++) {
37098e1b60eSMike Christie 			if (addr_compare(na->addr[addr_i], addr)) {
37136b71a8bSDavid Teigland 				*nodeid = na->nodeid;
372e125fbebSAlexander Aring 				*mark = na->mark;
37336b71a8bSDavid Teigland 				rv = 0;
37498e1b60eSMike Christie 				goto unlock;
37536b71a8bSDavid Teigland 			}
37698e1b60eSMike Christie 		}
37798e1b60eSMike Christie 	}
37898e1b60eSMike Christie unlock:
37936b71a8bSDavid Teigland 	spin_unlock(&dlm_node_addrs_spin);
38036b71a8bSDavid Teigland 	return rv;
38136b71a8bSDavid Teigland }
38236b71a8bSDavid Teigland 
3834f19d071SAlexander Aring /* caller need to held dlm_node_addrs_spin lock */
3844f19d071SAlexander Aring static bool dlm_lowcomms_na_has_addr(const struct dlm_node_addr *na,
3854f19d071SAlexander Aring 				     const struct sockaddr_storage *addr)
3864f19d071SAlexander Aring {
3874f19d071SAlexander Aring 	int i;
3884f19d071SAlexander Aring 
3894f19d071SAlexander Aring 	for (i = 0; i < na->addr_count; i++) {
3904f19d071SAlexander Aring 		if (addr_compare(na->addr[i], addr))
3914f19d071SAlexander Aring 			return true;
3924f19d071SAlexander Aring 	}
3934f19d071SAlexander Aring 
3944f19d071SAlexander Aring 	return false;
3954f19d071SAlexander Aring }
3964f19d071SAlexander Aring 
39736b71a8bSDavid Teigland int dlm_lowcomms_addr(int nodeid, struct sockaddr_storage *addr, int len)
39836b71a8bSDavid Teigland {
39936b71a8bSDavid Teigland 	struct sockaddr_storage *new_addr;
40036b71a8bSDavid Teigland 	struct dlm_node_addr *new_node, *na;
4014f19d071SAlexander Aring 	bool ret;
40236b71a8bSDavid Teigland 
40336b71a8bSDavid Teigland 	new_node = kzalloc(sizeof(struct dlm_node_addr), GFP_NOFS);
40436b71a8bSDavid Teigland 	if (!new_node)
40536b71a8bSDavid Teigland 		return -ENOMEM;
40636b71a8bSDavid Teigland 
40736b71a8bSDavid Teigland 	new_addr = kzalloc(sizeof(struct sockaddr_storage), GFP_NOFS);
40836b71a8bSDavid Teigland 	if (!new_addr) {
40936b71a8bSDavid Teigland 		kfree(new_node);
41036b71a8bSDavid Teigland 		return -ENOMEM;
41136b71a8bSDavid Teigland 	}
41236b71a8bSDavid Teigland 
41336b71a8bSDavid Teigland 	memcpy(new_addr, addr, len);
41436b71a8bSDavid Teigland 
41536b71a8bSDavid Teigland 	spin_lock(&dlm_node_addrs_spin);
41636b71a8bSDavid Teigland 	na = find_node_addr(nodeid);
41736b71a8bSDavid Teigland 	if (!na) {
41836b71a8bSDavid Teigland 		new_node->nodeid = nodeid;
41936b71a8bSDavid Teigland 		new_node->addr[0] = new_addr;
42036b71a8bSDavid Teigland 		new_node->addr_count = 1;
421e125fbebSAlexander Aring 		new_node->mark = dlm_config.ci_mark;
42236b71a8bSDavid Teigland 		list_add(&new_node->list, &dlm_node_addrs);
42336b71a8bSDavid Teigland 		spin_unlock(&dlm_node_addrs_spin);
42436b71a8bSDavid Teigland 		return 0;
42536b71a8bSDavid Teigland 	}
42636b71a8bSDavid Teigland 
4274f19d071SAlexander Aring 	ret = dlm_lowcomms_na_has_addr(na, addr);
4284f19d071SAlexander Aring 	if (ret) {
4294f19d071SAlexander Aring 		spin_unlock(&dlm_node_addrs_spin);
4304f19d071SAlexander Aring 		kfree(new_addr);
4314f19d071SAlexander Aring 		kfree(new_node);
4324f19d071SAlexander Aring 		return -EEXIST;
4334f19d071SAlexander Aring 	}
4344f19d071SAlexander Aring 
43536b71a8bSDavid Teigland 	if (na->addr_count >= DLM_MAX_ADDR_COUNT) {
43636b71a8bSDavid Teigland 		spin_unlock(&dlm_node_addrs_spin);
43736b71a8bSDavid Teigland 		kfree(new_addr);
43836b71a8bSDavid Teigland 		kfree(new_node);
43936b71a8bSDavid Teigland 		return -ENOSPC;
44036b71a8bSDavid Teigland 	}
44136b71a8bSDavid Teigland 
44236b71a8bSDavid Teigland 	na->addr[na->addr_count++] = new_addr;
44336b71a8bSDavid Teigland 	spin_unlock(&dlm_node_addrs_spin);
44436b71a8bSDavid Teigland 	kfree(new_node);
44536b71a8bSDavid Teigland 	return 0;
44636b71a8bSDavid Teigland }
44736b71a8bSDavid Teigland 
4486ed7257bSPatrick Caulfield /* Data available on socket or listen socket received a connect */
449676d2369SDavid S. Miller static void lowcomms_data_ready(struct sock *sk)
4506ed7257bSPatrick Caulfield {
45193eaadebStsutomu.owa@toshiba.co.jp 	struct connection *con;
45293eaadebStsutomu.owa@toshiba.co.jp 
45393eaadebStsutomu.owa@toshiba.co.jp 	read_lock_bh(&sk->sk_callback_lock);
45493eaadebStsutomu.owa@toshiba.co.jp 	con = sock2con(sk);
455afb853fbSPatrick Caulfield 	if (con && !test_and_set_bit(CF_READ_PENDING, &con->flags))
4566ed7257bSPatrick Caulfield 		queue_work(recv_workqueue, &con->rwork);
45793eaadebStsutomu.owa@toshiba.co.jp 	read_unlock_bh(&sk->sk_callback_lock);
4586ed7257bSPatrick Caulfield }
4596ed7257bSPatrick Caulfield 
460d11ccd45SAlexander Aring static void lowcomms_listen_data_ready(struct sock *sk)
461d11ccd45SAlexander Aring {
462d11ccd45SAlexander Aring 	queue_work(recv_workqueue, &listen_con.rwork);
463d11ccd45SAlexander Aring }
464d11ccd45SAlexander Aring 
4656ed7257bSPatrick Caulfield static void lowcomms_write_space(struct sock *sk)
4666ed7257bSPatrick Caulfield {
46793eaadebStsutomu.owa@toshiba.co.jp 	struct connection *con;
4686ed7257bSPatrick Caulfield 
46993eaadebStsutomu.owa@toshiba.co.jp 	read_lock_bh(&sk->sk_callback_lock);
47093eaadebStsutomu.owa@toshiba.co.jp 	con = sock2con(sk);
471b36930ddSDavid Miller 	if (!con)
47293eaadebStsutomu.owa@toshiba.co.jp 		goto out;
473b36930ddSDavid Miller 
47419633c7eSAlexander Aring 	if (!test_and_set_bit(CF_CONNECTED, &con->flags)) {
47519633c7eSAlexander Aring 		log_print("successful connected to node %d", con->nodeid);
47619633c7eSAlexander Aring 		queue_work(send_workqueue, &con->swork);
47719633c7eSAlexander Aring 		goto out;
47819633c7eSAlexander Aring 	}
47919633c7eSAlexander Aring 
480b36930ddSDavid Miller 	clear_bit(SOCK_NOSPACE, &con->sock->flags);
481b36930ddSDavid Miller 
482b36930ddSDavid Miller 	if (test_and_clear_bit(CF_APP_LIMITED, &con->flags)) {
483b36930ddSDavid Miller 		con->sock->sk->sk_write_pending--;
4849cd3e072SEric Dumazet 		clear_bit(SOCKWQ_ASYNC_NOSPACE, &con->sock->flags);
485b36930ddSDavid Miller 	}
486b36930ddSDavid Miller 
4876ed7257bSPatrick Caulfield 	queue_work(send_workqueue, &con->swork);
48893eaadebStsutomu.owa@toshiba.co.jp out:
48993eaadebStsutomu.owa@toshiba.co.jp 	read_unlock_bh(&sk->sk_callback_lock);
4906ed7257bSPatrick Caulfield }
4916ed7257bSPatrick Caulfield 
4926ed7257bSPatrick Caulfield static inline void lowcomms_connect_sock(struct connection *con)
4936ed7257bSPatrick Caulfield {
494063c4c99SLars Marowsky-Bree 	if (test_bit(CF_CLOSE, &con->flags))
495063c4c99SLars Marowsky-Bree 		return;
4966ed7257bSPatrick Caulfield 	queue_work(send_workqueue, &con->swork);
49761d9102bSBob Peterson 	cond_resched();
4986ed7257bSPatrick Caulfield }
4996ed7257bSPatrick Caulfield 
5006ed7257bSPatrick Caulfield static void lowcomms_state_change(struct sock *sk)
5016ed7257bSPatrick Caulfield {
502ee44b4bcSMarcelo Ricardo Leitner 	/* SCTP layer is not calling sk_data_ready when the connection
503ee44b4bcSMarcelo Ricardo Leitner 	 * is done, so we catch the signal through here. Also, it
504ee44b4bcSMarcelo Ricardo Leitner 	 * doesn't switch socket state when entering shutdown, so we
505ee44b4bcSMarcelo Ricardo Leitner 	 * skip the write in that case.
506ee44b4bcSMarcelo Ricardo Leitner 	 */
507ee44b4bcSMarcelo Ricardo Leitner 	if (sk->sk_shutdown) {
508ee44b4bcSMarcelo Ricardo Leitner 		if (sk->sk_shutdown == RCV_SHUTDOWN)
509ee44b4bcSMarcelo Ricardo Leitner 			lowcomms_data_ready(sk);
510ee44b4bcSMarcelo Ricardo Leitner 	} else if (sk->sk_state == TCP_ESTABLISHED) {
5116ed7257bSPatrick Caulfield 		lowcomms_write_space(sk);
5126ed7257bSPatrick Caulfield 	}
513ee44b4bcSMarcelo Ricardo Leitner }
5146ed7257bSPatrick Caulfield 
515391fbdc5SChristine Caulfield int dlm_lowcomms_connect_node(int nodeid)
516391fbdc5SChristine Caulfield {
517391fbdc5SChristine Caulfield 	struct connection *con;
518391fbdc5SChristine Caulfield 
519391fbdc5SChristine Caulfield 	if (nodeid == dlm_our_nodeid())
520391fbdc5SChristine Caulfield 		return 0;
521391fbdc5SChristine Caulfield 
522391fbdc5SChristine Caulfield 	con = nodeid2con(nodeid, GFP_NOFS);
523391fbdc5SChristine Caulfield 	if (!con)
524391fbdc5SChristine Caulfield 		return -ENOMEM;
525391fbdc5SChristine Caulfield 	lowcomms_connect_sock(con);
526391fbdc5SChristine Caulfield 	return 0;
527391fbdc5SChristine Caulfield }
528391fbdc5SChristine Caulfield 
529e125fbebSAlexander Aring int dlm_lowcomms_nodes_set_mark(int nodeid, unsigned int mark)
530e125fbebSAlexander Aring {
531e125fbebSAlexander Aring 	struct dlm_node_addr *na;
532e125fbebSAlexander Aring 
533e125fbebSAlexander Aring 	spin_lock(&dlm_node_addrs_spin);
534e125fbebSAlexander Aring 	na = find_node_addr(nodeid);
535e125fbebSAlexander Aring 	if (!na) {
536e125fbebSAlexander Aring 		spin_unlock(&dlm_node_addrs_spin);
537e125fbebSAlexander Aring 		return -ENOENT;
538e125fbebSAlexander Aring 	}
539e125fbebSAlexander Aring 
540e125fbebSAlexander Aring 	na->mark = mark;
541e125fbebSAlexander Aring 	spin_unlock(&dlm_node_addrs_spin);
542e125fbebSAlexander Aring 
543e125fbebSAlexander Aring 	return 0;
544e125fbebSAlexander Aring }
545e125fbebSAlexander Aring 
546b3a5bbfdSBob Peterson static void lowcomms_error_report(struct sock *sk)
547b3a5bbfdSBob Peterson {
548b81171cbSBob Peterson 	struct connection *con;
549b3a5bbfdSBob Peterson 	struct sockaddr_storage saddr;
550b81171cbSBob Peterson 	void (*orig_report)(struct sock *) = NULL;
551b3a5bbfdSBob Peterson 
552b81171cbSBob Peterson 	read_lock_bh(&sk->sk_callback_lock);
553b81171cbSBob Peterson 	con = sock2con(sk);
554b81171cbSBob Peterson 	if (con == NULL)
555b81171cbSBob Peterson 		goto out;
556b81171cbSBob Peterson 
557cc661fc9SBob Peterson 	orig_report = listen_sock.sk_error_report;
5581a31833dSBob Peterson 	if (con->sock == NULL ||
5599b2c45d4SDenys Vlasenko 	    kernel_getpeername(con->sock, (struct sockaddr *)&saddr) < 0) {
560b3a5bbfdSBob Peterson 		printk_ratelimited(KERN_ERR "dlm: node %d: socket error "
561b3a5bbfdSBob Peterson 				   "sending to node %d, port %d, "
562b3a5bbfdSBob Peterson 				   "sk_err=%d/%d\n", dlm_our_nodeid(),
563b3a5bbfdSBob Peterson 				   con->nodeid, dlm_config.ci_tcp_port,
564b3a5bbfdSBob Peterson 				   sk->sk_err, sk->sk_err_soft);
565b3a5bbfdSBob Peterson 	} else if (saddr.ss_family == AF_INET) {
566b3a5bbfdSBob Peterson 		struct sockaddr_in *sin4 = (struct sockaddr_in *)&saddr;
567b3a5bbfdSBob Peterson 
568b3a5bbfdSBob Peterson 		printk_ratelimited(KERN_ERR "dlm: node %d: socket error "
569b3a5bbfdSBob Peterson 				   "sending to node %d at %pI4, port %d, "
570b3a5bbfdSBob Peterson 				   "sk_err=%d/%d\n", dlm_our_nodeid(),
571b3a5bbfdSBob Peterson 				   con->nodeid, &sin4->sin_addr.s_addr,
572b3a5bbfdSBob Peterson 				   dlm_config.ci_tcp_port, sk->sk_err,
573b3a5bbfdSBob Peterson 				   sk->sk_err_soft);
574b3a5bbfdSBob Peterson 	} else {
575b3a5bbfdSBob Peterson 		struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)&saddr;
576b3a5bbfdSBob Peterson 
577b3a5bbfdSBob Peterson 		printk_ratelimited(KERN_ERR "dlm: node %d: socket error "
578b3a5bbfdSBob Peterson 				   "sending to node %d at %u.%u.%u.%u, "
579b3a5bbfdSBob Peterson 				   "port %d, sk_err=%d/%d\n", dlm_our_nodeid(),
580b3a5bbfdSBob Peterson 				   con->nodeid, sin6->sin6_addr.s6_addr32[0],
581b3a5bbfdSBob Peterson 				   sin6->sin6_addr.s6_addr32[1],
582b3a5bbfdSBob Peterson 				   sin6->sin6_addr.s6_addr32[2],
583b3a5bbfdSBob Peterson 				   sin6->sin6_addr.s6_addr32[3],
584b3a5bbfdSBob Peterson 				   dlm_config.ci_tcp_port, sk->sk_err,
585b3a5bbfdSBob Peterson 				   sk->sk_err_soft);
586b3a5bbfdSBob Peterson 	}
587b81171cbSBob Peterson out:
588b81171cbSBob Peterson 	read_unlock_bh(&sk->sk_callback_lock);
589b81171cbSBob Peterson 	if (orig_report)
590b81171cbSBob Peterson 		orig_report(sk);
591b81171cbSBob Peterson }
592b81171cbSBob Peterson 
593b81171cbSBob Peterson /* Note: sk_callback_lock must be locked before calling this function. */
594cc661fc9SBob Peterson static void save_listen_callbacks(struct socket *sock)
595b81171cbSBob Peterson {
596cc661fc9SBob Peterson 	struct sock *sk = sock->sk;
597cc661fc9SBob Peterson 
598cc661fc9SBob Peterson 	listen_sock.sk_data_ready = sk->sk_data_ready;
599cc661fc9SBob Peterson 	listen_sock.sk_state_change = sk->sk_state_change;
600cc661fc9SBob Peterson 	listen_sock.sk_write_space = sk->sk_write_space;
601cc661fc9SBob Peterson 	listen_sock.sk_error_report = sk->sk_error_report;
602b81171cbSBob Peterson }
603b81171cbSBob Peterson 
604cc661fc9SBob Peterson static void restore_callbacks(struct socket *sock)
605b81171cbSBob Peterson {
606cc661fc9SBob Peterson 	struct sock *sk = sock->sk;
607cc661fc9SBob Peterson 
608b81171cbSBob Peterson 	write_lock_bh(&sk->sk_callback_lock);
609b81171cbSBob Peterson 	sk->sk_user_data = NULL;
610cc661fc9SBob Peterson 	sk->sk_data_ready = listen_sock.sk_data_ready;
611cc661fc9SBob Peterson 	sk->sk_state_change = listen_sock.sk_state_change;
612cc661fc9SBob Peterson 	sk->sk_write_space = listen_sock.sk_write_space;
613cc661fc9SBob Peterson 	sk->sk_error_report = listen_sock.sk_error_report;
614b81171cbSBob Peterson 	write_unlock_bh(&sk->sk_callback_lock);
615b3a5bbfdSBob Peterson }
616b3a5bbfdSBob Peterson 
617d11ccd45SAlexander Aring static void add_listen_sock(struct socket *sock, struct listen_connection *con)
618d11ccd45SAlexander Aring {
619d11ccd45SAlexander Aring 	struct sock *sk = sock->sk;
620d11ccd45SAlexander Aring 
621d11ccd45SAlexander Aring 	write_lock_bh(&sk->sk_callback_lock);
622d11ccd45SAlexander Aring 	save_listen_callbacks(sock);
623d11ccd45SAlexander Aring 	con->sock = sock;
624d11ccd45SAlexander Aring 
625d11ccd45SAlexander Aring 	sk->sk_user_data = con;
626d11ccd45SAlexander Aring 	sk->sk_allocation = GFP_NOFS;
627d11ccd45SAlexander Aring 	/* Install a data_ready callback */
628d11ccd45SAlexander Aring 	sk->sk_data_ready = lowcomms_listen_data_ready;
629d11ccd45SAlexander Aring 	write_unlock_bh(&sk->sk_callback_lock);
630d11ccd45SAlexander Aring }
631d11ccd45SAlexander Aring 
6326ed7257bSPatrick Caulfield /* Make a socket active */
633988419a9Stsutomu.owa@toshiba.co.jp static void add_sock(struct socket *sock, struct connection *con)
6346ed7257bSPatrick Caulfield {
635b81171cbSBob Peterson 	struct sock *sk = sock->sk;
636b81171cbSBob Peterson 
637b81171cbSBob Peterson 	write_lock_bh(&sk->sk_callback_lock);
6386ed7257bSPatrick Caulfield 	con->sock = sock;
6396ed7257bSPatrick Caulfield 
640b81171cbSBob Peterson 	sk->sk_user_data = con;
6416ed7257bSPatrick Caulfield 	/* Install a data_ready callback */
642b81171cbSBob Peterson 	sk->sk_data_ready = lowcomms_data_ready;
643b81171cbSBob Peterson 	sk->sk_write_space = lowcomms_write_space;
644b81171cbSBob Peterson 	sk->sk_state_change = lowcomms_state_change;
645b81171cbSBob Peterson 	sk->sk_allocation = GFP_NOFS;
646b81171cbSBob Peterson 	sk->sk_error_report = lowcomms_error_report;
647b81171cbSBob Peterson 	write_unlock_bh(&sk->sk_callback_lock);
6486ed7257bSPatrick Caulfield }
6496ed7257bSPatrick Caulfield 
6506ed7257bSPatrick Caulfield /* Add the port number to an IPv6 or 4 sockaddr and return the address
6516ed7257bSPatrick Caulfield    length */
6526ed7257bSPatrick Caulfield static void make_sockaddr(struct sockaddr_storage *saddr, uint16_t port,
6536ed7257bSPatrick Caulfield 			  int *addr_len)
6546ed7257bSPatrick Caulfield {
6556ed7257bSPatrick Caulfield 	saddr->ss_family =  dlm_local_addr[0]->ss_family;
6566ed7257bSPatrick Caulfield 	if (saddr->ss_family == AF_INET) {
6576ed7257bSPatrick Caulfield 		struct sockaddr_in *in4_addr = (struct sockaddr_in *)saddr;
6586ed7257bSPatrick Caulfield 		in4_addr->sin_port = cpu_to_be16(port);
6596ed7257bSPatrick Caulfield 		*addr_len = sizeof(struct sockaddr_in);
6606ed7257bSPatrick Caulfield 		memset(&in4_addr->sin_zero, 0, sizeof(in4_addr->sin_zero));
6616ed7257bSPatrick Caulfield 	} else {
6626ed7257bSPatrick Caulfield 		struct sockaddr_in6 *in6_addr = (struct sockaddr_in6 *)saddr;
6636ed7257bSPatrick Caulfield 		in6_addr->sin6_port = cpu_to_be16(port);
6646ed7257bSPatrick Caulfield 		*addr_len = sizeof(struct sockaddr_in6);
6656ed7257bSPatrick Caulfield 	}
66601c8cab2SPatrick Caulfield 	memset((char *)saddr + *addr_len, 0, sizeof(struct sockaddr_storage) - *addr_len);
6676ed7257bSPatrick Caulfield }
6686ed7257bSPatrick Caulfield 
669d11ccd45SAlexander Aring static void dlm_close_sock(struct socket **sock)
670d11ccd45SAlexander Aring {
671d11ccd45SAlexander Aring 	if (*sock) {
672d11ccd45SAlexander Aring 		restore_callbacks(*sock);
673d11ccd45SAlexander Aring 		sock_release(*sock);
674d11ccd45SAlexander Aring 		*sock = NULL;
675d11ccd45SAlexander Aring 	}
676d11ccd45SAlexander Aring }
677d11ccd45SAlexander Aring 
6786ed7257bSPatrick Caulfield /* Close a remote connection and tidy up */
6790d737a8cSMarcelo Ricardo Leitner static void close_connection(struct connection *con, bool and_other,
6800d737a8cSMarcelo Ricardo Leitner 			     bool tx, bool rx)
6816ed7257bSPatrick Caulfield {
682b2a66629Stsutomu.owa@toshiba.co.jp 	bool closing = test_and_set_bit(CF_CLOSING, &con->flags);
683b2a66629Stsutomu.owa@toshiba.co.jp 
6840aa18464Stsutomu.owa@toshiba.co.jp 	if (tx && !closing && cancel_work_sync(&con->swork)) {
6850d737a8cSMarcelo Ricardo Leitner 		log_print("canceled swork for node %d", con->nodeid);
6860aa18464Stsutomu.owa@toshiba.co.jp 		clear_bit(CF_WRITE_PENDING, &con->flags);
6870aa18464Stsutomu.owa@toshiba.co.jp 	}
6880aa18464Stsutomu.owa@toshiba.co.jp 	if (rx && !closing && cancel_work_sync(&con->rwork)) {
6890d737a8cSMarcelo Ricardo Leitner 		log_print("canceled rwork for node %d", con->nodeid);
6900aa18464Stsutomu.owa@toshiba.co.jp 		clear_bit(CF_READ_PENDING, &con->flags);
6910aa18464Stsutomu.owa@toshiba.co.jp 	}
6926ed7257bSPatrick Caulfield 
6930d737a8cSMarcelo Ricardo Leitner 	mutex_lock(&con->sock_mutex);
694d11ccd45SAlexander Aring 	dlm_close_sock(&con->sock);
695d11ccd45SAlexander Aring 
6966ed7257bSPatrick Caulfield 	if (con->othercon && and_other) {
6976ed7257bSPatrick Caulfield 		/* Will only re-enter once. */
6980d737a8cSMarcelo Ricardo Leitner 		close_connection(con->othercon, false, true, true);
6996ed7257bSPatrick Caulfield 	}
7009e5f2825SPatrick Caulfield 
7014798cbbfSAlexander Aring 	con->rx_leftover = 0;
7026ed7257bSPatrick Caulfield 	con->retries = 0;
70319633c7eSAlexander Aring 	clear_bit(CF_CONNECTED, &con->flags);
7046ed7257bSPatrick Caulfield 	mutex_unlock(&con->sock_mutex);
705b2a66629Stsutomu.owa@toshiba.co.jp 	clear_bit(CF_CLOSING, &con->flags);
7066ed7257bSPatrick Caulfield }
7076ed7257bSPatrick Caulfield 
708055923bfSAlexander Aring static void shutdown_connection(struct connection *con)
709055923bfSAlexander Aring {
710055923bfSAlexander Aring 	int ret;
711055923bfSAlexander Aring 
712055923bfSAlexander Aring 	if (cancel_work_sync(&con->swork)) {
713055923bfSAlexander Aring 		log_print("canceled swork for node %d", con->nodeid);
714055923bfSAlexander Aring 		clear_bit(CF_WRITE_PENDING, &con->flags);
715055923bfSAlexander Aring 	}
716055923bfSAlexander Aring 
717055923bfSAlexander Aring 	mutex_lock(&con->sock_mutex);
718055923bfSAlexander Aring 	/* nothing to shutdown */
719055923bfSAlexander Aring 	if (!con->sock) {
720055923bfSAlexander Aring 		mutex_unlock(&con->sock_mutex);
721055923bfSAlexander Aring 		return;
722055923bfSAlexander Aring 	}
723055923bfSAlexander Aring 
724055923bfSAlexander Aring 	set_bit(CF_SHUTDOWN, &con->flags);
725055923bfSAlexander Aring 	ret = kernel_sock_shutdown(con->sock, SHUT_WR);
726055923bfSAlexander Aring 	mutex_unlock(&con->sock_mutex);
727055923bfSAlexander Aring 	if (ret) {
728055923bfSAlexander Aring 		log_print("Connection %p failed to shutdown: %d will force close",
729055923bfSAlexander Aring 			  con, ret);
730055923bfSAlexander Aring 		goto force_close;
731055923bfSAlexander Aring 	} else {
732055923bfSAlexander Aring 		ret = wait_event_timeout(con->shutdown_wait,
733055923bfSAlexander Aring 					 !test_bit(CF_SHUTDOWN, &con->flags),
734055923bfSAlexander Aring 					 DLM_SHUTDOWN_WAIT_TIMEOUT);
735055923bfSAlexander Aring 		if (ret == 0) {
736055923bfSAlexander Aring 			log_print("Connection %p shutdown timed out, will force close",
737055923bfSAlexander Aring 				  con);
738055923bfSAlexander Aring 			goto force_close;
739055923bfSAlexander Aring 		}
740055923bfSAlexander Aring 	}
741055923bfSAlexander Aring 
742055923bfSAlexander Aring 	return;
743055923bfSAlexander Aring 
744055923bfSAlexander Aring force_close:
745055923bfSAlexander Aring 	clear_bit(CF_SHUTDOWN, &con->flags);
746055923bfSAlexander Aring 	close_connection(con, false, true, true);
747055923bfSAlexander Aring }
748055923bfSAlexander Aring 
749055923bfSAlexander Aring static void dlm_tcp_shutdown(struct connection *con)
750055923bfSAlexander Aring {
751055923bfSAlexander Aring 	if (con->othercon)
752055923bfSAlexander Aring 		shutdown_connection(con->othercon);
753055923bfSAlexander Aring 	shutdown_connection(con);
754055923bfSAlexander Aring }
755055923bfSAlexander Aring 
7564798cbbfSAlexander Aring static int con_realloc_receive_buf(struct connection *con, int newlen)
7574798cbbfSAlexander Aring {
7584798cbbfSAlexander Aring 	unsigned char *newbuf;
7594798cbbfSAlexander Aring 
7604798cbbfSAlexander Aring 	newbuf = kmalloc(newlen, GFP_NOFS);
7614798cbbfSAlexander Aring 	if (!newbuf)
7624798cbbfSAlexander Aring 		return -ENOMEM;
7634798cbbfSAlexander Aring 
7644798cbbfSAlexander Aring 	/* copy any leftover from last receive */
7654798cbbfSAlexander Aring 	if (con->rx_leftover)
7664798cbbfSAlexander Aring 		memmove(newbuf, con->rx_buf, con->rx_leftover);
7674798cbbfSAlexander Aring 
7684798cbbfSAlexander Aring 	/* swap to new buffer space */
7694798cbbfSAlexander Aring 	kfree(con->rx_buf);
7704798cbbfSAlexander Aring 	con->rx_buflen = newlen;
7714798cbbfSAlexander Aring 	con->rx_buf = newbuf;
7724798cbbfSAlexander Aring 
7734798cbbfSAlexander Aring 	return 0;
7744798cbbfSAlexander Aring }
7754798cbbfSAlexander Aring 
7766ed7257bSPatrick Caulfield /* Data received from remote end */
7776ed7257bSPatrick Caulfield static int receive_from_sock(struct connection *con)
7786ed7257bSPatrick Caulfield {
7796ed7257bSPatrick Caulfield 	int call_again_soon = 0;
7804798cbbfSAlexander Aring 	struct msghdr msg;
7814798cbbfSAlexander Aring 	struct kvec iov;
7824798cbbfSAlexander Aring 	int ret, buflen;
7836ed7257bSPatrick Caulfield 
7846ed7257bSPatrick Caulfield 	mutex_lock(&con->sock_mutex);
7856ed7257bSPatrick Caulfield 
7866ed7257bSPatrick Caulfield 	if (con->sock == NULL) {
7876ed7257bSPatrick Caulfield 		ret = -EAGAIN;
7886ed7257bSPatrick Caulfield 		goto out_close;
7896ed7257bSPatrick Caulfield 	}
7904798cbbfSAlexander Aring 
7914798cbbfSAlexander Aring 	/* realloc if we get new buffer size to read out */
7924798cbbfSAlexander Aring 	buflen = dlm_config.ci_buffer_size;
7934798cbbfSAlexander Aring 	if (con->rx_buflen != buflen && con->rx_leftover <= buflen) {
7944798cbbfSAlexander Aring 		ret = con_realloc_receive_buf(con, buflen);
7954798cbbfSAlexander Aring 		if (ret < 0)
7966ed7257bSPatrick Caulfield 			goto out_resched;
7976ed7257bSPatrick Caulfield 	}
7986ed7257bSPatrick Caulfield 
7994798cbbfSAlexander Aring 	/* calculate new buffer parameter regarding last receive and
8004798cbbfSAlexander Aring 	 * possible leftover bytes
8016ed7257bSPatrick Caulfield 	 */
8024798cbbfSAlexander Aring 	iov.iov_base = con->rx_buf + con->rx_leftover;
8034798cbbfSAlexander Aring 	iov.iov_len = con->rx_buflen - con->rx_leftover;
8046ed7257bSPatrick Caulfield 
8054798cbbfSAlexander Aring 	memset(&msg, 0, sizeof(msg));
8064798cbbfSAlexander Aring 	msg.msg_flags = MSG_DONTWAIT | MSG_NOSIGNAL;
8074798cbbfSAlexander Aring 	ret = kernel_recvmsg(con->sock, &msg, &iov, 1, iov.iov_len,
8084798cbbfSAlexander Aring 			     msg.msg_flags);
8096ed7257bSPatrick Caulfield 	if (ret <= 0)
8106ed7257bSPatrick Caulfield 		goto out_close;
8114798cbbfSAlexander Aring 	else if (ret == iov.iov_len)
812ee44b4bcSMarcelo Ricardo Leitner 		call_again_soon = 1;
8136ed7257bSPatrick Caulfield 
8144798cbbfSAlexander Aring 	/* new buflen according readed bytes and leftover from last receive */
8154798cbbfSAlexander Aring 	buflen = ret + con->rx_leftover;
8164798cbbfSAlexander Aring 	ret = dlm_process_incoming_buffer(con->nodeid, con->rx_buf, buflen);
8174798cbbfSAlexander Aring 	if (ret < 0)
8184798cbbfSAlexander Aring 		goto out_close;
8196ed7257bSPatrick Caulfield 
8204798cbbfSAlexander Aring 	/* calculate leftover bytes from process and put it into begin of
8214798cbbfSAlexander Aring 	 * the receive buffer, so next receive we have the full message
8224798cbbfSAlexander Aring 	 * at the start address of the receive buffer.
8234798cbbfSAlexander Aring 	 */
8244798cbbfSAlexander Aring 	con->rx_leftover = buflen - ret;
8254798cbbfSAlexander Aring 	if (con->rx_leftover) {
8264798cbbfSAlexander Aring 		memmove(con->rx_buf, con->rx_buf + ret,
8274798cbbfSAlexander Aring 			con->rx_leftover);
8284798cbbfSAlexander Aring 		call_again_soon = true;
8296ed7257bSPatrick Caulfield 	}
8306ed7257bSPatrick Caulfield 
8316ed7257bSPatrick Caulfield 	if (call_again_soon)
8326ed7257bSPatrick Caulfield 		goto out_resched;
8334798cbbfSAlexander Aring 
8346ed7257bSPatrick Caulfield 	mutex_unlock(&con->sock_mutex);
8356ed7257bSPatrick Caulfield 	return 0;
8366ed7257bSPatrick Caulfield 
8376ed7257bSPatrick Caulfield out_resched:
8386ed7257bSPatrick Caulfield 	if (!test_and_set_bit(CF_READ_PENDING, &con->flags))
8396ed7257bSPatrick Caulfield 		queue_work(recv_workqueue, &con->rwork);
8406ed7257bSPatrick Caulfield 	mutex_unlock(&con->sock_mutex);
8416ed7257bSPatrick Caulfield 	return -EAGAIN;
8426ed7257bSPatrick Caulfield 
8436ed7257bSPatrick Caulfield out_close:
8446ed7257bSPatrick Caulfield 	mutex_unlock(&con->sock_mutex);
8459e5f2825SPatrick Caulfield 	if (ret != -EAGAIN) {
8466ed7257bSPatrick Caulfield 		/* Reconnect when there is something to send */
847055923bfSAlexander Aring 		close_connection(con, false, true, false);
848055923bfSAlexander Aring 		if (ret == 0) {
849055923bfSAlexander Aring 			log_print("connection %p got EOF from %d",
850055923bfSAlexander Aring 				  con, con->nodeid);
851055923bfSAlexander Aring 			/* handling for tcp shutdown */
852055923bfSAlexander Aring 			clear_bit(CF_SHUTDOWN, &con->flags);
853055923bfSAlexander Aring 			wake_up(&con->shutdown_wait);
854055923bfSAlexander Aring 			/* signal to breaking receive worker */
855055923bfSAlexander Aring 			ret = -1;
8566ed7257bSPatrick Caulfield 		}
857055923bfSAlexander Aring 	}
8586ed7257bSPatrick Caulfield 	return ret;
8596ed7257bSPatrick Caulfield }
8606ed7257bSPatrick Caulfield 
8616ed7257bSPatrick Caulfield /* Listening socket is busy, accept a connection */
862d11ccd45SAlexander Aring static int accept_from_sock(struct listen_connection *con)
8636ed7257bSPatrick Caulfield {
8646ed7257bSPatrick Caulfield 	int result;
8656ed7257bSPatrick Caulfield 	struct sockaddr_storage peeraddr;
8666ed7257bSPatrick Caulfield 	struct socket *newsock;
8676ed7257bSPatrick Caulfield 	int len;
8686ed7257bSPatrick Caulfield 	int nodeid;
8696ed7257bSPatrick Caulfield 	struct connection *newcon;
8706ed7257bSPatrick Caulfield 	struct connection *addcon;
8713f78cd7dSAlexander Aring 	unsigned int mark;
8726ed7257bSPatrick Caulfield 
873513ef596SDavid Teigland 	if (!dlm_allow_conn) {
874513ef596SDavid Teigland 		return -1;
875513ef596SDavid Teigland 	}
876513ef596SDavid Teigland 
877d11ccd45SAlexander Aring 	if (!con->sock)
8783421fb15Stsutomu.owa@toshiba.co.jp 		return -ENOTCONN;
8796ed7257bSPatrick Caulfield 
8803421fb15Stsutomu.owa@toshiba.co.jp 	result = kernel_accept(con->sock, &newsock, O_NONBLOCK);
8816ed7257bSPatrick Caulfield 	if (result < 0)
8826ed7257bSPatrick Caulfield 		goto accept_err;
8836ed7257bSPatrick Caulfield 
8846ed7257bSPatrick Caulfield 	/* Get the connected socket's peer */
8856ed7257bSPatrick Caulfield 	memset(&peeraddr, 0, sizeof(peeraddr));
8869b2c45d4SDenys Vlasenko 	len = newsock->ops->getname(newsock, (struct sockaddr *)&peeraddr, 2);
8879b2c45d4SDenys Vlasenko 	if (len < 0) {
8886ed7257bSPatrick Caulfield 		result = -ECONNABORTED;
8896ed7257bSPatrick Caulfield 		goto accept_err;
8906ed7257bSPatrick Caulfield 	}
8916ed7257bSPatrick Caulfield 
8926ed7257bSPatrick Caulfield 	/* Get the new node's NODEID */
8936ed7257bSPatrick Caulfield 	make_sockaddr(&peeraddr, 0, &len);
894e125fbebSAlexander Aring 	if (addr_to_nodeid(&peeraddr, &nodeid, &mark)) {
895bcaadf5cSMasatake YAMATO 		unsigned char *b=(unsigned char *)&peeraddr;
896617e82e1SDavid Teigland 		log_print("connect from non cluster node");
897bcaadf5cSMasatake YAMATO 		print_hex_dump_bytes("ss: ", DUMP_PREFIX_NONE,
898bcaadf5cSMasatake YAMATO 				     b, sizeof(struct sockaddr_storage));
8996ed7257bSPatrick Caulfield 		sock_release(newsock);
9006ed7257bSPatrick Caulfield 		return -1;
9016ed7257bSPatrick Caulfield 	}
9026ed7257bSPatrick Caulfield 
9036ed7257bSPatrick Caulfield 	log_print("got connection from %d", nodeid);
9046ed7257bSPatrick Caulfield 
9056ed7257bSPatrick Caulfield 	/*  Check to see if we already have a connection to this node. This
9066ed7257bSPatrick Caulfield 	 *  could happen if the two nodes initiate a connection at roughly
9076ed7257bSPatrick Caulfield 	 *  the same time and the connections cross on the wire.
9086ed7257bSPatrick Caulfield 	 *  In this case we store the incoming one in "othercon"
9096ed7257bSPatrick Caulfield 	 */
910748285ccSDavid Teigland 	newcon = nodeid2con(nodeid, GFP_NOFS);
9116ed7257bSPatrick Caulfield 	if (!newcon) {
9126ed7257bSPatrick Caulfield 		result = -ENOMEM;
9136ed7257bSPatrick Caulfield 		goto accept_err;
9146ed7257bSPatrick Caulfield 	}
915d11ccd45SAlexander Aring 
916e125fbebSAlexander Aring 	sock_set_mark(newsock->sk, mark);
917e125fbebSAlexander Aring 
918d11ccd45SAlexander Aring 	mutex_lock(&newcon->sock_mutex);
9196ed7257bSPatrick Caulfield 	if (newcon->sock) {
9206ed7257bSPatrick Caulfield 		struct connection *othercon = newcon->othercon;
9216ed7257bSPatrick Caulfield 
9226ed7257bSPatrick Caulfield 		if (!othercon) {
923a47666ebSAlexander Aring 			othercon = kzalloc(sizeof(*othercon), GFP_NOFS);
9246ed7257bSPatrick Caulfield 			if (!othercon) {
925617e82e1SDavid Teigland 				log_print("failed to allocate incoming socket");
9266ed7257bSPatrick Caulfield 				mutex_unlock(&newcon->sock_mutex);
9276ed7257bSPatrick Caulfield 				result = -ENOMEM;
9286ed7257bSPatrick Caulfield 				goto accept_err;
9296ed7257bSPatrick Caulfield 			}
9304798cbbfSAlexander Aring 
9316cde210aSAlexander Aring 			result = dlm_con_init(othercon, nodeid);
9326cde210aSAlexander Aring 			if (result < 0) {
9334798cbbfSAlexander Aring 				kfree(othercon);
9344798cbbfSAlexander Aring 				goto accept_err;
9354798cbbfSAlexander Aring 			}
9364798cbbfSAlexander Aring 
937e9a470acSAlexander Aring 			lockdep_set_subclass(&othercon->sock_mutex, 1);
9386cde210aSAlexander Aring 			newcon->othercon = othercon;
939ba3ab3caSAlexander Aring 		} else {
940ba3ab3caSAlexander Aring 			/* close other sock con if we have something new */
941ba3ab3caSAlexander Aring 			close_connection(othercon, false, true, false);
94261d96be0SPatrick Caulfield 		}
943ba3ab3caSAlexander Aring 
944e9a470acSAlexander Aring 		mutex_lock(&othercon->sock_mutex);
945988419a9Stsutomu.owa@toshiba.co.jp 		add_sock(newsock, othercon);
9466ed7257bSPatrick Caulfield 		addcon = othercon;
947c7355827Stsutomu.owa@toshiba.co.jp 		mutex_unlock(&othercon->sock_mutex);
9486ed7257bSPatrick Caulfield 	}
9496ed7257bSPatrick Caulfield 	else {
9503735b4b9SBob Peterson 		/* accept copies the sk after we've saved the callbacks, so we
9513735b4b9SBob Peterson 		   don't want to save them a second time or comm errors will
9523735b4b9SBob Peterson 		   result in calling sk_error_report recursively. */
953988419a9Stsutomu.owa@toshiba.co.jp 		add_sock(newsock, newcon);
9546ed7257bSPatrick Caulfield 		addcon = newcon;
9556ed7257bSPatrick Caulfield 	}
9566ed7257bSPatrick Caulfield 
957b30a624fSAlexander Aring 	set_bit(CF_CONNECTED, &addcon->flags);
9586ed7257bSPatrick Caulfield 	mutex_unlock(&newcon->sock_mutex);
9596ed7257bSPatrick Caulfield 
9606ed7257bSPatrick Caulfield 	/*
9616ed7257bSPatrick Caulfield 	 * Add it to the active queue in case we got data
96225985edcSLucas De Marchi 	 * between processing the accept adding the socket
9636ed7257bSPatrick Caulfield 	 * to the read_sockets list
9646ed7257bSPatrick Caulfield 	 */
9656ed7257bSPatrick Caulfield 	if (!test_and_set_bit(CF_READ_PENDING, &addcon->flags))
9666ed7257bSPatrick Caulfield 		queue_work(recv_workqueue, &addcon->rwork);
9676ed7257bSPatrick Caulfield 
9686ed7257bSPatrick Caulfield 	return 0;
9696ed7257bSPatrick Caulfield 
9706ed7257bSPatrick Caulfield accept_err:
9713421fb15Stsutomu.owa@toshiba.co.jp 	if (newsock)
9726ed7257bSPatrick Caulfield 		sock_release(newsock);
9736ed7257bSPatrick Caulfield 
9746ed7257bSPatrick Caulfield 	if (result != -EAGAIN)
975617e82e1SDavid Teigland 		log_print("error accepting connection from node: %d", result);
9766ed7257bSPatrick Caulfield 	return result;
9776ed7257bSPatrick Caulfield }
9786ed7257bSPatrick Caulfield 
9796ed7257bSPatrick Caulfield static void free_entry(struct writequeue_entry *e)
9806ed7257bSPatrick Caulfield {
9816ed7257bSPatrick Caulfield 	__free_page(e->page);
9826ed7257bSPatrick Caulfield 	kfree(e);
9836ed7257bSPatrick Caulfield }
9846ed7257bSPatrick Caulfield 
9855d689871SMike Christie /*
9865d689871SMike Christie  * writequeue_entry_complete - try to delete and free write queue entry
9875d689871SMike Christie  * @e: write queue entry to try to delete
9885d689871SMike Christie  * @completed: bytes completed
9895d689871SMike Christie  *
9905d689871SMike Christie  * writequeue_lock must be held.
9915d689871SMike Christie  */
9925d689871SMike Christie static void writequeue_entry_complete(struct writequeue_entry *e, int completed)
9935d689871SMike Christie {
9945d689871SMike Christie 	e->offset += completed;
9955d689871SMike Christie 	e->len -= completed;
9965d689871SMike Christie 
9975d689871SMike Christie 	if (e->len == 0 && e->users == 0) {
9985d689871SMike Christie 		list_del(&e->list);
9995d689871SMike Christie 		free_entry(e);
10005d689871SMike Christie 	}
10015d689871SMike Christie }
10025d689871SMike Christie 
1003ee44b4bcSMarcelo Ricardo Leitner /*
1004ee44b4bcSMarcelo Ricardo Leitner  * sctp_bind_addrs - bind a SCTP socket to all our addresses
1005ee44b4bcSMarcelo Ricardo Leitner  */
100613004e8aSAlexander Aring static int sctp_bind_addrs(struct socket *sock, uint16_t port)
1007ee44b4bcSMarcelo Ricardo Leitner {
1008ee44b4bcSMarcelo Ricardo Leitner 	struct sockaddr_storage localaddr;
1009c0425a42SChristoph Hellwig 	struct sockaddr *addr = (struct sockaddr *)&localaddr;
1010ee44b4bcSMarcelo Ricardo Leitner 	int i, addr_len, result = 0;
1011ee44b4bcSMarcelo Ricardo Leitner 
1012ee44b4bcSMarcelo Ricardo Leitner 	for (i = 0; i < dlm_local_count; i++) {
1013ee44b4bcSMarcelo Ricardo Leitner 		memcpy(&localaddr, dlm_local_addr[i], sizeof(localaddr));
1014ee44b4bcSMarcelo Ricardo Leitner 		make_sockaddr(&localaddr, port, &addr_len);
1015ee44b4bcSMarcelo Ricardo Leitner 
1016ee44b4bcSMarcelo Ricardo Leitner 		if (!i)
101713004e8aSAlexander Aring 			result = kernel_bind(sock, addr, addr_len);
1018ee44b4bcSMarcelo Ricardo Leitner 		else
101913004e8aSAlexander Aring 			result = sock_bind_add(sock->sk, addr, addr_len);
1020ee44b4bcSMarcelo Ricardo Leitner 
1021ee44b4bcSMarcelo Ricardo Leitner 		if (result < 0) {
1022ee44b4bcSMarcelo Ricardo Leitner 			log_print("Can't bind to %d addr number %d, %d.\n",
1023ee44b4bcSMarcelo Ricardo Leitner 				  port, i + 1, result);
1024ee44b4bcSMarcelo Ricardo Leitner 			break;
1025ee44b4bcSMarcelo Ricardo Leitner 		}
1026ee44b4bcSMarcelo Ricardo Leitner 	}
1027ee44b4bcSMarcelo Ricardo Leitner 	return result;
1028ee44b4bcSMarcelo Ricardo Leitner }
1029ee44b4bcSMarcelo Ricardo Leitner 
10306ed7257bSPatrick Caulfield /* Initiate an SCTP association.
10316ed7257bSPatrick Caulfield    This is a special case of send_to_sock() in that we don't yet have a
10326ed7257bSPatrick Caulfield    peeled-off socket for this association, so we use the listening socket
10336ed7257bSPatrick Caulfield    and add the primary IP address of the remote node.
10346ed7257bSPatrick Caulfield  */
1035ee44b4bcSMarcelo Ricardo Leitner static void sctp_connect_to_sock(struct connection *con)
10366ed7257bSPatrick Caulfield {
1037ee44b4bcSMarcelo Ricardo Leitner 	struct sockaddr_storage daddr;
1038ee44b4bcSMarcelo Ricardo Leitner 	int result;
1039ee44b4bcSMarcelo Ricardo Leitner 	int addr_len;
1040ee44b4bcSMarcelo Ricardo Leitner 	struct socket *sock;
10419c9f168fSAlexander Aring 	unsigned int mark;
1042ee44b4bcSMarcelo Ricardo Leitner 
10435d689871SMike Christie 	mutex_lock(&con->sock_mutex);
10446ed7257bSPatrick Caulfield 
1045ee44b4bcSMarcelo Ricardo Leitner 	/* Some odd races can cause double-connects, ignore them */
1046ee44b4bcSMarcelo Ricardo Leitner 	if (con->retries++ > MAX_CONNECT_RETRIES)
1047ee44b4bcSMarcelo Ricardo Leitner 		goto out;
1048ee44b4bcSMarcelo Ricardo Leitner 
1049ee44b4bcSMarcelo Ricardo Leitner 	if (con->sock) {
1050ee44b4bcSMarcelo Ricardo Leitner 		log_print("node %d already connected.", con->nodeid);
1051ee44b4bcSMarcelo Ricardo Leitner 		goto out;
1052ee44b4bcSMarcelo Ricardo Leitner 	}
1053ee44b4bcSMarcelo Ricardo Leitner 
1054ee44b4bcSMarcelo Ricardo Leitner 	memset(&daddr, 0, sizeof(daddr));
1055e125fbebSAlexander Aring 	result = nodeid_to_addr(con->nodeid, &daddr, NULL, true, &mark);
1056ee44b4bcSMarcelo Ricardo Leitner 	if (result < 0) {
10576ed7257bSPatrick Caulfield 		log_print("no address for nodeid %d", con->nodeid);
1058ee44b4bcSMarcelo Ricardo Leitner 		goto out;
105904bedd79SDavid Teigland 	}
10606ed7257bSPatrick Caulfield 
1061ee44b4bcSMarcelo Ricardo Leitner 	/* Create a socket to communicate with */
1062ee44b4bcSMarcelo Ricardo Leitner 	result = sock_create_kern(&init_net, dlm_local_addr[0]->ss_family,
1063ee44b4bcSMarcelo Ricardo Leitner 				  SOCK_STREAM, IPPROTO_SCTP, &sock);
1064ee44b4bcSMarcelo Ricardo Leitner 	if (result < 0)
1065ee44b4bcSMarcelo Ricardo Leitner 		goto socket_err;
10666ed7257bSPatrick Caulfield 
10679c9f168fSAlexander Aring 	sock_set_mark(sock->sk, mark);
10689c9f168fSAlexander Aring 
1069988419a9Stsutomu.owa@toshiba.co.jp 	add_sock(sock, con);
10706ed7257bSPatrick Caulfield 
1071ee44b4bcSMarcelo Ricardo Leitner 	/* Bind to all addresses. */
107213004e8aSAlexander Aring 	if (sctp_bind_addrs(con->sock, 0))
1073ee44b4bcSMarcelo Ricardo Leitner 		goto bind_err;
107498e1b60eSMike Christie 
1075ee44b4bcSMarcelo Ricardo Leitner 	make_sockaddr(&daddr, dlm_config.ci_tcp_port, &addr_len);
10766ed7257bSPatrick Caulfield 
1077ee44b4bcSMarcelo Ricardo Leitner 	log_print("connecting to %d", con->nodeid);
10786ed7257bSPatrick Caulfield 
1079ee44b4bcSMarcelo Ricardo Leitner 	/* Turn off Nagle's algorithm */
108040ef92c6SChristoph Hellwig 	sctp_sock_set_nodelay(sock->sk);
1081ee44b4bcSMarcelo Ricardo Leitner 
1082f706d830SGang He 	/*
1083f706d830SGang He 	 * Make sock->ops->connect() function return in specified time,
1084f706d830SGang He 	 * since O_NONBLOCK argument in connect() function does not work here,
1085f706d830SGang He 	 * then, we should restore the default value of this attribute.
1086f706d830SGang He 	 */
108776ee0785SChristoph Hellwig 	sock_set_sndtimeo(sock->sk, 5);
1088ee44b4bcSMarcelo Ricardo Leitner 	result = sock->ops->connect(sock, (struct sockaddr *)&daddr, addr_len,
1089da3627c3SGang He 				   0);
109076ee0785SChristoph Hellwig 	sock_set_sndtimeo(sock->sk, 0);
1091f706d830SGang He 
1092ee44b4bcSMarcelo Ricardo Leitner 	if (result == -EINPROGRESS)
1093ee44b4bcSMarcelo Ricardo Leitner 		result = 0;
109419633c7eSAlexander Aring 	if (result == 0) {
109519633c7eSAlexander Aring 		if (!test_and_set_bit(CF_CONNECTED, &con->flags))
109619633c7eSAlexander Aring 			log_print("successful connected to node %d", con->nodeid);
1097ee44b4bcSMarcelo Ricardo Leitner 		goto out;
109819633c7eSAlexander Aring 	}
1099ee44b4bcSMarcelo Ricardo Leitner 
1100ee44b4bcSMarcelo Ricardo Leitner bind_err:
1101ee44b4bcSMarcelo Ricardo Leitner 	con->sock = NULL;
1102ee44b4bcSMarcelo Ricardo Leitner 	sock_release(sock);
1103ee44b4bcSMarcelo Ricardo Leitner 
1104ee44b4bcSMarcelo Ricardo Leitner socket_err:
1105ee44b4bcSMarcelo Ricardo Leitner 	/*
1106ee44b4bcSMarcelo Ricardo Leitner 	 * Some errors are fatal and this list might need adjusting. For other
1107ee44b4bcSMarcelo Ricardo Leitner 	 * errors we try again until the max number of retries is reached.
1108ee44b4bcSMarcelo Ricardo Leitner 	 */
1109ee44b4bcSMarcelo Ricardo Leitner 	if (result != -EHOSTUNREACH &&
1110ee44b4bcSMarcelo Ricardo Leitner 	    result != -ENETUNREACH &&
1111ee44b4bcSMarcelo Ricardo Leitner 	    result != -ENETDOWN &&
1112ee44b4bcSMarcelo Ricardo Leitner 	    result != -EINVAL &&
1113ee44b4bcSMarcelo Ricardo Leitner 	    result != -EPROTONOSUPPORT) {
1114ee44b4bcSMarcelo Ricardo Leitner 		log_print("connect %d try %d error %d", con->nodeid,
1115ee44b4bcSMarcelo Ricardo Leitner 			  con->retries, result);
1116ee44b4bcSMarcelo Ricardo Leitner 		mutex_unlock(&con->sock_mutex);
1117ee44b4bcSMarcelo Ricardo Leitner 		msleep(1000);
1118ee44b4bcSMarcelo Ricardo Leitner 		lowcomms_connect_sock(con);
1119ee44b4bcSMarcelo Ricardo Leitner 		return;
11206ed7257bSPatrick Caulfield 	}
11215d689871SMike Christie 
1122ee44b4bcSMarcelo Ricardo Leitner out:
11235d689871SMike Christie 	mutex_unlock(&con->sock_mutex);
11246ed7257bSPatrick Caulfield }
11256ed7257bSPatrick Caulfield 
11266ed7257bSPatrick Caulfield /* Connect a new socket to its peer */
11276ed7257bSPatrick Caulfield static void tcp_connect_to_sock(struct connection *con)
11286ed7257bSPatrick Caulfield {
11296bd8fedaSLon Hohberger 	struct sockaddr_storage saddr, src_addr;
1130e125fbebSAlexander Aring 	unsigned int mark;
11316ed7257bSPatrick Caulfield 	int addr_len;
1132a89d63a1SCasey Dahlin 	struct socket *sock = NULL;
113336b71a8bSDavid Teigland 	int result;
11346ed7257bSPatrick Caulfield 
11356ed7257bSPatrick Caulfield 	mutex_lock(&con->sock_mutex);
11366ed7257bSPatrick Caulfield 	if (con->retries++ > MAX_CONNECT_RETRIES)
11376ed7257bSPatrick Caulfield 		goto out;
11386ed7257bSPatrick Caulfield 
11396ed7257bSPatrick Caulfield 	/* Some odd races can cause double-connects, ignore them */
114036b71a8bSDavid Teigland 	if (con->sock)
11416ed7257bSPatrick Caulfield 		goto out;
11426ed7257bSPatrick Caulfield 
11436ed7257bSPatrick Caulfield 	/* Create a socket to communicate with */
1144eeb1bd5cSEric W. Biederman 	result = sock_create_kern(&init_net, dlm_local_addr[0]->ss_family,
1145eeb1bd5cSEric W. Biederman 				  SOCK_STREAM, IPPROTO_TCP, &sock);
11466ed7257bSPatrick Caulfield 	if (result < 0)
11476ed7257bSPatrick Caulfield 		goto out_err;
11486ed7257bSPatrick Caulfield 
11496ed7257bSPatrick Caulfield 	memset(&saddr, 0, sizeof(saddr));
1150e125fbebSAlexander Aring 	result = nodeid_to_addr(con->nodeid, &saddr, NULL, false, &mark);
115136b71a8bSDavid Teigland 	if (result < 0) {
115236b71a8bSDavid Teigland 		log_print("no address for nodeid %d", con->nodeid);
11536ed7257bSPatrick Caulfield 		goto out_err;
115436b71a8bSDavid Teigland 	}
11556ed7257bSPatrick Caulfield 
1156e125fbebSAlexander Aring 	sock_set_mark(sock->sk, mark);
1157e125fbebSAlexander Aring 
1158988419a9Stsutomu.owa@toshiba.co.jp 	add_sock(sock, con);
11596ed7257bSPatrick Caulfield 
11606bd8fedaSLon Hohberger 	/* Bind to our cluster-known address connecting to avoid
11616bd8fedaSLon Hohberger 	   routing problems */
11626bd8fedaSLon Hohberger 	memcpy(&src_addr, dlm_local_addr[0], sizeof(src_addr));
11636bd8fedaSLon Hohberger 	make_sockaddr(&src_addr, 0, &addr_len);
11646bd8fedaSLon Hohberger 	result = sock->ops->bind(sock, (struct sockaddr *) &src_addr,
11656bd8fedaSLon Hohberger 				 addr_len);
11666bd8fedaSLon Hohberger 	if (result < 0) {
11676bd8fedaSLon Hohberger 		log_print("could not bind for connect: %d", result);
11686bd8fedaSLon Hohberger 		/* This *may* not indicate a critical error */
11696bd8fedaSLon Hohberger 	}
11706bd8fedaSLon Hohberger 
11716ed7257bSPatrick Caulfield 	make_sockaddr(&saddr, dlm_config.ci_tcp_port, &addr_len);
11726ed7257bSPatrick Caulfield 
11736ed7257bSPatrick Caulfield 	log_print("connecting to %d", con->nodeid);
1174cb2d45daSDavid Teigland 
1175cb2d45daSDavid Teigland 	/* Turn off Nagle's algorithm */
117612abc5eeSChristoph Hellwig 	tcp_sock_set_nodelay(sock->sk);
1177cb2d45daSDavid Teigland 
117836b71a8bSDavid Teigland 	result = sock->ops->connect(sock, (struct sockaddr *)&saddr, addr_len,
11796ed7257bSPatrick Caulfield 				   O_NONBLOCK);
11806ed7257bSPatrick Caulfield 	if (result == -EINPROGRESS)
11816ed7257bSPatrick Caulfield 		result = 0;
11826ed7257bSPatrick Caulfield 	if (result == 0)
11836ed7257bSPatrick Caulfield 		goto out;
11846ed7257bSPatrick Caulfield 
11856ed7257bSPatrick Caulfield out_err:
11866ed7257bSPatrick Caulfield 	if (con->sock) {
11876ed7257bSPatrick Caulfield 		sock_release(con->sock);
11886ed7257bSPatrick Caulfield 		con->sock = NULL;
1189a89d63a1SCasey Dahlin 	} else if (sock) {
1190a89d63a1SCasey Dahlin 		sock_release(sock);
11916ed7257bSPatrick Caulfield 	}
11926ed7257bSPatrick Caulfield 	/*
11936ed7257bSPatrick Caulfield 	 * Some errors are fatal and this list might need adjusting. For other
11946ed7257bSPatrick Caulfield 	 * errors we try again until the max number of retries is reached.
11956ed7257bSPatrick Caulfield 	 */
119636b71a8bSDavid Teigland 	if (result != -EHOSTUNREACH &&
119736b71a8bSDavid Teigland 	    result != -ENETUNREACH &&
119836b71a8bSDavid Teigland 	    result != -ENETDOWN &&
119936b71a8bSDavid Teigland 	    result != -EINVAL &&
120036b71a8bSDavid Teigland 	    result != -EPROTONOSUPPORT) {
120136b71a8bSDavid Teigland 		log_print("connect %d try %d error %d", con->nodeid,
120236b71a8bSDavid Teigland 			  con->retries, result);
120336b71a8bSDavid Teigland 		mutex_unlock(&con->sock_mutex);
120436b71a8bSDavid Teigland 		msleep(1000);
12056ed7257bSPatrick Caulfield 		lowcomms_connect_sock(con);
120636b71a8bSDavid Teigland 		return;
12076ed7257bSPatrick Caulfield 	}
12086ed7257bSPatrick Caulfield out:
12096ed7257bSPatrick Caulfield 	mutex_unlock(&con->sock_mutex);
12106ed7257bSPatrick Caulfield 	return;
12116ed7257bSPatrick Caulfield }
12126ed7257bSPatrick Caulfield 
1213d11ccd45SAlexander Aring /* On error caller must run dlm_close_sock() for the
1214d11ccd45SAlexander Aring  * listen connection socket.
1215d11ccd45SAlexander Aring  */
1216d11ccd45SAlexander Aring static int tcp_create_listen_sock(struct listen_connection *con,
12176ed7257bSPatrick Caulfield 				  struct sockaddr_storage *saddr)
12186ed7257bSPatrick Caulfield {
12196ed7257bSPatrick Caulfield 	struct socket *sock = NULL;
12206ed7257bSPatrick Caulfield 	int result = 0;
12216ed7257bSPatrick Caulfield 	int addr_len;
12226ed7257bSPatrick Caulfield 
12236ed7257bSPatrick Caulfield 	if (dlm_local_addr[0]->ss_family == AF_INET)
12246ed7257bSPatrick Caulfield 		addr_len = sizeof(struct sockaddr_in);
12256ed7257bSPatrick Caulfield 	else
12266ed7257bSPatrick Caulfield 		addr_len = sizeof(struct sockaddr_in6);
12276ed7257bSPatrick Caulfield 
12286ed7257bSPatrick Caulfield 	/* Create a socket to communicate with */
1229eeb1bd5cSEric W. Biederman 	result = sock_create_kern(&init_net, dlm_local_addr[0]->ss_family,
1230eeb1bd5cSEric W. Biederman 				  SOCK_STREAM, IPPROTO_TCP, &sock);
12316ed7257bSPatrick Caulfield 	if (result < 0) {
1232617e82e1SDavid Teigland 		log_print("Can't create listening comms socket");
12336ed7257bSPatrick Caulfield 		goto create_out;
12346ed7257bSPatrick Caulfield 	}
12356ed7257bSPatrick Caulfield 
1236a5b7ab63SAlexander Aring 	sock_set_mark(sock->sk, dlm_config.ci_mark);
1237a5b7ab63SAlexander Aring 
1238cb2d45daSDavid Teigland 	/* Turn off Nagle's algorithm */
123912abc5eeSChristoph Hellwig 	tcp_sock_set_nodelay(sock->sk);
1240cb2d45daSDavid Teigland 
1241b58f0e8fSChristoph Hellwig 	sock_set_reuseaddr(sock->sk);
12426ed7257bSPatrick Caulfield 
1243d11ccd45SAlexander Aring 	add_listen_sock(sock, con);
12446ed7257bSPatrick Caulfield 
12456ed7257bSPatrick Caulfield 	/* Bind to our port */
12466ed7257bSPatrick Caulfield 	make_sockaddr(saddr, dlm_config.ci_tcp_port, &addr_len);
12476ed7257bSPatrick Caulfield 	result = sock->ops->bind(sock, (struct sockaddr *) saddr, addr_len);
12486ed7257bSPatrick Caulfield 	if (result < 0) {
1249617e82e1SDavid Teigland 		log_print("Can't bind to port %d", dlm_config.ci_tcp_port);
12506ed7257bSPatrick Caulfield 		goto create_out;
12516ed7257bSPatrick Caulfield 	}
1252ce3d9544SChristoph Hellwig 	sock_set_keepalive(sock->sk);
12536ed7257bSPatrick Caulfield 
12546ed7257bSPatrick Caulfield 	result = sock->ops->listen(sock, 5);
12556ed7257bSPatrick Caulfield 	if (result < 0) {
1256617e82e1SDavid Teigland 		log_print("Can't listen on port %d", dlm_config.ci_tcp_port);
12576ed7257bSPatrick Caulfield 		goto create_out;
12586ed7257bSPatrick Caulfield 	}
12596ed7257bSPatrick Caulfield 
1260d11ccd45SAlexander Aring 	return 0;
1261d11ccd45SAlexander Aring 
12626ed7257bSPatrick Caulfield create_out:
1263d11ccd45SAlexander Aring 	return result;
12646ed7257bSPatrick Caulfield }
12656ed7257bSPatrick Caulfield 
12666ed7257bSPatrick Caulfield /* Get local addresses */
12676ed7257bSPatrick Caulfield static void init_local(void)
12686ed7257bSPatrick Caulfield {
12696ed7257bSPatrick Caulfield 	struct sockaddr_storage sas, *addr;
12706ed7257bSPatrick Caulfield 	int i;
12716ed7257bSPatrick Caulfield 
127230d3a237SPatrick Caulfield 	dlm_local_count = 0;
12731b189b88SDavid Teigland 	for (i = 0; i < DLM_MAX_ADDR_COUNT; i++) {
12746ed7257bSPatrick Caulfield 		if (dlm_our_addr(&sas, i))
12756ed7257bSPatrick Caulfield 			break;
12766ed7257bSPatrick Caulfield 
12775c93f56fSAmitoj Kaur Chawla 		addr = kmemdup(&sas, sizeof(*addr), GFP_NOFS);
12786ed7257bSPatrick Caulfield 		if (!addr)
12796ed7257bSPatrick Caulfield 			break;
12806ed7257bSPatrick Caulfield 		dlm_local_addr[dlm_local_count++] = addr;
12816ed7257bSPatrick Caulfield 	}
12826ed7257bSPatrick Caulfield }
12836ed7257bSPatrick Caulfield 
1284043697f0SAlexander Aring static void deinit_local(void)
1285043697f0SAlexander Aring {
1286043697f0SAlexander Aring 	int i;
1287043697f0SAlexander Aring 
1288043697f0SAlexander Aring 	for (i = 0; i < dlm_local_count; i++)
1289043697f0SAlexander Aring 		kfree(dlm_local_addr[i]);
1290043697f0SAlexander Aring }
1291043697f0SAlexander Aring 
1292d11ccd45SAlexander Aring /* Initialise SCTP socket and bind to all interfaces
1293d11ccd45SAlexander Aring  * On error caller must run dlm_close_sock() for the
1294d11ccd45SAlexander Aring  * listen connection socket.
1295d11ccd45SAlexander Aring  */
1296d11ccd45SAlexander Aring static int sctp_listen_for_all(struct listen_connection *con)
12976ed7257bSPatrick Caulfield {
12986ed7257bSPatrick Caulfield 	struct socket *sock = NULL;
1299ee44b4bcSMarcelo Ricardo Leitner 	int result = -EINVAL;
13006ed7257bSPatrick Caulfield 
13016ed7257bSPatrick Caulfield 	log_print("Using SCTP for communications");
13026ed7257bSPatrick Caulfield 
1303eeb1bd5cSEric W. Biederman 	result = sock_create_kern(&init_net, dlm_local_addr[0]->ss_family,
1304ee44b4bcSMarcelo Ricardo Leitner 				  SOCK_STREAM, IPPROTO_SCTP, &sock);
13056ed7257bSPatrick Caulfield 	if (result < 0) {
13066ed7257bSPatrick Caulfield 		log_print("Can't create comms socket, check SCTP is loaded");
13076ed7257bSPatrick Caulfield 		goto out;
13086ed7257bSPatrick Caulfield 	}
13096ed7257bSPatrick Caulfield 
131026cfabf9SChristoph Hellwig 	sock_set_rcvbuf(sock->sk, NEEDED_RMEM);
1311a5b7ab63SAlexander Aring 	sock_set_mark(sock->sk, dlm_config.ci_mark);
131240ef92c6SChristoph Hellwig 	sctp_sock_set_nodelay(sock->sk);
131386e92ad2SMike Christie 
1314d11ccd45SAlexander Aring 	add_listen_sock(sock, con);
1315b81171cbSBob Peterson 
1316ee44b4bcSMarcelo Ricardo Leitner 	/* Bind to all addresses. */
1317d11ccd45SAlexander Aring 	result = sctp_bind_addrs(con->sock, dlm_config.ci_tcp_port);
1318d11ccd45SAlexander Aring 	if (result < 0)
1319d11ccd45SAlexander Aring 		goto out;
13206ed7257bSPatrick Caulfield 
13216ed7257bSPatrick Caulfield 	result = sock->ops->listen(sock, 5);
13226ed7257bSPatrick Caulfield 	if (result < 0) {
13236ed7257bSPatrick Caulfield 		log_print("Can't set socket listening");
1324d11ccd45SAlexander Aring 		goto out;
13256ed7257bSPatrick Caulfield 	}
13266ed7257bSPatrick Caulfield 
13276ed7257bSPatrick Caulfield 	return 0;
13286ed7257bSPatrick Caulfield 
13296ed7257bSPatrick Caulfield out:
13306ed7257bSPatrick Caulfield 	return result;
13316ed7257bSPatrick Caulfield }
13326ed7257bSPatrick Caulfield 
13336ed7257bSPatrick Caulfield static int tcp_listen_for_all(void)
13346ed7257bSPatrick Caulfield {
13356ed7257bSPatrick Caulfield 	/* We don't support multi-homed hosts */
13361a26bfafSAlexander Aring 	if (dlm_local_count > 1) {
1337617e82e1SDavid Teigland 		log_print("TCP protocol can't handle multi-homed hosts, "
1338617e82e1SDavid Teigland 			  "try SCTP");
13396ed7257bSPatrick Caulfield 		return -EINVAL;
13406ed7257bSPatrick Caulfield 	}
13416ed7257bSPatrick Caulfield 
13426ed7257bSPatrick Caulfield 	log_print("Using TCP for communications");
13436ed7257bSPatrick Caulfield 
1344d11ccd45SAlexander Aring 	return tcp_create_listen_sock(&listen_con, dlm_local_addr[0]);
13456ed7257bSPatrick Caulfield }
13466ed7257bSPatrick Caulfield 
13476ed7257bSPatrick Caulfield 
13486ed7257bSPatrick Caulfield 
13496ed7257bSPatrick Caulfield static struct writequeue_entry *new_writequeue_entry(struct connection *con,
13506ed7257bSPatrick Caulfield 						     gfp_t allocation)
13516ed7257bSPatrick Caulfield {
13526ed7257bSPatrick Caulfield 	struct writequeue_entry *entry;
13536ed7257bSPatrick Caulfield 
13546ed7257bSPatrick Caulfield 	entry = kmalloc(sizeof(struct writequeue_entry), allocation);
13556ed7257bSPatrick Caulfield 	if (!entry)
13566ed7257bSPatrick Caulfield 		return NULL;
13576ed7257bSPatrick Caulfield 
13586ed7257bSPatrick Caulfield 	entry->page = alloc_page(allocation);
13596ed7257bSPatrick Caulfield 	if (!entry->page) {
13606ed7257bSPatrick Caulfield 		kfree(entry);
13616ed7257bSPatrick Caulfield 		return NULL;
13626ed7257bSPatrick Caulfield 	}
13636ed7257bSPatrick Caulfield 
13646ed7257bSPatrick Caulfield 	entry->offset = 0;
13656ed7257bSPatrick Caulfield 	entry->len = 0;
13666ed7257bSPatrick Caulfield 	entry->end = 0;
13676ed7257bSPatrick Caulfield 	entry->users = 0;
13686ed7257bSPatrick Caulfield 	entry->con = con;
13696ed7257bSPatrick Caulfield 
13706ed7257bSPatrick Caulfield 	return entry;
13716ed7257bSPatrick Caulfield }
13726ed7257bSPatrick Caulfield 
1373617e82e1SDavid Teigland void *dlm_lowcomms_get_buffer(int nodeid, int len, gfp_t allocation, char **ppc)
13746ed7257bSPatrick Caulfield {
13756ed7257bSPatrick Caulfield 	struct connection *con;
13766ed7257bSPatrick Caulfield 	struct writequeue_entry *e;
13776ed7257bSPatrick Caulfield 	int offset = 0;
13786ed7257bSPatrick Caulfield 
1379692f51c8SAlexander Aring 	if (len > LOWCOMMS_MAX_TX_BUFFER_LEN) {
1380692f51c8SAlexander Aring 		BUILD_BUG_ON(PAGE_SIZE < LOWCOMMS_MAX_TX_BUFFER_LEN);
1381692f51c8SAlexander Aring 		log_print("failed to allocate a buffer of size %d", len);
1382692f51c8SAlexander Aring 		return NULL;
1383692f51c8SAlexander Aring 	}
1384692f51c8SAlexander Aring 
13856ed7257bSPatrick Caulfield 	con = nodeid2con(nodeid, allocation);
13866ed7257bSPatrick Caulfield 	if (!con)
13876ed7257bSPatrick Caulfield 		return NULL;
13886ed7257bSPatrick Caulfield 
13896ed7257bSPatrick Caulfield 	spin_lock(&con->writequeue_lock);
13906ed7257bSPatrick Caulfield 	e = list_entry(con->writequeue.prev, struct writequeue_entry, list);
13916ed7257bSPatrick Caulfield 	if ((&e->list == &con->writequeue) ||
139209cbfeafSKirill A. Shutemov 	    (PAGE_SIZE - e->end < len)) {
13936ed7257bSPatrick Caulfield 		e = NULL;
13946ed7257bSPatrick Caulfield 	} else {
13956ed7257bSPatrick Caulfield 		offset = e->end;
13966ed7257bSPatrick Caulfield 		e->end += len;
1397eeee2b5fSWei Yongjun 		e->users++;
13986ed7257bSPatrick Caulfield 	}
13996ed7257bSPatrick Caulfield 	spin_unlock(&con->writequeue_lock);
14006ed7257bSPatrick Caulfield 
14016ed7257bSPatrick Caulfield 	if (e) {
14026ed7257bSPatrick Caulfield 	got_one:
14036ed7257bSPatrick Caulfield 		*ppc = page_address(e->page) + offset;
14046ed7257bSPatrick Caulfield 		return e;
14056ed7257bSPatrick Caulfield 	}
14066ed7257bSPatrick Caulfield 
14076ed7257bSPatrick Caulfield 	e = new_writequeue_entry(con, allocation);
14086ed7257bSPatrick Caulfield 	if (e) {
14096ed7257bSPatrick Caulfield 		spin_lock(&con->writequeue_lock);
14106ed7257bSPatrick Caulfield 		offset = e->end;
14116ed7257bSPatrick Caulfield 		e->end += len;
1412eeee2b5fSWei Yongjun 		e->users++;
14136ed7257bSPatrick Caulfield 		list_add_tail(&e->list, &con->writequeue);
14146ed7257bSPatrick Caulfield 		spin_unlock(&con->writequeue_lock);
14156ed7257bSPatrick Caulfield 		goto got_one;
14166ed7257bSPatrick Caulfield 	}
14176ed7257bSPatrick Caulfield 	return NULL;
14186ed7257bSPatrick Caulfield }
14196ed7257bSPatrick Caulfield 
14206ed7257bSPatrick Caulfield void dlm_lowcomms_commit_buffer(void *mh)
14216ed7257bSPatrick Caulfield {
14226ed7257bSPatrick Caulfield 	struct writequeue_entry *e = (struct writequeue_entry *)mh;
14236ed7257bSPatrick Caulfield 	struct connection *con = e->con;
14246ed7257bSPatrick Caulfield 	int users;
14256ed7257bSPatrick Caulfield 
14266ed7257bSPatrick Caulfield 	spin_lock(&con->writequeue_lock);
14276ed7257bSPatrick Caulfield 	users = --e->users;
14286ed7257bSPatrick Caulfield 	if (users)
14296ed7257bSPatrick Caulfield 		goto out;
14306ed7257bSPatrick Caulfield 	e->len = e->end - e->offset;
14316ed7257bSPatrick Caulfield 	spin_unlock(&con->writequeue_lock);
14326ed7257bSPatrick Caulfield 
14336ed7257bSPatrick Caulfield 	queue_work(send_workqueue, &con->swork);
14346ed7257bSPatrick Caulfield 	return;
14356ed7257bSPatrick Caulfield 
14366ed7257bSPatrick Caulfield out:
14376ed7257bSPatrick Caulfield 	spin_unlock(&con->writequeue_lock);
14386ed7257bSPatrick Caulfield 	return;
14396ed7257bSPatrick Caulfield }
14406ed7257bSPatrick Caulfield 
14416ed7257bSPatrick Caulfield /* Send a message */
14426ed7257bSPatrick Caulfield static void send_to_sock(struct connection *con)
14436ed7257bSPatrick Caulfield {
14446ed7257bSPatrick Caulfield 	int ret = 0;
14456ed7257bSPatrick Caulfield 	const int msg_flags = MSG_DONTWAIT | MSG_NOSIGNAL;
14466ed7257bSPatrick Caulfield 	struct writequeue_entry *e;
14476ed7257bSPatrick Caulfield 	int len, offset;
1448f92c8dd7SBob Peterson 	int count = 0;
14496ed7257bSPatrick Caulfield 
14506ed7257bSPatrick Caulfield 	mutex_lock(&con->sock_mutex);
14516ed7257bSPatrick Caulfield 	if (con->sock == NULL)
14526ed7257bSPatrick Caulfield 		goto out_connect;
14536ed7257bSPatrick Caulfield 
14546ed7257bSPatrick Caulfield 	spin_lock(&con->writequeue_lock);
14556ed7257bSPatrick Caulfield 	for (;;) {
14566ed7257bSPatrick Caulfield 		e = list_entry(con->writequeue.next, struct writequeue_entry,
14576ed7257bSPatrick Caulfield 			       list);
14586ed7257bSPatrick Caulfield 		if ((struct list_head *) e == &con->writequeue)
14596ed7257bSPatrick Caulfield 			break;
14606ed7257bSPatrick Caulfield 
14616ed7257bSPatrick Caulfield 		len = e->len;
14626ed7257bSPatrick Caulfield 		offset = e->offset;
14636ed7257bSPatrick Caulfield 		BUG_ON(len == 0 && e->users == 0);
14646ed7257bSPatrick Caulfield 		spin_unlock(&con->writequeue_lock);
14656ed7257bSPatrick Caulfield 
14666ed7257bSPatrick Caulfield 		ret = 0;
14676ed7257bSPatrick Caulfield 		if (len) {
14681329e3f2SPaolo Bonzini 			ret = kernel_sendpage(con->sock, e->page, offset, len,
14696ed7257bSPatrick Caulfield 					      msg_flags);
1470d66f8277SPatrick Caulfield 			if (ret == -EAGAIN || ret == 0) {
1471b36930ddSDavid Miller 				if (ret == -EAGAIN &&
14729cd3e072SEric Dumazet 				    test_bit(SOCKWQ_ASYNC_NOSPACE, &con->sock->flags) &&
1473b36930ddSDavid Miller 				    !test_and_set_bit(CF_APP_LIMITED, &con->flags)) {
1474b36930ddSDavid Miller 					/* Notify TCP that we're limited by the
1475b36930ddSDavid Miller 					 * application window size.
1476b36930ddSDavid Miller 					 */
1477b36930ddSDavid Miller 					set_bit(SOCK_NOSPACE, &con->sock->flags);
1478b36930ddSDavid Miller 					con->sock->sk->sk_write_pending++;
1479b36930ddSDavid Miller 				}
1480d66f8277SPatrick Caulfield 				cond_resched();
14816ed7257bSPatrick Caulfield 				goto out;
14829c5bef58SYing Xue 			} else if (ret < 0)
14836ed7257bSPatrick Caulfield 				goto send_error;
1484d66f8277SPatrick Caulfield 		}
1485f92c8dd7SBob Peterson 
14866ed7257bSPatrick Caulfield 		/* Don't starve people filling buffers */
1487f92c8dd7SBob Peterson 		if (++count >= MAX_SEND_MSG_COUNT) {
14886ed7257bSPatrick Caulfield 			cond_resched();
1489f92c8dd7SBob Peterson 			count = 0;
1490f92c8dd7SBob Peterson 		}
14916ed7257bSPatrick Caulfield 
14926ed7257bSPatrick Caulfield 		spin_lock(&con->writequeue_lock);
14935d689871SMike Christie 		writequeue_entry_complete(e, ret);
14946ed7257bSPatrick Caulfield 	}
14956ed7257bSPatrick Caulfield 	spin_unlock(&con->writequeue_lock);
14966ed7257bSPatrick Caulfield out:
14976ed7257bSPatrick Caulfield 	mutex_unlock(&con->sock_mutex);
14986ed7257bSPatrick Caulfield 	return;
14996ed7257bSPatrick Caulfield 
15006ed7257bSPatrick Caulfield send_error:
15016ed7257bSPatrick Caulfield 	mutex_unlock(&con->sock_mutex);
1502ba3ab3caSAlexander Aring 	close_connection(con, false, false, true);
150301da24d3SBob Peterson 	/* Requeue the send work. When the work daemon runs again, it will try
150401da24d3SBob Peterson 	   a new connection, then call this function again. */
150501da24d3SBob Peterson 	queue_work(send_workqueue, &con->swork);
15066ed7257bSPatrick Caulfield 	return;
15076ed7257bSPatrick Caulfield 
15086ed7257bSPatrick Caulfield out_connect:
15096ed7257bSPatrick Caulfield 	mutex_unlock(&con->sock_mutex);
151001da24d3SBob Peterson 	queue_work(send_workqueue, &con->swork);
151101da24d3SBob Peterson 	cond_resched();
15126ed7257bSPatrick Caulfield }
15136ed7257bSPatrick Caulfield 
15146ed7257bSPatrick Caulfield static void clean_one_writequeue(struct connection *con)
15156ed7257bSPatrick Caulfield {
15165e9ccc37SChristine Caulfield 	struct writequeue_entry *e, *safe;
15176ed7257bSPatrick Caulfield 
15186ed7257bSPatrick Caulfield 	spin_lock(&con->writequeue_lock);
15195e9ccc37SChristine Caulfield 	list_for_each_entry_safe(e, safe, &con->writequeue, list) {
15206ed7257bSPatrick Caulfield 		list_del(&e->list);
15216ed7257bSPatrick Caulfield 		free_entry(e);
15226ed7257bSPatrick Caulfield 	}
15236ed7257bSPatrick Caulfield 	spin_unlock(&con->writequeue_lock);
15246ed7257bSPatrick Caulfield }
15256ed7257bSPatrick Caulfield 
15266ed7257bSPatrick Caulfield /* Called from recovery when it knows that a node has
15276ed7257bSPatrick Caulfield    left the cluster */
15286ed7257bSPatrick Caulfield int dlm_lowcomms_close(int nodeid)
15296ed7257bSPatrick Caulfield {
15306ed7257bSPatrick Caulfield 	struct connection *con;
153136b71a8bSDavid Teigland 	struct dlm_node_addr *na;
15326ed7257bSPatrick Caulfield 
15336ed7257bSPatrick Caulfield 	log_print("closing connection to node %d", nodeid);
15346ed7257bSPatrick Caulfield 	con = nodeid2con(nodeid, 0);
15356ed7257bSPatrick Caulfield 	if (con) {
1536063c4c99SLars Marowsky-Bree 		set_bit(CF_CLOSE, &con->flags);
15370d737a8cSMarcelo Ricardo Leitner 		close_connection(con, true, true, true);
15386ed7257bSPatrick Caulfield 		clean_one_writequeue(con);
153953a5edaaSAlexander Aring 		if (con->othercon)
154053a5edaaSAlexander Aring 			clean_one_writequeue(con->othercon);
15416ed7257bSPatrick Caulfield 	}
154236b71a8bSDavid Teigland 
154336b71a8bSDavid Teigland 	spin_lock(&dlm_node_addrs_spin);
154436b71a8bSDavid Teigland 	na = find_node_addr(nodeid);
154536b71a8bSDavid Teigland 	if (na) {
154636b71a8bSDavid Teigland 		list_del(&na->list);
154736b71a8bSDavid Teigland 		while (na->addr_count--)
154836b71a8bSDavid Teigland 			kfree(na->addr[na->addr_count]);
154936b71a8bSDavid Teigland 		kfree(na);
155036b71a8bSDavid Teigland 	}
155136b71a8bSDavid Teigland 	spin_unlock(&dlm_node_addrs_spin);
155236b71a8bSDavid Teigland 
15536ed7257bSPatrick Caulfield 	return 0;
15546ed7257bSPatrick Caulfield }
15556ed7257bSPatrick Caulfield 
15566ed7257bSPatrick Caulfield /* Receive workqueue function */
15576ed7257bSPatrick Caulfield static void process_recv_sockets(struct work_struct *work)
15586ed7257bSPatrick Caulfield {
15596ed7257bSPatrick Caulfield 	struct connection *con = container_of(work, struct connection, rwork);
15606ed7257bSPatrick Caulfield 	int err;
15616ed7257bSPatrick Caulfield 
15626ed7257bSPatrick Caulfield 	clear_bit(CF_READ_PENDING, &con->flags);
15636ed7257bSPatrick Caulfield 	do {
1564d11ccd45SAlexander Aring 		err = receive_from_sock(con);
15656ed7257bSPatrick Caulfield 	} while (!err);
15666ed7257bSPatrick Caulfield }
15676ed7257bSPatrick Caulfield 
1568d11ccd45SAlexander Aring static void process_listen_recv_socket(struct work_struct *work)
1569d11ccd45SAlexander Aring {
1570d11ccd45SAlexander Aring 	accept_from_sock(&listen_con);
1571d11ccd45SAlexander Aring }
1572d11ccd45SAlexander Aring 
15736ed7257bSPatrick Caulfield /* Send workqueue function */
15746ed7257bSPatrick Caulfield static void process_send_sockets(struct work_struct *work)
15756ed7257bSPatrick Caulfield {
15766ed7257bSPatrick Caulfield 	struct connection *con = container_of(work, struct connection, swork);
15776ed7257bSPatrick Caulfield 
15788a4abb08Stsutomu.owa@toshiba.co.jp 	clear_bit(CF_WRITE_PENDING, &con->flags);
157961d9102bSBob Peterson 	if (con->sock == NULL) /* not mutex protected so check it inside too */
15806ed7257bSPatrick Caulfield 		con->connect_action(con);
158101da24d3SBob Peterson 	if (!list_empty(&con->writequeue))
15826ed7257bSPatrick Caulfield 		send_to_sock(con);
15836ed7257bSPatrick Caulfield }
15846ed7257bSPatrick Caulfield 
15856ed7257bSPatrick Caulfield static void work_stop(void)
15866ed7257bSPatrick Caulfield {
1587b355516fSDavid Windsor 	if (recv_workqueue)
15886ed7257bSPatrick Caulfield 		destroy_workqueue(recv_workqueue);
1589b355516fSDavid Windsor 	if (send_workqueue)
15906ed7257bSPatrick Caulfield 		destroy_workqueue(send_workqueue);
15916ed7257bSPatrick Caulfield }
15926ed7257bSPatrick Caulfield 
15936ed7257bSPatrick Caulfield static int work_start(void)
15946ed7257bSPatrick Caulfield {
1595e43f055aSDavid Teigland 	recv_workqueue = alloc_workqueue("dlm_recv",
1596e43f055aSDavid Teigland 					 WQ_UNBOUND | WQ_MEM_RECLAIM, 1);
1597b9d41052SNamhyung Kim 	if (!recv_workqueue) {
1598b9d41052SNamhyung Kim 		log_print("can't start dlm_recv");
1599b9d41052SNamhyung Kim 		return -ENOMEM;
16006ed7257bSPatrick Caulfield 	}
16016ed7257bSPatrick Caulfield 
1602e43f055aSDavid Teigland 	send_workqueue = alloc_workqueue("dlm_send",
1603e43f055aSDavid Teigland 					 WQ_UNBOUND | WQ_MEM_RECLAIM, 1);
1604b9d41052SNamhyung Kim 	if (!send_workqueue) {
1605b9d41052SNamhyung Kim 		log_print("can't start dlm_send");
16066ed7257bSPatrick Caulfield 		destroy_workqueue(recv_workqueue);
1607b9d41052SNamhyung Kim 		return -ENOMEM;
16086ed7257bSPatrick Caulfield 	}
16096ed7257bSPatrick Caulfield 
16106ed7257bSPatrick Caulfield 	return 0;
16116ed7257bSPatrick Caulfield }
16126ed7257bSPatrick Caulfield 
1613f0fb83cbStsutomu.owa@toshiba.co.jp static void _stop_conn(struct connection *con, bool and_other)
16146ed7257bSPatrick Caulfield {
1615f0fb83cbStsutomu.owa@toshiba.co.jp 	mutex_lock(&con->sock_mutex);
1616173a31feStsutomu.owa@toshiba.co.jp 	set_bit(CF_CLOSE, &con->flags);
1617f0fb83cbStsutomu.owa@toshiba.co.jp 	set_bit(CF_READ_PENDING, &con->flags);
16188a4abb08Stsutomu.owa@toshiba.co.jp 	set_bit(CF_WRITE_PENDING, &con->flags);
161993eaadebStsutomu.owa@toshiba.co.jp 	if (con->sock && con->sock->sk) {
162093eaadebStsutomu.owa@toshiba.co.jp 		write_lock_bh(&con->sock->sk->sk_callback_lock);
1621afb853fbSPatrick Caulfield 		con->sock->sk->sk_user_data = NULL;
162293eaadebStsutomu.owa@toshiba.co.jp 		write_unlock_bh(&con->sock->sk->sk_callback_lock);
162393eaadebStsutomu.owa@toshiba.co.jp 	}
1624f0fb83cbStsutomu.owa@toshiba.co.jp 	if (con->othercon && and_other)
1625f0fb83cbStsutomu.owa@toshiba.co.jp 		_stop_conn(con->othercon, false);
1626f0fb83cbStsutomu.owa@toshiba.co.jp 	mutex_unlock(&con->sock_mutex);
1627f0fb83cbStsutomu.owa@toshiba.co.jp }
1628f0fb83cbStsutomu.owa@toshiba.co.jp 
1629f0fb83cbStsutomu.owa@toshiba.co.jp static void stop_conn(struct connection *con)
1630f0fb83cbStsutomu.owa@toshiba.co.jp {
1631f0fb83cbStsutomu.owa@toshiba.co.jp 	_stop_conn(con, true);
1632afb853fbSPatrick Caulfield }
16335e9ccc37SChristine Caulfield 
1634055923bfSAlexander Aring static void shutdown_conn(struct connection *con)
1635055923bfSAlexander Aring {
1636055923bfSAlexander Aring 	if (con->shutdown_action)
1637055923bfSAlexander Aring 		con->shutdown_action(con);
1638055923bfSAlexander Aring }
1639055923bfSAlexander Aring 
16404798cbbfSAlexander Aring static void connection_release(struct rcu_head *rcu)
16414798cbbfSAlexander Aring {
16424798cbbfSAlexander Aring 	struct connection *con = container_of(rcu, struct connection, rcu);
16434798cbbfSAlexander Aring 
16444798cbbfSAlexander Aring 	kfree(con->rx_buf);
16454798cbbfSAlexander Aring 	kfree(con);
16464798cbbfSAlexander Aring }
16474798cbbfSAlexander Aring 
16485e9ccc37SChristine Caulfield static void free_conn(struct connection *con)
16495e9ccc37SChristine Caulfield {
16500d737a8cSMarcelo Ricardo Leitner 	close_connection(con, true, true, true);
1651a47666ebSAlexander Aring 	spin_lock(&connections_lock);
1652a47666ebSAlexander Aring 	hlist_del_rcu(&con->list);
1653a47666ebSAlexander Aring 	spin_unlock(&connections_lock);
1654948c47e9SAlexander Aring 	if (con->othercon) {
1655948c47e9SAlexander Aring 		clean_one_writequeue(con->othercon);
16565cbec208SAlexander Aring 		call_srcu(&connections_srcu, &con->othercon->rcu,
16575cbec208SAlexander Aring 			  connection_release);
1658948c47e9SAlexander Aring 	}
16590de98432SAlexander Aring 	clean_one_writequeue(con);
16605cbec208SAlexander Aring 	call_srcu(&connections_srcu, &con->rcu, connection_release);
16616ed7257bSPatrick Caulfield }
16625e9ccc37SChristine Caulfield 
1663f0fb83cbStsutomu.owa@toshiba.co.jp static void work_flush(void)
1664f0fb83cbStsutomu.owa@toshiba.co.jp {
1665a47666ebSAlexander Aring 	int ok, idx;
1666f0fb83cbStsutomu.owa@toshiba.co.jp 	int i;
1667f0fb83cbStsutomu.owa@toshiba.co.jp 	struct connection *con;
1668f0fb83cbStsutomu.owa@toshiba.co.jp 
1669f0fb83cbStsutomu.owa@toshiba.co.jp 	do {
1670f0fb83cbStsutomu.owa@toshiba.co.jp 		ok = 1;
1671f0fb83cbStsutomu.owa@toshiba.co.jp 		foreach_conn(stop_conn);
1672b355516fSDavid Windsor 		if (recv_workqueue)
1673f0fb83cbStsutomu.owa@toshiba.co.jp 			flush_workqueue(recv_workqueue);
1674b355516fSDavid Windsor 		if (send_workqueue)
1675f0fb83cbStsutomu.owa@toshiba.co.jp 			flush_workqueue(send_workqueue);
1676a47666ebSAlexander Aring 		idx = srcu_read_lock(&connections_srcu);
1677f0fb83cbStsutomu.owa@toshiba.co.jp 		for (i = 0; i < CONN_HASH_SIZE && ok; i++) {
1678a47666ebSAlexander Aring 			hlist_for_each_entry_rcu(con, &connection_hash[i],
1679a47666ebSAlexander Aring 						 list) {
1680f0fb83cbStsutomu.owa@toshiba.co.jp 				ok &= test_bit(CF_READ_PENDING, &con->flags);
16818a4abb08Stsutomu.owa@toshiba.co.jp 				ok &= test_bit(CF_WRITE_PENDING, &con->flags);
16828a4abb08Stsutomu.owa@toshiba.co.jp 				if (con->othercon) {
1683f0fb83cbStsutomu.owa@toshiba.co.jp 					ok &= test_bit(CF_READ_PENDING,
1684f0fb83cbStsutomu.owa@toshiba.co.jp 						       &con->othercon->flags);
16858a4abb08Stsutomu.owa@toshiba.co.jp 					ok &= test_bit(CF_WRITE_PENDING,
16868a4abb08Stsutomu.owa@toshiba.co.jp 						       &con->othercon->flags);
16878a4abb08Stsutomu.owa@toshiba.co.jp 				}
1688f0fb83cbStsutomu.owa@toshiba.co.jp 			}
1689f0fb83cbStsutomu.owa@toshiba.co.jp 		}
1690a47666ebSAlexander Aring 		srcu_read_unlock(&connections_srcu, idx);
1691f0fb83cbStsutomu.owa@toshiba.co.jp 	} while (!ok);
1692f0fb83cbStsutomu.owa@toshiba.co.jp }
1693f0fb83cbStsutomu.owa@toshiba.co.jp 
16945e9ccc37SChristine Caulfield void dlm_lowcomms_stop(void)
16955e9ccc37SChristine Caulfield {
16965e9ccc37SChristine Caulfield 	/* Set all the flags to prevent any
16975e9ccc37SChristine Caulfield 	   socket activity.
16985e9ccc37SChristine Caulfield 	*/
1699513ef596SDavid Teigland 	dlm_allow_conn = 0;
1700aa7ab1e2SAlexander Aring 
1701aa7ab1e2SAlexander Aring 	if (recv_workqueue)
1702aa7ab1e2SAlexander Aring 		flush_workqueue(recv_workqueue);
1703aa7ab1e2SAlexander Aring 	if (send_workqueue)
1704aa7ab1e2SAlexander Aring 		flush_workqueue(send_workqueue);
1705aa7ab1e2SAlexander Aring 
1706d11ccd45SAlexander Aring 	dlm_close_sock(&listen_con.sock);
1707d11ccd45SAlexander Aring 
1708055923bfSAlexander Aring 	foreach_conn(shutdown_conn);
1709f0fb83cbStsutomu.owa@toshiba.co.jp 	work_flush();
17103a8db798SMarcelo Ricardo Leitner 	foreach_conn(free_conn);
17116ed7257bSPatrick Caulfield 	work_stop();
1712043697f0SAlexander Aring 	deinit_local();
17136ed7257bSPatrick Caulfield }
17146ed7257bSPatrick Caulfield 
17156ed7257bSPatrick Caulfield int dlm_lowcomms_start(void)
17166ed7257bSPatrick Caulfield {
17176ed7257bSPatrick Caulfield 	int error = -EINVAL;
17185e9ccc37SChristine Caulfield 	int i;
17195e9ccc37SChristine Caulfield 
17205e9ccc37SChristine Caulfield 	for (i = 0; i < CONN_HASH_SIZE; i++)
17215e9ccc37SChristine Caulfield 		INIT_HLIST_HEAD(&connection_hash[i]);
17226ed7257bSPatrick Caulfield 
17236ed7257bSPatrick Caulfield 	init_local();
17246ed7257bSPatrick Caulfield 	if (!dlm_local_count) {
1725617e82e1SDavid Teigland 		error = -ENOTCONN;
17266ed7257bSPatrick Caulfield 		log_print("no local IP address has been set");
1727513ef596SDavid Teigland 		goto fail;
17286ed7257bSPatrick Caulfield 	}
17296ed7257bSPatrick Caulfield 
1730d11ccd45SAlexander Aring 	INIT_WORK(&listen_con.rwork, process_listen_recv_socket);
1731d11ccd45SAlexander Aring 
1732513ef596SDavid Teigland 	error = work_start();
1733513ef596SDavid Teigland 	if (error)
1734a47666ebSAlexander Aring 		goto fail;
1735513ef596SDavid Teigland 
1736513ef596SDavid Teigland 	dlm_allow_conn = 1;
17376ed7257bSPatrick Caulfield 
17386ed7257bSPatrick Caulfield 	/* Start listening */
17396ed7257bSPatrick Caulfield 	if (dlm_config.ci_protocol == 0)
17406ed7257bSPatrick Caulfield 		error = tcp_listen_for_all();
17416ed7257bSPatrick Caulfield 	else
1742d11ccd45SAlexander Aring 		error = sctp_listen_for_all(&listen_con);
17436ed7257bSPatrick Caulfield 	if (error)
17446ed7257bSPatrick Caulfield 		goto fail_unlisten;
17456ed7257bSPatrick Caulfield 
17466ed7257bSPatrick Caulfield 	return 0;
17476ed7257bSPatrick Caulfield 
17486ed7257bSPatrick Caulfield fail_unlisten:
1749513ef596SDavid Teigland 	dlm_allow_conn = 0;
1750d11ccd45SAlexander Aring 	dlm_close_sock(&listen_con.sock);
1751513ef596SDavid Teigland fail:
17526ed7257bSPatrick Caulfield 	return error;
17536ed7257bSPatrick Caulfield }
175436b71a8bSDavid Teigland 
175536b71a8bSDavid Teigland void dlm_lowcomms_exit(void)
175636b71a8bSDavid Teigland {
175736b71a8bSDavid Teigland 	struct dlm_node_addr *na, *safe;
175836b71a8bSDavid Teigland 
175936b71a8bSDavid Teigland 	spin_lock(&dlm_node_addrs_spin);
176036b71a8bSDavid Teigland 	list_for_each_entry_safe(na, safe, &dlm_node_addrs, list) {
176136b71a8bSDavid Teigland 		list_del(&na->list);
176236b71a8bSDavid Teigland 		while (na->addr_count--)
176336b71a8bSDavid Teigland 			kfree(na->addr[na->addr_count]);
176436b71a8bSDavid Teigland 		kfree(na);
176536b71a8bSDavid Teigland 	}
176636b71a8bSDavid Teigland 	spin_unlock(&dlm_node_addrs_spin);
176736b71a8bSDavid Teigland }
1768