lowcomms.c 41.5 KB
Newer Older
1
// SPDX-License-Identifier: GPL-2.0-only
2 3 4 5
/******************************************************************************
*******************************************************************************
**
**  Copyright (C) Sistina Software, Inc.  1997-2003  All rights reserved.
6
**  Copyright (C) 2004-2009 Red Hat, Inc.  All rights reserved.
7 8 9 10 11 12 13 14 15 16 17 18 19 20 21
**
**
*******************************************************************************
******************************************************************************/

/*
 * lowcomms.c
 *
 * This is the "low-level" comms layer.
 *
 * It is responsible for sending/receiving messages
 * from other nodes in the cluster.
 *
 * Cluster nodes are referred to by their nodeids. nodeids are
 * simply 32 bit numbers to the locking module - if they need to
J
Joe Perches 已提交
22
 * be expanded for the cluster infrastructure then that is its
23 24 25 26 27 28 29 30 31 32 33 34 35 36
 * responsibility. It is this layer's
 * responsibility to resolve these into IP address or
 * whatever it needs for inter-node communication.
 *
 * The comms level is two kernel threads that deal mainly with
 * the receiving of messages from other nodes and passing them
 * up to the mid-level comms layer (which understands the
 * message format) for execution by the locking core, and
 * a send thread which does all the setting up of connections
 * to remote nodes and the sending of data. Threads are not allowed
 * to send their own data because it may cause them to wait in times
 * of high load. Also, this way, the sending thread can collect together
 * messages bound for one node and send them in one block.
 *
J
Joe Perches 已提交
37
 * lowcomms will choose to use either TCP or SCTP as its transport layer
38
 * depending on the configuration variable 'protocol'. This should be set
J
Joe Perches 已提交
39
 * to 0 (default) for TCP or 1 for SCTP. It should be configured using a
40 41
 * cluster-wide mechanism as it must be the same on all nodes of the cluster
 * for the DLM to function.
42 43 44 45 46 47 48
 *
 */

#include <asm/ioctls.h>
#include <net/sock.h>
#include <net/tcp.h>
#include <linux/pagemap.h>
49
#include <linux/file.h>
50
#include <linux/mutex.h>
51
#include <linux/sctp.h>
52
#include <linux/slab.h>
53
#include <net/sctp/sctp.h>
J
Joe Perches 已提交
54
#include <net/ipv6.h>
55 56 57 58 59 60

#include "dlm_internal.h"
#include "lowcomms.h"
#include "midcomms.h"
#include "config.h"

61
#define NEEDED_RMEM (4*1024*1024)
62
#define CONN_HASH_SIZE 32
63

64 65
/* Number of messages to send before rescheduling */
#define MAX_SEND_MSG_COUNT 25
66
#define DLM_SHUTDOWN_WAIT_TIMEOUT msecs_to_jiffies(10000)
67

68
struct cbuf {
P
Patrick Caulfield 已提交
69 70 71
	unsigned int base;
	unsigned int len;
	unsigned int mask;
72 73
};

P
Patrick Caulfield 已提交
74 75 76 77
static void cbuf_add(struct cbuf *cb, int n)
{
	cb->len += n;
}
78

P
Patrick Caulfield 已提交
79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100
static int cbuf_data(struct cbuf *cb)
{
	return ((cb->base + cb->len) & cb->mask);
}

static void cbuf_init(struct cbuf *cb, int size)
{
	cb->base = cb->len = 0;
	cb->mask = size-1;
}

static void cbuf_eat(struct cbuf *cb, int n)
{
	cb->len  -= n;
	cb->base += n;
	cb->base &= cb->mask;
}

static bool cbuf_empty(struct cbuf *cb)
{
	return cb->len == 0;
}
101 102 103 104

struct connection {
	struct socket *sock;	/* NULL if not connected */
	uint32_t nodeid;	/* So we know who we are in the list */
105
	struct mutex sock_mutex;
106
	unsigned long flags;
107
#define CF_READ_PENDING 1
108
#define CF_WRITE_PENDING 2
109 110
#define CF_INIT_PENDING 4
#define CF_IS_OTHERCON 5
111
#define CF_CLOSE 6
112
#define CF_APP_LIMITED 7
113
#define CF_CLOSING 8
114
#define CF_SHUTDOWN 9
P
Patrick Caulfield 已提交
115
	struct list_head writequeue;  /* List of outgoing writequeue_entries */
116 117
	spinlock_t writequeue_lock;
	int (*rx_action) (struct connection *);	/* What to do when active */
118
	void (*connect_action) (struct connection *);	/* What to do to connect */
119
	void (*shutdown_action)(struct connection *con); /* What to do to shutdown */
120 121 122 123
	struct page *rx_page;
	struct cbuf cb;
	int retries;
#define MAX_CONNECT_RETRIES 3
124
	struct hlist_node list;
125
	struct connection *othercon;
126 127
	struct work_struct rwork; /* Receive workqueue */
	struct work_struct swork; /* Send workqueue */
128
	wait_queue_head_t shutdown_wait; /* wait for graceful shutdown */
129
	struct rcu_head rcu;
130 131 132 133 134 135 136 137 138 139 140 141 142 143
};
#define sock2con(x) ((struct connection *)(x)->sk_user_data)

/* An entry waiting to be sent */
struct writequeue_entry {
	struct list_head list;
	struct page *page;
	int offset;
	int len;
	int end;
	int users;
	struct connection *con;
};

144 145 146 147
struct dlm_node_addr {
	struct list_head list;
	int nodeid;
	int addr_count;
148
	int curr_addr_index;
149 150 151
	struct sockaddr_storage *addr[DLM_MAX_ADDR_COUNT];
};

B
Bob Peterson 已提交
152 153 154 155 156 157 158
static struct listen_sock_callbacks {
	void (*sk_error_report)(struct sock *);
	void (*sk_data_ready)(struct sock *);
	void (*sk_state_change)(struct sock *);
	void (*sk_write_space)(struct sock *);
} listen_sock;

159 160 161
static LIST_HEAD(dlm_node_addrs);
static DEFINE_SPINLOCK(dlm_node_addrs_spin);

162 163
static struct sockaddr_storage *dlm_local_addr[DLM_MAX_ADDR_COUNT];
static int dlm_local_count;
164
static int dlm_allow_conn;
165

166 167 168
/* Work queues */
static struct workqueue_struct *recv_workqueue;
static struct workqueue_struct *send_workqueue;
169

170
static struct hlist_head connection_hash[CONN_HASH_SIZE];
171 172
static DEFINE_SPINLOCK(connections_lock);
DEFINE_STATIC_SRCU(connections_srcu);
173

174 175
static void process_recv_sockets(struct work_struct *work);
static void process_send_sockets(struct work_struct *work);
176

177 178 179 180 181 182 183 184 185 186 187

/* This is deliberately very simple because most clusters have simple
   sequential nodeids, so we should be able to go straight to a connection
   struct in the array */
static inline int nodeid_hash(int nodeid)
{
	return nodeid & (CONN_HASH_SIZE-1);
}

static struct connection *__find_con(int nodeid)
{
188
	int r, idx;
189 190 191 192
	struct connection *con;

	r = nodeid_hash(nodeid);

193 194 195 196
	idx = srcu_read_lock(&connections_srcu);
	hlist_for_each_entry_rcu(con, &connection_hash[r], list) {
		if (con->nodeid == nodeid) {
			srcu_read_unlock(&connections_srcu, idx);
197
			return con;
198
		}
199
	}
200 201
	srcu_read_unlock(&connections_srcu, idx);

202 203 204
	return NULL;
}

205 206 207 208
/*
 * If 'allocation' is zero then we don't attempt to create a new
 * connection structure for this node.
 */
209
static struct connection *nodeid2con(int nodeid, gfp_t alloc)
210 211
{
	struct connection *con = NULL;
212
	int r;
213

214
	con = __find_con(nodeid);
215 216
	if (con || !alloc)
		return con;
217

218
	con = kzalloc(sizeof(*con), alloc);
219 220
	if (!con)
		return NULL;
221

222 223 224 225 226 227
	con->nodeid = nodeid;
	mutex_init(&con->sock_mutex);
	INIT_LIST_HEAD(&con->writequeue);
	spin_lock_init(&con->writequeue_lock);
	INIT_WORK(&con->swork, process_send_sockets);
	INIT_WORK(&con->rwork, process_recv_sockets);
228
	init_waitqueue_head(&con->shutdown_wait);
229

230 231
	/* Setup action pointers for child sockets */
	if (con->nodeid) {
232
		struct connection *zerocon = __find_con(0);
233

234 235 236
		con->connect_action = zerocon->connect_action;
		if (!con->rx_action)
			con->rx_action = zerocon->rx_action;
237 238
	}

239 240 241 242 243 244
	r = nodeid_hash(nodeid);

	spin_lock(&connections_lock);
	hlist_add_head_rcu(&con->list, &connection_hash[r]);
	spin_unlock(&connections_lock);

245 246 247
	return con;
}

248 249 250
/* Loop round all connections */
static void foreach_conn(void (*conn_func)(struct connection *c))
{
251
	int i, idx;
252 253
	struct connection *con;

254
	idx = srcu_read_lock(&connections_srcu);
255
	for (i = 0; i < CONN_HASH_SIZE; i++) {
256
		hlist_for_each_entry_rcu(con, &connection_hash[i], list)
257 258
			conn_func(con);
	}
259
	srcu_read_unlock(&connections_srcu, idx);
260 261
}

262 263 264 265 266 267 268 269 270 271 272 273
static struct dlm_node_addr *find_node_addr(int nodeid)
{
	struct dlm_node_addr *na;

	list_for_each_entry(na, &dlm_node_addrs, list) {
		if (na->nodeid == nodeid)
			return na;
	}
	return NULL;
}

static int addr_compare(struct sockaddr_storage *x, struct sockaddr_storage *y)
274
{
275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300
	switch (x->ss_family) {
	case AF_INET: {
		struct sockaddr_in *sinx = (struct sockaddr_in *)x;
		struct sockaddr_in *siny = (struct sockaddr_in *)y;
		if (sinx->sin_addr.s_addr != siny->sin_addr.s_addr)
			return 0;
		if (sinx->sin_port != siny->sin_port)
			return 0;
		break;
	}
	case AF_INET6: {
		struct sockaddr_in6 *sinx = (struct sockaddr_in6 *)x;
		struct sockaddr_in6 *siny = (struct sockaddr_in6 *)y;
		if (!ipv6_addr_equal(&sinx->sin6_addr, &siny->sin6_addr))
			return 0;
		if (sinx->sin6_port != siny->sin6_port)
			return 0;
		break;
	}
	default:
		return 0;
	}
	return 1;
}

static int nodeid_to_addr(int nodeid, struct sockaddr_storage *sas_out,
301
			  struct sockaddr *sa_out, bool try_new_addr)
302 303 304
{
	struct sockaddr_storage sas;
	struct dlm_node_addr *na;
305 306 307 308

	if (!dlm_local_count)
		return -1;

309 310
	spin_lock(&dlm_node_addrs_spin);
	na = find_node_addr(nodeid);
311
	if (na && na->addr_count) {
312 313 314
		memcpy(&sas, na->addr[na->curr_addr_index],
		       sizeof(struct sockaddr_storage));

315 316 317 318 319 320
		if (try_new_addr) {
			na->curr_addr_index++;
			if (na->curr_addr_index == na->addr_count)
				na->curr_addr_index = 0;
		}
	}
321 322 323 324 325 326 327 328 329 330 331 332 333
	spin_unlock(&dlm_node_addrs_spin);

	if (!na)
		return -EEXIST;

	if (!na->addr_count)
		return -ENOENT;

	if (sas_out)
		memcpy(sas_out, &sas, sizeof(struct sockaddr_storage));

	if (!sa_out)
		return 0;
334 335

	if (dlm_local_addr[0]->ss_family == AF_INET) {
336 337
		struct sockaddr_in *in4  = (struct sockaddr_in *) &sas;
		struct sockaddr_in *ret4 = (struct sockaddr_in *) sa_out;
338 339
		ret4->sin_addr.s_addr = in4->sin_addr.s_addr;
	} else {
340 341
		struct sockaddr_in6 *in6  = (struct sockaddr_in6 *) &sas;
		struct sockaddr_in6 *ret6 = (struct sockaddr_in6 *) sa_out;
A
Alexey Dobriyan 已提交
342
		ret6->sin6_addr = in6->sin6_addr;
343 344 345 346 347
	}

	return 0;
}

348 349 350 351
static int addr_to_nodeid(struct sockaddr_storage *addr, int *nodeid)
{
	struct dlm_node_addr *na;
	int rv = -EEXIST;
352
	int addr_i;
353 354 355 356 357 358

	spin_lock(&dlm_node_addrs_spin);
	list_for_each_entry(na, &dlm_node_addrs, list) {
		if (!na->addr_count)
			continue;

359 360 361 362 363 364 365
		for (addr_i = 0; addr_i < na->addr_count; addr_i++) {
			if (addr_compare(na->addr[addr_i], addr)) {
				*nodeid = na->nodeid;
				rv = 0;
				goto unlock;
			}
		}
366
	}
367
unlock:
368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412
	spin_unlock(&dlm_node_addrs_spin);
	return rv;
}

int dlm_lowcomms_addr(int nodeid, struct sockaddr_storage *addr, int len)
{
	struct sockaddr_storage *new_addr;
	struct dlm_node_addr *new_node, *na;

	new_node = kzalloc(sizeof(struct dlm_node_addr), GFP_NOFS);
	if (!new_node)
		return -ENOMEM;

	new_addr = kzalloc(sizeof(struct sockaddr_storage), GFP_NOFS);
	if (!new_addr) {
		kfree(new_node);
		return -ENOMEM;
	}

	memcpy(new_addr, addr, len);

	spin_lock(&dlm_node_addrs_spin);
	na = find_node_addr(nodeid);
	if (!na) {
		new_node->nodeid = nodeid;
		new_node->addr[0] = new_addr;
		new_node->addr_count = 1;
		list_add(&new_node->list, &dlm_node_addrs);
		spin_unlock(&dlm_node_addrs_spin);
		return 0;
	}

	if (na->addr_count >= DLM_MAX_ADDR_COUNT) {
		spin_unlock(&dlm_node_addrs_spin);
		kfree(new_addr);
		kfree(new_node);
		return -ENOSPC;
	}

	na->addr[na->addr_count++] = new_addr;
	spin_unlock(&dlm_node_addrs_spin);
	kfree(new_node);
	return 0;
}

413
/* Data available on socket or listen socket received a connect */
414
static void lowcomms_data_ready(struct sock *sk)
415
{
416 417 418 419
	struct connection *con;

	read_lock_bh(&sk->sk_callback_lock);
	con = sock2con(sk);
P
Patrick Caulfield 已提交
420
	if (con && !test_and_set_bit(CF_READ_PENDING, &con->flags))
421
		queue_work(recv_workqueue, &con->rwork);
422
	read_unlock_bh(&sk->sk_callback_lock);
423 424 425 426
}

static void lowcomms_write_space(struct sock *sk)
{
427
	struct connection *con;
428

429 430
	read_lock_bh(&sk->sk_callback_lock);
	con = sock2con(sk);
431
	if (!con)
432
		goto out;
433 434 435 436 437

	clear_bit(SOCK_NOSPACE, &con->sock->flags);

	if (test_and_clear_bit(CF_APP_LIMITED, &con->flags)) {
		con->sock->sk->sk_write_pending--;
438
		clear_bit(SOCKWQ_ASYNC_NOSPACE, &con->sock->flags);
439 440
	}

441
	queue_work(send_workqueue, &con->swork);
442 443
out:
	read_unlock_bh(&sk->sk_callback_lock);
444 445 446 447
}

static inline void lowcomms_connect_sock(struct connection *con)
{
448 449
	if (test_bit(CF_CLOSE, &con->flags))
		return;
450 451
	queue_work(send_workqueue, &con->swork);
	cond_resched();
452 453 454 455
}

static void lowcomms_state_change(struct sock *sk)
{
456 457 458 459 460 461 462 463 464
	/* SCTP layer is not calling sk_data_ready when the connection
	 * is done, so we catch the signal through here. Also, it
	 * doesn't switch socket state when entering shutdown, so we
	 * skip the write in that case.
	 */
	if (sk->sk_shutdown) {
		if (sk->sk_shutdown == RCV_SHUTDOWN)
			lowcomms_data_ready(sk);
	} else if (sk->sk_state == TCP_ESTABLISHED) {
465
		lowcomms_write_space(sk);
466
	}
467 468
}

469 470 471 472 473 474 475 476 477 478 479 480 481 482
int dlm_lowcomms_connect_node(int nodeid)
{
	struct connection *con;

	if (nodeid == dlm_our_nodeid())
		return 0;

	con = nodeid2con(nodeid, GFP_NOFS);
	if (!con)
		return -ENOMEM;
	lowcomms_connect_sock(con);
	return 0;
}

483 484
static void lowcomms_error_report(struct sock *sk)
{
485
	struct connection *con;
486
	struct sockaddr_storage saddr;
487
	void (*orig_report)(struct sock *) = NULL;
488

489 490 491 492 493
	read_lock_bh(&sk->sk_callback_lock);
	con = sock2con(sk);
	if (con == NULL)
		goto out;

B
Bob Peterson 已提交
494
	orig_report = listen_sock.sk_error_report;
495
	if (con->sock == NULL ||
496
	    kernel_getpeername(con->sock, (struct sockaddr *)&saddr) < 0) {
497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523
		printk_ratelimited(KERN_ERR "dlm: node %d: socket error "
				   "sending to node %d, port %d, "
				   "sk_err=%d/%d\n", dlm_our_nodeid(),
				   con->nodeid, dlm_config.ci_tcp_port,
				   sk->sk_err, sk->sk_err_soft);
	} else if (saddr.ss_family == AF_INET) {
		struct sockaddr_in *sin4 = (struct sockaddr_in *)&saddr;

		printk_ratelimited(KERN_ERR "dlm: node %d: socket error "
				   "sending to node %d at %pI4, port %d, "
				   "sk_err=%d/%d\n", dlm_our_nodeid(),
				   con->nodeid, &sin4->sin_addr.s_addr,
				   dlm_config.ci_tcp_port, sk->sk_err,
				   sk->sk_err_soft);
	} else {
		struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)&saddr;

		printk_ratelimited(KERN_ERR "dlm: node %d: socket error "
				   "sending to node %d at %u.%u.%u.%u, "
				   "port %d, sk_err=%d/%d\n", dlm_our_nodeid(),
				   con->nodeid, sin6->sin6_addr.s6_addr32[0],
				   sin6->sin6_addr.s6_addr32[1],
				   sin6->sin6_addr.s6_addr32[2],
				   sin6->sin6_addr.s6_addr32[3],
				   dlm_config.ci_tcp_port, sk->sk_err,
				   sk->sk_err_soft);
	}
524 525 526 527 528 529 530
out:
	read_unlock_bh(&sk->sk_callback_lock);
	if (orig_report)
		orig_report(sk);
}

/* Note: sk_callback_lock must be locked before calling this function. */
B
Bob Peterson 已提交
531
static void save_listen_callbacks(struct socket *sock)
532
{
B
Bob Peterson 已提交
533 534 535 536 537 538
	struct sock *sk = sock->sk;

	listen_sock.sk_data_ready = sk->sk_data_ready;
	listen_sock.sk_state_change = sk->sk_state_change;
	listen_sock.sk_write_space = sk->sk_write_space;
	listen_sock.sk_error_report = sk->sk_error_report;
539 540
}

B
Bob Peterson 已提交
541
static void restore_callbacks(struct socket *sock)
542
{
B
Bob Peterson 已提交
543 544
	struct sock *sk = sock->sk;

545 546
	write_lock_bh(&sk->sk_callback_lock);
	sk->sk_user_data = NULL;
B
Bob Peterson 已提交
547 548 549 550
	sk->sk_data_ready = listen_sock.sk_data_ready;
	sk->sk_state_change = listen_sock.sk_state_change;
	sk->sk_write_space = listen_sock.sk_write_space;
	sk->sk_error_report = listen_sock.sk_error_report;
551
	write_unlock_bh(&sk->sk_callback_lock);
552 553
}

554
/* Make a socket active */
555
static void add_sock(struct socket *sock, struct connection *con)
556
{
557 558 559
	struct sock *sk = sock->sk;

	write_lock_bh(&sk->sk_callback_lock);
560 561
	con->sock = sock;

562
	sk->sk_user_data = con;
563
	/* Install a data_ready callback */
564 565 566 567 568 569
	sk->sk_data_ready = lowcomms_data_ready;
	sk->sk_write_space = lowcomms_write_space;
	sk->sk_state_change = lowcomms_state_change;
	sk->sk_allocation = GFP_NOFS;
	sk->sk_error_report = lowcomms_error_report;
	write_unlock_bh(&sk->sk_callback_lock);
570 571
}

572
/* Add the port number to an IPv6 or 4 sockaddr and return the address
573 574 575 576
   length */
static void make_sockaddr(struct sockaddr_storage *saddr, uint16_t port,
			  int *addr_len)
{
577
	saddr->ss_family =  dlm_local_addr[0]->ss_family;
P
Patrick Caulfield 已提交
578
	if (saddr->ss_family == AF_INET) {
579 580 581
		struct sockaddr_in *in4_addr = (struct sockaddr_in *)saddr;
		in4_addr->sin_port = cpu_to_be16(port);
		*addr_len = sizeof(struct sockaddr_in);
582
		memset(&in4_addr->sin_zero, 0, sizeof(in4_addr->sin_zero));
P
Patrick Caulfield 已提交
583
	} else {
584 585 586 587
		struct sockaddr_in6 *in6_addr = (struct sockaddr_in6 *)saddr;
		in6_addr->sin6_port = cpu_to_be16(port);
		*addr_len = sizeof(struct sockaddr_in6);
	}
588
	memset((char *)saddr + *addr_len, 0, sizeof(struct sockaddr_storage) - *addr_len);
589 590 591
}

/* Close a remote connection and tidy up */
592 593
static void close_connection(struct connection *con, bool and_other,
			     bool tx, bool rx)
594
{
595 596
	bool closing = test_and_set_bit(CF_CLOSING, &con->flags);

597
	if (tx && !closing && cancel_work_sync(&con->swork)) {
598
		log_print("canceled swork for node %d", con->nodeid);
599 600 601
		clear_bit(CF_WRITE_PENDING, &con->flags);
	}
	if (rx && !closing && cancel_work_sync(&con->rwork)) {
602
		log_print("canceled rwork for node %d", con->nodeid);
603 604
		clear_bit(CF_READ_PENDING, &con->flags);
	}
605

606
	mutex_lock(&con->sock_mutex);
607
	if (con->sock) {
B
Bob Peterson 已提交
608
		restore_callbacks(con->sock);
609 610 611 612
		sock_release(con->sock);
		con->sock = NULL;
	}
	if (con->othercon && and_other) {
P
Patrick Caulfield 已提交
613
		/* Will only re-enter once. */
614
		close_connection(con->othercon, false, true, true);
615 616 617 618 619
	}
	if (con->rx_page) {
		__free_page(con->rx_page);
		con->rx_page = NULL;
	}
P
Patrick Caulfield 已提交
620

621 622
	con->retries = 0;
	mutex_unlock(&con->sock_mutex);
623
	clear_bit(CF_CLOSING, &con->flags);
624 625
}

626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673
static void shutdown_connection(struct connection *con)
{
	int ret;

	if (cancel_work_sync(&con->swork)) {
		log_print("canceled swork for node %d", con->nodeid);
		clear_bit(CF_WRITE_PENDING, &con->flags);
	}

	mutex_lock(&con->sock_mutex);
	/* nothing to shutdown */
	if (!con->sock) {
		mutex_unlock(&con->sock_mutex);
		return;
	}

	set_bit(CF_SHUTDOWN, &con->flags);
	ret = kernel_sock_shutdown(con->sock, SHUT_WR);
	mutex_unlock(&con->sock_mutex);
	if (ret) {
		log_print("Connection %p failed to shutdown: %d will force close",
			  con, ret);
		goto force_close;
	} else {
		ret = wait_event_timeout(con->shutdown_wait,
					 !test_bit(CF_SHUTDOWN, &con->flags),
					 DLM_SHUTDOWN_WAIT_TIMEOUT);
		if (ret == 0) {
			log_print("Connection %p shutdown timed out, will force close",
				  con);
			goto force_close;
		}
	}

	return;

force_close:
	clear_bit(CF_SHUTDOWN, &con->flags);
	close_connection(con, false, true, true);
}

static void dlm_tcp_shutdown(struct connection *con)
{
	if (con->othercon)
		shutdown_connection(con->othercon);
	shutdown_connection(con);
}

674 675 676 677
/* Data received from remote end */
static int receive_from_sock(struct connection *con)
{
	int ret = 0;
A
Al Viro 已提交
678 679
	struct msghdr msg = {};
	struct kvec iov[2];
680 681 682
	unsigned len;
	int r;
	int call_again_soon = 0;
A
Al Viro 已提交
683
	int nvec;
684

685
	mutex_lock(&con->sock_mutex);
686

687 688 689 690
	if (con->sock == NULL) {
		ret = -EAGAIN;
		goto out_close;
	}
691 692 693 694
	if (con->nodeid == 0) {
		ret = -EINVAL;
		goto out_close;
	}
695

696 697 698 699 700 701 702 703
	if (con->rx_page == NULL) {
		/*
		 * This doesn't need to be atomic, but I think it should
		 * improve performance if it is.
		 */
		con->rx_page = alloc_page(GFP_ATOMIC);
		if (con->rx_page == NULL)
			goto out_resched;
704
		cbuf_init(&con->cb, PAGE_SIZE);
705 706 707 708 709 710
	}

	/*
	 * iov[0] is the bit of the circular buffer between the current end
	 * point (cb.base + cb.len) and the end of the buffer.
	 */
P
Patrick Caulfield 已提交
711 712
	iov[0].iov_len = con->cb.base - cbuf_data(&con->cb);
	iov[0].iov_base = page_address(con->rx_page) + cbuf_data(&con->cb);
713
	iov[1].iov_len = 0;
A
Al Viro 已提交
714
	nvec = 1;
715 716 717 718 719

	/*
	 * iov[1] is the bit of the circular buffer between the start of the
	 * buffer and the start of the currently used section (cb.base)
	 */
P
Patrick Caulfield 已提交
720
	if (cbuf_data(&con->cb) >= con->cb.base) {
721
		iov[0].iov_len = PAGE_SIZE - cbuf_data(&con->cb);
722 723
		iov[1].iov_len = con->cb.base;
		iov[1].iov_base = page_address(con->rx_page);
A
Al Viro 已提交
724
		nvec = 2;
725 726
	}
	len = iov[0].iov_len + iov[1].iov_len;
727
	iov_iter_kvec(&msg.msg_iter, READ, iov, nvec, len);
728

A
Al Viro 已提交
729
	r = ret = sock_recvmsg(con->sock, &msg, MSG_DONTWAIT | MSG_NOSIGNAL);
730 731
	if (ret <= 0)
		goto out_close;
732 733
	else if (ret == len)
		call_again_soon = 1;
P
Patrick Caulfield 已提交
734

P
Patrick Caulfield 已提交
735
	cbuf_add(&con->cb, ret);
736 737 738
	ret = dlm_process_incoming_buffer(con->nodeid,
					  page_address(con->rx_page),
					  con->cb.base, con->cb.len,
739
					  PAGE_SIZE);
740 741 742
	if (ret < 0) {
		log_print("lowcomms err %d: addr=%p, base=%u, len=%u, read=%d",
			  ret, page_address(con->rx_page), con->cb.base,
743
			  con->cb.len, r);
744 745 746
		cbuf_eat(&con->cb, r);
	} else {
		cbuf_eat(&con->cb, ret);
747 748
	}

P
Patrick Caulfield 已提交
749
	if (cbuf_empty(&con->cb) && !call_again_soon) {
750 751 752 753 754 755
		__free_page(con->rx_page);
		con->rx_page = NULL;
	}

	if (call_again_soon)
		goto out_resched;
756
	mutex_unlock(&con->sock_mutex);
P
Patrick Caulfield 已提交
757
	return 0;
758

P
Patrick Caulfield 已提交
759
out_resched:
760 761
	if (!test_and_set_bit(CF_READ_PENDING, &con->flags))
		queue_work(recv_workqueue, &con->rwork);
762
	mutex_unlock(&con->sock_mutex);
P
Patrick Caulfield 已提交
763
	return -EAGAIN;
764

P
Patrick Caulfield 已提交
765
out_close:
766
	mutex_unlock(&con->sock_mutex);
P
Patrick Caulfield 已提交
767
	if (ret != -EAGAIN) {
768
		/* Reconnect when there is something to send */
769 770 771 772 773 774 775 776 777 778
		close_connection(con, false, true, false);
		if (ret == 0) {
			log_print("connection %p got EOF from %d",
				  con, con->nodeid);
			/* handling for tcp shutdown */
			clear_bit(CF_SHUTDOWN, &con->flags);
			wake_up(&con->shutdown_wait);
			/* signal to breaking receive worker */
			ret = -1;
		}
779 780 781 782 783
	}
	return ret;
}

/* Listening socket is busy, accept a connection */
784
static int accept_from_sock(struct connection *con)
785 786 787 788 789 790 791
{
	int result;
	struct sockaddr_storage peeraddr;
	struct socket *newsock;
	int len;
	int nodeid;
	struct connection *newcon;
P
Patrick Caulfield 已提交
792
	struct connection *addcon;
793

794 795 796 797
	if (!dlm_allow_conn) {
		return -1;
	}

798
	mutex_lock_nested(&con->sock_mutex, 0);
799

800 801 802 803
	if (!con->sock) {
		mutex_unlock(&con->sock_mutex);
		return -ENOTCONN;
	}
804

805
	result = kernel_accept(con->sock, &newsock, O_NONBLOCK);
806 807 808 809 810
	if (result < 0)
		goto accept_err;

	/* Get the connected socket's peer */
	memset(&peeraddr, 0, sizeof(peeraddr));
811 812
	len = newsock->ops->getname(newsock, (struct sockaddr *)&peeraddr, 2);
	if (len < 0) {
813 814 815 816 817 818
		result = -ECONNABORTED;
		goto accept_err;
	}

	/* Get the new node's NODEID */
	make_sockaddr(&peeraddr, 0, &len);
819
	if (addr_to_nodeid(&peeraddr, &nodeid)) {
820
		unsigned char *b=(unsigned char *)&peeraddr;
D
David Teigland 已提交
821
		log_print("connect from non cluster node");
822 823
		print_hex_dump_bytes("ss: ", DUMP_PREFIX_NONE, 
				     b, sizeof(struct sockaddr_storage));
824
		sock_release(newsock);
825
		mutex_unlock(&con->sock_mutex);
826 827 828 829 830 831 832 833 834 835
		return -1;
	}

	log_print("got connection from %d", nodeid);

	/*  Check to see if we already have a connection to this node. This
	 *  could happen if the two nodes initiate a connection at roughly
	 *  the same time and the connections cross on the wire.
	 *  In this case we store the incoming one in "othercon"
	 */
D
David Teigland 已提交
836
	newcon = nodeid2con(nodeid, GFP_NOFS);
837 838 839 840
	if (!newcon) {
		result = -ENOMEM;
		goto accept_err;
	}
841
	mutex_lock_nested(&newcon->sock_mutex, 1);
842
	if (newcon->sock) {
P
Patrick Caulfield 已提交
843
		struct connection *othercon = newcon->othercon;
844 845

		if (!othercon) {
846
			othercon = kzalloc(sizeof(*othercon), GFP_NOFS);
847
			if (!othercon) {
D
David Teigland 已提交
848
				log_print("failed to allocate incoming socket");
849
				mutex_unlock(&newcon->sock_mutex);
850 851 852 853 854
				result = -ENOMEM;
				goto accept_err;
			}
			othercon->nodeid = nodeid;
			othercon->rx_action = receive_from_sock;
855
			mutex_init(&othercon->sock_mutex);
856 857
			INIT_LIST_HEAD(&othercon->writequeue);
			spin_lock_init(&othercon->writequeue_lock);
858 859
			INIT_WORK(&othercon->swork, process_send_sockets);
			INIT_WORK(&othercon->rwork, process_recv_sockets);
860
			init_waitqueue_head(&othercon->shutdown_wait);
861
			set_bit(CF_IS_OTHERCON, &othercon->flags);
862 863 864
		} else {
			/* close other sock con if we have something new */
			close_connection(othercon, false, true, false);
865
		}
866

867
		mutex_lock_nested(&othercon->sock_mutex, 2);
868 869 870 871
		newcon->othercon = othercon;
		add_sock(newsock, othercon);
		addcon = othercon;
		mutex_unlock(&othercon->sock_mutex);
872 873 874
	}
	else {
		newcon->rx_action = receive_from_sock;
875 876 877
		/* accept copies the sk after we've saved the callbacks, so we
		   don't want to save them a second time or comm errors will
		   result in calling sk_error_report recursively. */
878
		add_sock(newsock, newcon);
P
Patrick Caulfield 已提交
879
		addcon = newcon;
880 881
	}

882
	mutex_unlock(&newcon->sock_mutex);
883 884 885

	/*
	 * Add it to the active queue in case we got data
L
Lucas De Marchi 已提交
886
	 * between processing the accept adding the socket
887 888
	 * to the read_sockets list
	 */
P
Patrick Caulfield 已提交
889 890
	if (!test_and_set_bit(CF_READ_PENDING, &addcon->flags))
		queue_work(recv_workqueue, &addcon->rwork);
891
	mutex_unlock(&con->sock_mutex);
892 893 894

	return 0;

P
Patrick Caulfield 已提交
895
accept_err:
896
	mutex_unlock(&con->sock_mutex);
897 898
	if (newsock)
		sock_release(newsock);
899 900

	if (result != -EAGAIN)
D
David Teigland 已提交
901
		log_print("error accepting connection from node: %d", result);
902 903 904
	return result;
}

905 906 907 908 909 910
static void free_entry(struct writequeue_entry *e)
{
	__free_page(e->page);
	kfree(e);
}

M
Mike Christie 已提交
911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928
/*
 * writequeue_entry_complete - try to delete and free write queue entry
 * @e: write queue entry to try to delete
 * @completed: bytes completed
 *
 * writequeue_lock must be held.
 */
static void writequeue_entry_complete(struct writequeue_entry *e, int completed)
{
	e->offset += completed;
	e->len -= completed;

	if (e->len == 0 && e->users == 0) {
		list_del(&e->list);
		free_entry(e);
	}
}

929 930 931 932 933 934
/*
 * sctp_bind_addrs - bind a SCTP socket to all our addresses
 */
static int sctp_bind_addrs(struct connection *con, uint16_t port)
{
	struct sockaddr_storage localaddr;
935
	struct sockaddr *addr = (struct sockaddr *)&localaddr;
936 937 938 939 940 941 942
	int i, addr_len, result = 0;

	for (i = 0; i < dlm_local_count; i++) {
		memcpy(&localaddr, dlm_local_addr[i], sizeof(localaddr));
		make_sockaddr(&localaddr, port, &addr_len);

		if (!i)
943
			result = kernel_bind(con->sock, addr, addr_len);
944
		else
945
			result = sock_bind_add(con->sock->sk, addr, addr_len);
946 947 948 949 950 951 952 953 954 955

		if (result < 0) {
			log_print("Can't bind to %d addr number %d, %d.\n",
				  port, i + 1, result);
			break;
		}
	}
	return result;
}

956 957 958 959 960
/* Initiate an SCTP association.
   This is a special case of send_to_sock() in that we don't yet have a
   peeled-off socket for this association, so we use the listening socket
   and add the primary IP address of the remote node.
 */
961
static void sctp_connect_to_sock(struct connection *con)
962
{
963 964 965 966
	struct sockaddr_storage daddr;
	int result;
	int addr_len;
	struct socket *sock;
967
	unsigned int mark;
968 969 970 971 972

	if (con->nodeid == 0) {
		log_print("attempt to connect sock 0 foiled");
		return;
	}
973

M
Mike Christie 已提交
974
	mutex_lock(&con->sock_mutex);
975

976 977 978 979 980 981 982 983 984 985 986 987
	/* Some odd races can cause double-connects, ignore them */
	if (con->retries++ > MAX_CONNECT_RETRIES)
		goto out;

	if (con->sock) {
		log_print("node %d already connected.", con->nodeid);
		goto out;
	}

	memset(&daddr, 0, sizeof(daddr));
	result = nodeid_to_addr(con->nodeid, &daddr, NULL, true);
	if (result < 0) {
988
		log_print("no address for nodeid %d", con->nodeid);
989
		goto out;
990 991
	}

992 993 994 995 996
	/* Create a socket to communicate with */
	result = sock_create_kern(&init_net, dlm_local_addr[0]->ss_family,
				  SOCK_STREAM, IPPROTO_SCTP, &sock);
	if (result < 0)
		goto socket_err;
997

998 999 1000 1001 1002 1003 1004
	/* set skb mark */
	result = dlm_comm_mark(con->nodeid, &mark);
	if (result < 0)
		goto bind_err;

	sock_set_mark(sock->sk, mark);

1005 1006
	con->rx_action = receive_from_sock;
	con->connect_action = sctp_connect_to_sock;
1007
	add_sock(sock, con);
1008

1009 1010 1011
	/* Bind to all addresses. */
	if (sctp_bind_addrs(con, 0))
		goto bind_err;
1012

1013
	make_sockaddr(&daddr, dlm_config.ci_tcp_port, &addr_len);
1014

1015
	log_print("connecting to %d", con->nodeid);
1016

1017
	/* Turn off Nagle's algorithm */
1018
	sctp_sock_set_nodelay(sock->sk);
1019

1020 1021 1022 1023 1024
	/*
	 * Make sock->ops->connect() function return in specified time,
	 * since O_NONBLOCK argument in connect() function does not work here,
	 * then, we should restore the default value of this attribute.
	 */
C
Christoph Hellwig 已提交
1025
	sock_set_sndtimeo(sock->sk, 5);
1026
	result = sock->ops->connect(sock, (struct sockaddr *)&daddr, addr_len,
1027
				   0);
C
Christoph Hellwig 已提交
1028
	sock_set_sndtimeo(sock->sk, 0);
1029

1030 1031 1032 1033
	if (result == -EINPROGRESS)
		result = 0;
	if (result == 0)
		goto out;
1034

1035 1036 1037
bind_err:
	con->sock = NULL;
	sock_release(sock);
1038

1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054
socket_err:
	/*
	 * Some errors are fatal and this list might need adjusting. For other
	 * errors we try again until the max number of retries is reached.
	 */
	if (result != -EHOSTUNREACH &&
	    result != -ENETUNREACH &&
	    result != -ENETDOWN &&
	    result != -EINVAL &&
	    result != -EPROTONOSUPPORT) {
		log_print("connect %d try %d error %d", con->nodeid,
			  con->retries, result);
		mutex_unlock(&con->sock_mutex);
		msleep(1000);
		lowcomms_connect_sock(con);
		return;
1055
	}
M
Mike Christie 已提交
1056

1057
out:
M
Mike Christie 已提交
1058
	mutex_unlock(&con->sock_mutex);
1059 1060
}

1061
/* Connect a new socket to its peer */
1062
static void tcp_connect_to_sock(struct connection *con)
1063
{
1064
	struct sockaddr_storage saddr, src_addr;
1065
	int addr_len;
1066
	struct socket *sock = NULL;
1067
	unsigned int mark;
1068
	int result;
1069 1070 1071

	if (con->nodeid == 0) {
		log_print("attempt to connect sock 0 foiled");
P
Patrick Caulfield 已提交
1072
		return;
1073 1074
	}

1075
	mutex_lock(&con->sock_mutex);
1076 1077 1078 1079
	if (con->retries++ > MAX_CONNECT_RETRIES)
		goto out;

	/* Some odd races can cause double-connects, ignore them */
1080
	if (con->sock)
1081 1082 1083
		goto out;

	/* Create a socket to communicate with */
1084 1085
	result = sock_create_kern(&init_net, dlm_local_addr[0]->ss_family,
				  SOCK_STREAM, IPPROTO_TCP, &sock);
1086 1087 1088
	if (result < 0)
		goto out_err;

1089 1090 1091 1092 1093 1094 1095
	/* set skb mark */
	result = dlm_comm_mark(con->nodeid, &mark);
	if (result < 0)
		goto out_err;

	sock_set_mark(sock->sk, mark);

1096
	memset(&saddr, 0, sizeof(saddr));
1097
	result = nodeid_to_addr(con->nodeid, &saddr, NULL, false);
1098 1099
	if (result < 0) {
		log_print("no address for nodeid %d", con->nodeid);
P
Patrick Caulfield 已提交
1100
		goto out_err;
1101
	}
1102 1103

	con->rx_action = receive_from_sock;
1104
	con->connect_action = tcp_connect_to_sock;
1105
	con->shutdown_action = dlm_tcp_shutdown;
1106
	add_sock(sock, con);
1107

1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118
	/* Bind to our cluster-known address connecting to avoid
	   routing problems */
	memcpy(&src_addr, dlm_local_addr[0], sizeof(src_addr));
	make_sockaddr(&src_addr, 0, &addr_len);
	result = sock->ops->bind(sock, (struct sockaddr *) &src_addr,
				 addr_len);
	if (result < 0) {
		log_print("could not bind for connect: %d", result);
		/* This *may* not indicate a critical error */
	}

1119
	make_sockaddr(&saddr, dlm_config.ci_tcp_port, &addr_len);
1120 1121

	log_print("connecting to %d", con->nodeid);
D
David Teigland 已提交
1122 1123

	/* Turn off Nagle's algorithm */
1124
	tcp_sock_set_nodelay(sock->sk);
D
David Teigland 已提交
1125

1126
	result = sock->ops->connect(sock, (struct sockaddr *)&saddr, addr_len,
P
Patrick Caulfield 已提交
1127
				   O_NONBLOCK);
1128 1129
	if (result == -EINPROGRESS)
		result = 0;
P
Patrick Caulfield 已提交
1130 1131
	if (result == 0)
		goto out;
1132

P
Patrick Caulfield 已提交
1133
out_err:
1134 1135 1136
	if (con->sock) {
		sock_release(con->sock);
		con->sock = NULL;
1137 1138
	} else if (sock) {
		sock_release(sock);
1139 1140 1141 1142 1143
	}
	/*
	 * Some errors are fatal and this list might need adjusting. For other
	 * errors we try again until the max number of retries is reached.
	 */
1144 1145 1146 1147 1148 1149 1150 1151 1152
	if (result != -EHOSTUNREACH &&
	    result != -ENETUNREACH &&
	    result != -ENETDOWN && 
	    result != -EINVAL &&
	    result != -EPROTONOSUPPORT) {
		log_print("connect %d try %d error %d", con->nodeid,
			  con->retries, result);
		mutex_unlock(&con->sock_mutex);
		msleep(1000);
1153
		lowcomms_connect_sock(con);
1154
		return;
1155
	}
P
Patrick Caulfield 已提交
1156
out:
1157
	mutex_unlock(&con->sock_mutex);
P
Patrick Caulfield 已提交
1158
	return;
1159 1160
}

1161 1162
static struct socket *tcp_create_listen_sock(struct connection *con,
					     struct sockaddr_storage *saddr)
1163
{
P
Patrick Caulfield 已提交
1164
	struct socket *sock = NULL;
1165 1166 1167
	int result = 0;
	int addr_len;

1168
	if (dlm_local_addr[0]->ss_family == AF_INET)
1169 1170 1171 1172 1173
		addr_len = sizeof(struct sockaddr_in);
	else
		addr_len = sizeof(struct sockaddr_in6);

	/* Create a socket to communicate with */
1174 1175
	result = sock_create_kern(&init_net, dlm_local_addr[0]->ss_family,
				  SOCK_STREAM, IPPROTO_TCP, &sock);
1176
	if (result < 0) {
D
David Teigland 已提交
1177
		log_print("Can't create listening comms socket");
1178 1179 1180
		goto create_out;
	}

1181 1182
	sock_set_mark(sock->sk, dlm_config.ci_mark);

D
David Teigland 已提交
1183
	/* Turn off Nagle's algorithm */
1184
	tcp_sock_set_nodelay(sock->sk);
D
David Teigland 已提交
1185

C
Christoph Hellwig 已提交
1186
	sock_set_reuseaddr(sock->sk);
1187

1188
	write_lock_bh(&sock->sk->sk_callback_lock);
1189
	sock->sk->sk_user_data = con;
B
Bob Peterson 已提交
1190
	save_listen_callbacks(sock);
1191
	con->rx_action = accept_from_sock;
1192
	con->connect_action = tcp_connect_to_sock;
1193
	write_unlock_bh(&sock->sk->sk_callback_lock);
1194 1195

	/* Bind to our port */
1196
	make_sockaddr(saddr, dlm_config.ci_tcp_port, &addr_len);
1197 1198
	result = sock->ops->bind(sock, (struct sockaddr *) saddr, addr_len);
	if (result < 0) {
D
David Teigland 已提交
1199
		log_print("Can't bind to port %d", dlm_config.ci_tcp_port);
1200 1201 1202 1203 1204
		sock_release(sock);
		sock = NULL;
		con->sock = NULL;
		goto create_out;
	}
C
Christoph Hellwig 已提交
1205
	sock_set_keepalive(sock->sk);
1206 1207 1208

	result = sock->ops->listen(sock, 5);
	if (result < 0) {
D
David Teigland 已提交
1209
		log_print("Can't listen on port %d", dlm_config.ci_tcp_port);
1210 1211 1212 1213 1214
		sock_release(sock);
		sock = NULL;
		goto create_out;
	}

P
Patrick Caulfield 已提交
1215
create_out:
1216 1217 1218
	return sock;
}

1219 1220 1221 1222 1223 1224
/* Get local addresses */
static void init_local(void)
{
	struct sockaddr_storage sas, *addr;
	int i;

1225
	dlm_local_count = 0;
1226
	for (i = 0; i < DLM_MAX_ADDR_COUNT; i++) {
1227 1228 1229
		if (dlm_our_addr(&sas, i))
			break;

1230
		addr = kmemdup(&sas, sizeof(*addr), GFP_NOFS);
1231 1232 1233 1234 1235 1236
		if (!addr)
			break;
		dlm_local_addr[dlm_local_count++] = addr;
	}
}

1237 1238 1239 1240 1241 1242 1243 1244
static void deinit_local(void)
{
	int i;

	for (i = 0; i < dlm_local_count; i++)
		kfree(dlm_local_addr[i]);
}

1245 1246 1247 1248
/* Initialise SCTP socket and bind to all interfaces */
static int sctp_listen_for_all(void)
{
	struct socket *sock = NULL;
1249
	int result = -EINVAL;
D
David Teigland 已提交
1250
	struct connection *con = nodeid2con(0, GFP_NOFS);
1251 1252 1253 1254 1255 1256

	if (!con)
		return -ENOMEM;

	log_print("Using SCTP for communications");

1257
	result = sock_create_kern(&init_net, dlm_local_addr[0]->ss_family,
1258
				  SOCK_STREAM, IPPROTO_SCTP, &sock);
1259 1260 1261 1262 1263
	if (result < 0) {
		log_print("Can't create comms socket, check SCTP is loaded");
		goto out;
	}

C
Christoph Hellwig 已提交
1264
	sock_set_rcvbuf(sock->sk, NEEDED_RMEM);
1265
	sock_set_mark(sock->sk, dlm_config.ci_mark);
1266
	sctp_sock_set_nodelay(sock->sk);
M
Mike Christie 已提交
1267

1268
	write_lock_bh(&sock->sk->sk_callback_lock);
1269 1270
	/* Init con struct */
	sock->sk->sk_user_data = con;
B
Bob Peterson 已提交
1271
	save_listen_callbacks(sock);
1272 1273
	con->sock = sock;
	con->sock->sk->sk_data_ready = lowcomms_data_ready;
1274
	con->rx_action = accept_from_sock;
1275
	con->connect_action = sctp_connect_to_sock;
1276

1277 1278
	write_unlock_bh(&sock->sk->sk_callback_lock);

1279 1280 1281
	/* Bind to all addresses. */
	if (sctp_bind_addrs(con, dlm_config.ci_tcp_port))
		goto create_delsock;
1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298

	result = sock->ops->listen(sock, 5);
	if (result < 0) {
		log_print("Can't set socket listening");
		goto create_delsock;
	}

	return 0;

create_delsock:
	sock_release(sock);
	con->sock = NULL;
out:
	return result;
}

static int tcp_listen_for_all(void)
1299 1300
{
	struct socket *sock = NULL;
D
David Teigland 已提交
1301
	struct connection *con = nodeid2con(0, GFP_NOFS);
1302 1303
	int result = -EINVAL;

1304 1305 1306
	if (!con)
		return -ENOMEM;

1307
	/* We don't support multi-homed hosts */
1308
	if (dlm_local_addr[1] != NULL) {
D
David Teigland 已提交
1309 1310
		log_print("TCP protocol can't handle multi-homed hosts, "
			  "try SCTP");
1311 1312 1313 1314 1315 1316
		return -EINVAL;
	}

	log_print("Using TCP for communications");

	sock = tcp_create_listen_sock(con, dlm_local_addr[0]);
1317
	if (sock) {
1318
		add_sock(sock, con);
1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353
		result = 0;
	}
	else {
		result = -EADDRINUSE;
	}

	return result;
}



static struct writequeue_entry *new_writequeue_entry(struct connection *con,
						     gfp_t allocation)
{
	struct writequeue_entry *entry;

	entry = kmalloc(sizeof(struct writequeue_entry), allocation);
	if (!entry)
		return NULL;

	entry->page = alloc_page(allocation);
	if (!entry->page) {
		kfree(entry);
		return NULL;
	}

	entry->offset = 0;
	entry->len = 0;
	entry->end = 0;
	entry->users = 0;
	entry->con = con;

	return entry;
}

D
David Teigland 已提交
1354
void *dlm_lowcomms_get_buffer(int nodeid, int len, gfp_t allocation, char **ppc)
1355 1356 1357 1358 1359 1360 1361 1362 1363
{
	struct connection *con;
	struct writequeue_entry *e;
	int offset = 0;

	con = nodeid2con(nodeid, allocation);
	if (!con)
		return NULL;

1364
	spin_lock(&con->writequeue_lock);
1365
	e = list_entry(con->writequeue.prev, struct writequeue_entry, list);
P
Patrick Caulfield 已提交
1366
	if ((&e->list == &con->writequeue) ||
1367
	    (PAGE_SIZE - e->end < len)) {
1368 1369 1370 1371
		e = NULL;
	} else {
		offset = e->end;
		e->end += len;
1372
		e->users++;
1373 1374 1375 1376
	}
	spin_unlock(&con->writequeue_lock);

	if (e) {
P
Patrick Caulfield 已提交
1377
	got_one:
1378 1379 1380 1381 1382 1383 1384 1385 1386
		*ppc = page_address(e->page) + offset;
		return e;
	}

	e = new_writequeue_entry(con, allocation);
	if (e) {
		spin_lock(&con->writequeue_lock);
		offset = e->end;
		e->end += len;
1387
		e->users++;
1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400
		list_add_tail(&e->list, &con->writequeue);
		spin_unlock(&con->writequeue_lock);
		goto got_one;
	}
	return NULL;
}

void dlm_lowcomms_commit_buffer(void *mh)
{
	struct writequeue_entry *e = (struct writequeue_entry *)mh;
	struct connection *con = e->con;
	int users;

1401
	spin_lock(&con->writequeue_lock);
1402 1403 1404 1405 1406 1407
	users = --e->users;
	if (users)
		goto out;
	e->len = e->end - e->offset;
	spin_unlock(&con->writequeue_lock);

1408
	queue_work(send_workqueue, &con->swork);
1409 1410
	return;

P
Patrick Caulfield 已提交
1411
out:
1412 1413 1414 1415 1416
	spin_unlock(&con->writequeue_lock);
	return;
}

/* Send a message */
P
Patrick Caulfield 已提交
1417
static void send_to_sock(struct connection *con)
1418 1419 1420 1421 1422
{
	int ret = 0;
	const int msg_flags = MSG_DONTWAIT | MSG_NOSIGNAL;
	struct writequeue_entry *e;
	int len, offset;
1423
	int count = 0;
1424

1425
	mutex_lock(&con->sock_mutex);
1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442
	if (con->sock == NULL)
		goto out_connect;

	spin_lock(&con->writequeue_lock);
	for (;;) {
		e = list_entry(con->writequeue.next, struct writequeue_entry,
			       list);
		if ((struct list_head *) e == &con->writequeue)
			break;

		len = e->len;
		offset = e->offset;
		BUG_ON(len == 0 && e->users == 0);
		spin_unlock(&con->writequeue_lock);

		ret = 0;
		if (len) {
P
Paolo Bonzini 已提交
1443 1444
			ret = kernel_sendpage(con->sock, e->page, offset, len,
					      msg_flags);
1445
			if (ret == -EAGAIN || ret == 0) {
1446
				if (ret == -EAGAIN &&
1447
				    test_bit(SOCKWQ_ASYNC_NOSPACE, &con->sock->flags) &&
1448 1449 1450 1451 1452 1453 1454
				    !test_and_set_bit(CF_APP_LIMITED, &con->flags)) {
					/* Notify TCP that we're limited by the
					 * application window size.
					 */
					set_bit(SOCK_NOSPACE, &con->sock->flags);
					con->sock->sk->sk_write_pending++;
				}
1455
				cond_resched();
1456
				goto out;
Y
Ying Xue 已提交
1457
			} else if (ret < 0)
1458
				goto send_error;
1459
		}
1460 1461 1462

		/* Don't starve people filling buffers */
		if (++count >= MAX_SEND_MSG_COUNT) {
P
Patrick Caulfield 已提交
1463
			cond_resched();
1464 1465
			count = 0;
		}
1466 1467

		spin_lock(&con->writequeue_lock);
M
Mike Christie 已提交
1468
		writequeue_entry_complete(e, ret);
1469 1470
	}
	spin_unlock(&con->writequeue_lock);
P
Patrick Caulfield 已提交
1471
out:
1472
	mutex_unlock(&con->sock_mutex);
P
Patrick Caulfield 已提交
1473
	return;
1474

P
Patrick Caulfield 已提交
1475
send_error:
1476
	mutex_unlock(&con->sock_mutex);
1477
	close_connection(con, false, false, true);
1478 1479 1480
	/* Requeue the send work. When the work daemon runs again, it will try
	   a new connection, then call this function again. */
	queue_work(send_workqueue, &con->swork);
P
Patrick Caulfield 已提交
1481
	return;
1482

P
Patrick Caulfield 已提交
1483
out_connect:
1484
	mutex_unlock(&con->sock_mutex);
1485 1486
	queue_work(send_workqueue, &con->swork);
	cond_resched();
1487 1488 1489 1490
}

static void clean_one_writequeue(struct connection *con)
{
1491
	struct writequeue_entry *e, *safe;
1492 1493

	spin_lock(&con->writequeue_lock);
1494
	list_for_each_entry_safe(e, safe, &con->writequeue, list) {
1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505
		list_del(&e->list);
		free_entry(e);
	}
	spin_unlock(&con->writequeue_lock);
}

/* Called from recovery when it knows that a node has
   left the cluster */
int dlm_lowcomms_close(int nodeid)
{
	struct connection *con;
1506
	struct dlm_node_addr *na;
1507 1508 1509 1510

	log_print("closing connection to node %d", nodeid);
	con = nodeid2con(nodeid, 0);
	if (con) {
1511
		set_bit(CF_CLOSE, &con->flags);
1512
		close_connection(con, true, true, true);
1513 1514
		clean_one_writequeue(con);
	}
1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525

	spin_lock(&dlm_node_addrs_spin);
	na = find_node_addr(nodeid);
	if (na) {
		list_del(&na->list);
		while (na->addr_count--)
			kfree(na->addr[na->addr_count]);
		kfree(na);
	}
	spin_unlock(&dlm_node_addrs_spin);

1526 1527 1528
	return 0;
}

1529
/* Receive workqueue function */
1530
static void process_recv_sockets(struct work_struct *work)
1531
{
1532 1533
	struct connection *con = container_of(work, struct connection, rwork);
	int err;
1534

1535 1536 1537 1538
	clear_bit(CF_READ_PENDING, &con->flags);
	do {
		err = con->rx_action(con);
	} while (!err);
1539 1540
}

1541
/* Send workqueue function */
1542
static void process_send_sockets(struct work_struct *work)
1543
{
1544
	struct connection *con = container_of(work, struct connection, swork);
1545

1546
	clear_bit(CF_WRITE_PENDING, &con->flags);
1547
	if (con->sock == NULL) /* not mutex protected so check it inside too */
1548
		con->connect_action(con);
1549
	if (!list_empty(&con->writequeue))
1550
		send_to_sock(con);
1551 1552 1553 1554 1555 1556
}


/* Discard all entries on the write queues */
static void clean_writequeues(void)
{
1557
	foreach_conn(clean_one_writequeue);
1558 1559
}

1560
static void work_stop(void)
1561
{
1562 1563 1564 1565
	if (recv_workqueue)
		destroy_workqueue(recv_workqueue);
	if (send_workqueue)
		destroy_workqueue(send_workqueue);
1566 1567
}

1568
static int work_start(void)
1569
{
1570 1571
	recv_workqueue = alloc_workqueue("dlm_recv",
					 WQ_UNBOUND | WQ_MEM_RECLAIM, 1);
1572 1573 1574
	if (!recv_workqueue) {
		log_print("can't start dlm_recv");
		return -ENOMEM;
1575 1576
	}

1577 1578
	send_workqueue = alloc_workqueue("dlm_send",
					 WQ_UNBOUND | WQ_MEM_RECLAIM, 1);
1579 1580
	if (!send_workqueue) {
		log_print("can't start dlm_send");
1581
		destroy_workqueue(recv_workqueue);
1582
		return -ENOMEM;
1583 1584 1585 1586 1587
	}

	return 0;
}

1588
static void _stop_conn(struct connection *con, bool and_other)
1589
{
1590
	mutex_lock(&con->sock_mutex);
1591
	set_bit(CF_CLOSE, &con->flags);
1592
	set_bit(CF_READ_PENDING, &con->flags);
1593
	set_bit(CF_WRITE_PENDING, &con->flags);
1594 1595
	if (con->sock && con->sock->sk) {
		write_lock_bh(&con->sock->sk->sk_callback_lock);
1596
		con->sock->sk->sk_user_data = NULL;
1597 1598
		write_unlock_bh(&con->sock->sk->sk_callback_lock);
	}
1599 1600 1601 1602 1603 1604 1605 1606
	if (con->othercon && and_other)
		_stop_conn(con->othercon, false);
	mutex_unlock(&con->sock_mutex);
}

static void stop_conn(struct connection *con)
{
	_stop_conn(con, true);
1607
}
1608

1609 1610 1611 1612 1613 1614
static void shutdown_conn(struct connection *con)
{
	if (con->shutdown_action)
		con->shutdown_action(con);
}

1615 1616
static void free_conn(struct connection *con)
{
1617
	close_connection(con, true, true, true);
1618
	if (con->othercon)
1619 1620 1621 1622 1623
		kfree_rcu(con->othercon, rcu);
	spin_lock(&connections_lock);
	hlist_del_rcu(&con->list);
	spin_unlock(&connections_lock);
	kfree_rcu(con, rcu);
1624 1625
}

1626 1627
static void work_flush(void)
{
1628
	int ok, idx;
1629 1630 1631 1632 1633 1634
	int i;
	struct connection *con;

	do {
		ok = 1;
		foreach_conn(stop_conn);
1635 1636 1637 1638
		if (recv_workqueue)
			flush_workqueue(recv_workqueue);
		if (send_workqueue)
			flush_workqueue(send_workqueue);
1639
		idx = srcu_read_lock(&connections_srcu);
1640
		for (i = 0; i < CONN_HASH_SIZE && ok; i++) {
1641 1642
			hlist_for_each_entry_rcu(con, &connection_hash[i],
						 list) {
1643
				ok &= test_bit(CF_READ_PENDING, &con->flags);
1644 1645
				ok &= test_bit(CF_WRITE_PENDING, &con->flags);
				if (con->othercon) {
1646 1647
					ok &= test_bit(CF_READ_PENDING,
						       &con->othercon->flags);
1648 1649 1650
					ok &= test_bit(CF_WRITE_PENDING,
						       &con->othercon->flags);
				}
1651 1652
			}
		}
1653
		srcu_read_unlock(&connections_srcu, idx);
1654 1655 1656
	} while (!ok);
}

1657 1658
void dlm_lowcomms_stop(void)
{
P
Patrick Caulfield 已提交
1659
	/* Set all the flags to prevent any
1660 1661
	   socket activity.
	*/
1662
	dlm_allow_conn = 0;
1663 1664 1665 1666 1667 1668

	if (recv_workqueue)
		flush_workqueue(recv_workqueue);
	if (send_workqueue)
		flush_workqueue(send_workqueue);

1669
	foreach_conn(shutdown_conn);
1670
	work_flush();
1671 1672
	clean_writequeues();
	foreach_conn(free_conn);
1673
	work_stop();
1674
	deinit_local();
1675 1676 1677 1678
}

int dlm_lowcomms_start(void)
{
1679 1680
	int error = -EINVAL;
	struct connection *con;
1681 1682 1683 1684
	int i;

	for (i = 0; i < CONN_HASH_SIZE; i++)
		INIT_HLIST_HEAD(&connection_hash[i]);
1685

1686 1687
	init_local();
	if (!dlm_local_count) {
D
David Teigland 已提交
1688
		error = -ENOTCONN;
1689
		log_print("no local IP address has been set");
1690
		goto fail;
1691 1692
	}

1693 1694
	error = work_start();
	if (error)
1695
		goto fail;
1696 1697

	dlm_allow_conn = 1;
1698 1699

	/* Start listening */
1700 1701 1702 1703
	if (dlm_config.ci_protocol == 0)
		error = tcp_listen_for_all();
	else
		error = sctp_listen_for_all();
1704 1705 1706 1707 1708
	if (error)
		goto fail_unlisten;

	return 0;

P
Patrick Caulfield 已提交
1709
fail_unlisten:
1710
	dlm_allow_conn = 0;
1711 1712
	con = nodeid2con(0,0);
	if (con) {
1713
		close_connection(con, false, true, true);
1714
		kfree_rcu(con, rcu);
1715
	}
1716
fail:
1717 1718
	return error;
}
1719 1720 1721 1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732

void dlm_lowcomms_exit(void)
{
	struct dlm_node_addr *na, *safe;

	spin_lock(&dlm_node_addrs_spin);
	list_for_each_entry_safe(na, safe, &dlm_node_addrs, list) {
		list_del(&na->list);
		while (na->addr_count--)
			kfree(na->addr[na->addr_count]);
		kfree(na);
	}
	spin_unlock(&dlm_node_addrs_spin);
}