lowcomms.c 42.5 KB
Newer Older
1 2 3 4
/******************************************************************************
*******************************************************************************
**
**  Copyright (C) Sistina Software, Inc.  1997-2003  All rights reserved.
5
**  Copyright (C) 2004-2009 Red Hat, Inc.  All rights reserved.
6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23
**
**  This copyrighted material is made available to anyone wishing to use,
**  modify, copy, or redistribute it subject to the terms and conditions
**  of the GNU General Public License v.2.
**
*******************************************************************************
******************************************************************************/

/*
 * 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 已提交
24
 * be expanded for the cluster infrastructure then that is its
25 26 27 28 29 30 31 32 33 34 35 36 37 38
 * 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 已提交
39
 * lowcomms will choose to use either TCP or SCTP as its transport layer
40
 * depending on the configuration variable 'protocol'. This should be set
J
Joe Perches 已提交
41
 * to 0 (default) for TCP or 1 for SCTP. It should be configured using a
42 43
 * cluster-wide mechanism as it must be the same on all nodes of the cluster
 * for the DLM to function.
44 45 46 47 48 49 50
 *
 */

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

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

63
#define NEEDED_RMEM (4*1024*1024)
64
#define CONN_HASH_SIZE 32
65

66 67 68
/* Number of messages to send before rescheduling */
#define MAX_SEND_MSG_COUNT 25

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

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

P
Patrick Caulfield 已提交
80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101
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;
}
102 103 104 105

struct connection {
	struct socket *sock;	/* NULL if not connected */
	uint32_t nodeid;	/* So we know who we are in the list */
106
	struct mutex sock_mutex;
107
	unsigned long flags;
108
#define CF_READ_PENDING 1
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
P
Patrick Caulfield 已提交
114
	struct list_head writequeue;  /* List of outgoing writequeue_entries */
115 116
	spinlock_t writequeue_lock;
	int (*rx_action) (struct connection *);	/* What to do when active */
117
	void (*connect_action) (struct connection *);	/* What to do to connect */
118 119 120 121
	struct page *rx_page;
	struct cbuf cb;
	int retries;
#define MAX_CONNECT_RETRIES 3
122
	struct hlist_node list;
123
	struct connection *othercon;
124 125
	struct work_struct rwork; /* Receive workqueue */
	struct work_struct swork; /* Send workqueue */
126 127 128 129 130 131 132 133 134 135 136 137 138 139
};
#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;
};

140 141 142 143
struct dlm_node_addr {
	struct list_head list;
	int nodeid;
	int addr_count;
144
	int curr_addr_index;
145 146 147
	struct sockaddr_storage *addr[DLM_MAX_ADDR_COUNT];
};

B
Bob Peterson 已提交
148 149 150 151 152 153 154
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;

155 156 157
static LIST_HEAD(dlm_node_addrs);
static DEFINE_SPINLOCK(dlm_node_addrs_spin);

158 159
static struct sockaddr_storage *dlm_local_addr[DLM_MAX_ADDR_COUNT];
static int dlm_local_count;
160
static int dlm_allow_conn;
161

162 163 164
/* Work queues */
static struct workqueue_struct *recv_workqueue;
static struct workqueue_struct *send_workqueue;
165

166
static struct hlist_head connection_hash[CONN_HASH_SIZE];
167
static DEFINE_MUTEX(connections_lock);
P
Patrick Caulfield 已提交
168
static struct kmem_cache *con_cache;
169

170 171
static void process_recv_sockets(struct work_struct *work);
static void process_send_sockets(struct work_struct *work);
172

173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188

/* 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)
{
	int r;
	struct connection *con;

	r = nodeid_hash(nodeid);

189
	hlist_for_each_entry(con, &connection_hash[r], list) {
190 191 192 193 194 195
		if (con->nodeid == nodeid)
			return con;
	}
	return NULL;
}

196 197 198 199 200
/*
 * 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)
201 202
{
	struct connection *con = NULL;
203
	int r;
204

205
	con = __find_con(nodeid);
206 207
	if (con || !alloc)
		return con;
208

209 210 211
	con = kmem_cache_zalloc(con_cache, alloc);
	if (!con)
		return NULL;
212

213 214
	r = nodeid_hash(nodeid);
	hlist_add_head(&con->list, &connection_hash[r]);
215

216 217 218 219 220 221
	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);
222

223 224
	/* Setup action pointers for child sockets */
	if (con->nodeid) {
225
		struct connection *zerocon = __find_con(0);
226

227 228 229
		con->connect_action = zerocon->connect_action;
		if (!con->rx_action)
			con->rx_action = zerocon->rx_action;
230 231
	}

232 233 234
	return con;
}

235 236 237 238
/* Loop round all connections */
static void foreach_conn(void (*conn_func)(struct connection *c))
{
	int i;
239
	struct hlist_node *n;
240 241 242
	struct connection *con;

	for (i = 0; i < CONN_HASH_SIZE; i++) {
243
		hlist_for_each_entry_safe(con, n, &connection_hash[i], list)
244 245 246 247
			conn_func(con);
	}
}

248 249 250 251
static struct connection *nodeid2con(int nodeid, gfp_t allocation)
{
	struct connection *con;

252
	mutex_lock(&connections_lock);
253
	con = __nodeid2con(nodeid, allocation);
254
	mutex_unlock(&connections_lock);
255

256 257 258
	return con;
}

259 260 261 262 263 264 265 266 267 268 269 270
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)
271
{
272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297
	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,
298
			  struct sockaddr *sa_out, bool try_new_addr)
299 300 301
{
	struct sockaddr_storage sas;
	struct dlm_node_addr *na;
302 303 304 305

	if (!dlm_local_count)
		return -1;

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

312 313 314 315 316 317
		if (try_new_addr) {
			na->curr_addr_index++;
			if (na->curr_addr_index == na->addr_count)
				na->curr_addr_index = 0;
		}
	}
318 319 320 321 322 323 324 325 326 327 328 329 330
	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;
331 332

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

	return 0;
}

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

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

356 357 358 359 360 361 362
		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;
			}
		}
363
	}
364
unlock:
365 366 367 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
	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;
}

410
/* Data available on socket or listen socket received a connect */
411
static void lowcomms_data_ready(struct sock *sk)
412 413
{
	struct connection *con = sock2con(sk);
P
Patrick Caulfield 已提交
414
	if (con && !test_and_set_bit(CF_READ_PENDING, &con->flags))
415
		queue_work(recv_workqueue, &con->rwork);
416 417 418 419 420 421
}

static void lowcomms_write_space(struct sock *sk)
{
	struct connection *con = sock2con(sk);

422 423 424 425 426 427 428
	if (!con)
		return;

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

	if (test_and_clear_bit(CF_APP_LIMITED, &con->flags)) {
		con->sock->sk->sk_write_pending--;
429
		clear_bit(SOCKWQ_ASYNC_NOSPACE, &con->sock->flags);
430 431
	}

432
	queue_work(send_workqueue, &con->swork);
433 434 435 436
}

static inline void lowcomms_connect_sock(struct connection *con)
{
437 438
	if (test_bit(CF_CLOSE, &con->flags))
		return;
439 440
	queue_work(send_workqueue, &con->swork);
	cond_resched();
441 442 443 444
}

static void lowcomms_state_change(struct sock *sk)
{
445 446 447 448 449 450 451 452 453
	/* 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) {
454
		lowcomms_write_space(sk);
455
	}
456 457
}

458 459 460 461 462 463 464 465 466 467 468 469 470 471
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;
}

472 473
static void lowcomms_error_report(struct sock *sk)
{
474
	struct connection *con;
475
	struct sockaddr_storage saddr;
476
	int buflen;
477
	void (*orig_report)(struct sock *) = NULL;
478

479 480 481 482 483
	read_lock_bh(&sk->sk_callback_lock);
	con = sock2con(sk);
	if (con == NULL)
		goto out;

B
Bob Peterson 已提交
484
	orig_report = listen_sock.sk_error_report;
485 486
	if (con->sock == NULL ||
	    kernel_getpeername(con->sock, (struct sockaddr *)&saddr, &buflen)) {
487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513
		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);
	}
514 515 516 517 518 519 520
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 已提交
521
static void save_listen_callbacks(struct socket *sock)
522
{
B
Bob Peterson 已提交
523 524 525 526 527 528
	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;
529 530
}

B
Bob Peterson 已提交
531
static void restore_callbacks(struct socket *sock)
532
{
B
Bob Peterson 已提交
533 534
	struct sock *sk = sock->sk;

535 536
	write_lock_bh(&sk->sk_callback_lock);
	sk->sk_user_data = NULL;
B
Bob Peterson 已提交
537 538 539 540
	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;
541
	write_unlock_bh(&sk->sk_callback_lock);
542 543
}

544
/* Make a socket active */
545
static void add_sock(struct socket *sock, struct connection *con)
546
{
547 548 549
	struct sock *sk = sock->sk;

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

552
	sk->sk_user_data = con;
553
	/* Install a data_ready callback */
554 555 556 557 558 559
	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);
560 561
}

562
/* Add the port number to an IPv6 or 4 sockaddr and return the address
563 564 565 566
   length */
static void make_sockaddr(struct sockaddr_storage *saddr, uint16_t port,
			  int *addr_len)
{
567
	saddr->ss_family =  dlm_local_addr[0]->ss_family;
P
Patrick Caulfield 已提交
568
	if (saddr->ss_family == AF_INET) {
569 570 571
		struct sockaddr_in *in4_addr = (struct sockaddr_in *)saddr;
		in4_addr->sin_port = cpu_to_be16(port);
		*addr_len = sizeof(struct sockaddr_in);
572
		memset(&in4_addr->sin_zero, 0, sizeof(in4_addr->sin_zero));
P
Patrick Caulfield 已提交
573
	} else {
574 575 576 577
		struct sockaddr_in6 *in6_addr = (struct sockaddr_in6 *)saddr;
		in6_addr->sin6_port = cpu_to_be16(port);
		*addr_len = sizeof(struct sockaddr_in6);
	}
578
	memset((char *)saddr + *addr_len, 0, sizeof(struct sockaddr_storage) - *addr_len);
579 580 581
}

/* Close a remote connection and tidy up */
582 583
static void close_connection(struct connection *con, bool and_other,
			     bool tx, bool rx)
584
{
585 586 587
	bool closing = test_and_set_bit(CF_CLOSING, &con->flags);

	if (tx && !closing && cancel_work_sync(&con->swork))
588
		log_print("canceled swork for node %d", con->nodeid);
589
	if (rx && !closing && cancel_work_sync(&con->rwork))
590
		log_print("canceled rwork for node %d", con->nodeid);
591

592
	mutex_lock(&con->sock_mutex);
593
	if (con->sock) {
B
Bob Peterson 已提交
594
		restore_callbacks(con->sock);
595 596 597 598
		sock_release(con->sock);
		con->sock = NULL;
	}
	if (con->othercon && and_other) {
P
Patrick Caulfield 已提交
599
		/* Will only re-enter once. */
600
		close_connection(con->othercon, false, true, true);
601 602 603 604 605
	}
	if (con->rx_page) {
		__free_page(con->rx_page);
		con->rx_page = NULL;
	}
P
Patrick Caulfield 已提交
606

607 608
	con->retries = 0;
	mutex_unlock(&con->sock_mutex);
609
	clear_bit(CF_CLOSING, &con->flags);
610 611 612 613 614 615
}

/* Data received from remote end */
static int receive_from_sock(struct connection *con)
{
	int ret = 0;
A
Al Viro 已提交
616 617
	struct msghdr msg = {};
	struct kvec iov[2];
618 619 620
	unsigned len;
	int r;
	int call_again_soon = 0;
A
Al Viro 已提交
621
	int nvec;
622

623
	mutex_lock(&con->sock_mutex);
624

625 626 627 628
	if (con->sock == NULL) {
		ret = -EAGAIN;
		goto out_close;
	}
629 630 631 632
	if (con->nodeid == 0) {
		ret = -EINVAL;
		goto out_close;
	}
633

634 635 636 637 638 639 640 641
	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;
642
		cbuf_init(&con->cb, PAGE_SIZE);
643 644 645 646 647 648
	}

	/*
	 * 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 已提交
649 650
	iov[0].iov_len = con->cb.base - cbuf_data(&con->cb);
	iov[0].iov_base = page_address(con->rx_page) + cbuf_data(&con->cb);
651
	iov[1].iov_len = 0;
A
Al Viro 已提交
652
	nvec = 1;
653 654 655 656 657

	/*
	 * 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 已提交
658
	if (cbuf_data(&con->cb) >= con->cb.base) {
659
		iov[0].iov_len = PAGE_SIZE - cbuf_data(&con->cb);
660 661
		iov[1].iov_len = con->cb.base;
		iov[1].iov_base = page_address(con->rx_page);
A
Al Viro 已提交
662
		nvec = 2;
663 664 665
	}
	len = iov[0].iov_len + iov[1].iov_len;

A
Al Viro 已提交
666
	r = ret = kernel_recvmsg(con->sock, &msg, iov, nvec, len,
667 668 669
			       MSG_DONTWAIT | MSG_NOSIGNAL);
	if (ret <= 0)
		goto out_close;
670 671
	else if (ret == len)
		call_again_soon = 1;
P
Patrick Caulfield 已提交
672

P
Patrick Caulfield 已提交
673
	cbuf_add(&con->cb, ret);
674 675 676
	ret = dlm_process_incoming_buffer(con->nodeid,
					  page_address(con->rx_page),
					  con->cb.base, con->cb.len,
677
					  PAGE_SIZE);
678
	if (ret == -EBADMSG) {
679 680 681
		log_print("lowcomms: addr=%p, base=%u, len=%u, read=%d",
			  page_address(con->rx_page), con->cb.base,
			  con->cb.len, r);
682 683 684
	}
	if (ret < 0)
		goto out_close;
P
Patrick Caulfield 已提交
685
	cbuf_eat(&con->cb, ret);
686

P
Patrick Caulfield 已提交
687
	if (cbuf_empty(&con->cb) && !call_again_soon) {
688 689 690 691 692 693
		__free_page(con->rx_page);
		con->rx_page = NULL;
	}

	if (call_again_soon)
		goto out_resched;
694
	mutex_unlock(&con->sock_mutex);
P
Patrick Caulfield 已提交
695
	return 0;
696

P
Patrick Caulfield 已提交
697
out_resched:
698 699
	if (!test_and_set_bit(CF_READ_PENDING, &con->flags))
		queue_work(recv_workqueue, &con->rwork);
700
	mutex_unlock(&con->sock_mutex);
P
Patrick Caulfield 已提交
701
	return -EAGAIN;
702

P
Patrick Caulfield 已提交
703
out_close:
704
	mutex_unlock(&con->sock_mutex);
P
Patrick Caulfield 已提交
705
	if (ret != -EAGAIN) {
706
		close_connection(con, false, true, false);
707 708
		/* Reconnect when there is something to send */
	}
709 710 711
	/* Don't return success if we really got EOF */
	if (ret == 0)
		ret = -EAGAIN;
712 713 714 715 716

	return ret;
}

/* Listening socket is busy, accept a connection */
717
static int tcp_accept_from_sock(struct connection *con)
718 719 720 721 722 723 724
{
	int result;
	struct sockaddr_storage peeraddr;
	struct socket *newsock;
	int len;
	int nodeid;
	struct connection *newcon;
P
Patrick Caulfield 已提交
725
	struct connection *addcon;
726

727 728 729 730 731 732 733
	mutex_lock(&connections_lock);
	if (!dlm_allow_conn) {
		mutex_unlock(&connections_lock);
		return -1;
	}
	mutex_unlock(&connections_lock);

734
	memset(&peeraddr, 0, sizeof(peeraddr));
735
	result = sock_create_lite(dlm_local_addr[0]->ss_family,
736
				  SOCK_STREAM, IPPROTO_TCP, &newsock);
737 738 739
	if (result < 0)
		return -ENOMEM;

740
	mutex_lock_nested(&con->sock_mutex, 0);
741 742 743 744 745 746 747 748

	result = -ENOTCONN;
	if (con->sock == NULL)
		goto accept_err;

	newsock->type = con->sock->type;
	newsock->ops = con->sock->ops;

749
	result = con->sock->ops->accept(con->sock, newsock, O_NONBLOCK, true);
750 751 752 753 754 755 756 757 758 759 760 761 762
	if (result < 0)
		goto accept_err;

	/* Get the connected socket's peer */
	memset(&peeraddr, 0, sizeof(peeraddr));
	if (newsock->ops->getname(newsock, (struct sockaddr *)&peeraddr,
				  &len, 2)) {
		result = -ECONNABORTED;
		goto accept_err;
	}

	/* Get the new node's NODEID */
	make_sockaddr(&peeraddr, 0, &len);
763
	if (addr_to_nodeid(&peeraddr, &nodeid)) {
764
		unsigned char *b=(unsigned char *)&peeraddr;
D
David Teigland 已提交
765
		log_print("connect from non cluster node");
766 767
		print_hex_dump_bytes("ss: ", DUMP_PREFIX_NONE, 
				     b, sizeof(struct sockaddr_storage));
768
		sock_release(newsock);
769
		mutex_unlock(&con->sock_mutex);
770 771 772 773 774 775 776 777 778 779
		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 已提交
780
	newcon = nodeid2con(nodeid, GFP_NOFS);
781 782 783 784
	if (!newcon) {
		result = -ENOMEM;
		goto accept_err;
	}
785
	mutex_lock_nested(&newcon->sock_mutex, 1);
786
	if (newcon->sock) {
P
Patrick Caulfield 已提交
787
		struct connection *othercon = newcon->othercon;
788 789

		if (!othercon) {
D
David Teigland 已提交
790
			othercon = kmem_cache_zalloc(con_cache, GFP_NOFS);
791
			if (!othercon) {
D
David Teigland 已提交
792
				log_print("failed to allocate incoming socket");
793
				mutex_unlock(&newcon->sock_mutex);
794 795 796 797 798
				result = -ENOMEM;
				goto accept_err;
			}
			othercon->nodeid = nodeid;
			othercon->rx_action = receive_from_sock;
799
			mutex_init(&othercon->sock_mutex);
800 801
			INIT_WORK(&othercon->swork, process_send_sockets);
			INIT_WORK(&othercon->rwork, process_recv_sockets);
802
			set_bit(CF_IS_OTHERCON, &othercon->flags);
803 804
		}
		if (!othercon->sock) {
805
			newcon->othercon = othercon;
806 807
			othercon->sock = newsock;
			newsock->sk->sk_user_data = othercon;
808
			add_sock(newsock, othercon);
809 810 811 812 813
			addcon = othercon;
		}
		else {
			printk("Extra connection from node %d attempted\n", nodeid);
			result = -EAGAIN;
814
			mutex_unlock(&newcon->sock_mutex);
815
			goto accept_err;
816 817 818 819 820
		}
	}
	else {
		newsock->sk->sk_user_data = newcon;
		newcon->rx_action = receive_from_sock;
821 822 823
		/* 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. */
824
		add_sock(newsock, newcon);
P
Patrick Caulfield 已提交
825
		addcon = newcon;
826 827
	}

828
	mutex_unlock(&newcon->sock_mutex);
829 830 831

	/*
	 * Add it to the active queue in case we got data
L
Lucas De Marchi 已提交
832
	 * between processing the accept adding the socket
833 834
	 * to the read_sockets list
	 */
P
Patrick Caulfield 已提交
835 836
	if (!test_and_set_bit(CF_READ_PENDING, &addcon->flags))
		queue_work(recv_workqueue, &addcon->rwork);
837
	mutex_unlock(&con->sock_mutex);
838 839 840

	return 0;

P
Patrick Caulfield 已提交
841
accept_err:
842
	mutex_unlock(&con->sock_mutex);
843 844 845
	sock_release(newsock);

	if (result != -EAGAIN)
D
David Teigland 已提交
846
		log_print("error accepting connection from node: %d", result);
847 848 849
	return result;
}

850
static int sctp_accept_from_sock(struct connection *con)
851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884
{
	/* Check that the new node is in the lockspace */
	struct sctp_prim prim;
	int nodeid;
	int prim_len, ret;
	int addr_len;
	struct connection *newcon;
	struct connection *addcon;
	struct socket *newsock;

	mutex_lock(&connections_lock);
	if (!dlm_allow_conn) {
		mutex_unlock(&connections_lock);
		return -1;
	}
	mutex_unlock(&connections_lock);

	mutex_lock_nested(&con->sock_mutex, 0);

	ret = kernel_accept(con->sock, &newsock, O_NONBLOCK);
	if (ret < 0)
		goto accept_err;

	memset(&prim, 0, sizeof(struct sctp_prim));
	prim_len = sizeof(struct sctp_prim);

	ret = kernel_getsockopt(newsock, IPPROTO_SCTP, SCTP_PRIMARY_ADDR,
				(char *)&prim, &prim_len);
	if (ret < 0) {
		log_print("getsockopt/sctp_primary_addr failed: %d", ret);
		goto accept_err;
	}

	make_sockaddr(&prim.ssp_addr, 0, &addr_len);
885 886
	ret = addr_to_nodeid(&prim.ssp_addr, &nodeid);
	if (ret) {
887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924
		unsigned char *b = (unsigned char *)&prim.ssp_addr;

		log_print("reject connect from unknown addr");
		print_hex_dump_bytes("ss: ", DUMP_PREFIX_NONE,
				     b, sizeof(struct sockaddr_storage));
		goto accept_err;
	}

	newcon = nodeid2con(nodeid, GFP_NOFS);
	if (!newcon) {
		ret = -ENOMEM;
		goto accept_err;
	}

	mutex_lock_nested(&newcon->sock_mutex, 1);

	if (newcon->sock) {
		struct connection *othercon = newcon->othercon;

		if (!othercon) {
			othercon = kmem_cache_zalloc(con_cache, GFP_NOFS);
			if (!othercon) {
				log_print("failed to allocate incoming socket");
				mutex_unlock(&newcon->sock_mutex);
				ret = -ENOMEM;
				goto accept_err;
			}
			othercon->nodeid = nodeid;
			othercon->rx_action = receive_from_sock;
			mutex_init(&othercon->sock_mutex);
			INIT_WORK(&othercon->swork, process_send_sockets);
			INIT_WORK(&othercon->rwork, process_recv_sockets);
			set_bit(CF_IS_OTHERCON, &othercon->flags);
		}
		if (!othercon->sock) {
			newcon->othercon = othercon;
			othercon->sock = newsock;
			newsock->sk->sk_user_data = othercon;
925
			add_sock(newsock, othercon);
926 927 928 929 930 931 932 933 934 935
			addcon = othercon;
		} else {
			printk("Extra connection from node %d attempted\n", nodeid);
			ret = -EAGAIN;
			mutex_unlock(&newcon->sock_mutex);
			goto accept_err;
		}
	} else {
		newsock->sk->sk_user_data = newcon;
		newcon->rx_action = receive_from_sock;
936
		add_sock(newsock, newcon);
937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964
		addcon = newcon;
	}

	log_print("connected to %d", nodeid);

	mutex_unlock(&newcon->sock_mutex);

	/*
	 * Add it to the active queue in case we got data
	 * between processing the accept adding the socket
	 * to the read_sockets list
	 */
	if (!test_and_set_bit(CF_READ_PENDING, &addcon->flags))
		queue_work(recv_workqueue, &addcon->rwork);
	mutex_unlock(&con->sock_mutex);

	return 0;

accept_err:
	mutex_unlock(&con->sock_mutex);
	if (newsock)
		sock_release(newsock);
	if (ret != -EAGAIN)
		log_print("error accepting connection from node: %d", ret);

	return ret;
}

965 966 967 968 969 970
static void free_entry(struct writequeue_entry *e)
{
	__free_page(e->page);
	kfree(e);
}

M
Mike Christie 已提交
971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988
/*
 * 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);
	}
}

989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018
/*
 * 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;
	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)
			result = kernel_bind(con->sock,
					     (struct sockaddr *)&localaddr,
					     addr_len);
		else
			result = kernel_setsockopt(con->sock, SOL_SCTP,
						   SCTP_SOCKOPT_BINDX_ADD,
						   (char *)&localaddr, addr_len);

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

1019 1020 1021 1022 1023
/* 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.
 */
1024
static void sctp_connect_to_sock(struct connection *con)
1025
{
1026 1027 1028 1029 1030 1031 1032 1033 1034 1035
	struct sockaddr_storage daddr;
	int one = 1;
	int result;
	int addr_len;
	struct socket *sock;

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

M
Mike Christie 已提交
1037
	mutex_lock(&con->sock_mutex);
1038

1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050
	/* 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) {
1051
		log_print("no address for nodeid %d", con->nodeid);
1052
		goto out;
1053 1054
	}

1055 1056 1057 1058 1059
	/* 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;
1060

1061 1062 1063
	sock->sk->sk_user_data = con;
	con->rx_action = receive_from_sock;
	con->connect_action = sctp_connect_to_sock;
1064
	add_sock(sock, con);
1065

1066 1067 1068
	/* Bind to all addresses. */
	if (sctp_bind_addrs(con, 0))
		goto bind_err;
1069

1070
	make_sockaddr(&daddr, dlm_config.ci_tcp_port, &addr_len);
1071

1072
	log_print("connecting to %d", con->nodeid);
1073

1074 1075 1076
	/* Turn off Nagle's algorithm */
	kernel_setsockopt(sock, SOL_TCP, TCP_NODELAY, (char *)&one,
			  sizeof(one));
1077

1078 1079 1080 1081 1082 1083
	result = sock->ops->connect(sock, (struct sockaddr *)&daddr, addr_len,
				   O_NONBLOCK);
	if (result == -EINPROGRESS)
		result = 0;
	if (result == 0)
		goto out;
1084

1085 1086 1087
bind_err:
	con->sock = NULL;
	sock_release(sock);
1088

1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104
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;
1105
	}
M
Mike Christie 已提交
1106

1107
out:
M
Mike Christie 已提交
1108
	mutex_unlock(&con->sock_mutex);
1109 1110
}

1111
/* Connect a new socket to its peer */
1112
static void tcp_connect_to_sock(struct connection *con)
1113
{
1114
	struct sockaddr_storage saddr, src_addr;
1115
	int addr_len;
1116
	struct socket *sock = NULL;
D
David Teigland 已提交
1117
	int one = 1;
1118
	int result;
1119 1120 1121

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

1125
	mutex_lock(&con->sock_mutex);
1126 1127 1128 1129
	if (con->retries++ > MAX_CONNECT_RETRIES)
		goto out;

	/* Some odd races can cause double-connects, ignore them */
1130
	if (con->sock)
1131 1132 1133
		goto out;

	/* Create a socket to communicate with */
1134 1135
	result = sock_create_kern(&init_net, dlm_local_addr[0]->ss_family,
				  SOCK_STREAM, IPPROTO_TCP, &sock);
1136 1137 1138 1139
	if (result < 0)
		goto out_err;

	memset(&saddr, 0, sizeof(saddr));
1140
	result = nodeid_to_addr(con->nodeid, &saddr, NULL, false);
1141 1142
	if (result < 0) {
		log_print("no address for nodeid %d", con->nodeid);
P
Patrick Caulfield 已提交
1143
		goto out_err;
1144
	}
1145 1146 1147

	sock->sk->sk_user_data = con;
	con->rx_action = receive_from_sock;
1148
	con->connect_action = tcp_connect_to_sock;
1149
	add_sock(sock, con);
1150

1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161
	/* 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 */
	}

1162
	make_sockaddr(&saddr, dlm_config.ci_tcp_port, &addr_len);
1163 1164

	log_print("connecting to %d", con->nodeid);
D
David Teigland 已提交
1165 1166 1167 1168 1169

	/* Turn off Nagle's algorithm */
	kernel_setsockopt(sock, SOL_TCP, TCP_NODELAY, (char *)&one,
			  sizeof(one));

1170
	result = sock->ops->connect(sock, (struct sockaddr *)&saddr, addr_len,
P
Patrick Caulfield 已提交
1171
				   O_NONBLOCK);
1172 1173
	if (result == -EINPROGRESS)
		result = 0;
P
Patrick Caulfield 已提交
1174 1175
	if (result == 0)
		goto out;
1176

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

1205 1206
static struct socket *tcp_create_listen_sock(struct connection *con,
					     struct sockaddr_storage *saddr)
1207
{
P
Patrick Caulfield 已提交
1208
	struct socket *sock = NULL;
1209 1210 1211 1212
	int result = 0;
	int one = 1;
	int addr_len;

1213
	if (dlm_local_addr[0]->ss_family == AF_INET)
1214 1215 1216 1217 1218
		addr_len = sizeof(struct sockaddr_in);
	else
		addr_len = sizeof(struct sockaddr_in6);

	/* Create a socket to communicate with */
1219 1220
	result = sock_create_kern(&init_net, dlm_local_addr[0]->ss_family,
				  SOCK_STREAM, IPPROTO_TCP, &sock);
1221
	if (result < 0) {
D
David Teigland 已提交
1222
		log_print("Can't create listening comms socket");
1223 1224 1225
		goto create_out;
	}

D
David Teigland 已提交
1226 1227 1228 1229
	/* Turn off Nagle's algorithm */
	kernel_setsockopt(sock, SOL_TCP, TCP_NODELAY, (char *)&one,
			  sizeof(one));

1230 1231 1232
	result = kernel_setsockopt(sock, SOL_SOCKET, SO_REUSEADDR,
				   (char *)&one, sizeof(one));

1233
	if (result < 0) {
D
David Teigland 已提交
1234
		log_print("Failed to set SO_REUSEADDR on socket: %d", result);
1235
	}
1236
	sock->sk->sk_user_data = con;
B
Bob Peterson 已提交
1237
	save_listen_callbacks(sock);
1238 1239
	con->rx_action = tcp_accept_from_sock;
	con->connect_action = tcp_connect_to_sock;
1240 1241

	/* Bind to our port */
1242
	make_sockaddr(saddr, dlm_config.ci_tcp_port, &addr_len);
1243 1244
	result = sock->ops->bind(sock, (struct sockaddr *) saddr, addr_len);
	if (result < 0) {
D
David Teigland 已提交
1245
		log_print("Can't bind to port %d", dlm_config.ci_tcp_port);
1246 1247 1248 1249 1250
		sock_release(sock);
		sock = NULL;
		con->sock = NULL;
		goto create_out;
	}
1251
	result = kernel_setsockopt(sock, SOL_SOCKET, SO_KEEPALIVE,
P
Patrick Caulfield 已提交
1252
				 (char *)&one, sizeof(one));
1253
	if (result < 0) {
D
David Teigland 已提交
1254
		log_print("Set keepalive failed: %d", result);
1255 1256 1257 1258
	}

	result = sock->ops->listen(sock, 5);
	if (result < 0) {
D
David Teigland 已提交
1259
		log_print("Can't listen on port %d", dlm_config.ci_tcp_port);
1260 1261 1262 1263 1264
		sock_release(sock);
		sock = NULL;
		goto create_out;
	}

P
Patrick Caulfield 已提交
1265
create_out:
1266 1267 1268
	return sock;
}

1269 1270 1271 1272 1273 1274
/* Get local addresses */
static void init_local(void)
{
	struct sockaddr_storage sas, *addr;
	int i;

1275
	dlm_local_count = 0;
1276
	for (i = 0; i < DLM_MAX_ADDR_COUNT; i++) {
1277 1278 1279
		if (dlm_our_addr(&sas, i))
			break;

1280
		addr = kmemdup(&sas, sizeof(*addr), GFP_NOFS);
1281 1282 1283 1284 1285 1286 1287 1288 1289 1290
		if (!addr)
			break;
		dlm_local_addr[dlm_local_count++] = addr;
	}
}

/* Initialise SCTP socket and bind to all interfaces */
static int sctp_listen_for_all(void)
{
	struct socket *sock = NULL;
1291
	int result = -EINVAL;
D
David Teigland 已提交
1292
	struct connection *con = nodeid2con(0, GFP_NOFS);
1293
	int bufsize = NEEDED_RMEM;
M
Mike Christie 已提交
1294
	int one = 1;
1295 1296 1297 1298 1299 1300

	if (!con)
		return -ENOMEM;

	log_print("Using SCTP for communications");

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

1308
	result = kernel_setsockopt(sock, SOL_SOCKET, SO_RCVBUFFORCE,
1309 1310
				 (char *)&bufsize, sizeof(bufsize));
	if (result)
D
David Teigland 已提交
1311
		log_print("Error increasing buffer space on socket %d", result);
1312

M
Mike Christie 已提交
1313 1314 1315 1316 1317
	result = kernel_setsockopt(sock, SOL_SCTP, SCTP_NODELAY, (char *)&one,
				   sizeof(one));
	if (result < 0)
		log_print("Could not set SCTP NODELAY error %d\n", result);

1318
	write_lock_bh(&sock->sk->sk_callback_lock);
1319 1320
	/* Init con struct */
	sock->sk->sk_user_data = con;
B
Bob Peterson 已提交
1321
	save_listen_callbacks(sock);
1322 1323
	con->sock = sock;
	con->sock->sk->sk_data_ready = lowcomms_data_ready;
1324 1325
	con->rx_action = sctp_accept_from_sock;
	con->connect_action = sctp_connect_to_sock;
1326

1327 1328
	write_unlock_bh(&sock->sk->sk_callback_lock);

1329 1330 1331
	/* Bind to all addresses. */
	if (sctp_bind_addrs(con, dlm_config.ci_tcp_port))
		goto create_delsock;
1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348

	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)
1349 1350
{
	struct socket *sock = NULL;
D
David Teigland 已提交
1351
	struct connection *con = nodeid2con(0, GFP_NOFS);
1352 1353
	int result = -EINVAL;

1354 1355 1356
	if (!con)
		return -ENOMEM;

1357
	/* We don't support multi-homed hosts */
1358
	if (dlm_local_addr[1] != NULL) {
D
David Teigland 已提交
1359 1360
		log_print("TCP protocol can't handle multi-homed hosts, "
			  "try SCTP");
1361 1362 1363 1364 1365 1366
		return -EINVAL;
	}

	log_print("Using TCP for communications");

	sock = tcp_create_listen_sock(con, dlm_local_addr[0]);
1367
	if (sock) {
1368
		add_sock(sock, con);
1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403
		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 已提交
1404
void *dlm_lowcomms_get_buffer(int nodeid, int len, gfp_t allocation, char **ppc)
1405 1406 1407 1408 1409 1410 1411 1412 1413
{
	struct connection *con;
	struct writequeue_entry *e;
	int offset = 0;

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

1414
	spin_lock(&con->writequeue_lock);
1415
	e = list_entry(con->writequeue.prev, struct writequeue_entry, list);
P
Patrick Caulfield 已提交
1416
	if ((&e->list == &con->writequeue) ||
1417
	    (PAGE_SIZE - e->end < len)) {
1418 1419 1420 1421
		e = NULL;
	} else {
		offset = e->end;
		e->end += len;
1422
		e->users++;
1423 1424 1425 1426
	}
	spin_unlock(&con->writequeue_lock);

	if (e) {
P
Patrick Caulfield 已提交
1427
	got_one:
1428 1429 1430 1431 1432 1433 1434 1435 1436
		*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;
1437
		e->users++;
1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450
		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;

1451
	spin_lock(&con->writequeue_lock);
1452 1453 1454 1455 1456 1457
	users = --e->users;
	if (users)
		goto out;
	e->len = e->end - e->offset;
	spin_unlock(&con->writequeue_lock);

1458
	queue_work(send_workqueue, &con->swork);
1459 1460
	return;

P
Patrick Caulfield 已提交
1461
out:
1462 1463 1464 1465 1466
	spin_unlock(&con->writequeue_lock);
	return;
}

/* Send a message */
P
Patrick Caulfield 已提交
1467
static void send_to_sock(struct connection *con)
1468 1469 1470 1471 1472
{
	int ret = 0;
	const int msg_flags = MSG_DONTWAIT | MSG_NOSIGNAL;
	struct writequeue_entry *e;
	int len, offset;
1473
	int count = 0;
1474

1475
	mutex_lock(&con->sock_mutex);
1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492
	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 已提交
1493 1494
			ret = kernel_sendpage(con->sock, e->page, offset, len,
					      msg_flags);
1495
			if (ret == -EAGAIN || ret == 0) {
1496
				if (ret == -EAGAIN &&
1497
				    test_bit(SOCKWQ_ASYNC_NOSPACE, &con->sock->flags) &&
1498 1499 1500 1501 1502 1503 1504
				    !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++;
				}
1505
				cond_resched();
1506
				goto out;
Y
Ying Xue 已提交
1507
			} else if (ret < 0)
1508
				goto send_error;
1509
		}
1510 1511 1512

		/* Don't starve people filling buffers */
		if (++count >= MAX_SEND_MSG_COUNT) {
P
Patrick Caulfield 已提交
1513
			cond_resched();
1514 1515
			count = 0;
		}
1516 1517

		spin_lock(&con->writequeue_lock);
M
Mike Christie 已提交
1518
		writequeue_entry_complete(e, ret);
1519 1520
	}
	spin_unlock(&con->writequeue_lock);
P
Patrick Caulfield 已提交
1521
out:
1522
	mutex_unlock(&con->sock_mutex);
P
Patrick Caulfield 已提交
1523
	return;
1524

P
Patrick Caulfield 已提交
1525
send_error:
1526
	mutex_unlock(&con->sock_mutex);
1527
	close_connection(con, false, false, true);
1528 1529 1530
	/* 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 已提交
1531
	return;
1532

P
Patrick Caulfield 已提交
1533
out_connect:
1534
	mutex_unlock(&con->sock_mutex);
1535 1536
	queue_work(send_workqueue, &con->swork);
	cond_resched();
1537 1538 1539 1540
}

static void clean_one_writequeue(struct connection *con)
{
1541
	struct writequeue_entry *e, *safe;
1542 1543

	spin_lock(&con->writequeue_lock);
1544
	list_for_each_entry_safe(e, safe, &con->writequeue, list) {
1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555
		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;
1556
	struct dlm_node_addr *na;
1557 1558 1559 1560

	log_print("closing connection to node %d", nodeid);
	con = nodeid2con(nodeid, 0);
	if (con) {
1561
		set_bit(CF_CLOSE, &con->flags);
1562
		close_connection(con, true, true, true);
1563 1564
		clean_one_writequeue(con);
	}
1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575

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

1576 1577 1578
	return 0;
}

1579
/* Receive workqueue function */
1580
static void process_recv_sockets(struct work_struct *work)
1581
{
1582 1583
	struct connection *con = container_of(work, struct connection, rwork);
	int err;
1584

1585 1586 1587 1588
	clear_bit(CF_READ_PENDING, &con->flags);
	do {
		err = con->rx_action(con);
	} while (!err);
1589 1590
}

1591
/* Send workqueue function */
1592
static void process_send_sockets(struct work_struct *work)
1593
{
1594
	struct connection *con = container_of(work, struct connection, swork);
1595

1596
	if (con->sock == NULL) /* not mutex protected so check it inside too */
1597
		con->connect_action(con);
1598
	if (!list_empty(&con->writequeue))
1599
		send_to_sock(con);
1600 1601 1602 1603 1604 1605
}


/* Discard all entries on the write queues */
static void clean_writequeues(void)
{
1606
	foreach_conn(clean_one_writequeue);
1607 1608
}

1609
static void work_stop(void)
1610
{
1611 1612
	destroy_workqueue(recv_workqueue);
	destroy_workqueue(send_workqueue);
1613 1614
}

1615
static int work_start(void)
1616
{
1617 1618
	recv_workqueue = alloc_workqueue("dlm_recv",
					 WQ_UNBOUND | WQ_MEM_RECLAIM, 1);
1619 1620 1621
	if (!recv_workqueue) {
		log_print("can't start dlm_recv");
		return -ENOMEM;
1622 1623
	}

1624 1625
	send_workqueue = alloc_workqueue("dlm_send",
					 WQ_UNBOUND | WQ_MEM_RECLAIM, 1);
1626 1627
	if (!send_workqueue) {
		log_print("can't start dlm_send");
1628
		destroy_workqueue(recv_workqueue);
1629
		return -ENOMEM;
1630 1631 1632 1633 1634
	}

	return 0;
}

1635
static void _stop_conn(struct connection *con, bool and_other)
1636
{
1637 1638
	mutex_lock(&con->sock_mutex);
	set_bit(CF_READ_PENDING, &con->flags);
1639
	if (con->sock && con->sock->sk)
1640
		con->sock->sk->sk_user_data = NULL;
1641 1642 1643 1644 1645 1646 1647 1648
	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);
1649
}
1650

1651 1652
static void free_conn(struct connection *con)
{
1653
	close_connection(con, true, true, true);
1654 1655 1656 1657 1658 1659
	if (con->othercon)
		kmem_cache_free(con_cache, con->othercon);
	hlist_del(&con->list);
	kmem_cache_free(con_cache, con);
}

1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677 1678 1679 1680 1681 1682 1683 1684 1685
static void work_flush(void)
{
	int ok;
	int i;
	struct hlist_node *n;
	struct connection *con;

	flush_workqueue(recv_workqueue);
	flush_workqueue(send_workqueue);
	do {
		ok = 1;
		foreach_conn(stop_conn);
		flush_workqueue(recv_workqueue);
		flush_workqueue(send_workqueue);
		for (i = 0; i < CONN_HASH_SIZE && ok; i++) {
			hlist_for_each_entry_safe(con, n,
						  &connection_hash[i], list) {
				ok &= test_bit(CF_READ_PENDING, &con->flags);
				if (con->othercon)
					ok &= test_bit(CF_READ_PENDING,
						       &con->othercon->flags);
			}
		}
	} while (!ok);
}

1686 1687
void dlm_lowcomms_stop(void)
{
P
Patrick Caulfield 已提交
1688
	/* Set all the flags to prevent any
1689 1690
	   socket activity.
	*/
1691
	mutex_lock(&connections_lock);
1692
	dlm_allow_conn = 0;
1693 1694
	mutex_unlock(&connections_lock);
	work_flush();
1695 1696
	clean_writequeues();
	foreach_conn(free_conn);
1697
	work_stop();
1698

1699 1700 1701 1702 1703
	kmem_cache_destroy(con_cache);
}

int dlm_lowcomms_start(void)
{
1704 1705
	int error = -EINVAL;
	struct connection *con;
1706 1707 1708 1709
	int i;

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

1711 1712
	init_local();
	if (!dlm_local_count) {
D
David Teigland 已提交
1713
		error = -ENOTCONN;
1714
		log_print("no local IP address has been set");
1715
		goto fail;
1716 1717
	}

1718
	error = -ENOMEM;
1719
	con_cache = kmem_cache_create("dlm_conn", sizeof(struct connection),
P
Patrick Caulfield 已提交
1720
				      __alignof__(struct connection), 0,
1721
				      NULL);
1722
	if (!con_cache)
1723 1724 1725 1726 1727 1728 1729
		goto fail;

	error = work_start();
	if (error)
		goto fail_destroy;

	dlm_allow_conn = 1;
1730 1731

	/* Start listening */
1732 1733 1734 1735
	if (dlm_config.ci_protocol == 0)
		error = tcp_listen_for_all();
	else
		error = sctp_listen_for_all();
1736 1737 1738 1739 1740
	if (error)
		goto fail_unlisten;

	return 0;

P
Patrick Caulfield 已提交
1741
fail_unlisten:
1742
	dlm_allow_conn = 0;
1743 1744
	con = nodeid2con(0,0);
	if (con) {
1745
		close_connection(con, false, true, true);
1746 1747
		kmem_cache_free(con_cache, con);
	}
1748
fail_destroy:
1749
	kmem_cache_destroy(con_cache);
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);
}