lowcomms.c 42.4 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 69 70
struct connection {
	struct socket *sock;	/* NULL if not connected */
	uint32_t nodeid;	/* So we know who we are in the list */
71
	struct mutex sock_mutex;
72
	unsigned long flags;
73
#define CF_READ_PENDING 1
74
#define CF_WRITE_PENDING 2
75 76
#define CF_INIT_PENDING 4
#define CF_IS_OTHERCON 5
77
#define CF_CLOSE 6
78
#define CF_APP_LIMITED 7
79
#define CF_CLOSING 8
80
#define CF_SHUTDOWN 9
81
#define CF_CONNECTED 10
P
Patrick Caulfield 已提交
82
	struct list_head writequeue;  /* List of outgoing writequeue_entries */
83
	spinlock_t writequeue_lock;
84
	void (*connect_action) (struct connection *);	/* What to do to connect */
85
	void (*shutdown_action)(struct connection *con); /* What to do to shutdown */
86 87
	int retries;
#define MAX_CONNECT_RETRIES 3
88
	struct hlist_node list;
89
	struct connection *othercon;
90 91
	struct work_struct rwork; /* Receive workqueue */
	struct work_struct swork; /* Send workqueue */
92
	wait_queue_head_t shutdown_wait; /* wait for graceful shutdown */
93 94 95
	unsigned char *rx_buf;
	int rx_buflen;
	int rx_leftover;
96
	struct rcu_head rcu;
97 98 99
};
#define sock2con(x) ((struct connection *)(x)->sk_user_data)

100 101 102 103 104
struct listen_connection {
	struct socket *sock;
	struct work_struct rwork;
};

105 106 107 108 109 110 111 112 113 114 115
/* 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;
};

116 117 118
struct dlm_node_addr {
	struct list_head list;
	int nodeid;
119
	int mark;
120
	int addr_count;
121
	int curr_addr_index;
122 123 124
	struct sockaddr_storage *addr[DLM_MAX_ADDR_COUNT];
};

B
Bob Peterson 已提交
125 126 127 128 129 130 131
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;

132 133 134
static LIST_HEAD(dlm_node_addrs);
static DEFINE_SPINLOCK(dlm_node_addrs_spin);

135
static struct listen_connection listen_con;
136 137
static struct sockaddr_storage *dlm_local_addr[DLM_MAX_ADDR_COUNT];
static int dlm_local_count;
138
static int dlm_allow_conn;
139

140 141 142
/* Work queues */
static struct workqueue_struct *recv_workqueue;
static struct workqueue_struct *send_workqueue;
143

144
static struct hlist_head connection_hash[CONN_HASH_SIZE];
145 146
static DEFINE_SPINLOCK(connections_lock);
DEFINE_STATIC_SRCU(connections_srcu);
147

148 149
static void process_recv_sockets(struct work_struct *work);
static void process_send_sockets(struct work_struct *work);
150

151 152
static void sctp_connect_to_sock(struct connection *con);
static void tcp_connect_to_sock(struct connection *con);
153
static void dlm_tcp_shutdown(struct connection *con);
154 155 156 157 158 159 160 161 162 163 164

/* 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)
{
165
	int r, idx;
166 167 168 169
	struct connection *con;

	r = nodeid_hash(nodeid);

170 171 172 173
	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);
174
			return con;
175
		}
176
	}
177 178
	srcu_read_unlock(&connections_srcu, idx);

179 180 181
	return NULL;
}

182
static int dlm_con_init(struct connection *con, int nodeid)
183
{
184 185
	con->rx_buflen = dlm_config.ci_buffer_size;
	con->rx_buf = kmalloc(con->rx_buflen, GFP_NOFS);
186 187
	if (!con->rx_buf)
		return -ENOMEM;
188

189 190 191 192 193 194
	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);
195
	init_waitqueue_head(&con->shutdown_wait);
196

197
	if (dlm_config.ci_protocol == 0) {
198
		con->connect_action = tcp_connect_to_sock;
199 200
		con->shutdown_action = dlm_tcp_shutdown;
	} else {
201
		con->connect_action = sctp_connect_to_sock;
202
	}
203

204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229
	return 0;
}

/*
 * If 'allocation' is zero then we don't attempt to create a new
 * connection structure for this node.
 */
static struct connection *nodeid2con(int nodeid, gfp_t alloc)
{
	struct connection *con, *tmp;
	int r, ret;

	con = __find_con(nodeid);
	if (con || !alloc)
		return con;

	con = kzalloc(sizeof(*con), alloc);
	if (!con)
		return NULL;

	ret = dlm_con_init(con, nodeid);
	if (ret) {
		kfree(con);
		return NULL;
	}

230 231 232
	r = nodeid_hash(nodeid);

	spin_lock(&connections_lock);
A
Alexander Aring 已提交
233 234 235 236 237 238 239 240 241 242 243 244 245 246
	/* Because multiple workqueues/threads calls this function it can
	 * race on multiple cpu's. Instead of locking hot path __find_con()
	 * we just check in rare cases of recently added nodes again
	 * under protection of connections_lock. If this is the case we
	 * abort our connection creation and return the existing connection.
	 */
	tmp = __find_con(nodeid);
	if (tmp) {
		spin_unlock(&connections_lock);
		kfree(con->rx_buf);
		kfree(con);
		return tmp;
	}

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

250 251 252
	return con;
}

253 254 255
/* Loop round all connections */
static void foreach_conn(void (*conn_func)(struct connection *c))
{
256
	int i, idx;
257 258
	struct connection *con;

259
	idx = srcu_read_lock(&connections_srcu);
260
	for (i = 0; i < CONN_HASH_SIZE; i++) {
261
		hlist_for_each_entry_rcu(con, &connection_hash[i], list)
262 263
			conn_func(con);
	}
264
	srcu_read_unlock(&connections_srcu, idx);
265 266
}

267 268 269 270 271 272 273 274 275 276 277
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;
}

A
Alexander Aring 已提交
278 279
static int addr_compare(const struct sockaddr_storage *x,
			const struct sockaddr_storage *y)
280
{
281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306
	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,
307 308
			  struct sockaddr *sa_out, bool try_new_addr,
			  unsigned int *mark)
309 310 311
{
	struct sockaddr_storage sas;
	struct dlm_node_addr *na;
312 313 314 315

	if (!dlm_local_count)
		return -1;

316 317
	spin_lock(&dlm_node_addrs_spin);
	na = find_node_addr(nodeid);
318
	if (na && na->addr_count) {
319 320 321
		memcpy(&sas, na->addr[na->curr_addr_index],
		       sizeof(struct sockaddr_storage));

322 323 324 325 326 327
		if (try_new_addr) {
			na->curr_addr_index++;
			if (na->curr_addr_index == na->addr_count)
				na->curr_addr_index = 0;
		}
	}
328 329 330 331 332 333 334 335
	spin_unlock(&dlm_node_addrs_spin);

	if (!na)
		return -EEXIST;

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

336 337
	*mark = na->mark;

338 339 340 341 342
	if (sas_out)
		memcpy(sas_out, &sas, sizeof(struct sockaddr_storage));

	if (!sa_out)
		return 0;
343 344

	if (dlm_local_addr[0]->ss_family == AF_INET) {
345 346
		struct sockaddr_in *in4  = (struct sockaddr_in *) &sas;
		struct sockaddr_in *ret4 = (struct sockaddr_in *) sa_out;
347 348
		ret4->sin_addr.s_addr = in4->sin_addr.s_addr;
	} else {
349 350
		struct sockaddr_in6 *in6  = (struct sockaddr_in6 *) &sas;
		struct sockaddr_in6 *ret6 = (struct sockaddr_in6 *) sa_out;
A
Alexey Dobriyan 已提交
351
		ret6->sin6_addr = in6->sin6_addr;
352 353 354 355 356
	}

	return 0;
}

357 358
static int addr_to_nodeid(struct sockaddr_storage *addr, int *nodeid,
			  unsigned int *mark)
359 360 361
{
	struct dlm_node_addr *na;
	int rv = -EEXIST;
362
	int addr_i;
363 364 365 366 367 368

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

369 370 371
		for (addr_i = 0; addr_i < na->addr_count; addr_i++) {
			if (addr_compare(na->addr[addr_i], addr)) {
				*nodeid = na->nodeid;
372
				*mark = na->mark;
373 374 375 376
				rv = 0;
				goto unlock;
			}
		}
377
	}
378
unlock:
379 380 381 382
	spin_unlock(&dlm_node_addrs_spin);
	return rv;
}

383 384 385 386 387 388 389 390 391 392 393 394 395 396
/* caller need to held dlm_node_addrs_spin lock */
static bool dlm_lowcomms_na_has_addr(const struct dlm_node_addr *na,
				     const struct sockaddr_storage *addr)
{
	int i;

	for (i = 0; i < na->addr_count; i++) {
		if (addr_compare(na->addr[i], addr))
			return true;
	}

	return false;
}

397 398 399 400
int dlm_lowcomms_addr(int nodeid, struct sockaddr_storage *addr, int len)
{
	struct sockaddr_storage *new_addr;
	struct dlm_node_addr *new_node, *na;
401
	bool ret;
402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420

	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;
421
		new_node->mark = dlm_config.ci_mark;
422 423 424 425 426
		list_add(&new_node->list, &dlm_node_addrs);
		spin_unlock(&dlm_node_addrs_spin);
		return 0;
	}

427 428 429 430 431 432 433 434
	ret = dlm_lowcomms_na_has_addr(na, addr);
	if (ret) {
		spin_unlock(&dlm_node_addrs_spin);
		kfree(new_addr);
		kfree(new_node);
		return -EEXIST;
	}

435 436 437 438 439 440 441 442 443 444 445 446 447
	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;
}

448
/* Data available on socket or listen socket received a connect */
449
static void lowcomms_data_ready(struct sock *sk)
450
{
451 452 453 454
	struct connection *con;

	read_lock_bh(&sk->sk_callback_lock);
	con = sock2con(sk);
P
Patrick Caulfield 已提交
455
	if (con && !test_and_set_bit(CF_READ_PENDING, &con->flags))
456
		queue_work(recv_workqueue, &con->rwork);
457
	read_unlock_bh(&sk->sk_callback_lock);
458 459
}

460 461 462 463 464
static void lowcomms_listen_data_ready(struct sock *sk)
{
	queue_work(recv_workqueue, &listen_con.rwork);
}

465 466
static void lowcomms_write_space(struct sock *sk)
{
467
	struct connection *con;
468

469 470
	read_lock_bh(&sk->sk_callback_lock);
	con = sock2con(sk);
471
	if (!con)
472
		goto out;
473

474 475 476 477 478 479
	if (!test_and_set_bit(CF_CONNECTED, &con->flags)) {
		log_print("successful connected to node %d", con->nodeid);
		queue_work(send_workqueue, &con->swork);
		goto out;
	}

480 481 482 483
	clear_bit(SOCK_NOSPACE, &con->sock->flags);

	if (test_and_clear_bit(CF_APP_LIMITED, &con->flags)) {
		con->sock->sk->sk_write_pending--;
484
		clear_bit(SOCKWQ_ASYNC_NOSPACE, &con->sock->flags);
485 486
	}

487
	queue_work(send_workqueue, &con->swork);
488 489
out:
	read_unlock_bh(&sk->sk_callback_lock);
490 491 492 493
}

static inline void lowcomms_connect_sock(struct connection *con)
{
494 495
	if (test_bit(CF_CLOSE, &con->flags))
		return;
496 497
	queue_work(send_workqueue, &con->swork);
	cond_resched();
498 499 500 501
}

static void lowcomms_state_change(struct sock *sk)
{
502 503 504 505 506 507 508 509 510
	/* 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) {
511
		lowcomms_write_space(sk);
512
	}
513 514
}

515 516 517 518 519 520 521 522 523 524 525 526 527 528
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;
}

529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545
int dlm_lowcomms_nodes_set_mark(int nodeid, unsigned int mark)
{
	struct dlm_node_addr *na;

	spin_lock(&dlm_node_addrs_spin);
	na = find_node_addr(nodeid);
	if (!na) {
		spin_unlock(&dlm_node_addrs_spin);
		return -ENOENT;
	}

	na->mark = mark;
	spin_unlock(&dlm_node_addrs_spin);

	return 0;
}

546 547
static void lowcomms_error_report(struct sock *sk)
{
548
	struct connection *con;
549
	struct sockaddr_storage saddr;
550
	void (*orig_report)(struct sock *) = NULL;
551

552 553 554 555 556
	read_lock_bh(&sk->sk_callback_lock);
	con = sock2con(sk);
	if (con == NULL)
		goto out;

B
Bob Peterson 已提交
557
	orig_report = listen_sock.sk_error_report;
558
	if (con->sock == NULL ||
559
	    kernel_getpeername(con->sock, (struct sockaddr *)&saddr) < 0) {
560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586
		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);
	}
587 588 589 590 591 592 593
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 已提交
594
static void save_listen_callbacks(struct socket *sock)
595
{
B
Bob Peterson 已提交
596 597 598 599 600 601
	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;
602 603
}

B
Bob Peterson 已提交
604
static void restore_callbacks(struct socket *sock)
605
{
B
Bob Peterson 已提交
606 607
	struct sock *sk = sock->sk;

608 609
	write_lock_bh(&sk->sk_callback_lock);
	sk->sk_user_data = NULL;
B
Bob Peterson 已提交
610 611 612 613
	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;
614
	write_unlock_bh(&sk->sk_callback_lock);
615 616
}

617 618 619 620 621 622 623 624 625 626 627 628 629 630 631
static void add_listen_sock(struct socket *sock, struct listen_connection *con)
{
	struct sock *sk = sock->sk;

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

	sk->sk_user_data = con;
	sk->sk_allocation = GFP_NOFS;
	/* Install a data_ready callback */
	sk->sk_data_ready = lowcomms_listen_data_ready;
	write_unlock_bh(&sk->sk_callback_lock);
}

632
/* Make a socket active */
633
static void add_sock(struct socket *sock, struct connection *con)
634
{
635 636 637
	struct sock *sk = sock->sk;

	write_lock_bh(&sk->sk_callback_lock);
638 639
	con->sock = sock;

640
	sk->sk_user_data = con;
641
	/* Install a data_ready callback */
642 643 644 645 646 647
	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);
648 649
}

650
/* Add the port number to an IPv6 or 4 sockaddr and return the address
651 652 653 654
   length */
static void make_sockaddr(struct sockaddr_storage *saddr, uint16_t port,
			  int *addr_len)
{
655
	saddr->ss_family =  dlm_local_addr[0]->ss_family;
P
Patrick Caulfield 已提交
656
	if (saddr->ss_family == AF_INET) {
657 658 659
		struct sockaddr_in *in4_addr = (struct sockaddr_in *)saddr;
		in4_addr->sin_port = cpu_to_be16(port);
		*addr_len = sizeof(struct sockaddr_in);
660
		memset(&in4_addr->sin_zero, 0, sizeof(in4_addr->sin_zero));
P
Patrick Caulfield 已提交
661
	} else {
662 663 664 665
		struct sockaddr_in6 *in6_addr = (struct sockaddr_in6 *)saddr;
		in6_addr->sin6_port = cpu_to_be16(port);
		*addr_len = sizeof(struct sockaddr_in6);
	}
666
	memset((char *)saddr + *addr_len, 0, sizeof(struct sockaddr_storage) - *addr_len);
667 668
}

669 670 671 672 673 674 675 676 677
static void dlm_close_sock(struct socket **sock)
{
	if (*sock) {
		restore_callbacks(*sock);
		sock_release(*sock);
		*sock = NULL;
	}
}

678
/* Close a remote connection and tidy up */
679 680
static void close_connection(struct connection *con, bool and_other,
			     bool tx, bool rx)
681
{
682 683
	bool closing = test_and_set_bit(CF_CLOSING, &con->flags);

684
	if (tx && !closing && cancel_work_sync(&con->swork)) {
685
		log_print("canceled swork for node %d", con->nodeid);
686 687 688
		clear_bit(CF_WRITE_PENDING, &con->flags);
	}
	if (rx && !closing && cancel_work_sync(&con->rwork)) {
689
		log_print("canceled rwork for node %d", con->nodeid);
690 691
		clear_bit(CF_READ_PENDING, &con->flags);
	}
692

693
	mutex_lock(&con->sock_mutex);
694 695
	dlm_close_sock(&con->sock);

696
	if (con->othercon && and_other) {
P
Patrick Caulfield 已提交
697
		/* Will only re-enter once. */
698
		close_connection(con->othercon, false, true, true);
699
	}
P
Patrick Caulfield 已提交
700

701
	con->rx_leftover = 0;
702
	con->retries = 0;
703
	clear_bit(CF_CONNECTED, &con->flags);
704
	mutex_unlock(&con->sock_mutex);
705
	clear_bit(CF_CLOSING, &con->flags);
706 707
}

708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755
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);
}

756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775
static int con_realloc_receive_buf(struct connection *con, int newlen)
{
	unsigned char *newbuf;

	newbuf = kmalloc(newlen, GFP_NOFS);
	if (!newbuf)
		return -ENOMEM;

	/* copy any leftover from last receive */
	if (con->rx_leftover)
		memmove(newbuf, con->rx_buf, con->rx_leftover);

	/* swap to new buffer space */
	kfree(con->rx_buf);
	con->rx_buflen = newlen;
	con->rx_buf = newbuf;

	return 0;
}

776 777 778 779
/* Data received from remote end */
static int receive_from_sock(struct connection *con)
{
	int call_again_soon = 0;
780 781 782
	struct msghdr msg;
	struct kvec iov;
	int ret, buflen;
783

784
	mutex_lock(&con->sock_mutex);
785

786 787 788 789
	if (con->sock == NULL) {
		ret = -EAGAIN;
		goto out_close;
	}
790 791 792 793 794 795

	/* realloc if we get new buffer size to read out */
	buflen = dlm_config.ci_buffer_size;
	if (con->rx_buflen != buflen && con->rx_leftover <= buflen) {
		ret = con_realloc_receive_buf(con, buflen);
		if (ret < 0)
796 797 798
			goto out_resched;
	}

799 800
	/* calculate new buffer parameter regarding last receive and
	 * possible leftover bytes
801
	 */
802 803
	iov.iov_base = con->rx_buf + con->rx_leftover;
	iov.iov_len = con->rx_buflen - con->rx_leftover;
804

805 806 807 808
	memset(&msg, 0, sizeof(msg));
	msg.msg_flags = MSG_DONTWAIT | MSG_NOSIGNAL;
	ret = kernel_recvmsg(con->sock, &msg, &iov, 1, iov.iov_len,
			     msg.msg_flags);
809 810
	if (ret <= 0)
		goto out_close;
811
	else if (ret == iov.iov_len)
812
		call_again_soon = 1;
P
Patrick Caulfield 已提交
813

814 815 816 817 818
	/* new buflen according readed bytes and leftover from last receive */
	buflen = ret + con->rx_leftover;
	ret = dlm_process_incoming_buffer(con->nodeid, con->rx_buf, buflen);
	if (ret < 0)
		goto out_close;
819

820 821 822 823 824 825 826 827 828
	/* calculate leftover bytes from process and put it into begin of
	 * the receive buffer, so next receive we have the full message
	 * at the start address of the receive buffer.
	 */
	con->rx_leftover = buflen - ret;
	if (con->rx_leftover) {
		memmove(con->rx_buf, con->rx_buf + ret,
			con->rx_leftover);
		call_again_soon = true;
829 830 831 832
	}

	if (call_again_soon)
		goto out_resched;
833

834
	mutex_unlock(&con->sock_mutex);
P
Patrick Caulfield 已提交
835
	return 0;
836

P
Patrick Caulfield 已提交
837
out_resched:
838 839
	if (!test_and_set_bit(CF_READ_PENDING, &con->flags))
		queue_work(recv_workqueue, &con->rwork);
840
	mutex_unlock(&con->sock_mutex);
P
Patrick Caulfield 已提交
841
	return -EAGAIN;
842

P
Patrick Caulfield 已提交
843
out_close:
844
	mutex_unlock(&con->sock_mutex);
P
Patrick Caulfield 已提交
845
	if (ret != -EAGAIN) {
846
		/* Reconnect when there is something to send */
847 848 849 850 851 852 853 854 855 856
		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;
		}
857 858 859 860 861
	}
	return ret;
}

/* Listening socket is busy, accept a connection */
862
static int accept_from_sock(struct listen_connection *con)
863 864 865 866 867 868 869
{
	int result;
	struct sockaddr_storage peeraddr;
	struct socket *newsock;
	int len;
	int nodeid;
	struct connection *newcon;
P
Patrick Caulfield 已提交
870
	struct connection *addcon;
871
	unsigned int mark;
872

873 874 875 876
	if (!dlm_allow_conn) {
		return -1;
	}

877
	if (!con->sock)
878
		return -ENOTCONN;
879

880
	result = kernel_accept(con->sock, &newsock, O_NONBLOCK);
881 882 883 884 885
	if (result < 0)
		goto accept_err;

	/* Get the connected socket's peer */
	memset(&peeraddr, 0, sizeof(peeraddr));
886 887
	len = newsock->ops->getname(newsock, (struct sockaddr *)&peeraddr, 2);
	if (len < 0) {
888 889 890 891 892 893
		result = -ECONNABORTED;
		goto accept_err;
	}

	/* Get the new node's NODEID */
	make_sockaddr(&peeraddr, 0, &len);
894
	if (addr_to_nodeid(&peeraddr, &nodeid, &mark)) {
895
		unsigned char *b=(unsigned char *)&peeraddr;
D
David Teigland 已提交
896
		log_print("connect from non cluster node");
897 898
		print_hex_dump_bytes("ss: ", DUMP_PREFIX_NONE, 
				     b, sizeof(struct sockaddr_storage));
899 900 901 902 903 904 905 906 907 908 909
		sock_release(newsock);
		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 已提交
910
	newcon = nodeid2con(nodeid, GFP_NOFS);
911 912 913 914
	if (!newcon) {
		result = -ENOMEM;
		goto accept_err;
	}
915

916 917
	sock_set_mark(newsock->sk, mark);

918
	mutex_lock(&newcon->sock_mutex);
919
	if (newcon->sock) {
P
Patrick Caulfield 已提交
920
		struct connection *othercon = newcon->othercon;
921 922

		if (!othercon) {
923
			othercon = kzalloc(sizeof(*othercon), GFP_NOFS);
924
			if (!othercon) {
D
David Teigland 已提交
925
				log_print("failed to allocate incoming socket");
926
				mutex_unlock(&newcon->sock_mutex);
927 928 929
				result = -ENOMEM;
				goto accept_err;
			}
930

931 932
			result = dlm_con_init(othercon, nodeid);
			if (result < 0) {
933 934 935 936
				kfree(othercon);
				goto accept_err;
			}

937
			newcon->othercon = othercon;
938 939 940
		} else {
			/* close other sock con if we have something new */
			close_connection(othercon, false, true, false);
941
		}
942

943
		mutex_lock_nested(&othercon->sock_mutex, 1);
944 945 946
		add_sock(newsock, othercon);
		addcon = othercon;
		mutex_unlock(&othercon->sock_mutex);
947 948
	}
	else {
949 950 951
		/* 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. */
952
		add_sock(newsock, newcon);
P
Patrick Caulfield 已提交
953
		addcon = newcon;
954 955
	}

956
	set_bit(CF_CONNECTED, &addcon->flags);
957
	mutex_unlock(&newcon->sock_mutex);
958 959 960

	/*
	 * Add it to the active queue in case we got data
L
Lucas De Marchi 已提交
961
	 * between processing the accept adding the socket
962 963
	 * to the read_sockets list
	 */
P
Patrick Caulfield 已提交
964 965
	if (!test_and_set_bit(CF_READ_PENDING, &addcon->flags))
		queue_work(recv_workqueue, &addcon->rwork);
966 967 968

	return 0;

P
Patrick Caulfield 已提交
969
accept_err:
970 971
	if (newsock)
		sock_release(newsock);
972 973

	if (result != -EAGAIN)
D
David Teigland 已提交
974
		log_print("error accepting connection from node: %d", result);
975 976 977
	return result;
}

978 979 980 981 982 983
static void free_entry(struct writequeue_entry *e)
{
	__free_page(e->page);
	kfree(e);
}

M
Mike Christie 已提交
984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001
/*
 * 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);
	}
}

1002 1003 1004
/*
 * sctp_bind_addrs - bind a SCTP socket to all our addresses
 */
1005
static int sctp_bind_addrs(struct socket *sock, uint16_t port)
1006 1007
{
	struct sockaddr_storage localaddr;
1008
	struct sockaddr *addr = (struct sockaddr *)&localaddr;
1009 1010 1011 1012 1013 1014 1015
	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)
1016
			result = kernel_bind(sock, addr, addr_len);
1017
		else
1018
			result = sock_bind_add(sock->sk, addr, addr_len);
1019 1020 1021 1022 1023 1024 1025 1026 1027 1028

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

1029 1030 1031 1032 1033
/* 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.
 */
1034
static void sctp_connect_to_sock(struct connection *con)
1035
{
1036 1037 1038 1039
	struct sockaddr_storage daddr;
	int result;
	int addr_len;
	struct socket *sock;
1040
	unsigned int mark;
1041

M
Mike Christie 已提交
1042
	mutex_lock(&con->sock_mutex);
1043

1044 1045 1046 1047 1048 1049 1050 1051 1052 1053
	/* 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));
1054
	result = nodeid_to_addr(con->nodeid, &daddr, NULL, true, &mark);
1055
	if (result < 0) {
1056
		log_print("no address for nodeid %d", con->nodeid);
1057
		goto out;
1058 1059
	}

1060 1061 1062 1063 1064
	/* 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;
1065

1066 1067
	sock_set_mark(sock->sk, mark);

1068
	add_sock(sock, con);
1069

1070
	/* Bind to all addresses. */
1071
	if (sctp_bind_addrs(con->sock, 0))
1072
		goto bind_err;
1073

1074
	make_sockaddr(&daddr, dlm_config.ci_tcp_port, &addr_len);
1075

1076
	log_print("connecting to %d", con->nodeid);
1077

1078
	/* Turn off Nagle's algorithm */
1079
	sctp_sock_set_nodelay(sock->sk);
1080

1081 1082 1083 1084 1085
	/*
	 * 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 已提交
1086
	sock_set_sndtimeo(sock->sk, 5);
1087
	result = sock->ops->connect(sock, (struct sockaddr *)&daddr, addr_len,
1088
				   0);
C
Christoph Hellwig 已提交
1089
	sock_set_sndtimeo(sock->sk, 0);
1090

1091 1092
	if (result == -EINPROGRESS)
		result = 0;
1093 1094 1095
	if (result == 0) {
		if (!test_and_set_bit(CF_CONNECTED, &con->flags))
			log_print("successful connected to node %d", con->nodeid);
1096
		goto out;
1097
	}
1098

1099 1100 1101
bind_err:
	con->sock = NULL;
	sock_release(sock);
1102

1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118
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;
1119
	}
M
Mike Christie 已提交
1120

1121
out:
M
Mike Christie 已提交
1122
	mutex_unlock(&con->sock_mutex);
1123 1124
}

1125
/* Connect a new socket to its peer */
1126
static void tcp_connect_to_sock(struct connection *con)
1127
{
1128
	struct sockaddr_storage saddr, src_addr;
1129
	unsigned int mark;
1130
	int addr_len;
1131
	struct socket *sock = NULL;
1132
	int result;
1133

1134
	mutex_lock(&con->sock_mutex);
1135 1136 1137 1138
	if (con->retries++ > MAX_CONNECT_RETRIES)
		goto out;

	/* Some odd races can cause double-connects, ignore them */
1139
	if (con->sock)
1140 1141 1142
		goto out;

	/* Create a socket to communicate with */
1143 1144
	result = sock_create_kern(&init_net, dlm_local_addr[0]->ss_family,
				  SOCK_STREAM, IPPROTO_TCP, &sock);
1145 1146 1147 1148
	if (result < 0)
		goto out_err;

	memset(&saddr, 0, sizeof(saddr));
1149
	result = nodeid_to_addr(con->nodeid, &saddr, NULL, false, &mark);
1150 1151
	if (result < 0) {
		log_print("no address for nodeid %d", con->nodeid);
P
Patrick Caulfield 已提交
1152
		goto out_err;
1153
	}
1154

1155 1156
	sock_set_mark(sock->sk, mark);

1157
	add_sock(sock, con);
1158

1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169
	/* 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 */
	}

1170
	make_sockaddr(&saddr, dlm_config.ci_tcp_port, &addr_len);
1171 1172

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

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

1177
	result = sock->ops->connect(sock, (struct sockaddr *)&saddr, addr_len,
P
Patrick Caulfield 已提交
1178
				   O_NONBLOCK);
1179 1180
	if (result == -EINPROGRESS)
		result = 0;
P
Patrick Caulfield 已提交
1181 1182
	if (result == 0)
		goto out;
1183

P
Patrick Caulfield 已提交
1184
out_err:
1185 1186 1187
	if (con->sock) {
		sock_release(con->sock);
		con->sock = NULL;
1188 1189
	} else if (sock) {
		sock_release(sock);
1190 1191 1192 1193 1194
	}
	/*
	 * Some errors are fatal and this list might need adjusting. For other
	 * errors we try again until the max number of retries is reached.
	 */
1195 1196 1197 1198 1199 1200 1201 1202 1203
	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);
1204
		lowcomms_connect_sock(con);
1205
		return;
1206
	}
P
Patrick Caulfield 已提交
1207
out:
1208
	mutex_unlock(&con->sock_mutex);
P
Patrick Caulfield 已提交
1209
	return;
1210 1211
}

1212 1213 1214 1215 1216
/* On error caller must run dlm_close_sock() for the
 * listen connection socket.
 */
static int tcp_create_listen_sock(struct listen_connection *con,
				  struct sockaddr_storage *saddr)
1217
{
P
Patrick Caulfield 已提交
1218
	struct socket *sock = NULL;
1219 1220 1221
	int result = 0;
	int addr_len;

1222
	if (dlm_local_addr[0]->ss_family == AF_INET)
1223 1224 1225 1226 1227
		addr_len = sizeof(struct sockaddr_in);
	else
		addr_len = sizeof(struct sockaddr_in6);

	/* Create a socket to communicate with */
1228 1229
	result = sock_create_kern(&init_net, dlm_local_addr[0]->ss_family,
				  SOCK_STREAM, IPPROTO_TCP, &sock);
1230
	if (result < 0) {
D
David Teigland 已提交
1231
		log_print("Can't create listening comms socket");
1232 1233 1234
		goto create_out;
	}

1235 1236
	sock_set_mark(sock->sk, dlm_config.ci_mark);

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

C
Christoph Hellwig 已提交
1240
	sock_set_reuseaddr(sock->sk);
1241

1242
	add_listen_sock(sock, con);
1243 1244

	/* Bind to our port */
1245
	make_sockaddr(saddr, dlm_config.ci_tcp_port, &addr_len);
1246 1247
	result = sock->ops->bind(sock, (struct sockaddr *) saddr, addr_len);
	if (result < 0) {
D
David Teigland 已提交
1248
		log_print("Can't bind to port %d", dlm_config.ci_tcp_port);
1249 1250
		goto create_out;
	}
C
Christoph Hellwig 已提交
1251
	sock_set_keepalive(sock->sk);
1252 1253 1254

	result = sock->ops->listen(sock, 5);
	if (result < 0) {
D
David Teigland 已提交
1255
		log_print("Can't listen on port %d", dlm_config.ci_tcp_port);
1256 1257 1258
		goto create_out;
	}

1259 1260
	return 0;

P
Patrick Caulfield 已提交
1261
create_out:
1262
	return result;
1263 1264
}

1265 1266 1267 1268 1269 1270
/* Get local addresses */
static void init_local(void)
{
	struct sockaddr_storage sas, *addr;
	int i;

1271
	dlm_local_count = 0;
1272
	for (i = 0; i < DLM_MAX_ADDR_COUNT; i++) {
1273 1274 1275
		if (dlm_our_addr(&sas, i))
			break;

1276
		addr = kmemdup(&sas, sizeof(*addr), GFP_NOFS);
1277 1278 1279 1280 1281 1282
		if (!addr)
			break;
		dlm_local_addr[dlm_local_count++] = addr;
	}
}

1283 1284 1285 1286 1287 1288 1289 1290
static void deinit_local(void)
{
	int i;

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

1291 1292 1293 1294 1295
/* Initialise SCTP socket and bind to all interfaces
 * On error caller must run dlm_close_sock() for the
 * listen connection socket.
 */
static int sctp_listen_for_all(struct listen_connection *con)
1296 1297
{
	struct socket *sock = NULL;
1298
	int result = -EINVAL;
1299 1300 1301

	log_print("Using SCTP for communications");

1302
	result = sock_create_kern(&init_net, dlm_local_addr[0]->ss_family,
1303
				  SOCK_STREAM, IPPROTO_SCTP, &sock);
1304 1305 1306 1307 1308
	if (result < 0) {
		log_print("Can't create comms socket, check SCTP is loaded");
		goto out;
	}

C
Christoph Hellwig 已提交
1309
	sock_set_rcvbuf(sock->sk, NEEDED_RMEM);
1310
	sock_set_mark(sock->sk, dlm_config.ci_mark);
1311
	sctp_sock_set_nodelay(sock->sk);
M
Mike Christie 已提交
1312

1313
	add_listen_sock(sock, con);
1314

1315
	/* Bind to all addresses. */
1316 1317 1318
	result = sctp_bind_addrs(con->sock, dlm_config.ci_tcp_port);
	if (result < 0)
		goto out;
1319 1320 1321 1322

	result = sock->ops->listen(sock, 5);
	if (result < 0) {
		log_print("Can't set socket listening");
1323
		goto out;
1324 1325 1326 1327 1328 1329 1330 1331 1332
	}

	return 0;

out:
	return result;
}

static int tcp_listen_for_all(void)
1333 1334
{
	/* We don't support multi-homed hosts */
1335
	if (dlm_local_count > 1) {
D
David Teigland 已提交
1336 1337
		log_print("TCP protocol can't handle multi-homed hosts, "
			  "try SCTP");
1338 1339 1340 1341 1342
		return -EINVAL;
	}

	log_print("Using TCP for communications");

1343
	return tcp_create_listen_sock(&listen_con, dlm_local_addr[0]);
1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371
}



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 已提交
1372
void *dlm_lowcomms_get_buffer(int nodeid, int len, gfp_t allocation, char **ppc)
1373 1374 1375 1376 1377
{
	struct connection *con;
	struct writequeue_entry *e;
	int offset = 0;

1378 1379 1380 1381 1382 1383
	if (len > LOWCOMMS_MAX_TX_BUFFER_LEN) {
		BUILD_BUG_ON(PAGE_SIZE < LOWCOMMS_MAX_TX_BUFFER_LEN);
		log_print("failed to allocate a buffer of size %d", len);
		return NULL;
	}

1384 1385 1386 1387
	con = nodeid2con(nodeid, allocation);
	if (!con)
		return NULL;

1388
	spin_lock(&con->writequeue_lock);
1389
	e = list_entry(con->writequeue.prev, struct writequeue_entry, list);
P
Patrick Caulfield 已提交
1390
	if ((&e->list == &con->writequeue) ||
1391
	    (PAGE_SIZE - e->end < len)) {
1392 1393 1394 1395
		e = NULL;
	} else {
		offset = e->end;
		e->end += len;
1396
		e->users++;
1397 1398 1399 1400
	}
	spin_unlock(&con->writequeue_lock);

	if (e) {
P
Patrick Caulfield 已提交
1401
	got_one:
1402 1403 1404 1405 1406 1407 1408 1409 1410
		*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;
1411
		e->users++;
1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424
		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;

1425
	spin_lock(&con->writequeue_lock);
1426 1427 1428 1429 1430 1431
	users = --e->users;
	if (users)
		goto out;
	e->len = e->end - e->offset;
	spin_unlock(&con->writequeue_lock);

1432
	queue_work(send_workqueue, &con->swork);
1433 1434
	return;

P
Patrick Caulfield 已提交
1435
out:
1436 1437 1438 1439 1440
	spin_unlock(&con->writequeue_lock);
	return;
}

/* Send a message */
P
Patrick Caulfield 已提交
1441
static void send_to_sock(struct connection *con)
1442 1443 1444 1445 1446
{
	int ret = 0;
	const int msg_flags = MSG_DONTWAIT | MSG_NOSIGNAL;
	struct writequeue_entry *e;
	int len, offset;
1447
	int count = 0;
1448

1449
	mutex_lock(&con->sock_mutex);
1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466
	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 已提交
1467 1468
			ret = kernel_sendpage(con->sock, e->page, offset, len,
					      msg_flags);
1469
			if (ret == -EAGAIN || ret == 0) {
1470
				if (ret == -EAGAIN &&
1471
				    test_bit(SOCKWQ_ASYNC_NOSPACE, &con->sock->flags) &&
1472 1473 1474 1475 1476 1477 1478
				    !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++;
				}
1479
				cond_resched();
1480
				goto out;
Y
Ying Xue 已提交
1481
			} else if (ret < 0)
1482
				goto send_error;
1483
		}
1484 1485 1486

		/* Don't starve people filling buffers */
		if (++count >= MAX_SEND_MSG_COUNT) {
P
Patrick Caulfield 已提交
1487
			cond_resched();
1488 1489
			count = 0;
		}
1490 1491

		spin_lock(&con->writequeue_lock);
M
Mike Christie 已提交
1492
		writequeue_entry_complete(e, ret);
1493 1494
	}
	spin_unlock(&con->writequeue_lock);
P
Patrick Caulfield 已提交
1495
out:
1496
	mutex_unlock(&con->sock_mutex);
P
Patrick Caulfield 已提交
1497
	return;
1498

P
Patrick Caulfield 已提交
1499
send_error:
1500
	mutex_unlock(&con->sock_mutex);
1501
	close_connection(con, false, false, true);
1502 1503 1504
	/* 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 已提交
1505
	return;
1506

P
Patrick Caulfield 已提交
1507
out_connect:
1508
	mutex_unlock(&con->sock_mutex);
1509 1510
	queue_work(send_workqueue, &con->swork);
	cond_resched();
1511 1512 1513 1514
}

static void clean_one_writequeue(struct connection *con)
{
1515
	struct writequeue_entry *e, *safe;
1516 1517

	spin_lock(&con->writequeue_lock);
1518
	list_for_each_entry_safe(e, safe, &con->writequeue, list) {
1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529
		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;
1530
	struct dlm_node_addr *na;
1531 1532 1533 1534

	log_print("closing connection to node %d", nodeid);
	con = nodeid2con(nodeid, 0);
	if (con) {
1535
		set_bit(CF_CLOSE, &con->flags);
1536
		close_connection(con, true, true, true);
1537
		clean_one_writequeue(con);
A
Alexander Aring 已提交
1538 1539
		if (con->othercon)
			clean_one_writequeue(con->othercon);
1540
	}
1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551

	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);

1552 1553 1554
	return 0;
}

1555
/* Receive workqueue function */
1556
static void process_recv_sockets(struct work_struct *work)
1557
{
1558 1559
	struct connection *con = container_of(work, struct connection, rwork);
	int err;
1560

1561 1562
	clear_bit(CF_READ_PENDING, &con->flags);
	do {
1563
		err = receive_from_sock(con);
1564
	} while (!err);
1565 1566
}

1567 1568 1569 1570 1571
static void process_listen_recv_socket(struct work_struct *work)
{
	accept_from_sock(&listen_con);
}

1572
/* Send workqueue function */
1573
static void process_send_sockets(struct work_struct *work)
1574
{
1575
	struct connection *con = container_of(work, struct connection, swork);
1576

1577
	clear_bit(CF_WRITE_PENDING, &con->flags);
1578
	if (con->sock == NULL) /* not mutex protected so check it inside too */
1579
		con->connect_action(con);
1580
	if (!list_empty(&con->writequeue))
1581
		send_to_sock(con);
1582 1583
}

1584
static void work_stop(void)
1585
{
1586 1587 1588 1589
	if (recv_workqueue)
		destroy_workqueue(recv_workqueue);
	if (send_workqueue)
		destroy_workqueue(send_workqueue);
1590 1591
}

1592
static int work_start(void)
1593
{
1594 1595
	recv_workqueue = alloc_workqueue("dlm_recv",
					 WQ_UNBOUND | WQ_MEM_RECLAIM, 1);
1596 1597 1598
	if (!recv_workqueue) {
		log_print("can't start dlm_recv");
		return -ENOMEM;
1599 1600
	}

1601 1602
	send_workqueue = alloc_workqueue("dlm_send",
					 WQ_UNBOUND | WQ_MEM_RECLAIM, 1);
1603 1604
	if (!send_workqueue) {
		log_print("can't start dlm_send");
1605
		destroy_workqueue(recv_workqueue);
1606
		return -ENOMEM;
1607 1608 1609 1610 1611
	}

	return 0;
}

1612
static void _stop_conn(struct connection *con, bool and_other)
1613
{
1614
	mutex_lock(&con->sock_mutex);
1615
	set_bit(CF_CLOSE, &con->flags);
1616
	set_bit(CF_READ_PENDING, &con->flags);
1617
	set_bit(CF_WRITE_PENDING, &con->flags);
1618 1619
	if (con->sock && con->sock->sk) {
		write_lock_bh(&con->sock->sk->sk_callback_lock);
1620
		con->sock->sk->sk_user_data = NULL;
1621 1622
		write_unlock_bh(&con->sock->sk->sk_callback_lock);
	}
1623 1624 1625 1626 1627 1628 1629 1630
	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);
1631
}
1632

1633 1634 1635 1636 1637 1638
static void shutdown_conn(struct connection *con)
{
	if (con->shutdown_action)
		con->shutdown_action(con);
}

1639 1640 1641 1642 1643 1644 1645 1646
static void connection_release(struct rcu_head *rcu)
{
	struct connection *con = container_of(rcu, struct connection, rcu);

	kfree(con->rx_buf);
	kfree(con);
}

1647 1648
static void free_conn(struct connection *con)
{
1649
	close_connection(con, true, true, true);
1650 1651 1652
	spin_lock(&connections_lock);
	hlist_del_rcu(&con->list);
	spin_unlock(&connections_lock);
1653 1654
	if (con->othercon) {
		clean_one_writequeue(con->othercon);
1655 1656
		call_srcu(&connections_srcu, &con->othercon->rcu,
			  connection_release);
1657
	}
1658
	clean_one_writequeue(con);
1659
	call_srcu(&connections_srcu, &con->rcu, connection_release);
1660 1661
}

1662 1663
static void work_flush(void)
{
1664
	int ok, idx;
1665 1666 1667 1668 1669 1670
	int i;
	struct connection *con;

	do {
		ok = 1;
		foreach_conn(stop_conn);
1671 1672 1673 1674
		if (recv_workqueue)
			flush_workqueue(recv_workqueue);
		if (send_workqueue)
			flush_workqueue(send_workqueue);
1675
		idx = srcu_read_lock(&connections_srcu);
1676
		for (i = 0; i < CONN_HASH_SIZE && ok; i++) {
1677 1678
			hlist_for_each_entry_rcu(con, &connection_hash[i],
						 list) {
1679
				ok &= test_bit(CF_READ_PENDING, &con->flags);
1680 1681
				ok &= test_bit(CF_WRITE_PENDING, &con->flags);
				if (con->othercon) {
1682 1683
					ok &= test_bit(CF_READ_PENDING,
						       &con->othercon->flags);
1684 1685 1686
					ok &= test_bit(CF_WRITE_PENDING,
						       &con->othercon->flags);
				}
1687 1688
			}
		}
1689
		srcu_read_unlock(&connections_srcu, idx);
1690 1691 1692
	} while (!ok);
}

1693 1694
void dlm_lowcomms_stop(void)
{
P
Patrick Caulfield 已提交
1695
	/* Set all the flags to prevent any
1696 1697
	   socket activity.
	*/
1698
	dlm_allow_conn = 0;
1699 1700 1701 1702 1703 1704

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

1705 1706
	dlm_close_sock(&listen_con.sock);

1707
	foreach_conn(shutdown_conn);
1708
	work_flush();
1709
	foreach_conn(free_conn);
1710
	work_stop();
1711
	deinit_local();
1712 1713 1714 1715
}

int dlm_lowcomms_start(void)
{
1716
	int error = -EINVAL;
1717 1718 1719 1720
	int i;

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

1722 1723
	init_local();
	if (!dlm_local_count) {
D
David Teigland 已提交
1724
		error = -ENOTCONN;
1725
		log_print("no local IP address has been set");
1726
		goto fail;
1727 1728
	}

1729 1730
	INIT_WORK(&listen_con.rwork, process_listen_recv_socket);

1731 1732
	error = work_start();
	if (error)
1733
		goto fail;
1734 1735

	dlm_allow_conn = 1;
1736 1737

	/* Start listening */
1738 1739 1740
	if (dlm_config.ci_protocol == 0)
		error = tcp_listen_for_all();
	else
1741
		error = sctp_listen_for_all(&listen_con);
1742 1743 1744 1745 1746
	if (error)
		goto fail_unlisten;

	return 0;

P
Patrick Caulfield 已提交
1747
fail_unlisten:
1748
	dlm_allow_conn = 0;
1749
	dlm_close_sock(&listen_con.sock);
1750
fail:
1751 1752
	return error;
}
1753 1754 1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765 1766

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);
}