drbd_receiver.c 140.9 KB
Newer Older
P
Philipp Reisner 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50
/*
   drbd_receiver.c

   This file is part of DRBD by Philipp Reisner and Lars Ellenberg.

   Copyright (C) 2001-2008, LINBIT Information Technologies GmbH.
   Copyright (C) 1999-2008, Philipp Reisner <philipp.reisner@linbit.com>.
   Copyright (C) 2002-2008, Lars Ellenberg <lars.ellenberg@linbit.com>.

   drbd is free software; you can redistribute it and/or modify
   it under the terms of the GNU General Public License as published by
   the Free Software Foundation; either version 2, or (at your option)
   any later version.

   drbd is distributed in the hope that it will be useful,
   but WITHOUT ANY WARRANTY; without even the implied warranty of
   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
   GNU General Public License for more details.

   You should have received a copy of the GNU General Public License
   along with drbd; see the file COPYING.  If not, write to
   the Free Software Foundation, 675 Mass Ave, Cambridge, MA 02139, USA.
 */


#include <linux/module.h>

#include <asm/uaccess.h>
#include <net/sock.h>

#include <linux/drbd.h>
#include <linux/fs.h>
#include <linux/file.h>
#include <linux/in.h>
#include <linux/mm.h>
#include <linux/memcontrol.h>
#include <linux/mm_inline.h>
#include <linux/slab.h>
#include <linux/pkt_sched.h>
#define __KERNEL_SYSCALLS__
#include <linux/unistd.h>
#include <linux/vmalloc.h>
#include <linux/random.h>
#include <linux/string.h>
#include <linux/scatterlist.h>
#include "drbd_int.h"
#include "drbd_req.h"

#include "drbd_vli.h"

51 52
struct packet_info {
	enum drbd_packet cmd;
53 54
	unsigned int size;
	unsigned int vnr;
55
	void *data;
56 57
};

P
Philipp Reisner 已提交
58 59 60 61 62 63
enum finish_epoch {
	FE_STILL_LIVE,
	FE_DESTROYED,
	FE_RECYCLED,
};

64
static int drbd_do_features(struct drbd_tconn *tconn);
65
static int drbd_do_auth(struct drbd_tconn *tconn);
P
Philipp Reisner 已提交
66
static int drbd_disconnected(struct drbd_conf *mdev);
P
Philipp Reisner 已提交
67 68

static enum finish_epoch drbd_may_finish_epoch(struct drbd_conf *, struct drbd_epoch *, enum epoch_event);
69
static int e_end_block(struct drbd_work *, int);
P
Philipp Reisner 已提交
70 71 72 73


#define GFP_TRY	(__GFP_HIGHMEM | __GFP_NOWARN)

74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91
/*
 * some helper functions to deal with single linked page lists,
 * page->private being our "next" pointer.
 */

/* If at least n pages are linked at head, get n pages off.
 * Otherwise, don't modify head, and return NULL.
 * Locking is the responsibility of the caller.
 */
static struct page *page_chain_del(struct page **head, int n)
{
	struct page *page;
	struct page *tmp;

	BUG_ON(!n);
	BUG_ON(!head);

	page = *head;
92 93 94 95

	if (!page)
		return NULL;

96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152
	while (page) {
		tmp = page_chain_next(page);
		if (--n == 0)
			break; /* found sufficient pages */
		if (tmp == NULL)
			/* insufficient pages, don't use any of them. */
			return NULL;
		page = tmp;
	}

	/* add end of list marker for the returned list */
	set_page_private(page, 0);
	/* actual return value, and adjustment of head */
	page = *head;
	*head = tmp;
	return page;
}

/* may be used outside of locks to find the tail of a (usually short)
 * "private" page chain, before adding it back to a global chain head
 * with page_chain_add() under a spinlock. */
static struct page *page_chain_tail(struct page *page, int *len)
{
	struct page *tmp;
	int i = 1;
	while ((tmp = page_chain_next(page)))
		++i, page = tmp;
	if (len)
		*len = i;
	return page;
}

static int page_chain_free(struct page *page)
{
	struct page *tmp;
	int i = 0;
	page_chain_for_each_safe(page, tmp) {
		put_page(page);
		++i;
	}
	return i;
}

static void page_chain_add(struct page **head,
		struct page *chain_first, struct page *chain_last)
{
#if 1
	struct page *tmp;
	tmp = page_chain_tail(chain_first, NULL);
	BUG_ON(tmp != chain_last);
#endif

	/* add chain to head */
	set_page_private(chain_last, (unsigned long)*head);
	*head = chain_first;
}

153 154
static struct page *__drbd_alloc_pages(struct drbd_conf *mdev,
				       unsigned int number)
P
Philipp Reisner 已提交
155 156
{
	struct page *page = NULL;
157
	struct page *tmp = NULL;
158
	unsigned int i = 0;
P
Philipp Reisner 已提交
159 160 161

	/* Yes, testing drbd_pp_vacant outside the lock is racy.
	 * So what. It saves a spin_lock. */
162
	if (drbd_pp_vacant >= number) {
P
Philipp Reisner 已提交
163
		spin_lock(&drbd_pp_lock);
164 165 166
		page = page_chain_del(&drbd_pp_pool, number);
		if (page)
			drbd_pp_vacant -= number;
P
Philipp Reisner 已提交
167
		spin_unlock(&drbd_pp_lock);
168 169
		if (page)
			return page;
P
Philipp Reisner 已提交
170
	}
171

P
Philipp Reisner 已提交
172 173 174
	/* GFP_TRY, because we must not cause arbitrary write-out: in a DRBD
	 * "criss-cross" setup, that might cause write-out on some other DRBD,
	 * which in turn might block on the other node at this very place.  */
175 176 177 178 179 180 181 182 183 184 185 186
	for (i = 0; i < number; i++) {
		tmp = alloc_page(GFP_TRY);
		if (!tmp)
			break;
		set_page_private(tmp, (unsigned long)page);
		page = tmp;
	}

	if (i == number)
		return page;

	/* Not enough pages immediately available this time.
187
	 * No need to jump around here, drbd_alloc_pages will retry this
188 189 190 191 192 193 194 195 196
	 * function "soon". */
	if (page) {
		tmp = page_chain_tail(page, NULL);
		spin_lock(&drbd_pp_lock);
		page_chain_add(&drbd_pp_pool, page, tmp);
		drbd_pp_vacant += i;
		spin_unlock(&drbd_pp_lock);
	}
	return NULL;
P
Philipp Reisner 已提交
197 198
}

199 200
static void reclaim_finished_net_peer_reqs(struct drbd_conf *mdev,
					   struct list_head *to_be_freed)
P
Philipp Reisner 已提交
201
{
202
	struct drbd_peer_request *peer_req;
P
Philipp Reisner 已提交
203 204 205 206 207 208 209 210
	struct list_head *le, *tle;

	/* The EEs are always appended to the end of the list. Since
	   they are sent in order over the wire, they have to finish
	   in order. As soon as we see the first not finished we can
	   stop to examine the list... */

	list_for_each_safe(le, tle, &mdev->net_ee) {
211
		peer_req = list_entry(le, struct drbd_peer_request, w.list);
212
		if (drbd_peer_req_has_active_page(peer_req))
P
Philipp Reisner 已提交
213 214 215 216 217 218 219 220
			break;
		list_move(le, to_be_freed);
	}
}

static void drbd_kick_lo_and_reclaim_net(struct drbd_conf *mdev)
{
	LIST_HEAD(reclaimed);
221
	struct drbd_peer_request *peer_req, *t;
P
Philipp Reisner 已提交
222

223
	spin_lock_irq(&mdev->tconn->req_lock);
224
	reclaim_finished_net_peer_reqs(mdev, &reclaimed);
225
	spin_unlock_irq(&mdev->tconn->req_lock);
P
Philipp Reisner 已提交
226

227
	list_for_each_entry_safe(peer_req, t, &reclaimed, w.list)
228
		drbd_free_net_peer_req(mdev, peer_req);
P
Philipp Reisner 已提交
229 230 231
}

/**
232
 * drbd_alloc_pages() - Returns @number pages, retries forever (or until signalled)
P
Philipp Reisner 已提交
233
 * @mdev:	DRBD device.
234 235 236 237 238 239
 * @number:	number of pages requested
 * @retry:	whether to retry, if not enough pages are available right now
 *
 * Tries to allocate number pages, first from our own page pool, then from
 * the kernel, unless this allocation would exceed the max_buffers setting.
 * Possibly retry until DRBD frees sufficient pages somewhere else.
P
Philipp Reisner 已提交
240
 *
241
 * Returns a page chain linked via page->private.
P
Philipp Reisner 已提交
242
 */
243 244
struct page *drbd_alloc_pages(struct drbd_conf *mdev, unsigned int number,
			      bool retry)
P
Philipp Reisner 已提交
245 246
{
	struct page *page = NULL;
247
	struct net_conf *nc;
P
Philipp Reisner 已提交
248
	DEFINE_WAIT(wait);
249
	int mxb;
P
Philipp Reisner 已提交
250

251 252
	/* Yes, we may run up to @number over max_buffers. If we
	 * follow it strictly, the admin will get it wrong anyways. */
253 254 255 256 257 258
	rcu_read_lock();
	nc = rcu_dereference(mdev->tconn->net_conf);
	mxb = nc ? nc->max_buffers : 1000000;
	rcu_read_unlock();

	if (atomic_read(&mdev->pp_in_use) < mxb)
259
		page = __drbd_alloc_pages(mdev, number);
P
Philipp Reisner 已提交
260

261
	while (page == NULL) {
P
Philipp Reisner 已提交
262 263 264 265
		prepare_to_wait(&drbd_pp_wait, &wait, TASK_INTERRUPTIBLE);

		drbd_kick_lo_and_reclaim_net(mdev);

266
		if (atomic_read(&mdev->pp_in_use) < mxb) {
267
			page = __drbd_alloc_pages(mdev, number);
P
Philipp Reisner 已提交
268 269 270 271 272 273 274 275
			if (page)
				break;
		}

		if (!retry)
			break;

		if (signal_pending(current)) {
276
			dev_warn(DEV, "drbd_alloc_pages interrupted!\n");
P
Philipp Reisner 已提交
277 278 279 280 281 282 283
			break;
		}

		schedule();
	}
	finish_wait(&drbd_pp_wait, &wait);

284 285
	if (page)
		atomic_add(number, &mdev->pp_in_use);
P
Philipp Reisner 已提交
286 287 288
	return page;
}

289
/* Must not be used from irq, as that may deadlock: see drbd_alloc_pages.
290
 * Is also used from inside an other spin_lock_irq(&mdev->tconn->req_lock);
291 292
 * Either links the page chain back to the global pool,
 * or returns all pages to the system. */
293
static void drbd_free_pages(struct drbd_conf *mdev, struct page *page, int is_net)
P
Philipp Reisner 已提交
294
{
295
	atomic_t *a = is_net ? &mdev->pp_in_use_by_net : &mdev->pp_in_use;
P
Philipp Reisner 已提交
296
	int i;
297

298
	if (drbd_pp_vacant > (DRBD_MAX_BIO_SIZE/PAGE_SIZE) * minor_count)
299 300 301 302 303 304 305 306
		i = page_chain_free(page);
	else {
		struct page *tmp;
		tmp = page_chain_tail(page, &i);
		spin_lock(&drbd_pp_lock);
		page_chain_add(&drbd_pp_pool, page, tmp);
		drbd_pp_vacant += i;
		spin_unlock(&drbd_pp_lock);
P
Philipp Reisner 已提交
307
	}
308
	i = atomic_sub_return(i, a);
309
	if (i < 0)
310 311
		dev_warn(DEV, "ASSERTION FAILED: %s: %d < 0\n",
			is_net ? "pp_in_use_by_net" : "pp_in_use", i);
P
Philipp Reisner 已提交
312 313 314 315 316 317 318 319
	wake_up(&drbd_pp_wait);
}

/*
You need to hold the req_lock:
 _drbd_wait_ee_list_empty()

You must not have the req_lock:
320
 drbd_free_peer_req()
321
 drbd_alloc_peer_req()
322
 drbd_free_peer_reqs()
P
Philipp Reisner 已提交
323
 drbd_ee_fix_bhs()
324
 drbd_finish_peer_reqs()
P
Philipp Reisner 已提交
325 326 327 328
 drbd_clear_done_ee()
 drbd_wait_ee_list_empty()
*/

329
struct drbd_peer_request *
330 331
drbd_alloc_peer_req(struct drbd_conf *mdev, u64 id, sector_t sector,
		    unsigned int data_size, gfp_t gfp_mask) __must_hold(local)
P
Philipp Reisner 已提交
332
{
333
	struct drbd_peer_request *peer_req;
P
Philipp Reisner 已提交
334
	struct page *page;
335
	unsigned nr_pages = (data_size + PAGE_SIZE -1) >> PAGE_SHIFT;
P
Philipp Reisner 已提交
336

337
	if (drbd_insert_fault(mdev, DRBD_FAULT_AL_EE))
P
Philipp Reisner 已提交
338 339
		return NULL;

340 341
	peer_req = mempool_alloc(drbd_ee_mempool, gfp_mask & ~__GFP_HIGHMEM);
	if (!peer_req) {
P
Philipp Reisner 已提交
342
		if (!(gfp_mask & __GFP_NOWARN))
343
			dev_err(DEV, "%s: allocation failed\n", __func__);
P
Philipp Reisner 已提交
344 345 346
		return NULL;
	}

347
	page = drbd_alloc_pages(mdev, nr_pages, (gfp_mask & __GFP_WAIT));
348 349
	if (!page)
		goto fail;
P
Philipp Reisner 已提交
350

351 352 353 354 355 356 357
	drbd_clear_interval(&peer_req->i);
	peer_req->i.size = data_size;
	peer_req->i.sector = sector;
	peer_req->i.local = false;
	peer_req->i.waiting = false;

	peer_req->epoch = NULL;
358
	peer_req->w.mdev = mdev;
359 360 361
	peer_req->pages = page;
	atomic_set(&peer_req->pending_bios, 0);
	peer_req->flags = 0;
362 363 364 365
	/*
	 * The block_id is opaque to the receiver.  It is not endianness
	 * converted, and sent back to the sender unchanged.
	 */
366
	peer_req->block_id = id;
P
Philipp Reisner 已提交
367

368
	return peer_req;
P
Philipp Reisner 已提交
369

370
 fail:
371
	mempool_free(peer_req, drbd_ee_mempool);
P
Philipp Reisner 已提交
372 373 374
	return NULL;
}

375
void __drbd_free_peer_req(struct drbd_conf *mdev, struct drbd_peer_request *peer_req,
376
		       int is_net)
P
Philipp Reisner 已提交
377
{
378 379
	if (peer_req->flags & EE_HAS_DIGEST)
		kfree(peer_req->digest);
380
	drbd_free_pages(mdev, peer_req->pages, is_net);
381 382 383
	D_ASSERT(atomic_read(&peer_req->pending_bios) == 0);
	D_ASSERT(drbd_interval_empty(&peer_req->i));
	mempool_free(peer_req, drbd_ee_mempool);
P
Philipp Reisner 已提交
384 385
}

386
int drbd_free_peer_reqs(struct drbd_conf *mdev, struct list_head *list)
P
Philipp Reisner 已提交
387 388
{
	LIST_HEAD(work_list);
389
	struct drbd_peer_request *peer_req, *t;
P
Philipp Reisner 已提交
390
	int count = 0;
391
	int is_net = list == &mdev->net_ee;
P
Philipp Reisner 已提交
392

393
	spin_lock_irq(&mdev->tconn->req_lock);
P
Philipp Reisner 已提交
394
	list_splice_init(list, &work_list);
395
	spin_unlock_irq(&mdev->tconn->req_lock);
P
Philipp Reisner 已提交
396

397
	list_for_each_entry_safe(peer_req, t, &work_list, w.list) {
398
		__drbd_free_peer_req(mdev, peer_req, is_net);
P
Philipp Reisner 已提交
399 400 401 402 403
		count++;
	}
	return count;
}

404 405
/*
 * See also comments in _req_mod(,BARRIER_ACKED) and receive_Barrier.
P
Philipp Reisner 已提交
406
 */
407
static int drbd_finish_peer_reqs(struct drbd_conf *mdev)
P
Philipp Reisner 已提交
408 409 410
{
	LIST_HEAD(work_list);
	LIST_HEAD(reclaimed);
411
	struct drbd_peer_request *peer_req, *t;
412
	int err = 0;
P
Philipp Reisner 已提交
413

414
	spin_lock_irq(&mdev->tconn->req_lock);
415
	reclaim_finished_net_peer_reqs(mdev, &reclaimed);
P
Philipp Reisner 已提交
416
	list_splice_init(&mdev->done_ee, &work_list);
417
	spin_unlock_irq(&mdev->tconn->req_lock);
P
Philipp Reisner 已提交
418

419
	list_for_each_entry_safe(peer_req, t, &reclaimed, w.list)
420
		drbd_free_net_peer_req(mdev, peer_req);
P
Philipp Reisner 已提交
421 422

	/* possible callbacks here:
423
	 * e_end_block, and e_end_resync_block, e_send_discard_write.
P
Philipp Reisner 已提交
424 425
	 * all ignore the last argument.
	 */
426
	list_for_each_entry_safe(peer_req, t, &work_list, w.list) {
427 428
		int err2;

P
Philipp Reisner 已提交
429
		/* list_del not necessary, next/prev members not touched */
430 431 432
		err2 = peer_req->w.cb(&peer_req->w, !!err);
		if (!err)
			err = err2;
433
		drbd_free_peer_req(mdev, peer_req);
P
Philipp Reisner 已提交
434 435 436
	}
	wake_up(&mdev->ee_wait);

437
	return err;
P
Philipp Reisner 已提交
438 439
}

440 441
static void _drbd_wait_ee_list_empty(struct drbd_conf *mdev,
				     struct list_head *head)
P
Philipp Reisner 已提交
442 443 444 445 446 447 448
{
	DEFINE_WAIT(wait);

	/* avoids spin_lock/unlock
	 * and calling prepare_to_wait in the fast path */
	while (!list_empty(head)) {
		prepare_to_wait(&mdev->ee_wait, &wait, TASK_UNINTERRUPTIBLE);
449
		spin_unlock_irq(&mdev->tconn->req_lock);
J
Jens Axboe 已提交
450
		io_schedule();
P
Philipp Reisner 已提交
451
		finish_wait(&mdev->ee_wait, &wait);
452
		spin_lock_irq(&mdev->tconn->req_lock);
P
Philipp Reisner 已提交
453 454 455
	}
}

456 457
static void drbd_wait_ee_list_empty(struct drbd_conf *mdev,
				    struct list_head *head)
P
Philipp Reisner 已提交
458
{
459
	spin_lock_irq(&mdev->tconn->req_lock);
P
Philipp Reisner 已提交
460
	_drbd_wait_ee_list_empty(mdev, head);
461
	spin_unlock_irq(&mdev->tconn->req_lock);
P
Philipp Reisner 已提交
462 463 464 465
}

/* see also kernel_accept; which is only present since 2.6.18.
 * also we want to log which part of it failed, exactly */
466
static int drbd_accept(const char **what, struct socket *sock, struct socket **newsock)
P
Philipp Reisner 已提交
467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494
{
	struct sock *sk = sock->sk;
	int err = 0;

	*what = "listen";
	err = sock->ops->listen(sock, 5);
	if (err < 0)
		goto out;

	*what = "sock_create_lite";
	err = sock_create_lite(sk->sk_family, sk->sk_type, sk->sk_protocol,
			       newsock);
	if (err < 0)
		goto out;

	*what = "accept";
	err = sock->ops->accept(sock, *newsock, 0);
	if (err < 0) {
		sock_release(*newsock);
		*newsock = NULL;
		goto out;
	}
	(*newsock)->ops  = sock->ops;

out:
	return err;
}

495
static int drbd_recv_short(struct socket *sock, void *buf, size_t size, int flags)
P
Philipp Reisner 已提交
496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516
{
	mm_segment_t oldfs;
	struct kvec iov = {
		.iov_base = buf,
		.iov_len = size,
	};
	struct msghdr msg = {
		.msg_iovlen = 1,
		.msg_iov = (struct iovec *)&iov,
		.msg_flags = (flags ? flags : MSG_WAITALL | MSG_NOSIGNAL)
	};
	int rv;

	oldfs = get_fs();
	set_fs(KERNEL_DS);
	rv = sock_recvmsg(sock, &msg, size, msg.msg_flags);
	set_fs(oldfs);

	return rv;
}

517
static int drbd_recv(struct drbd_tconn *tconn, void *buf, size_t size)
P
Philipp Reisner 已提交
518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534
{
	mm_segment_t oldfs;
	struct kvec iov = {
		.iov_base = buf,
		.iov_len = size,
	};
	struct msghdr msg = {
		.msg_iovlen = 1,
		.msg_iov = (struct iovec *)&iov,
		.msg_flags = MSG_WAITALL | MSG_NOSIGNAL
	};
	int rv;

	oldfs = get_fs();
	set_fs(KERNEL_DS);

	for (;;) {
535
		rv = sock_recvmsg(tconn->data.socket, &msg, size, msg.msg_flags);
P
Philipp Reisner 已提交
536 537 538 539 540 541 542 543 544 545
		if (rv == size)
			break;

		/* Note:
		 * ECONNRESET	other side closed the connection
		 * ERESTARTSYS	(on  sock) we got a signal
		 */

		if (rv < 0) {
			if (rv == -ECONNRESET)
546
				conn_info(tconn, "sock was reset by peer\n");
P
Philipp Reisner 已提交
547
			else if (rv != -ERESTARTSYS)
548
				conn_err(tconn, "sock_recvmsg returned %d\n", rv);
P
Philipp Reisner 已提交
549 550
			break;
		} else if (rv == 0) {
551
			conn_info(tconn, "sock was shut down by peer\n");
P
Philipp Reisner 已提交
552 553 554 555 556 557 558 559 560 561 562 563 564
			break;
		} else	{
			/* signal came in, or peer/link went down,
			 * after we read a partial message
			 */
			/* D_ASSERT(signal_pending(current)); */
			break;
		}
	};

	set_fs(oldfs);

	if (rv != size)
565
		conn_request_state(tconn, NS(conn, C_BROKEN_PIPE), CS_HARD);
P
Philipp Reisner 已提交
566 567 568 569

	return rv;
}

570 571 572 573 574 575 576 577 578 579 580 581 582
static int drbd_recv_all(struct drbd_tconn *tconn, void *buf, size_t size)
{
	int err;

	err = drbd_recv(tconn, buf, size);
	if (err != size) {
		if (err >= 0)
			err = -EIO;
	} else
		err = 0;
	return err;
}

583 584 585 586 587 588 589 590 591 592
static int drbd_recv_all_warn(struct drbd_tconn *tconn, void *buf, size_t size)
{
	int err;

	err = drbd_recv_all(tconn, buf, size);
	if (err && !signal_pending(current))
		conn_warn(tconn, "short read (expected size %d)\n", (int)size);
	return err;
}

593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611
/* quoting tcp(7):
 *   On individual connections, the socket buffer size must be set prior to the
 *   listen(2) or connect(2) calls in order to have it take effect.
 * This is our wrapper to do so.
 */
static void drbd_setbufsize(struct socket *sock, unsigned int snd,
		unsigned int rcv)
{
	/* open coded SO_SNDBUF, SO_RCVBUF */
	if (snd) {
		sock->sk->sk_sndbuf = snd;
		sock->sk->sk_userlocks |= SOCK_SNDBUF_LOCK;
	}
	if (rcv) {
		sock->sk->sk_rcvbuf = rcv;
		sock->sk->sk_userlocks |= SOCK_RCVBUF_LOCK;
	}
}

612
static struct socket *drbd_try_connect(struct drbd_tconn *tconn)
P
Philipp Reisner 已提交
613 614 615 616
{
	const char *what;
	struct socket *sock;
	struct sockaddr_in6 src_in6;
617 618 619
	struct sockaddr_in6 peer_in6;
	struct net_conf *nc;
	int err, peer_addr_len, my_addr_len;
620
	int sndbuf_size, rcvbuf_size, connect_int;
P
Philipp Reisner 已提交
621 622
	int disconnect_on_error = 1;

623 624 625 626
	rcu_read_lock();
	nc = rcu_dereference(tconn->net_conf);
	if (!nc) {
		rcu_read_unlock();
P
Philipp Reisner 已提交
627
		return NULL;
628 629 630
	}
	sndbuf_size = nc->sndbuf_size;
	rcvbuf_size = nc->rcvbuf_size;
631
	connect_int = nc->connect_int;
632
	rcu_read_unlock();
633

634 635
	my_addr_len = min_t(int, tconn->my_addr_len, sizeof(src_in6));
	memcpy(&src_in6, &tconn->my_addr, my_addr_len);
636

637
	if (((struct sockaddr *)&tconn->my_addr)->sa_family == AF_INET6)
638 639 640 641
		src_in6.sin6_port = 0;
	else
		((struct sockaddr_in *)&src_in6)->sin_port = 0; /* AF_INET & AF_SCI */

642 643
	peer_addr_len = min_t(int, tconn->peer_addr_len, sizeof(src_in6));
	memcpy(&peer_in6, &tconn->peer_addr, peer_addr_len);
P
Philipp Reisner 已提交
644 645

	what = "sock_create_kern";
646 647
	err = sock_create_kern(((struct sockaddr *)&src_in6)->sa_family,
			       SOCK_STREAM, IPPROTO_TCP, &sock);
P
Philipp Reisner 已提交
648 649 650 651 652 653
	if (err < 0) {
		sock = NULL;
		goto out;
	}

	sock->sk->sk_rcvtimeo =
654
	sock->sk->sk_sndtimeo = connect_int * HZ;
655
	drbd_setbufsize(sock, sndbuf_size, rcvbuf_size);
P
Philipp Reisner 已提交
656 657 658 659 660 661 662 663 664

       /* explicitly bind to the configured IP as source IP
	*  for the outgoing connections.
	*  This is needed for multihomed hosts and to be
	*  able to use lo: interfaces for drbd.
	* Make sure to use 0 as port number, so linux selects
	*  a free one dynamically.
	*/
	what = "bind before connect";
665
	err = sock->ops->bind(sock, (struct sockaddr *) &src_in6, my_addr_len);
P
Philipp Reisner 已提交
666 667 668 669 670 671 672
	if (err < 0)
		goto out;

	/* connect may fail, peer not yet available.
	 * stay C_WF_CONNECTION, don't go Disconnecting! */
	disconnect_on_error = 0;
	what = "connect";
673
	err = sock->ops->connect(sock, (struct sockaddr *) &peer_in6, peer_addr_len, 0);
P
Philipp Reisner 已提交
674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690

out:
	if (err < 0) {
		if (sock) {
			sock_release(sock);
			sock = NULL;
		}
		switch (-err) {
			/* timeout, busy, signal pending */
		case ETIMEDOUT: case EAGAIN: case EINPROGRESS:
		case EINTR: case ERESTARTSYS:
			/* peer not (yet) available, network problem */
		case ECONNREFUSED: case ENETUNREACH:
		case EHOSTDOWN:    case EHOSTUNREACH:
			disconnect_on_error = 0;
			break;
		default:
691
			conn_err(tconn, "%s failed, err = %d\n", what, err);
P
Philipp Reisner 已提交
692 693
		}
		if (disconnect_on_error)
694
			conn_request_state(tconn, NS(conn, C_DISCONNECTING), CS_HARD);
P
Philipp Reisner 已提交
695
	}
696

P
Philipp Reisner 已提交
697 698 699
	return sock;
}

700
static struct socket *drbd_wait_for_connect(struct drbd_tconn *tconn)
P
Philipp Reisner 已提交
701
{
702
	int timeo, err, my_addr_len;
703
	int sndbuf_size, rcvbuf_size, connect_int;
P
Philipp Reisner 已提交
704
	struct socket *s_estab = NULL, *s_listen;
705 706
	struct sockaddr_in6 my_addr;
	struct net_conf *nc;
P
Philipp Reisner 已提交
707 708
	const char *what;

709 710 711 712
	rcu_read_lock();
	nc = rcu_dereference(tconn->net_conf);
	if (!nc) {
		rcu_read_unlock();
P
Philipp Reisner 已提交
713
		return NULL;
714 715 716
	}
	sndbuf_size = nc->sndbuf_size;
	rcvbuf_size = nc->rcvbuf_size;
717
	connect_int = nc->connect_int;
718
	rcu_read_unlock();
P
Philipp Reisner 已提交
719

720 721 722
	my_addr_len = min_t(int, tconn->my_addr_len, sizeof(struct sockaddr_in6));
	memcpy(&my_addr, &tconn->my_addr, my_addr_len);

P
Philipp Reisner 已提交
723
	what = "sock_create_kern";
724
	err = sock_create_kern(((struct sockaddr *)&my_addr)->sa_family,
P
Philipp Reisner 已提交
725 726 727 728 729 730
		SOCK_STREAM, IPPROTO_TCP, &s_listen);
	if (err) {
		s_listen = NULL;
		goto out;
	}

731
	timeo = connect_int * HZ;
P
Philipp Reisner 已提交
732 733 734 735 736
	timeo += (random32() & 1) ? timeo / 7 : -timeo / 7; /* 28.5% random jitter */

	s_listen->sk->sk_reuse    = 1; /* SO_REUSEADDR */
	s_listen->sk->sk_rcvtimeo = timeo;
	s_listen->sk->sk_sndtimeo = timeo;
737
	drbd_setbufsize(s_listen, sndbuf_size, rcvbuf_size);
P
Philipp Reisner 已提交
738 739

	what = "bind before listen";
740
	err = s_listen->ops->bind(s_listen, (struct sockaddr *)&my_addr, my_addr_len);
P
Philipp Reisner 已提交
741 742 743
	if (err < 0)
		goto out;

744
	err = drbd_accept(&what, s_listen, &s_estab);
P
Philipp Reisner 已提交
745 746 747 748 749 750

out:
	if (s_listen)
		sock_release(s_listen);
	if (err < 0) {
		if (err != -EAGAIN && err != -EINTR && err != -ERESTARTSYS) {
751
			conn_err(tconn, "%s failed, err = %d\n", what, err);
752
			conn_request_state(tconn, NS(conn, C_DISCONNECTING), CS_HARD);
P
Philipp Reisner 已提交
753 754 755 756 757 758
		}
	}

	return s_estab;
}

759
static int decode_header(struct drbd_tconn *, void *, struct packet_info *);
P
Philipp Reisner 已提交
760

761 762 763 764 765
static int send_first_packet(struct drbd_tconn *tconn, struct drbd_socket *sock,
			     enum drbd_packet cmd)
{
	if (!conn_prepare_command(tconn, sock))
		return -EIO;
766
	return conn_send_command(tconn, sock, cmd, 0, NULL, 0);
P
Philipp Reisner 已提交
767 768
}

769
static int receive_first_packet(struct drbd_tconn *tconn, struct socket *sock)
P
Philipp Reisner 已提交
770
{
771 772 773
	unsigned int header_size = drbd_header_size(tconn);
	struct packet_info pi;
	int err;
P
Philipp Reisner 已提交
774

775 776 777 778 779 780 781 782 783 784
	err = drbd_recv_short(sock, tconn->data.rbuf, header_size, 0);
	if (err != header_size) {
		if (err >= 0)
			err = -EIO;
		return err;
	}
	err = decode_header(tconn, tconn->data.rbuf, &pi);
	if (err)
		return err;
	return pi.cmd;
P
Philipp Reisner 已提交
785 786 787 788 789 790
}

/**
 * drbd_socket_okay() - Free the socket if its connection is not okay
 * @sock:	pointer to the pointer to the socket.
 */
791
static int drbd_socket_okay(struct socket **sock)
P
Philipp Reisner 已提交
792 793 794 795 796
{
	int rr;
	char tb[4];

	if (!*sock)
797
		return false;
P
Philipp Reisner 已提交
798

799
	rr = drbd_recv_short(*sock, tb, 4, MSG_DONTWAIT | MSG_PEEK);
P
Philipp Reisner 已提交
800 801

	if (rr > 0 || rr == -EAGAIN) {
802
		return true;
P
Philipp Reisner 已提交
803 804 805
	} else {
		sock_release(*sock);
		*sock = NULL;
806
		return false;
P
Philipp Reisner 已提交
807 808
	}
}
809 810
/* Gets called if a connection is established, or if a new minor gets created
   in a connection */
P
Philipp Reisner 已提交
811
int drbd_connected(struct drbd_conf *mdev)
812
{
813
	int err;
814 815 816 817

	atomic_set(&mdev->packet_seq, 0);
	mdev->peer_seq = 0;

818 819 820 821
	mdev->state_mutex = mdev->tconn->agreed_pro_version < 100 ?
		&mdev->tconn->cstate_mutex :
		&mdev->own_state_mutex;

822 823 824 825 826 827 828
	err = drbd_send_sync_param(mdev);
	if (!err)
		err = drbd_send_sizes(mdev, 0, 0);
	if (!err)
		err = drbd_send_uuids(mdev);
	if (!err)
		err = drbd_send_state(mdev);
829 830
	clear_bit(USE_DEGR_WFC_T, &mdev->flags);
	clear_bit(RESIZE_PENDING, &mdev->flags);
831
	mod_timer(&mdev->request_timer, jiffies + HZ); /* just start it here. */
832
	return err;
833 834
}

P
Philipp Reisner 已提交
835 836 837 838 839 840 841 842
/*
 * return values:
 *   1 yes, we have a valid connection
 *   0 oops, did not work out, please try again
 *  -1 peer talks different language,
 *     no point in trying again, please go standalone.
 *  -2 We do not have a network config...
 */
843
static int conn_connect(struct drbd_tconn *tconn)
P
Philipp Reisner 已提交
844
{
845
	struct socket *sock, *msock;
P
Philipp Reisner 已提交
846
	struct drbd_conf *mdev;
847
	struct net_conf *nc;
P
Philipp Reisner 已提交
848
	int vnr, timeout, try, h, ok;
P
Philipp Reisner 已提交
849

850
	if (conn_request_state(tconn, NS(conn, C_WF_CONNECTION), CS_VERBOSE) < SS_SUCCESS)
P
Philipp Reisner 已提交
851 852
		return -2;

853
	clear_bit(DISCARD_CONCURRENT, &tconn->flags);
854 855 856

	/* Assume that the peer only understands protocol 80 until we know better.  */
	tconn->agreed_pro_version = 80;
P
Philipp Reisner 已提交
857 858

	do {
859 860
		struct socket *s;

P
Philipp Reisner 已提交
861 862
		for (try = 0;;) {
			/* 3 tries, this should take less than a second! */
863
			s = drbd_try_connect(tconn);
P
Philipp Reisner 已提交
864 865 866
			if (s || ++try >= 3)
				break;
			/* give the other side time to call bind() & listen() */
867
			schedule_timeout_interruptible(HZ / 10);
P
Philipp Reisner 已提交
868 869 870
		}

		if (s) {
871 872
			if (!tconn->data.socket) {
				tconn->data.socket = s;
873
				send_first_packet(tconn, &tconn->data, P_INITIAL_DATA);
874 875
			} else if (!tconn->meta.socket) {
				tconn->meta.socket = s;
876
				send_first_packet(tconn, &tconn->meta, P_INITIAL_META);
P
Philipp Reisner 已提交
877
			} else {
878
				conn_err(tconn, "Logic error in conn_connect()\n");
P
Philipp Reisner 已提交
879 880 881 882
				goto out_release_sockets;
			}
		}

883
		if (tconn->data.socket && tconn->meta.socket) {
884
			schedule_timeout_interruptible(tconn->net_conf->ping_timeo*HZ/10);
885 886
			ok = drbd_socket_okay(&tconn->data.socket);
			ok = drbd_socket_okay(&tconn->meta.socket) && ok;
P
Philipp Reisner 已提交
887 888 889 890 891
			if (ok)
				break;
		}

retry:
892
		s = drbd_wait_for_connect(tconn);
P
Philipp Reisner 已提交
893
		if (s) {
894
			try = receive_first_packet(tconn, s);
895 896
			drbd_socket_okay(&tconn->data.socket);
			drbd_socket_okay(&tconn->meta.socket);
P
Philipp Reisner 已提交
897
			switch (try) {
898
			case P_INITIAL_DATA:
899
				if (tconn->data.socket) {
900
					conn_warn(tconn, "initial packet S crossed\n");
901
					sock_release(tconn->data.socket);
P
Philipp Reisner 已提交
902
				}
903
				tconn->data.socket = s;
P
Philipp Reisner 已提交
904
				break;
905
			case P_INITIAL_META:
906
				if (tconn->meta.socket) {
907
					conn_warn(tconn, "initial packet M crossed\n");
908
					sock_release(tconn->meta.socket);
P
Philipp Reisner 已提交
909
				}
910
				tconn->meta.socket = s;
911
				set_bit(DISCARD_CONCURRENT, &tconn->flags);
P
Philipp Reisner 已提交
912 913
				break;
			default:
914
				conn_warn(tconn, "Error receiving initial packet\n");
P
Philipp Reisner 已提交
915 916 917 918 919 920
				sock_release(s);
				if (random32() & 1)
					goto retry;
			}
		}

921
		if (tconn->cstate <= C_DISCONNECTING)
P
Philipp Reisner 已提交
922 923 924 925
			goto out_release_sockets;
		if (signal_pending(current)) {
			flush_signals(current);
			smp_rmb();
926
			if (get_t_state(&tconn->receiver) == EXITING)
P
Philipp Reisner 已提交
927 928 929
				goto out_release_sockets;
		}

930 931 932
		if (tconn->data.socket && &tconn->meta.socket) {
			ok = drbd_socket_okay(&tconn->data.socket);
			ok = drbd_socket_okay(&tconn->meta.socket) && ok;
P
Philipp Reisner 已提交
933 934 935 936 937
			if (ok)
				break;
		}
	} while (1);

938 939 940
	sock  = tconn->data.socket;
	msock = tconn->meta.socket;

P
Philipp Reisner 已提交
941 942 943 944 945 946 947 948 949 950
	msock->sk->sk_reuse = 1; /* SO_REUSEADDR */
	sock->sk->sk_reuse = 1; /* SO_REUSEADDR */

	sock->sk->sk_allocation = GFP_NOIO;
	msock->sk->sk_allocation = GFP_NOIO;

	sock->sk->sk_priority = TC_PRIO_INTERACTIVE_BULK;
	msock->sk->sk_priority = TC_PRIO_INTERACTIVE;

	/* NOT YET ...
951
	 * sock->sk->sk_sndtimeo = tconn->net_conf->timeout*HZ/10;
P
Philipp Reisner 已提交
952
	 * sock->sk->sk_rcvtimeo = MAX_SCHEDULE_TIMEOUT;
953
	 * first set it to the P_CONNECTION_FEATURES timeout,
P
Philipp Reisner 已提交
954
	 * which we set to 4x the configured ping_timeout. */
955 956 957
	rcu_read_lock();
	nc = rcu_dereference(tconn->net_conf);

P
Philipp Reisner 已提交
958
	sock->sk->sk_sndtimeo =
959 960 961 962 963
	sock->sk->sk_rcvtimeo = nc->ping_timeo*4*HZ/10;

	msock->sk->sk_rcvtimeo = nc->ping_int*HZ;
	timeout = nc->timeout * HZ / 10;
	rcu_read_unlock();
P
Philipp Reisner 已提交
964

965
	msock->sk->sk_sndtimeo = timeout;
P
Philipp Reisner 已提交
966 967

	/* we don't want delays.
L
Lucas De Marchi 已提交
968
	 * we use TCP_CORK where appropriate, though */
P
Philipp Reisner 已提交
969 970 971
	drbd_tcp_nodelay(sock);
	drbd_tcp_nodelay(msock);

972
	tconn->last_received = jiffies;
P
Philipp Reisner 已提交
973

974
	h = drbd_do_features(tconn);
P
Philipp Reisner 已提交
975 976 977
	if (h <= 0)
		return h;

978
	if (tconn->cram_hmac_tfm) {
P
Philipp Reisner 已提交
979
		/* drbd_request_state(mdev, NS(conn, WFAuth)); */
980
		switch (drbd_do_auth(tconn)) {
981
		case -1:
982
			conn_err(tconn, "Authentication of peer failed\n");
P
Philipp Reisner 已提交
983
			return -1;
984
		case 0:
985
			conn_err(tconn, "Authentication of peer failed, trying again.\n");
986
			return 0;
P
Philipp Reisner 已提交
987 988 989
		}
	}

990
	if (conn_request_state(tconn, NS(conn, C_WF_REPORT_PARAMS), CS_VERBOSE) < SS_SUCCESS)
P
Philipp Reisner 已提交
991 992
		return 0;

993
	sock->sk->sk_sndtimeo = timeout;
P
Philipp Reisner 已提交
994 995
	sock->sk->sk_rcvtimeo = MAX_SCHEDULE_TIMEOUT;

996
	drbd_thread_start(&tconn->asender);
P
Philipp Reisner 已提交
997

998
	if (drbd_send_protocol(tconn) == -EOPNOTSUPP)
999
		return -1;
P
Philipp Reisner 已提交
1000

P
Philipp Reisner 已提交
1001 1002 1003 1004 1005 1006 1007 1008 1009 1010
	rcu_read_lock();
	idr_for_each_entry(&tconn->volumes, mdev, vnr) {
		kref_get(&mdev->kref);
		rcu_read_unlock();
		drbd_connected(mdev);
		kref_put(&mdev->kref, &drbd_minor_destroy);
		rcu_read_lock();
	}
	rcu_read_unlock();

1011
	return h;
P
Philipp Reisner 已提交
1012 1013

out_release_sockets:
1014 1015 1016 1017 1018 1019 1020 1021
	if (tconn->data.socket) {
		sock_release(tconn->data.socket);
		tconn->data.socket = NULL;
	}
	if (tconn->meta.socket) {
		sock_release(tconn->meta.socket);
		tconn->meta.socket = NULL;
	}
P
Philipp Reisner 已提交
1022 1023 1024
	return -1;
}

1025
static int decode_header(struct drbd_tconn *tconn, void *header, struct packet_info *pi)
P
Philipp Reisner 已提交
1026
{
1027 1028
	unsigned int header_size = drbd_header_size(tconn);

1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040
	if (header_size == sizeof(struct p_header100) &&
	    *(__be32 *)header == cpu_to_be32(DRBD_MAGIC_100)) {
		struct p_header100 *h = header;
		if (h->pad != 0) {
			conn_err(tconn, "Header padding is not zero\n");
			return -EINVAL;
		}
		pi->vnr = be16_to_cpu(h->volume);
		pi->cmd = be16_to_cpu(h->command);
		pi->size = be32_to_cpu(h->length);
	} else if (header_size == sizeof(struct p_header95) &&
		   *(__be16 *)header == cpu_to_be16(DRBD_MAGIC_BIG)) {
1041 1042
		struct p_header95 *h = header;
		pi->cmd = be16_to_cpu(h->command);
1043 1044
		pi->size = be32_to_cpu(h->length);
		pi->vnr = 0;
1045 1046 1047 1048 1049
	} else if (header_size == sizeof(struct p_header80) &&
		   *(__be32 *)header == cpu_to_be32(DRBD_MAGIC)) {
		struct p_header80 *h = header;
		pi->cmd = be16_to_cpu(h->command);
		pi->size = be16_to_cpu(h->length);
1050
		pi->vnr = 0;
1051
	} else {
1052 1053 1054
		conn_err(tconn, "Wrong magic value 0x%08x in protocol version %d\n",
			 be32_to_cpu(*(__be32 *)header),
			 tconn->agreed_pro_version);
1055
		return -EINVAL;
P
Philipp Reisner 已提交
1056
	}
1057
	pi->data = header + header_size;
1058
	return 0;
1059 1060
}

1061
static int drbd_recv_header(struct drbd_tconn *tconn, struct packet_info *pi)
1062
{
1063
	void *buffer = tconn->data.rbuf;
1064
	int err;
1065

1066
	err = drbd_recv_all_warn(tconn, buffer, drbd_header_size(tconn));
1067
	if (err)
1068
		return err;
1069

1070
	err = decode_header(tconn, buffer, pi);
1071
	tconn->last_received = jiffies;
P
Philipp Reisner 已提交
1072

1073
	return err;
P
Philipp Reisner 已提交
1074 1075
}

1076
static void drbd_flush(struct drbd_conf *mdev)
P
Philipp Reisner 已提交
1077 1078 1079 1080
{
	int rv;

	if (mdev->write_ordering >= WO_bdev_flush && get_ldev(mdev)) {
1081
		rv = blkdev_issue_flush(mdev->ldev->backing_bdev, GFP_KERNEL,
1082
					NULL);
P
Philipp Reisner 已提交
1083
		if (rv) {
1084
			dev_info(DEV, "local disk flush failed with status %d\n", rv);
P
Philipp Reisner 已提交
1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103
			/* would rather check on EOPNOTSUPP, but that is not reliable.
			 * don't try again for ANY return value != 0
			 * if (rv == -EOPNOTSUPP) */
			drbd_bump_write_ordering(mdev, WO_drain_io);
		}
		put_ldev(mdev);
	}
}

/**
 * drbd_may_finish_epoch() - Applies an epoch_event to the epoch's state, eventually finishes it.
 * @mdev:	DRBD device.
 * @epoch:	Epoch object.
 * @ev:		Epoch event.
 */
static enum finish_epoch drbd_may_finish_epoch(struct drbd_conf *mdev,
					       struct drbd_epoch *epoch,
					       enum epoch_event ev)
{
1104
	int epoch_size;
P
Philipp Reisner 已提交
1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127
	struct drbd_epoch *next_epoch;
	enum finish_epoch rv = FE_STILL_LIVE;

	spin_lock(&mdev->epoch_lock);
	do {
		next_epoch = NULL;

		epoch_size = atomic_read(&epoch->epoch_size);

		switch (ev & ~EV_CLEANUP) {
		case EV_PUT:
			atomic_dec(&epoch->active);
			break;
		case EV_GOT_BARRIER_NR:
			set_bit(DE_HAVE_BARRIER_NUMBER, &epoch->flags);
			break;
		case EV_BECAME_LAST:
			/* nothing to do*/
			break;
		}

		if (epoch_size != 0 &&
		    atomic_read(&epoch->active) == 0 &&
1128
		    test_bit(DE_HAVE_BARRIER_NUMBER, &epoch->flags)) {
P
Philipp Reisner 已提交
1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147
			if (!(ev & EV_CLEANUP)) {
				spin_unlock(&mdev->epoch_lock);
				drbd_send_b_ack(mdev, epoch->barrier_nr, epoch_size);
				spin_lock(&mdev->epoch_lock);
			}
			dec_unacked(mdev);

			if (mdev->current_epoch != epoch) {
				next_epoch = list_entry(epoch->list.next, struct drbd_epoch, list);
				list_del(&epoch->list);
				ev = EV_BECAME_LAST | (ev & EV_CLEANUP);
				mdev->epochs--;
				kfree(epoch);

				if (rv == FE_STILL_LIVE)
					rv = FE_DESTROYED;
			} else {
				epoch->flags = 0;
				atomic_set(&epoch->epoch_size, 0);
1148
				/* atomic_set(&epoch->active, 0); is already zero */
P
Philipp Reisner 已提交
1149 1150
				if (rv == FE_STILL_LIVE)
					rv = FE_RECYCLED;
1151
				wake_up(&mdev->ee_wait);
P
Philipp Reisner 已提交
1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172
			}
		}

		if (!next_epoch)
			break;

		epoch = next_epoch;
	} while (1);

	spin_unlock(&mdev->epoch_lock);

	return rv;
}

/**
 * drbd_bump_write_ordering() - Fall back to an other write ordering method
 * @mdev:	DRBD device.
 * @wo:		Write ordering method to try.
 */
void drbd_bump_write_ordering(struct drbd_conf *mdev, enum write_ordering_e wo) __must_hold(local)
{
P
Philipp Reisner 已提交
1173
	struct disk_conf *dc;
P
Philipp Reisner 已提交
1174 1175 1176 1177 1178 1179 1180 1181 1182
	enum write_ordering_e pwo;
	static char *write_ordering_str[] = {
		[WO_none] = "none",
		[WO_drain_io] = "drain",
		[WO_bdev_flush] = "flush",
	};

	pwo = mdev->write_ordering;
	wo = min(pwo, wo);
P
Philipp Reisner 已提交
1183 1184 1185
	rcu_read_lock();
	dc = rcu_dereference(mdev->ldev->disk_conf);

1186
	if (wo == WO_bdev_flush && !dc->disk_flushes)
P
Philipp Reisner 已提交
1187
		wo = WO_drain_io;
1188
	if (wo == WO_drain_io && !dc->disk_drain)
P
Philipp Reisner 已提交
1189
		wo = WO_none;
P
Philipp Reisner 已提交
1190
	rcu_read_unlock();
P
Philipp Reisner 已提交
1191
	mdev->write_ordering = wo;
1192
	if (pwo != mdev->write_ordering || wo == WO_bdev_flush)
P
Philipp Reisner 已提交
1193 1194 1195
		dev_info(DEV, "Method to ensure write ordering: %s\n", write_ordering_str[mdev->write_ordering]);
}

1196
/**
1197
 * drbd_submit_peer_request()
1198
 * @mdev:	DRBD device.
1199
 * @peer_req:	peer request
1200
 * @rw:		flag field, see bio->bi_rw
1201 1202 1203 1204 1205 1206 1207 1208 1209 1210
 *
 * May spread the pages to multiple bios,
 * depending on bio_add_page restrictions.
 *
 * Returns 0 if all bios have been submitted,
 * -ENOMEM if we could not allocate enough bios,
 * -ENOSPC (any better suggestion?) if we have not been able to bio_add_page a
 *  single page to an empty bio (which should never happen and likely indicates
 *  that the lower level IO stack is in some way broken). This has been observed
 *  on certain Xen deployments.
1211 1212
 */
/* TODO allocate from our own bio_set. */
1213 1214 1215
int drbd_submit_peer_request(struct drbd_conf *mdev,
			     struct drbd_peer_request *peer_req,
			     const unsigned rw, const int fault_type)
1216 1217 1218
{
	struct bio *bios = NULL;
	struct bio *bio;
1219 1220 1221
	struct page *page = peer_req->pages;
	sector_t sector = peer_req->i.sector;
	unsigned ds = peer_req->i.size;
1222 1223
	unsigned n_bios = 0;
	unsigned nr_pages = (ds + PAGE_SIZE -1) >> PAGE_SHIFT;
1224
	int err = -ENOMEM;
1225 1226 1227 1228

	/* In most cases, we will only need one bio.  But in case the lower
	 * level restrictions happen to be different at this offset on this
	 * side than those of the sending peer, we may need to submit the
1229 1230 1231 1232 1233
	 * request in more than one bio.
	 *
	 * Plain bio_alloc is good enough here, this is no DRBD internally
	 * generated bio, but a bio allocated on behalf of the peer.
	 */
1234 1235 1236 1237 1238 1239
next_bio:
	bio = bio_alloc(GFP_NOIO, nr_pages);
	if (!bio) {
		dev_err(DEV, "submit_ee: Allocation of a bio failed\n");
		goto fail;
	}
1240
	/* > peer_req->i.sector, unless this is the first bio */
1241 1242 1243
	bio->bi_sector = sector;
	bio->bi_bdev = mdev->ldev->backing_bdev;
	bio->bi_rw = rw;
1244
	bio->bi_private = peer_req;
1245
	bio->bi_end_io = drbd_peer_request_endio;
1246 1247 1248 1249 1250 1251 1252 1253

	bio->bi_next = bios;
	bios = bio;
	++n_bios;

	page_chain_for_each(page) {
		unsigned len = min_t(unsigned, ds, PAGE_SIZE);
		if (!bio_add_page(bio, page, len, 0)) {
1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264
			/* A single page must always be possible!
			 * But in case it fails anyways,
			 * we deal with it, and complain (below). */
			if (bio->bi_vcnt == 0) {
				dev_err(DEV,
					"bio_add_page failed for len=%u, "
					"bi_vcnt=0 (bi_sector=%llu)\n",
					len, (unsigned long long)bio->bi_sector);
				err = -ENOSPC;
				goto fail;
			}
1265 1266 1267 1268 1269 1270 1271 1272 1273
			goto next_bio;
		}
		ds -= len;
		sector += len >> 9;
		--nr_pages;
	}
	D_ASSERT(page == NULL);
	D_ASSERT(ds == 0);

1274
	atomic_set(&peer_req->pending_bios, n_bios);
1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289
	do {
		bio = bios;
		bios = bios->bi_next;
		bio->bi_next = NULL;

		drbd_generic_make_request(mdev, fault_type, bio);
	} while (bios);
	return 0;

fail:
	while (bios) {
		bio = bios;
		bios = bios->bi_next;
		bio_put(bio);
	}
1290
	return err;
1291 1292
}

1293
static void drbd_remove_epoch_entry_interval(struct drbd_conf *mdev,
1294
					     struct drbd_peer_request *peer_req)
1295
{
1296
	struct drbd_interval *i = &peer_req->i;
1297 1298 1299 1300

	drbd_remove_interval(&mdev->write_requests, i);
	drbd_clear_interval(i);

A
Andreas Gruenbacher 已提交
1301
	/* Wake up any processes waiting for this peer request to complete.  */
1302 1303 1304 1305
	if (i->waiting)
		wake_up(&mdev->misc_wait);
}

1306
static int receive_Barrier(struct drbd_tconn *tconn, struct packet_info *pi)
P
Philipp Reisner 已提交
1307
{
1308
	struct drbd_conf *mdev;
1309
	int rv;
1310
	struct p_barrier *p = pi->data;
P
Philipp Reisner 已提交
1311 1312
	struct drbd_epoch *epoch;

1313 1314 1315 1316
	mdev = vnr_to_mdev(tconn, pi->vnr);
	if (!mdev)
		return -EIO;

P
Philipp Reisner 已提交
1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329
	inc_unacked(mdev);

	mdev->current_epoch->barrier_nr = p->barrier;
	rv = drbd_may_finish_epoch(mdev, mdev->current_epoch, EV_GOT_BARRIER_NR);

	/* P_BARRIER_ACK may imply that the corresponding extent is dropped from
	 * the activity log, which means it would not be resynced in case the
	 * R_PRIMARY crashes now.
	 * Therefore we must send the barrier_ack after the barrier request was
	 * completed. */
	switch (mdev->write_ordering) {
	case WO_none:
		if (rv == FE_RECYCLED)
1330
			return 0;
1331 1332 1333 1334 1335 1336 1337 1338 1339

		/* receiver context, in the writeout path of the other node.
		 * avoid potential distributed deadlock */
		epoch = kmalloc(sizeof(struct drbd_epoch), GFP_NOIO);
		if (epoch)
			break;
		else
			dev_warn(DEV, "Allocation of an epoch failed, slowing down\n");
			/* Fall through */
P
Philipp Reisner 已提交
1340 1341 1342 1343

	case WO_bdev_flush:
	case WO_drain_io:
		drbd_wait_ee_list_empty(mdev, &mdev->active_ee);
1344 1345 1346 1347 1348 1349
		drbd_flush(mdev);

		if (atomic_read(&mdev->current_epoch->epoch_size)) {
			epoch = kmalloc(sizeof(struct drbd_epoch), GFP_NOIO);
			if (epoch)
				break;
P
Philipp Reisner 已提交
1350 1351
		}

1352 1353 1354 1355 1356
		epoch = mdev->current_epoch;
		wait_event(mdev->ee_wait, atomic_read(&epoch->epoch_size) == 0);

		D_ASSERT(atomic_read(&epoch->active) == 0);
		D_ASSERT(epoch->flags == 0);
P
Philipp Reisner 已提交
1357

1358
		return 0;
1359 1360
	default:
		dev_err(DEV, "Strangeness in mdev->write_ordering %d\n", mdev->write_ordering);
1361
		return -EIO;
P
Philipp Reisner 已提交
1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378
	}

	epoch->flags = 0;
	atomic_set(&epoch->epoch_size, 0);
	atomic_set(&epoch->active, 0);

	spin_lock(&mdev->epoch_lock);
	if (atomic_read(&mdev->current_epoch->epoch_size)) {
		list_add(&epoch->list, &mdev->current_epoch->list);
		mdev->current_epoch = epoch;
		mdev->epochs++;
	} else {
		/* The current_epoch got recycled while we allocated this one... */
		kfree(epoch);
	}
	spin_unlock(&mdev->epoch_lock);

1379
	return 0;
P
Philipp Reisner 已提交
1380 1381 1382 1383
}

/* used from receive_RSDataReply (recv_resync_read)
 * and from receive_Data */
1384 1385 1386
static struct drbd_peer_request *
read_in_block(struct drbd_conf *mdev, u64 id, sector_t sector,
	      int data_size) __must_hold(local)
P
Philipp Reisner 已提交
1387
{
1388
	const sector_t capacity = drbd_get_capacity(mdev->this_bdev);
1389
	struct drbd_peer_request *peer_req;
P
Philipp Reisner 已提交
1390
	struct page *page;
1391
	int dgs, ds, err;
1392 1393
	void *dig_in = mdev->tconn->int_dig_in;
	void *dig_vv = mdev->tconn->int_dig_vv;
1394
	unsigned long *data;
P
Philipp Reisner 已提交
1395

1396 1397 1398
	dgs = 0;
	if (mdev->tconn->peer_integrity_tfm) {
		dgs = crypto_hash_digestsize(mdev->tconn->peer_integrity_tfm);
1399 1400 1401 1402
		/*
		 * FIXME: Receive the incoming digest into the receive buffer
		 *	  here, together with its struct p_data?
		 */
1403 1404
		err = drbd_recv_all_warn(mdev->tconn, dig_in, dgs);
		if (err)
P
Philipp Reisner 已提交
1405
			return NULL;
1406
		data_size -= dgs;
P
Philipp Reisner 已提交
1407 1408
	}

1409 1410 1411 1412 1413 1414
	if (!expect(data_size != 0))
		return NULL;
	if (!expect(IS_ALIGNED(data_size, 512)))
		return NULL;
	if (!expect(data_size <= DRBD_MAX_BIO_SIZE))
		return NULL;
P
Philipp Reisner 已提交
1415

1416 1417 1418
	/* even though we trust out peer,
	 * we sometimes have to double check. */
	if (sector + (data_size>>9) > capacity) {
1419 1420
		dev_err(DEV, "request from peer beyond end of local disk: "
			"capacity: %llus < sector: %llus + size: %u\n",
1421 1422 1423 1424 1425
			(unsigned long long)capacity,
			(unsigned long long)sector, data_size);
		return NULL;
	}

P
Philipp Reisner 已提交
1426 1427 1428
	/* GFP_NOIO, because we must not cause arbitrary write-out: in a DRBD
	 * "criss-cross" setup, that might cause write-out on some other DRBD,
	 * which in turn might block on the other node at this very place.  */
1429
	peer_req = drbd_alloc_peer_req(mdev, id, sector, data_size, GFP_NOIO);
1430
	if (!peer_req)
P
Philipp Reisner 已提交
1431
		return NULL;
1432

P
Philipp Reisner 已提交
1433
	ds = data_size;
1434
	page = peer_req->pages;
1435 1436
	page_chain_for_each(page) {
		unsigned len = min_t(int, ds, PAGE_SIZE);
1437
		data = kmap(page);
1438
		err = drbd_recv_all_warn(mdev->tconn, data, len);
1439
		if (drbd_insert_fault(mdev, DRBD_FAULT_RECEIVE)) {
1440 1441 1442
			dev_err(DEV, "Fault injection: Corrupting data on receive\n");
			data[0] = data[0] ^ (unsigned long)-1;
		}
P
Philipp Reisner 已提交
1443
		kunmap(page);
1444
		if (err) {
1445
			drbd_free_peer_req(mdev, peer_req);
P
Philipp Reisner 已提交
1446 1447
			return NULL;
		}
1448
		ds -= len;
P
Philipp Reisner 已提交
1449 1450 1451
	}

	if (dgs) {
1452
		drbd_csum_ee(mdev, mdev->tconn->peer_integrity_tfm, peer_req, dig_vv);
P
Philipp Reisner 已提交
1453
		if (memcmp(dig_in, dig_vv, dgs)) {
1454 1455
			dev_err(DEV, "Digest integrity check FAILED: %llus +%u\n",
				(unsigned long long)sector, data_size);
1456
			drbd_free_peer_req(mdev, peer_req);
P
Philipp Reisner 已提交
1457 1458 1459 1460
			return NULL;
		}
	}
	mdev->recv_cnt += data_size>>9;
1461
	return peer_req;
P
Philipp Reisner 已提交
1462 1463 1464 1465 1466 1467 1468 1469
}

/* drbd_drain_block() just takes a data block
 * out of the socket input buffer, and discards it.
 */
static int drbd_drain_block(struct drbd_conf *mdev, int data_size)
{
	struct page *page;
1470
	int err = 0;
P
Philipp Reisner 已提交
1471 1472
	void *data;

1473
	if (!data_size)
1474
		return 0;
1475

1476
	page = drbd_alloc_pages(mdev, 1, 1);
P
Philipp Reisner 已提交
1477 1478 1479

	data = kmap(page);
	while (data_size) {
1480 1481
		unsigned int len = min_t(int, data_size, PAGE_SIZE);

1482 1483
		err = drbd_recv_all_warn(mdev->tconn, data, len);
		if (err)
P
Philipp Reisner 已提交
1484
			break;
1485
		data_size -= len;
P
Philipp Reisner 已提交
1486 1487
	}
	kunmap(page);
1488
	drbd_free_pages(mdev, page, 0);
1489
	return err;
P
Philipp Reisner 已提交
1490 1491 1492 1493 1494 1495 1496
}

static int recv_dless_read(struct drbd_conf *mdev, struct drbd_request *req,
			   sector_t sector, int data_size)
{
	struct bio_vec *bvec;
	struct bio *bio;
1497
	int dgs, err, i, expect;
1498 1499
	void *dig_in = mdev->tconn->int_dig_in;
	void *dig_vv = mdev->tconn->int_dig_vv;
P
Philipp Reisner 已提交
1500

1501 1502 1503
	dgs = 0;
	if (mdev->tconn->peer_integrity_tfm) {
		dgs = crypto_hash_digestsize(mdev->tconn->peer_integrity_tfm);
1504 1505 1506
		err = drbd_recv_all_warn(mdev->tconn, dig_in, dgs);
		if (err)
			return err;
1507
		data_size -= dgs;
P
Philipp Reisner 已提交
1508 1509 1510 1511 1512 1513 1514 1515 1516 1517
	}

	/* optimistically update recv_cnt.  if receiving fails below,
	 * we disconnect anyways, and counters will be reset. */
	mdev->recv_cnt += data_size>>9;

	bio = req->master_bio;
	D_ASSERT(sector == bio->bi_sector);

	bio_for_each_segment(bvec, bio, i) {
1518
		void *mapped = kmap(bvec->bv_page) + bvec->bv_offset;
P
Philipp Reisner 已提交
1519
		expect = min_t(int, data_size, bvec->bv_len);
1520
		err = drbd_recv_all_warn(mdev->tconn, mapped, expect);
P
Philipp Reisner 已提交
1521
		kunmap(bvec->bv_page);
1522 1523 1524
		if (err)
			return err;
		data_size -= expect;
P
Philipp Reisner 已提交
1525 1526 1527
	}

	if (dgs) {
1528
		drbd_csum_bio(mdev, mdev->tconn->peer_integrity_tfm, bio, dig_vv);
P
Philipp Reisner 已提交
1529 1530
		if (memcmp(dig_in, dig_vv, dgs)) {
			dev_err(DEV, "Digest integrity check FAILED. Broken NICs?\n");
1531
			return -EINVAL;
P
Philipp Reisner 已提交
1532 1533 1534 1535
		}
	}

	D_ASSERT(data_size == 0);
1536
	return 0;
P
Philipp Reisner 已提交
1537 1538
}

1539 1540 1541 1542
/*
 * e_end_resync_block() is called in asender context via
 * drbd_finish_peer_reqs().
 */
1543
static int e_end_resync_block(struct drbd_work *w, int unused)
P
Philipp Reisner 已提交
1544
{
1545 1546
	struct drbd_peer_request *peer_req =
		container_of(w, struct drbd_peer_request, w);
1547
	struct drbd_conf *mdev = w->mdev;
1548
	sector_t sector = peer_req->i.sector;
1549
	int err;
P
Philipp Reisner 已提交
1550

1551
	D_ASSERT(drbd_interval_empty(&peer_req->i));
P
Philipp Reisner 已提交
1552

1553 1554
	if (likely((peer_req->flags & EE_WAS_ERROR) == 0)) {
		drbd_set_in_sync(mdev, sector, peer_req->i.size);
1555
		err = drbd_send_ack(mdev, P_RS_WRITE_ACK, peer_req);
P
Philipp Reisner 已提交
1556 1557
	} else {
		/* Record failure to sync */
1558
		drbd_rs_failed_io(mdev, sector, peer_req->i.size);
P
Philipp Reisner 已提交
1559

1560
		err  = drbd_send_ack(mdev, P_NEG_ACK, peer_req);
P
Philipp Reisner 已提交
1561 1562 1563
	}
	dec_unacked(mdev);

1564
	return err;
P
Philipp Reisner 已提交
1565 1566 1567 1568
}

static int recv_resync_read(struct drbd_conf *mdev, sector_t sector, int data_size) __releases(local)
{
1569
	struct drbd_peer_request *peer_req;
P
Philipp Reisner 已提交
1570

1571 1572
	peer_req = read_in_block(mdev, ID_SYNCER, sector, data_size);
	if (!peer_req)
1573
		goto fail;
P
Philipp Reisner 已提交
1574 1575 1576 1577 1578 1579 1580

	dec_rs_pending(mdev);

	inc_unacked(mdev);
	/* corresponding dec_unacked() in e_end_resync_block()
	 * respective _drbd_clear_done_ee */

1581
	peer_req->w.cb = e_end_resync_block;
1582

1583
	spin_lock_irq(&mdev->tconn->req_lock);
1584
	list_add(&peer_req->w.list, &mdev->sync_ee);
1585
	spin_unlock_irq(&mdev->tconn->req_lock);
P
Philipp Reisner 已提交
1586

1587
	atomic_add(data_size >> 9, &mdev->rs_sect_ev);
1588
	if (drbd_submit_peer_request(mdev, peer_req, WRITE, DRBD_FAULT_RS_WR) == 0)
1589
		return 0;
P
Philipp Reisner 已提交
1590

1591 1592
	/* don't care for the reason here */
	dev_err(DEV, "submit failed, triggering re-connect\n");
1593
	spin_lock_irq(&mdev->tconn->req_lock);
1594
	list_del(&peer_req->w.list);
1595
	spin_unlock_irq(&mdev->tconn->req_lock);
1596

1597
	drbd_free_peer_req(mdev, peer_req);
1598 1599
fail:
	put_ldev(mdev);
1600
	return -EIO;
P
Philipp Reisner 已提交
1601 1602
}

1603
static struct drbd_request *
1604 1605
find_request(struct drbd_conf *mdev, struct rb_root *root, u64 id,
	     sector_t sector, bool missing_ok, const char *func)
1606 1607 1608
{
	struct drbd_request *req;

1609 1610
	/* Request object according to our peer */
	req = (struct drbd_request *)(unsigned long)id;
1611
	if (drbd_contains_interval(root, sector, &req->i) && req->i.local)
1612
		return req;
1613
	if (!missing_ok) {
1614
		dev_err(DEV, "%s: failed to find request 0x%lx, sector %llus\n", func,
1615 1616
			(unsigned long)id, (unsigned long long)sector);
	}
1617 1618 1619
	return NULL;
}

1620
static int receive_DataReply(struct drbd_tconn *tconn, struct packet_info *pi)
P
Philipp Reisner 已提交
1621
{
1622
	struct drbd_conf *mdev;
P
Philipp Reisner 已提交
1623 1624
	struct drbd_request *req;
	sector_t sector;
1625
	int err;
1626
	struct p_data *p = pi->data;
1627 1628 1629 1630

	mdev = vnr_to_mdev(tconn, pi->vnr);
	if (!mdev)
		return -EIO;
P
Philipp Reisner 已提交
1631 1632 1633

	sector = be64_to_cpu(p->sector);

1634
	spin_lock_irq(&mdev->tconn->req_lock);
1635
	req = find_request(mdev, &mdev->read_requests, p->block_id, sector, false, __func__);
1636
	spin_unlock_irq(&mdev->tconn->req_lock);
1637
	if (unlikely(!req))
1638
		return -EIO;
P
Philipp Reisner 已提交
1639

B
Bart Van Assche 已提交
1640
	/* hlist_del(&req->collision) is done in _req_may_be_done, to avoid
P
Philipp Reisner 已提交
1641 1642
	 * special casing it there for the various failure cases.
	 * still no race with drbd_fail_pending_reads */
1643
	err = recv_dless_read(mdev, req, sector, pi->size);
1644
	if (!err)
1645
		req_mod(req, DATA_RECEIVED);
P
Philipp Reisner 已提交
1646 1647 1648 1649
	/* else: nothing. handled from drbd_disconnect...
	 * I don't think we may complete this just yet
	 * in case we are "on-disconnect: freeze" */

1650
	return err;
P
Philipp Reisner 已提交
1651 1652
}

1653
static int receive_RSDataReply(struct drbd_tconn *tconn, struct packet_info *pi)
P
Philipp Reisner 已提交
1654
{
1655
	struct drbd_conf *mdev;
P
Philipp Reisner 已提交
1656
	sector_t sector;
1657
	int err;
1658
	struct p_data *p = pi->data;
1659 1660 1661 1662

	mdev = vnr_to_mdev(tconn, pi->vnr);
	if (!mdev)
		return -EIO;
P
Philipp Reisner 已提交
1663 1664 1665 1666 1667 1668 1669

	sector = be64_to_cpu(p->sector);
	D_ASSERT(p->block_id == ID_SYNCER);

	if (get_ldev(mdev)) {
		/* data is submitted to disk within recv_resync_read.
		 * corresponding put_ldev done below on error,
1670
		 * or in drbd_peer_request_endio. */
1671
		err = recv_resync_read(mdev, sector, pi->size);
P
Philipp Reisner 已提交
1672 1673 1674 1675
	} else {
		if (__ratelimit(&drbd_ratelimit_state))
			dev_err(DEV, "Can not write resync data to local disk.\n");

1676
		err = drbd_drain_block(mdev, pi->size);
P
Philipp Reisner 已提交
1677

1678
		drbd_send_ack_dp(mdev, P_NEG_ACK, p, pi->size);
P
Philipp Reisner 已提交
1679 1680
	}

1681
	atomic_add(pi->size >> 9, &mdev->rs_sect_in);
1682

1683
	return err;
P
Philipp Reisner 已提交
1684 1685
}

1686
static int w_restart_write(struct drbd_work *w, int cancel)
1687 1688 1689 1690 1691 1692 1693 1694 1695 1696
{
	struct drbd_request *req = container_of(w, struct drbd_request, w);
	struct drbd_conf *mdev = w->mdev;
	struct bio *bio;
	unsigned long start_time;
	unsigned long flags;

	spin_lock_irqsave(&mdev->tconn->req_lock, flags);
	if (!expect(req->rq_state & RQ_POSTPONED)) {
		spin_unlock_irqrestore(&mdev->tconn->req_lock, flags);
1697
		return -EIO;
1698 1699 1700 1701 1702 1703 1704 1705 1706
	}
	bio = req->master_bio;
	start_time = req->start_time;
	/* Postponed requests will not have their master_bio completed!  */
	__req_mod(req, DISCARD_WRITE, NULL);
	spin_unlock_irqrestore(&mdev->tconn->req_lock, flags);

	while (__drbd_make_request(mdev, bio, start_time))
		/* retry */ ;
1707
	return 0;
1708 1709 1710 1711 1712 1713 1714 1715 1716 1717 1718 1719 1720 1721 1722 1723 1724 1725 1726 1727 1728 1729 1730
}

static void restart_conflicting_writes(struct drbd_conf *mdev,
				       sector_t sector, int size)
{
	struct drbd_interval *i;
	struct drbd_request *req;

	drbd_for_each_overlap(i, &mdev->write_requests, sector, size) {
		if (!i->local)
			continue;
		req = container_of(i, struct drbd_request, i);
		if (req->rq_state & RQ_LOCAL_PENDING ||
		    !(req->rq_state & RQ_POSTPONED))
			continue;
		if (expect(list_empty(&req->w.list))) {
			req->w.mdev = mdev;
			req->w.cb = w_restart_write;
			drbd_queue_work(&mdev->tconn->data.work, &req->w);
		}
	}
}

1731 1732
/*
 * e_end_block() is called in asender context via drbd_finish_peer_reqs().
P
Philipp Reisner 已提交
1733
 */
1734
static int e_end_block(struct drbd_work *w, int cancel)
P
Philipp Reisner 已提交
1735
{
1736 1737
	struct drbd_peer_request *peer_req =
		container_of(w, struct drbd_peer_request, w);
1738
	struct drbd_conf *mdev = w->mdev;
1739
	sector_t sector = peer_req->i.sector;
1740
	int err = 0, pcmd;
P
Philipp Reisner 已提交
1741

1742
	if (peer_req->flags & EE_SEND_WRITE_ACK) {
1743
		if (likely((peer_req->flags & EE_WAS_ERROR) == 0)) {
P
Philipp Reisner 已提交
1744 1745
			pcmd = (mdev->state.conn >= C_SYNC_SOURCE &&
				mdev->state.conn <= C_PAUSED_SYNC_T &&
1746
				peer_req->flags & EE_MAY_SET_IN_SYNC) ?
P
Philipp Reisner 已提交
1747
				P_RS_WRITE_ACK : P_WRITE_ACK;
1748
			err = drbd_send_ack(mdev, pcmd, peer_req);
P
Philipp Reisner 已提交
1749
			if (pcmd == P_RS_WRITE_ACK)
1750
				drbd_set_in_sync(mdev, sector, peer_req->i.size);
P
Philipp Reisner 已提交
1751
		} else {
1752
			err = drbd_send_ack(mdev, P_NEG_ACK, peer_req);
P
Philipp Reisner 已提交
1753 1754 1755 1756 1757 1758 1759
			/* we expect it to be marked out of sync anyways...
			 * maybe assert this?  */
		}
		dec_unacked(mdev);
	}
	/* we delete from the conflict detection hash _after_ we sent out the
	 * P_WRITE_ACK / P_NEG_ACK, to get the sequence number right.  */
1760
	if (peer_req->flags & EE_IN_INTERVAL_TREE) {
1761
		spin_lock_irq(&mdev->tconn->req_lock);
1762 1763
		D_ASSERT(!drbd_interval_empty(&peer_req->i));
		drbd_remove_epoch_entry_interval(mdev, peer_req);
1764 1765
		if (peer_req->flags & EE_RESTART_REQUESTS)
			restart_conflicting_writes(mdev, sector, peer_req->i.size);
1766
		spin_unlock_irq(&mdev->tconn->req_lock);
1767
	} else
1768
		D_ASSERT(drbd_interval_empty(&peer_req->i));
P
Philipp Reisner 已提交
1769

1770
	drbd_may_finish_epoch(mdev, peer_req->epoch, EV_PUT + (cancel ? EV_CLEANUP : 0));
P
Philipp Reisner 已提交
1771

1772
	return err;
P
Philipp Reisner 已提交
1773 1774
}

1775
static int e_send_ack(struct drbd_work *w, enum drbd_packet ack)
P
Philipp Reisner 已提交
1776
{
1777
	struct drbd_conf *mdev = w->mdev;
1778 1779
	struct drbd_peer_request *peer_req =
		container_of(w, struct drbd_peer_request, w);
1780
	int err;
P
Philipp Reisner 已提交
1781

1782
	err = drbd_send_ack(mdev, ack, peer_req);
P
Philipp Reisner 已提交
1783 1784
	dec_unacked(mdev);

1785
	return err;
P
Philipp Reisner 已提交
1786 1787
}

1788
static int e_send_discard_write(struct drbd_work *w, int unused)
1789 1790 1791 1792
{
	return e_send_ack(w, P_DISCARD_WRITE);
}

1793
static int e_send_retry_write(struct drbd_work *w, int unused)
1794 1795 1796 1797 1798 1799 1800
{
	struct drbd_tconn *tconn = w->mdev->tconn;

	return e_send_ack(w, tconn->agreed_pro_version >= 100 ?
			     P_RETRY_WRITE : P_DISCARD_WRITE);
}

1801 1802 1803 1804 1805 1806 1807 1808 1809 1810 1811 1812 1813 1814 1815
static bool seq_greater(u32 a, u32 b)
{
	/*
	 * We assume 32-bit wrap-around here.
	 * For 24-bit wrap-around, we would have to shift:
	 *  a <<= 8; b <<= 8;
	 */
	return (s32)a - (s32)b > 0;
}

static u32 seq_max(u32 a, u32 b)
{
	return seq_greater(a, b) ? a : b;
}

1816 1817 1818
static bool need_peer_seq(struct drbd_conf *mdev)
{
	struct drbd_tconn *tconn = mdev->tconn;
1819
	int tp;
1820 1821 1822 1823 1824 1825

	/*
	 * We only need to keep track of the last packet_seq number of our peer
	 * if we are in dual-primary mode and we have the discard flag set; see
	 * handle_write_conflicts().
	 */
1826 1827 1828 1829 1830 1831

	rcu_read_lock();
	tp = rcu_dereference(mdev->tconn->net_conf)->two_primaries;
	rcu_read_unlock();

	return tp && test_bit(DISCARD_CONCURRENT, &tconn->flags);
1832 1833
}

1834
static void update_peer_seq(struct drbd_conf *mdev, unsigned int peer_seq)
1835
{
1836
	unsigned int newest_peer_seq;
1837

1838 1839
	if (need_peer_seq(mdev)) {
		spin_lock(&mdev->peer_seq_lock);
1840 1841
		newest_peer_seq = seq_max(mdev->peer_seq, peer_seq);
		mdev->peer_seq = newest_peer_seq;
1842
		spin_unlock(&mdev->peer_seq_lock);
1843 1844
		/* wake up only if we actually changed mdev->peer_seq */
		if (peer_seq == newest_peer_seq)
1845 1846
			wake_up(&mdev->seq_wait);
	}
1847 1848
}

P
Philipp Reisner 已提交
1849 1850 1851 1852 1853 1854 1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869
/* Called from receive_Data.
 * Synchronize packets on sock with packets on msock.
 *
 * This is here so even when a P_DATA packet traveling via sock overtook an Ack
 * packet traveling on msock, they are still processed in the order they have
 * been sent.
 *
 * Note: we don't care for Ack packets overtaking P_DATA packets.
 *
 * In case packet_seq is larger than mdev->peer_seq number, there are
 * outstanding packets on the msock. We wait for them to arrive.
 * In case we are the logically next packet, we update mdev->peer_seq
 * ourselves. Correctly handles 32bit wrap around.
 *
 * Assume we have a 10 GBit connection, that is about 1<<30 byte per second,
 * about 1<<21 sectors per second. So "worst" case, we have 1<<3 == 8 seconds
 * for the 24bit wrap (historical atomic_t guarantee on some archs), and we have
 * 1<<9 == 512 seconds aka ages for the 32bit wrap around...
 *
 * returns 0 if we may process the packet,
 * -ERESTARTSYS if we were interrupted (by disconnect signal). */
1870
static int wait_for_and_update_peer_seq(struct drbd_conf *mdev, const u32 peer_seq)
P
Philipp Reisner 已提交
1871 1872 1873
{
	DEFINE_WAIT(wait);
	long timeout;
1874 1875 1876 1877 1878
	int ret;

	if (!need_peer_seq(mdev))
		return 0;

P
Philipp Reisner 已提交
1879 1880
	spin_lock(&mdev->peer_seq_lock);
	for (;;) {
1881 1882 1883
		if (!seq_greater(peer_seq - 1, mdev->peer_seq)) {
			mdev->peer_seq = seq_max(mdev->peer_seq, peer_seq);
			ret = 0;
P
Philipp Reisner 已提交
1884
			break;
1885
		}
P
Philipp Reisner 已提交
1886 1887 1888 1889
		if (signal_pending(current)) {
			ret = -ERESTARTSYS;
			break;
		}
1890
		prepare_to_wait(&mdev->seq_wait, &wait, TASK_INTERRUPTIBLE);
P
Philipp Reisner 已提交
1891
		spin_unlock(&mdev->peer_seq_lock);
1892 1893 1894
		rcu_read_lock();
		timeout = rcu_dereference(mdev->tconn->net_conf)->ping_timeo*HZ/10;
		rcu_read_unlock();
1895
		timeout = schedule_timeout(timeout);
P
Philipp Reisner 已提交
1896
		spin_lock(&mdev->peer_seq_lock);
1897
		if (!timeout) {
P
Philipp Reisner 已提交
1898
			ret = -ETIMEDOUT;
1899
			dev_err(DEV, "Timed out waiting for missing ack packets; disconnecting\n");
P
Philipp Reisner 已提交
1900 1901 1902 1903
			break;
		}
	}
	spin_unlock(&mdev->peer_seq_lock);
1904
	finish_wait(&mdev->seq_wait, &wait);
P
Philipp Reisner 已提交
1905 1906 1907
	return ret;
}

1908 1909 1910 1911
/* see also bio_flags_to_wire()
 * DRBD_REQ_*, because we need to semantically map the flags to data packet
 * flags and back. We may replicate to other kernel versions. */
static unsigned long wire_flags_to_bio(struct drbd_conf *mdev, u32 dpf)
1912
{
1913 1914 1915 1916
	return  (dpf & DP_RW_SYNC ? REQ_SYNC : 0) |
		(dpf & DP_FUA ? REQ_FUA : 0) |
		(dpf & DP_FLUSH ? REQ_FLUSH : 0) |
		(dpf & DP_DISCARD ? REQ_DISCARD : 0);
1917 1918
}

1919 1920 1921 1922 1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933 1934 1935 1936 1937 1938 1939 1940 1941 1942 1943 1944 1945 1946 1947 1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967 1968 1969 1970 1971 1972 1973 1974 1975 1976 1977 1978 1979 1980 1981 1982 1983 1984 1985 1986 1987 1988 1989 1990 1991 1992 1993 1994 1995 1996 1997 1998 1999 2000 2001 2002 2003 2004 2005 2006 2007 2008 2009 2010 2011 2012 2013 2014 2015 2016 2017 2018 2019 2020 2021 2022 2023 2024 2025 2026 2027 2028 2029 2030 2031 2032 2033 2034 2035 2036 2037 2038 2039 2040 2041 2042 2043 2044 2045 2046 2047 2048 2049 2050 2051
static void fail_postponed_requests(struct drbd_conf *mdev, sector_t sector,
				    unsigned int size)
{
	struct drbd_interval *i;

    repeat:
	drbd_for_each_overlap(i, &mdev->write_requests, sector, size) {
		struct drbd_request *req;
		struct bio_and_error m;

		if (!i->local)
			continue;
		req = container_of(i, struct drbd_request, i);
		if (!(req->rq_state & RQ_POSTPONED))
			continue;
		req->rq_state &= ~RQ_POSTPONED;
		__req_mod(req, NEG_ACKED, &m);
		spin_unlock_irq(&mdev->tconn->req_lock);
		if (m.bio)
			complete_master_bio(mdev, &m);
		spin_lock_irq(&mdev->tconn->req_lock);
		goto repeat;
	}
}

static int handle_write_conflicts(struct drbd_conf *mdev,
				  struct drbd_peer_request *peer_req)
{
	struct drbd_tconn *tconn = mdev->tconn;
	bool resolve_conflicts = test_bit(DISCARD_CONCURRENT, &tconn->flags);
	sector_t sector = peer_req->i.sector;
	const unsigned int size = peer_req->i.size;
	struct drbd_interval *i;
	bool equal;
	int err;

	/*
	 * Inserting the peer request into the write_requests tree will prevent
	 * new conflicting local requests from being added.
	 */
	drbd_insert_interval(&mdev->write_requests, &peer_req->i);

    repeat:
	drbd_for_each_overlap(i, &mdev->write_requests, sector, size) {
		if (i == &peer_req->i)
			continue;

		if (!i->local) {
			/*
			 * Our peer has sent a conflicting remote request; this
			 * should not happen in a two-node setup.  Wait for the
			 * earlier peer request to complete.
			 */
			err = drbd_wait_misc(mdev, i);
			if (err)
				goto out;
			goto repeat;
		}

		equal = i->sector == sector && i->size == size;
		if (resolve_conflicts) {
			/*
			 * If the peer request is fully contained within the
			 * overlapping request, it can be discarded; otherwise,
			 * it will be retried once all overlapping requests
			 * have completed.
			 */
			bool discard = i->sector <= sector && i->sector +
				       (i->size >> 9) >= sector + (size >> 9);

			if (!equal)
				dev_alert(DEV, "Concurrent writes detected: "
					       "local=%llus +%u, remote=%llus +%u, "
					       "assuming %s came first\n",
					  (unsigned long long)i->sector, i->size,
					  (unsigned long long)sector, size,
					  discard ? "local" : "remote");

			inc_unacked(mdev);
			peer_req->w.cb = discard ? e_send_discard_write :
						   e_send_retry_write;
			list_add_tail(&peer_req->w.list, &mdev->done_ee);
			wake_asender(mdev->tconn);

			err = -ENOENT;
			goto out;
		} else {
			struct drbd_request *req =
				container_of(i, struct drbd_request, i);

			if (!equal)
				dev_alert(DEV, "Concurrent writes detected: "
					       "local=%llus +%u, remote=%llus +%u\n",
					  (unsigned long long)i->sector, i->size,
					  (unsigned long long)sector, size);

			if (req->rq_state & RQ_LOCAL_PENDING ||
			    !(req->rq_state & RQ_POSTPONED)) {
				/*
				 * Wait for the node with the discard flag to
				 * decide if this request will be discarded or
				 * retried.  Requests that are discarded will
				 * disappear from the write_requests tree.
				 *
				 * In addition, wait for the conflicting
				 * request to finish locally before submitting
				 * the conflicting peer request.
				 */
				err = drbd_wait_misc(mdev, &req->i);
				if (err) {
					_conn_request_state(mdev->tconn,
							    NS(conn, C_TIMEOUT),
							    CS_HARD);
					fail_postponed_requests(mdev, sector, size);
					goto out;
				}
				goto repeat;
			}
			/*
			 * Remember to restart the conflicting requests after
			 * the new peer request has completed.
			 */
			peer_req->flags |= EE_RESTART_REQUESTS;
		}
	}
	err = 0;

    out:
	if (err)
		drbd_remove_epoch_entry_interval(mdev, peer_req);
	return err;
}

P
Philipp Reisner 已提交
2052
/* mirrored write */
2053
static int receive_Data(struct drbd_tconn *tconn, struct packet_info *pi)
P
Philipp Reisner 已提交
2054
{
2055
	struct drbd_conf *mdev;
P
Philipp Reisner 已提交
2056
	sector_t sector;
2057
	struct drbd_peer_request *peer_req;
2058
	struct p_data *p = pi->data;
2059
	u32 peer_seq = be32_to_cpu(p->seq_num);
P
Philipp Reisner 已提交
2060 2061
	int rw = WRITE;
	u32 dp_flags;
2062
	int err, tp;
P
Philipp Reisner 已提交
2063

2064 2065 2066 2067
	mdev = vnr_to_mdev(tconn, pi->vnr);
	if (!mdev)
		return -EIO;

2068
	if (!get_ldev(mdev)) {
2069 2070
		int err2;

2071
		err = wait_for_and_update_peer_seq(mdev, peer_seq);
2072
		drbd_send_ack_dp(mdev, P_NEG_ACK, p, pi->size);
P
Philipp Reisner 已提交
2073
		atomic_inc(&mdev->current_epoch->epoch_size);
2074
		err2 = drbd_drain_block(mdev, pi->size);
2075 2076 2077
		if (!err)
			err = err2;
		return err;
P
Philipp Reisner 已提交
2078 2079
	}

2080 2081 2082 2083 2084
	/*
	 * Corresponding put_ldev done either below (on various errors), or in
	 * drbd_peer_request_endio, if we successfully submit the data at the
	 * end of this function.
	 */
P
Philipp Reisner 已提交
2085 2086

	sector = be64_to_cpu(p->sector);
2087
	peer_req = read_in_block(mdev, p->block_id, sector, pi->size);
2088
	if (!peer_req) {
P
Philipp Reisner 已提交
2089
		put_ldev(mdev);
2090
		return -EIO;
P
Philipp Reisner 已提交
2091 2092
	}

2093
	peer_req->w.cb = e_end_block;
P
Philipp Reisner 已提交
2094

2095 2096 2097 2098
	dp_flags = be32_to_cpu(p->dp_flags);
	rw |= wire_flags_to_bio(mdev, dp_flags);

	if (dp_flags & DP_MAY_SET_IN_SYNC)
2099
		peer_req->flags |= EE_MAY_SET_IN_SYNC;
2100

P
Philipp Reisner 已提交
2101
	spin_lock(&mdev->epoch_lock);
2102 2103 2104
	peer_req->epoch = mdev->current_epoch;
	atomic_inc(&peer_req->epoch->epoch_size);
	atomic_inc(&peer_req->epoch->active);
P
Philipp Reisner 已提交
2105 2106
	spin_unlock(&mdev->epoch_lock);

2107 2108 2109 2110 2111
	rcu_read_lock();
	tp = rcu_dereference(mdev->tconn->net_conf)->two_primaries;
	rcu_read_unlock();
	if (tp) {
		peer_req->flags |= EE_IN_INTERVAL_TREE;
2112 2113
		err = wait_for_and_update_peer_seq(mdev, peer_seq);
		if (err)
P
Philipp Reisner 已提交
2114
			goto out_interrupted;
2115
		spin_lock_irq(&mdev->tconn->req_lock);
2116 2117 2118 2119
		err = handle_write_conflicts(mdev, peer_req);
		if (err) {
			spin_unlock_irq(&mdev->tconn->req_lock);
			if (err == -ENOENT) {
P
Philipp Reisner 已提交
2120
				put_ldev(mdev);
2121
				return 0;
P
Philipp Reisner 已提交
2122
			}
2123
			goto out_interrupted;
P
Philipp Reisner 已提交
2124
		}
2125 2126
	} else
		spin_lock_irq(&mdev->tconn->req_lock);
2127
	list_add(&peer_req->w.list, &mdev->active_ee);
2128
	spin_unlock_irq(&mdev->tconn->req_lock);
P
Philipp Reisner 已提交
2129

2130
	if (mdev->tconn->agreed_pro_version < 100) {
2131 2132
		rcu_read_lock();
		switch (rcu_dereference(mdev->tconn->net_conf)->wire_protocol) {
2133 2134 2135 2136 2137 2138 2139
		case DRBD_PROT_C:
			dp_flags |= DP_SEND_WRITE_ACK;
			break;
		case DRBD_PROT_B:
			dp_flags |= DP_SEND_RECEIVE_ACK;
			break;
		}
2140
		rcu_read_unlock();
2141 2142 2143 2144
	}

	if (dp_flags & DP_SEND_WRITE_ACK) {
		peer_req->flags |= EE_SEND_WRITE_ACK;
P
Philipp Reisner 已提交
2145 2146 2147
		inc_unacked(mdev);
		/* corresponding dec_unacked() in e_end_block()
		 * respective _drbd_clear_done_ee */
2148 2149 2150
	}

	if (dp_flags & DP_SEND_RECEIVE_ACK) {
P
Philipp Reisner 已提交
2151 2152
		/* I really don't like it that the receiver thread
		 * sends on the msock, but anyways */
2153
		drbd_send_ack(mdev, P_RECV_ACK, peer_req);
P
Philipp Reisner 已提交
2154 2155
	}

2156
	if (mdev->state.pdsk < D_INCONSISTENT) {
P
Philipp Reisner 已提交
2157
		/* In case we have the only disk of the cluster, */
2158 2159 2160
		drbd_set_out_of_sync(mdev, peer_req->i.sector, peer_req->i.size);
		peer_req->flags |= EE_CALL_AL_COMPLETE_IO;
		peer_req->flags &= ~EE_MAY_SET_IN_SYNC;
2161
		drbd_al_begin_io(mdev, &peer_req->i);
P
Philipp Reisner 已提交
2162 2163
	}

2164 2165 2166
	err = drbd_submit_peer_request(mdev, peer_req, rw, DRBD_FAULT_DT_WR);
	if (!err)
		return 0;
P
Philipp Reisner 已提交
2167

2168 2169
	/* don't care for the reason here */
	dev_err(DEV, "submit failed, triggering re-connect\n");
2170
	spin_lock_irq(&mdev->tconn->req_lock);
2171 2172
	list_del(&peer_req->w.list);
	drbd_remove_epoch_entry_interval(mdev, peer_req);
2173
	spin_unlock_irq(&mdev->tconn->req_lock);
2174
	if (peer_req->flags & EE_CALL_AL_COMPLETE_IO)
2175
		drbd_al_complete_io(mdev, &peer_req->i);
2176

P
Philipp Reisner 已提交
2177
out_interrupted:
2178
	drbd_may_finish_epoch(mdev, peer_req->epoch, EV_PUT + EV_CLEANUP);
P
Philipp Reisner 已提交
2179
	put_ldev(mdev);
2180
	drbd_free_peer_req(mdev, peer_req);
2181
	return err;
P
Philipp Reisner 已提交
2182 2183
}

2184 2185 2186 2187 2188 2189 2190 2191 2192 2193 2194
/* We may throttle resync, if the lower device seems to be busy,
 * and current sync rate is above c_min_rate.
 *
 * To decide whether or not the lower device is busy, we use a scheme similar
 * to MD RAID is_mddev_idle(): if the partition stats reveal "significant"
 * (more than 64 sectors) of activity we cannot account for with our own resync
 * activity, it obviously is "busy".
 *
 * The current sync rate used here uses only the most recent two step marks,
 * to have a short time average so we can react faster.
 */
2195
int drbd_rs_should_slow_down(struct drbd_conf *mdev, sector_t sector)
2196 2197 2198
{
	struct gendisk *disk = mdev->ldev->backing_bdev->bd_contains->bd_disk;
	unsigned long db, dt, dbdt;
2199
	struct lc_element *tmp;
2200 2201
	int curr_events;
	int throttle = 0;
P
Philipp Reisner 已提交
2202 2203 2204 2205 2206
	unsigned int c_min_rate;

	rcu_read_lock();
	c_min_rate = rcu_dereference(mdev->ldev->disk_conf)->c_min_rate;
	rcu_read_unlock();
2207 2208

	/* feature disabled? */
P
Philipp Reisner 已提交
2209
	if (c_min_rate == 0)
2210 2211
		return 0;

2212 2213 2214 2215 2216 2217 2218 2219 2220 2221 2222 2223
	spin_lock_irq(&mdev->al_lock);
	tmp = lc_find(mdev->resync, BM_SECT_TO_EXT(sector));
	if (tmp) {
		struct bm_extent *bm_ext = lc_entry(tmp, struct bm_extent, lce);
		if (test_bit(BME_PRIORITY, &bm_ext->flags)) {
			spin_unlock_irq(&mdev->al_lock);
			return 0;
		}
		/* Do not slow down if app IO is already waiting for this extent */
	}
	spin_unlock_irq(&mdev->al_lock);

2224 2225 2226
	curr_events = (int)part_stat_read(&disk->part0, sectors[0]) +
		      (int)part_stat_read(&disk->part0, sectors[1]) -
			atomic_read(&mdev->rs_sect_ev);
2227

2228 2229 2230 2231 2232 2233 2234 2235
	if (!mdev->rs_last_events || curr_events - mdev->rs_last_events > 64) {
		unsigned long rs_left;
		int i;

		mdev->rs_last_events = curr_events;

		/* sync speed average over the last 2*DRBD_SYNC_MARK_STEP,
		 * approx. */
2236 2237 2238 2239 2240 2241
		i = (mdev->rs_last_mark + DRBD_SYNC_MARKS-1) % DRBD_SYNC_MARKS;

		if (mdev->state.conn == C_VERIFY_S || mdev->state.conn == C_VERIFY_T)
			rs_left = mdev->ov_left;
		else
			rs_left = drbd_bm_total_weight(mdev) - mdev->rs_failed;
2242 2243 2244 2245 2246 2247 2248

		dt = ((long)jiffies - (long)mdev->rs_mark_time[i]) / HZ;
		if (!dt)
			dt++;
		db = mdev->rs_mark_left[i] - rs_left;
		dbdt = Bit2KB(db/dt);

P
Philipp Reisner 已提交
2249
		if (dbdt > c_min_rate)
2250 2251 2252 2253 2254 2255
			throttle = 1;
	}
	return throttle;
}


2256
static int receive_DataRequest(struct drbd_tconn *tconn, struct packet_info *pi)
P
Philipp Reisner 已提交
2257
{
2258
	struct drbd_conf *mdev;
P
Philipp Reisner 已提交
2259
	sector_t sector;
2260
	sector_t capacity;
2261
	struct drbd_peer_request *peer_req;
P
Philipp Reisner 已提交
2262
	struct digest_info *di = NULL;
2263
	int size, verb;
P
Philipp Reisner 已提交
2264
	unsigned int fault_type;
2265
	struct p_block_req *p =	pi->data;
2266 2267 2268 2269 2270

	mdev = vnr_to_mdev(tconn, pi->vnr);
	if (!mdev)
		return -EIO;
	capacity = drbd_get_capacity(mdev->this_bdev);
P
Philipp Reisner 已提交
2271 2272 2273 2274

	sector = be64_to_cpu(p->sector);
	size   = be32_to_cpu(p->blksize);

2275
	if (size <= 0 || !IS_ALIGNED(size, 512) || size > DRBD_MAX_BIO_SIZE) {
P
Philipp Reisner 已提交
2276 2277
		dev_err(DEV, "%s:%d: sector: %llus, size: %u\n", __FILE__, __LINE__,
				(unsigned long long)sector, size);
2278
		return -EINVAL;
P
Philipp Reisner 已提交
2279 2280 2281 2282
	}
	if (sector + (size>>9) > capacity) {
		dev_err(DEV, "%s:%d: sector: %llus, size: %u\n", __FILE__, __LINE__,
				(unsigned long long)sector, size);
2283
		return -EINVAL;
P
Philipp Reisner 已提交
2284 2285 2286
	}

	if (!get_ldev_if_state(mdev, D_UP_TO_DATE)) {
2287
		verb = 1;
2288
		switch (pi->cmd) {
2289 2290 2291 2292 2293 2294 2295 2296 2297 2298 2299 2300 2301 2302
		case P_DATA_REQUEST:
			drbd_send_ack_rp(mdev, P_NEG_DREPLY, p);
			break;
		case P_RS_DATA_REQUEST:
		case P_CSUM_RS_REQUEST:
		case P_OV_REQUEST:
			drbd_send_ack_rp(mdev, P_NEG_RS_DREPLY , p);
			break;
		case P_OV_REPLY:
			verb = 0;
			dec_rs_pending(mdev);
			drbd_send_ack_ex(mdev, P_OV_RESULT, sector, size, ID_IN_SYNC);
			break;
		default:
2303
			BUG();
2304 2305
		}
		if (verb && __ratelimit(&drbd_ratelimit_state))
P
Philipp Reisner 已提交
2306 2307
			dev_err(DEV, "Can not satisfy peer's read request, "
			    "no local data.\n");
2308

L
Lars Ellenberg 已提交
2309
		/* drain possibly payload */
2310
		return drbd_drain_block(mdev, pi->size);
P
Philipp Reisner 已提交
2311 2312 2313 2314 2315
	}

	/* GFP_NOIO, because we must not cause arbitrary write-out: in a DRBD
	 * "criss-cross" setup, that might cause write-out on some other DRBD,
	 * which in turn might block on the other node at this very place.  */
2316
	peer_req = drbd_alloc_peer_req(mdev, p->block_id, sector, size, GFP_NOIO);
2317
	if (!peer_req) {
P
Philipp Reisner 已提交
2318
		put_ldev(mdev);
2319
		return -ENOMEM;
P
Philipp Reisner 已提交
2320 2321
	}

2322
	switch (pi->cmd) {
P
Philipp Reisner 已提交
2323
	case P_DATA_REQUEST:
2324
		peer_req->w.cb = w_e_end_data_req;
P
Philipp Reisner 已提交
2325
		fault_type = DRBD_FAULT_DT_RD;
2326 2327 2328
		/* application IO, don't drbd_rs_begin_io */
		goto submit;

P
Philipp Reisner 已提交
2329
	case P_RS_DATA_REQUEST:
2330
		peer_req->w.cb = w_e_end_rsdata_req;
P
Philipp Reisner 已提交
2331
		fault_type = DRBD_FAULT_RS_RD;
2332 2333
		/* used in the sector offset progress display */
		mdev->bm_resync_fo = BM_SECT_TO_BIT(sector);
P
Philipp Reisner 已提交
2334 2335 2336 2337 2338
		break;

	case P_OV_REPLY:
	case P_CSUM_RS_REQUEST:
		fault_type = DRBD_FAULT_RS_RD;
2339
		di = kmalloc(sizeof(*di) + pi->size, GFP_NOIO);
P
Philipp Reisner 已提交
2340 2341 2342
		if (!di)
			goto out_free_e;

2343
		di->digest_size = pi->size;
P
Philipp Reisner 已提交
2344 2345
		di->digest = (((char *)di)+sizeof(struct digest_info));

2346 2347
		peer_req->digest = di;
		peer_req->flags |= EE_HAS_DIGEST;
2348

2349
		if (drbd_recv_all(mdev->tconn, di->digest, pi->size))
P
Philipp Reisner 已提交
2350 2351
			goto out_free_e;

2352
		if (pi->cmd == P_CSUM_RS_REQUEST) {
2353
			D_ASSERT(mdev->tconn->agreed_pro_version >= 89);
2354
			peer_req->w.cb = w_e_end_csum_rs_req;
2355 2356
			/* used in the sector offset progress display */
			mdev->bm_resync_fo = BM_SECT_TO_BIT(sector);
2357
		} else if (pi->cmd == P_OV_REPLY) {
2358 2359
			/* track progress, we may need to throttle */
			atomic_add(size >> 9, &mdev->rs_sect_in);
2360
			peer_req->w.cb = w_e_end_ov_reply;
P
Philipp Reisner 已提交
2361
			dec_rs_pending(mdev);
2362 2363 2364
			/* drbd_rs_begin_io done when we sent this request,
			 * but accounting still needs to be done. */
			goto submit_for_resync;
P
Philipp Reisner 已提交
2365 2366 2367 2368 2369
		}
		break;

	case P_OV_REQUEST:
		if (mdev->ov_start_sector == ~(sector_t)0 &&
2370
		    mdev->tconn->agreed_pro_version >= 90) {
2371 2372
			unsigned long now = jiffies;
			int i;
P
Philipp Reisner 已提交
2373 2374
			mdev->ov_start_sector = sector;
			mdev->ov_position = sector;
2375 2376
			mdev->ov_left = drbd_bm_bits(mdev) - BM_SECT_TO_BIT(sector);
			mdev->rs_total = mdev->ov_left;
2377 2378 2379 2380
			for (i = 0; i < DRBD_SYNC_MARKS; i++) {
				mdev->rs_mark_left[i] = mdev->ov_left;
				mdev->rs_mark_time[i] = now;
			}
P
Philipp Reisner 已提交
2381 2382 2383
			dev_info(DEV, "Online Verify start sector: %llu\n",
					(unsigned long long)sector);
		}
2384
		peer_req->w.cb = w_e_end_ov_req;
P
Philipp Reisner 已提交
2385 2386 2387 2388
		fault_type = DRBD_FAULT_RS_RD;
		break;

	default:
2389
		BUG();
P
Philipp Reisner 已提交
2390 2391
	}

2392 2393 2394 2395 2396 2397 2398 2399 2400 2401 2402 2403 2404 2405 2406 2407 2408 2409 2410 2411 2412 2413
	/* Throttle, drbd_rs_begin_io and submit should become asynchronous
	 * wrt the receiver, but it is not as straightforward as it may seem.
	 * Various places in the resync start and stop logic assume resync
	 * requests are processed in order, requeuing this on the worker thread
	 * introduces a bunch of new code for synchronization between threads.
	 *
	 * Unlimited throttling before drbd_rs_begin_io may stall the resync
	 * "forever", throttling after drbd_rs_begin_io will lock that extent
	 * for application writes for the same time.  For now, just throttle
	 * here, where the rest of the code expects the receiver to sleep for
	 * a while, anyways.
	 */

	/* Throttle before drbd_rs_begin_io, as that locks out application IO;
	 * this defers syncer requests for some time, before letting at least
	 * on request through.  The resync controller on the receiving side
	 * will adapt to the incoming rate accordingly.
	 *
	 * We cannot throttle here if remote is Primary/SyncTarget:
	 * we would also throttle its application reads.
	 * In that case, throttling is done on the SyncTarget only.
	 */
2414 2415 2416
	if (mdev->state.peer != R_PRIMARY && drbd_rs_should_slow_down(mdev, sector))
		schedule_timeout_uninterruptible(HZ/10);
	if (drbd_rs_begin_io(mdev, sector))
2417
		goto out_free_e;
P
Philipp Reisner 已提交
2418

2419 2420 2421
submit_for_resync:
	atomic_add(size >> 9, &mdev->rs_sect_ev);

2422
submit:
P
Philipp Reisner 已提交
2423
	inc_unacked(mdev);
2424
	spin_lock_irq(&mdev->tconn->req_lock);
2425
	list_add_tail(&peer_req->w.list, &mdev->read_ee);
2426
	spin_unlock_irq(&mdev->tconn->req_lock);
P
Philipp Reisner 已提交
2427

2428
	if (drbd_submit_peer_request(mdev, peer_req, READ, fault_type) == 0)
2429
		return 0;
P
Philipp Reisner 已提交
2430

2431 2432
	/* don't care for the reason here */
	dev_err(DEV, "submit failed, triggering re-connect\n");
2433
	spin_lock_irq(&mdev->tconn->req_lock);
2434
	list_del(&peer_req->w.list);
2435
	spin_unlock_irq(&mdev->tconn->req_lock);
2436 2437
	/* no drbd_rs_complete_io(), we are dropping the connection anyways */

P
Philipp Reisner 已提交
2438 2439
out_free_e:
	put_ldev(mdev);
2440
	drbd_free_peer_req(mdev, peer_req);
2441
	return -EIO;
P
Philipp Reisner 已提交
2442 2443 2444 2445 2446 2447
}

static int drbd_asb_recover_0p(struct drbd_conf *mdev) __must_hold(local)
{
	int self, peer, rv = -100;
	unsigned long ch_self, ch_peer;
2448
	enum drbd_after_sb_p after_sb_0p;
P
Philipp Reisner 已提交
2449 2450 2451 2452 2453 2454 2455

	self = mdev->ldev->md.uuid[UI_BITMAP] & 1;
	peer = mdev->p_uuid[UI_BITMAP] & 1;

	ch_peer = mdev->p_uuid[UI_SIZE];
	ch_self = mdev->comm_bm_set;

2456 2457 2458 2459
	rcu_read_lock();
	after_sb_0p = rcu_dereference(mdev->tconn->net_conf)->after_sb_0p;
	rcu_read_unlock();
	switch (after_sb_0p) {
P
Philipp Reisner 已提交
2460 2461 2462
	case ASB_CONSENSUS:
	case ASB_DISCARD_SECONDARY:
	case ASB_CALL_HELPER:
2463
	case ASB_VIOLENTLY:
P
Philipp Reisner 已提交
2464 2465 2466 2467 2468 2469 2470 2471 2472 2473 2474 2475 2476 2477 2478 2479 2480 2481 2482 2483 2484 2485 2486 2487
		dev_err(DEV, "Configuration error.\n");
		break;
	case ASB_DISCONNECT:
		break;
	case ASB_DISCARD_YOUNGER_PRI:
		if (self == 0 && peer == 1) {
			rv = -1;
			break;
		}
		if (self == 1 && peer == 0) {
			rv =  1;
			break;
		}
		/* Else fall through to one of the other strategies... */
	case ASB_DISCARD_OLDER_PRI:
		if (self == 0 && peer == 1) {
			rv = 1;
			break;
		}
		if (self == 1 && peer == 0) {
			rv = -1;
			break;
		}
		/* Else fall through to one of the other strategies... */
L
Lars Ellenberg 已提交
2488
		dev_warn(DEV, "Discard younger/older primary did not find a decision\n"
P
Philipp Reisner 已提交
2489 2490 2491
		     "Using discard-least-changes instead\n");
	case ASB_DISCARD_ZERO_CHG:
		if (ch_peer == 0 && ch_self == 0) {
2492
			rv = test_bit(DISCARD_CONCURRENT, &mdev->tconn->flags)
P
Philipp Reisner 已提交
2493 2494 2495 2496 2497 2498
				? -1 : 1;
			break;
		} else {
			if (ch_peer == 0) { rv =  1; break; }
			if (ch_self == 0) { rv = -1; break; }
		}
2499
		if (after_sb_0p == ASB_DISCARD_ZERO_CHG)
P
Philipp Reisner 已提交
2500 2501 2502 2503 2504 2505 2506 2507
			break;
	case ASB_DISCARD_LEAST_CHG:
		if	(ch_self < ch_peer)
			rv = -1;
		else if (ch_self > ch_peer)
			rv =  1;
		else /* ( ch_self == ch_peer ) */
		     /* Well, then use something else. */
2508
			rv = test_bit(DISCARD_CONCURRENT, &mdev->tconn->flags)
P
Philipp Reisner 已提交
2509 2510 2511 2512 2513 2514 2515 2516 2517 2518 2519 2520 2521 2522
				? -1 : 1;
		break;
	case ASB_DISCARD_LOCAL:
		rv = -1;
		break;
	case ASB_DISCARD_REMOTE:
		rv =  1;
	}

	return rv;
}

static int drbd_asb_recover_1p(struct drbd_conf *mdev) __must_hold(local)
{
2523
	int hg, rv = -100;
2524
	enum drbd_after_sb_p after_sb_1p;
P
Philipp Reisner 已提交
2525

2526 2527 2528 2529
	rcu_read_lock();
	after_sb_1p = rcu_dereference(mdev->tconn->net_conf)->after_sb_1p;
	rcu_read_unlock();
	switch (after_sb_1p) {
P
Philipp Reisner 已提交
2530 2531 2532 2533 2534
	case ASB_DISCARD_YOUNGER_PRI:
	case ASB_DISCARD_OLDER_PRI:
	case ASB_DISCARD_LEAST_CHG:
	case ASB_DISCARD_LOCAL:
	case ASB_DISCARD_REMOTE:
2535
	case ASB_DISCARD_ZERO_CHG:
P
Philipp Reisner 已提交
2536 2537 2538 2539 2540 2541 2542 2543 2544 2545 2546 2547 2548 2549 2550 2551 2552 2553 2554
		dev_err(DEV, "Configuration error.\n");
		break;
	case ASB_DISCONNECT:
		break;
	case ASB_CONSENSUS:
		hg = drbd_asb_recover_0p(mdev);
		if (hg == -1 && mdev->state.role == R_SECONDARY)
			rv = hg;
		if (hg == 1  && mdev->state.role == R_PRIMARY)
			rv = hg;
		break;
	case ASB_VIOLENTLY:
		rv = drbd_asb_recover_0p(mdev);
		break;
	case ASB_DISCARD_SECONDARY:
		return mdev->state.role == R_PRIMARY ? 1 : -1;
	case ASB_CALL_HELPER:
		hg = drbd_asb_recover_0p(mdev);
		if (hg == -1 && mdev->state.role == R_PRIMARY) {
2555 2556 2557
			enum drbd_state_rv rv2;

			drbd_set_role(mdev, R_SECONDARY, 0);
P
Philipp Reisner 已提交
2558 2559 2560
			 /* drbd_change_state() does not sleep while in SS_IN_TRANSIENT_STATE,
			  * we might be here in C_WF_REPORT_PARAMS which is transient.
			  * we do not need to wait for the after state change work either. */
2561 2562
			rv2 = drbd_change_state(mdev, CS_VERBOSE, NS(role, R_SECONDARY));
			if (rv2 != SS_SUCCESS) {
P
Philipp Reisner 已提交
2563 2564 2565 2566 2567 2568 2569 2570 2571 2572 2573 2574 2575 2576
				drbd_khelper(mdev, "pri-lost-after-sb");
			} else {
				dev_warn(DEV, "Successfully gave up primary role.\n");
				rv = hg;
			}
		} else
			rv = hg;
	}

	return rv;
}

static int drbd_asb_recover_2p(struct drbd_conf *mdev) __must_hold(local)
{
2577
	int hg, rv = -100;
2578
	enum drbd_after_sb_p after_sb_2p;
P
Philipp Reisner 已提交
2579

2580 2581 2582 2583
	rcu_read_lock();
	after_sb_2p = rcu_dereference(mdev->tconn->net_conf)->after_sb_2p;
	rcu_read_unlock();
	switch (after_sb_2p) {
P
Philipp Reisner 已提交
2584 2585 2586 2587 2588 2589 2590
	case ASB_DISCARD_YOUNGER_PRI:
	case ASB_DISCARD_OLDER_PRI:
	case ASB_DISCARD_LEAST_CHG:
	case ASB_DISCARD_LOCAL:
	case ASB_DISCARD_REMOTE:
	case ASB_CONSENSUS:
	case ASB_DISCARD_SECONDARY:
2591
	case ASB_DISCARD_ZERO_CHG:
P
Philipp Reisner 已提交
2592 2593 2594 2595 2596 2597 2598 2599 2600 2601
		dev_err(DEV, "Configuration error.\n");
		break;
	case ASB_VIOLENTLY:
		rv = drbd_asb_recover_0p(mdev);
		break;
	case ASB_DISCONNECT:
		break;
	case ASB_CALL_HELPER:
		hg = drbd_asb_recover_0p(mdev);
		if (hg == -1) {
2602 2603
			enum drbd_state_rv rv2;

P
Philipp Reisner 已提交
2604 2605 2606
			 /* drbd_change_state() does not sleep while in SS_IN_TRANSIENT_STATE,
			  * we might be here in C_WF_REPORT_PARAMS which is transient.
			  * we do not need to wait for the after state change work either. */
2607 2608
			rv2 = drbd_change_state(mdev, CS_VERBOSE, NS(role, R_SECONDARY));
			if (rv2 != SS_SUCCESS) {
P
Philipp Reisner 已提交
2609 2610 2611 2612 2613 2614 2615 2616 2617 2618 2619 2620 2621 2622 2623 2624 2625 2626 2627 2628 2629 2630 2631 2632 2633 2634 2635 2636 2637 2638 2639 2640 2641 2642 2643 2644 2645 2646
				drbd_khelper(mdev, "pri-lost-after-sb");
			} else {
				dev_warn(DEV, "Successfully gave up primary role.\n");
				rv = hg;
			}
		} else
			rv = hg;
	}

	return rv;
}

static void drbd_uuid_dump(struct drbd_conf *mdev, char *text, u64 *uuid,
			   u64 bits, u64 flags)
{
	if (!uuid) {
		dev_info(DEV, "%s uuid info vanished while I was looking!\n", text);
		return;
	}
	dev_info(DEV, "%s %016llX:%016llX:%016llX:%016llX bits:%llu flags:%llX\n",
	     text,
	     (unsigned long long)uuid[UI_CURRENT],
	     (unsigned long long)uuid[UI_BITMAP],
	     (unsigned long long)uuid[UI_HISTORY_START],
	     (unsigned long long)uuid[UI_HISTORY_END],
	     (unsigned long long)bits,
	     (unsigned long long)flags);
}

/*
  100	after split brain try auto recover
    2	C_SYNC_SOURCE set BitMap
    1	C_SYNC_SOURCE use BitMap
    0	no Sync
   -1	C_SYNC_TARGET use BitMap
   -2	C_SYNC_TARGET set BitMap
 -100	after split brain, disconnect
-1000	unrelated data
2647 2648
-1091   requires proto 91
-1096   requires proto 96
P
Philipp Reisner 已提交
2649 2650 2651 2652 2653 2654 2655 2656 2657 2658 2659 2660 2661 2662 2663 2664 2665 2666 2667 2668 2669 2670 2671 2672 2673 2674 2675 2676
 */
static int drbd_uuid_compare(struct drbd_conf *mdev, int *rule_nr) __must_hold(local)
{
	u64 self, peer;
	int i, j;

	self = mdev->ldev->md.uuid[UI_CURRENT] & ~((u64)1);
	peer = mdev->p_uuid[UI_CURRENT] & ~((u64)1);

	*rule_nr = 10;
	if (self == UUID_JUST_CREATED && peer == UUID_JUST_CREATED)
		return 0;

	*rule_nr = 20;
	if ((self == UUID_JUST_CREATED || self == (u64)0) &&
	     peer != UUID_JUST_CREATED)
		return -2;

	*rule_nr = 30;
	if (self != UUID_JUST_CREATED &&
	    (peer == UUID_JUST_CREATED || peer == (u64)0))
		return 2;

	if (self == peer) {
		int rct, dc; /* roles at crash time */

		if (mdev->p_uuid[UI_BITMAP] == (u64)0 && mdev->ldev->md.uuid[UI_BITMAP] != (u64)0) {

2677
			if (mdev->tconn->agreed_pro_version < 91)
2678
				return -1091;
P
Philipp Reisner 已提交
2679 2680 2681 2682 2683 2684 2685 2686 2687 2688 2689 2690 2691 2692 2693 2694 2695 2696 2697

			if ((mdev->ldev->md.uuid[UI_BITMAP] & ~((u64)1)) == (mdev->p_uuid[UI_HISTORY_START] & ~((u64)1)) &&
			    (mdev->ldev->md.uuid[UI_HISTORY_START] & ~((u64)1)) == (mdev->p_uuid[UI_HISTORY_START + 1] & ~((u64)1))) {
				dev_info(DEV, "was SyncSource, missed the resync finished event, corrected myself:\n");
				drbd_uuid_set_bm(mdev, 0UL);

				drbd_uuid_dump(mdev, "self", mdev->ldev->md.uuid,
					       mdev->state.disk >= D_NEGOTIATING ? drbd_bm_total_weight(mdev) : 0, 0);
				*rule_nr = 34;
			} else {
				dev_info(DEV, "was SyncSource (peer failed to write sync_uuid)\n");
				*rule_nr = 36;
			}

			return 1;
		}

		if (mdev->ldev->md.uuid[UI_BITMAP] == (u64)0 && mdev->p_uuid[UI_BITMAP] != (u64)0) {

2698
			if (mdev->tconn->agreed_pro_version < 91)
2699
				return -1091;
P
Philipp Reisner 已提交
2700 2701 2702 2703 2704 2705 2706 2707 2708 2709 2710 2711 2712 2713 2714 2715 2716 2717 2718 2719 2720 2721 2722 2723 2724 2725 2726 2727 2728 2729 2730

			if ((mdev->ldev->md.uuid[UI_HISTORY_START] & ~((u64)1)) == (mdev->p_uuid[UI_BITMAP] & ~((u64)1)) &&
			    (mdev->ldev->md.uuid[UI_HISTORY_START + 1] & ~((u64)1)) == (mdev->p_uuid[UI_HISTORY_START] & ~((u64)1))) {
				dev_info(DEV, "was SyncTarget, peer missed the resync finished event, corrected peer:\n");

				mdev->p_uuid[UI_HISTORY_START + 1] = mdev->p_uuid[UI_HISTORY_START];
				mdev->p_uuid[UI_HISTORY_START] = mdev->p_uuid[UI_BITMAP];
				mdev->p_uuid[UI_BITMAP] = 0UL;

				drbd_uuid_dump(mdev, "peer", mdev->p_uuid, mdev->p_uuid[UI_SIZE], mdev->p_uuid[UI_FLAGS]);
				*rule_nr = 35;
			} else {
				dev_info(DEV, "was SyncTarget (failed to write sync_uuid)\n");
				*rule_nr = 37;
			}

			return -1;
		}

		/* Common power [off|failure] */
		rct = (test_bit(CRASHED_PRIMARY, &mdev->flags) ? 1 : 0) +
			(mdev->p_uuid[UI_FLAGS] & 2);
		/* lowest bit is set when we were primary,
		 * next bit (weight 2) is set when peer was primary */
		*rule_nr = 40;

		switch (rct) {
		case 0: /* !self_pri && !peer_pri */ return 0;
		case 1: /*  self_pri && !peer_pri */ return 1;
		case 2: /* !self_pri &&  peer_pri */ return -1;
		case 3: /*  self_pri &&  peer_pri */
2731
			dc = test_bit(DISCARD_CONCURRENT, &mdev->tconn->flags);
P
Philipp Reisner 已提交
2732 2733 2734 2735 2736 2737 2738 2739 2740 2741 2742 2743
			return dc ? -1 : 1;
		}
	}

	*rule_nr = 50;
	peer = mdev->p_uuid[UI_BITMAP] & ~((u64)1);
	if (self == peer)
		return -1;

	*rule_nr = 51;
	peer = mdev->p_uuid[UI_HISTORY_START] & ~((u64)1);
	if (self == peer) {
2744
		if (mdev->tconn->agreed_pro_version < 96 ?
2745 2746 2747
		    (mdev->ldev->md.uuid[UI_HISTORY_START] & ~((u64)1)) ==
		    (mdev->p_uuid[UI_HISTORY_START + 1] & ~((u64)1)) :
		    peer + UUID_NEW_BM_OFFSET == (mdev->p_uuid[UI_BITMAP] & ~((u64)1))) {
P
Philipp Reisner 已提交
2748 2749 2750
			/* The last P_SYNC_UUID did not get though. Undo the last start of
			   resync as sync source modifications of the peer's UUIDs. */

2751
			if (mdev->tconn->agreed_pro_version < 91)
2752
				return -1091;
P
Philipp Reisner 已提交
2753 2754 2755

			mdev->p_uuid[UI_BITMAP] = mdev->p_uuid[UI_HISTORY_START];
			mdev->p_uuid[UI_HISTORY_START] = mdev->p_uuid[UI_HISTORY_START + 1];
2756 2757 2758 2759

			dev_info(DEV, "Did not got last syncUUID packet, corrected:\n");
			drbd_uuid_dump(mdev, "peer", mdev->p_uuid, mdev->p_uuid[UI_SIZE], mdev->p_uuid[UI_FLAGS]);

P
Philipp Reisner 已提交
2760 2761 2762 2763 2764 2765 2766 2767 2768 2769 2770 2771 2772 2773 2774 2775 2776 2777 2778 2779 2780
			return -1;
		}
	}

	*rule_nr = 60;
	self = mdev->ldev->md.uuid[UI_CURRENT] & ~((u64)1);
	for (i = UI_HISTORY_START; i <= UI_HISTORY_END; i++) {
		peer = mdev->p_uuid[i] & ~((u64)1);
		if (self == peer)
			return -2;
	}

	*rule_nr = 70;
	self = mdev->ldev->md.uuid[UI_BITMAP] & ~((u64)1);
	peer = mdev->p_uuid[UI_CURRENT] & ~((u64)1);
	if (self == peer)
		return 1;

	*rule_nr = 71;
	self = mdev->ldev->md.uuid[UI_HISTORY_START] & ~((u64)1);
	if (self == peer) {
2781
		if (mdev->tconn->agreed_pro_version < 96 ?
2782 2783 2784
		    (mdev->ldev->md.uuid[UI_HISTORY_START + 1] & ~((u64)1)) ==
		    (mdev->p_uuid[UI_HISTORY_START] & ~((u64)1)) :
		    self + UUID_NEW_BM_OFFSET == (mdev->ldev->md.uuid[UI_BITMAP] & ~((u64)1))) {
P
Philipp Reisner 已提交
2785 2786 2787
			/* The last P_SYNC_UUID did not get though. Undo the last start of
			   resync as sync source modifications of our UUIDs. */

2788
			if (mdev->tconn->agreed_pro_version < 91)
2789
				return -1091;
P
Philipp Reisner 已提交
2790 2791 2792 2793

			_drbd_uuid_set(mdev, UI_BITMAP, mdev->ldev->md.uuid[UI_HISTORY_START]);
			_drbd_uuid_set(mdev, UI_HISTORY_START, mdev->ldev->md.uuid[UI_HISTORY_START + 1]);

2794
			dev_info(DEV, "Last syncUUID did not get through, corrected:\n");
P
Philipp Reisner 已提交
2795 2796 2797 2798 2799 2800 2801 2802 2803
			drbd_uuid_dump(mdev, "self", mdev->ldev->md.uuid,
				       mdev->state.disk >= D_NEGOTIATING ? drbd_bm_total_weight(mdev) : 0, 0);

			return 1;
		}
	}


	*rule_nr = 80;
2804
	peer = mdev->p_uuid[UI_CURRENT] & ~((u64)1);
P
Philipp Reisner 已提交
2805 2806 2807 2808 2809 2810 2811 2812 2813 2814 2815 2816 2817 2818 2819 2820 2821 2822 2823 2824 2825 2826 2827 2828 2829 2830 2831 2832 2833 2834 2835 2836 2837
	for (i = UI_HISTORY_START; i <= UI_HISTORY_END; i++) {
		self = mdev->ldev->md.uuid[i] & ~((u64)1);
		if (self == peer)
			return 2;
	}

	*rule_nr = 90;
	self = mdev->ldev->md.uuid[UI_BITMAP] & ~((u64)1);
	peer = mdev->p_uuid[UI_BITMAP] & ~((u64)1);
	if (self == peer && self != ((u64)0))
		return 100;

	*rule_nr = 100;
	for (i = UI_HISTORY_START; i <= UI_HISTORY_END; i++) {
		self = mdev->ldev->md.uuid[i] & ~((u64)1);
		for (j = UI_HISTORY_START; j <= UI_HISTORY_END; j++) {
			peer = mdev->p_uuid[j] & ~((u64)1);
			if (self == peer)
				return -100;
		}
	}

	return -1000;
}

/* drbd_sync_handshake() returns the new conn state on success, or
   CONN_MASK (-1) on failure.
 */
static enum drbd_conns drbd_sync_handshake(struct drbd_conf *mdev, enum drbd_role peer_role,
					   enum drbd_disk_state peer_disk) __must_hold(local)
{
	enum drbd_conns rv = C_MASK;
	enum drbd_disk_state mydisk;
2838
	struct net_conf *nc;
2839
	int hg, rule_nr, rr_conflict, tentative;
P
Philipp Reisner 已提交
2840 2841 2842 2843 2844 2845 2846 2847 2848 2849 2850 2851 2852 2853 2854 2855 2856 2857

	mydisk = mdev->state.disk;
	if (mydisk == D_NEGOTIATING)
		mydisk = mdev->new_state_tmp.disk;

	dev_info(DEV, "drbd_sync_handshake:\n");
	drbd_uuid_dump(mdev, "self", mdev->ldev->md.uuid, mdev->comm_bm_set, 0);
	drbd_uuid_dump(mdev, "peer", mdev->p_uuid,
		       mdev->p_uuid[UI_SIZE], mdev->p_uuid[UI_FLAGS]);

	hg = drbd_uuid_compare(mdev, &rule_nr);

	dev_info(DEV, "uuid_compare()=%d by rule %d\n", hg, rule_nr);

	if (hg == -1000) {
		dev_alert(DEV, "Unrelated data, aborting!\n");
		return C_MASK;
	}
2858 2859
	if (hg < -1000) {
		dev_alert(DEV, "To resolve this both sides have to support at least protocol %d\n", -hg - 1000);
P
Philipp Reisner 已提交
2860 2861 2862 2863 2864 2865 2866 2867 2868 2869 2870 2871 2872
		return C_MASK;
	}

	if    ((mydisk == D_INCONSISTENT && peer_disk > D_INCONSISTENT) ||
	    (peer_disk == D_INCONSISTENT && mydisk    > D_INCONSISTENT)) {
		int f = (hg == -100) || abs(hg) == 2;
		hg = mydisk > D_INCONSISTENT ? 1 : -1;
		if (f)
			hg = hg*2;
		dev_info(DEV, "Becoming sync %s due to disk states.\n",
		     hg > 0 ? "source" : "target");
	}

2873 2874 2875
	if (abs(hg) == 100)
		drbd_khelper(mdev, "initial-split-brain");

2876 2877 2878 2879
	rcu_read_lock();
	nc = rcu_dereference(mdev->tconn->net_conf);

	if (hg == 100 || (hg == -100 && nc->always_asbp)) {
P
Philipp Reisner 已提交
2880 2881 2882 2883 2884 2885 2886 2887 2888 2889 2890 2891 2892 2893 2894 2895 2896 2897 2898 2899 2900 2901 2902 2903 2904 2905 2906 2907
		int pcount = (mdev->state.role == R_PRIMARY)
			   + (peer_role == R_PRIMARY);
		int forced = (hg == -100);

		switch (pcount) {
		case 0:
			hg = drbd_asb_recover_0p(mdev);
			break;
		case 1:
			hg = drbd_asb_recover_1p(mdev);
			break;
		case 2:
			hg = drbd_asb_recover_2p(mdev);
			break;
		}
		if (abs(hg) < 100) {
			dev_warn(DEV, "Split-Brain detected, %d primaries, "
			     "automatically solved. Sync from %s node\n",
			     pcount, (hg < 0) ? "peer" : "this");
			if (forced) {
				dev_warn(DEV, "Doing a full sync, since"
				     " UUIDs where ambiguous.\n");
				hg = hg*2;
			}
		}
	}

	if (hg == -100) {
2908
		if (nc->discard_my_data && !(mdev->p_uuid[UI_FLAGS]&1))
P
Philipp Reisner 已提交
2909
			hg = -1;
2910
		if (!nc->discard_my_data && (mdev->p_uuid[UI_FLAGS]&1))
P
Philipp Reisner 已提交
2911 2912 2913 2914 2915 2916 2917
			hg = 1;

		if (abs(hg) < 100)
			dev_warn(DEV, "Split-Brain detected, manually solved. "
			     "Sync from %s node\n",
			     (hg < 0) ? "peer" : "this");
	}
2918
	rr_conflict = nc->rr_conflict;
2919
	tentative = nc->tentative;
2920
	rcu_read_unlock();
P
Philipp Reisner 已提交
2921 2922

	if (hg == -100) {
2923 2924 2925 2926
		/* FIXME this log message is not correct if we end up here
		 * after an attempted attach on a diskless node.
		 * We just refuse to attach -- well, we drop the "connection"
		 * to that disk, in a way... */
2927
		dev_alert(DEV, "Split-Brain detected but unresolved, dropping connection!\n");
P
Philipp Reisner 已提交
2928 2929 2930 2931 2932 2933 2934 2935 2936 2937 2938
		drbd_khelper(mdev, "split-brain");
		return C_MASK;
	}

	if (hg > 0 && mydisk <= D_INCONSISTENT) {
		dev_err(DEV, "I shall become SyncSource, but I am inconsistent!\n");
		return C_MASK;
	}

	if (hg < 0 && /* by intention we do not use mydisk here. */
	    mdev->state.role == R_PRIMARY && mdev->state.disk >= D_CONSISTENT) {
2939
		switch (rr_conflict) {
P
Philipp Reisner 已提交
2940 2941 2942 2943 2944 2945 2946 2947 2948 2949 2950 2951
		case ASB_CALL_HELPER:
			drbd_khelper(mdev, "pri-lost");
			/* fall through */
		case ASB_DISCONNECT:
			dev_err(DEV, "I shall become SyncTarget, but I am primary!\n");
			return C_MASK;
		case ASB_VIOLENTLY:
			dev_warn(DEV, "Becoming SyncTarget, violating the stable-data"
			     "assumption\n");
		}
	}

2952
	if (tentative || test_bit(CONN_DRY_RUN, &mdev->tconn->flags)) {
2953 2954 2955 2956 2957 2958 2959 2960 2961
		if (hg == 0)
			dev_info(DEV, "dry-run connect: No resync, would become Connected immediately.\n");
		else
			dev_info(DEV, "dry-run connect: Would become %s, doing a %s resync.",
				 drbd_conn_str(hg > 0 ? C_SYNC_SOURCE : C_SYNC_TARGET),
				 abs(hg) >= 2 ? "full" : "bit-map based");
		return C_MASK;
	}

P
Philipp Reisner 已提交
2962 2963
	if (abs(hg) >= 2) {
		dev_info(DEV, "Writing the whole bitmap, full sync required after drbd_sync_handshake.\n");
2964 2965
		if (drbd_bitmap_io(mdev, &drbd_bmio_set_n_write, "set_n_write from sync_handshake",
					BM_LOCKED_SET_ALLOWED))
P
Philipp Reisner 已提交
2966 2967 2968 2969 2970 2971 2972 2973 2974 2975 2976 2977 2978 2979 2980 2981 2982 2983
			return C_MASK;
	}

	if (hg > 0) { /* become sync source. */
		rv = C_WF_BITMAP_S;
	} else if (hg < 0) { /* become sync target */
		rv = C_WF_BITMAP_T;
	} else {
		rv = C_CONNECTED;
		if (drbd_bm_total_weight(mdev)) {
			dev_info(DEV, "No resync, but %lu bits in bitmap!\n",
			     drbd_bm_total_weight(mdev));
		}
	}

	return rv;
}

2984
static enum drbd_after_sb_p convert_after_sb(enum drbd_after_sb_p peer)
P
Philipp Reisner 已提交
2985 2986
{
	/* ASB_DISCARD_REMOTE - ASB_DISCARD_LOCAL is valid */
2987 2988
	if (peer == ASB_DISCARD_REMOTE)
		return ASB_DISCARD_LOCAL;
P
Philipp Reisner 已提交
2989 2990

	/* any other things with ASB_DISCARD_REMOTE or ASB_DISCARD_LOCAL are invalid */
2991 2992
	if (peer == ASB_DISCARD_LOCAL)
		return ASB_DISCARD_REMOTE;
P
Philipp Reisner 已提交
2993 2994

	/* everything else is valid if they are equal on both sides. */
2995
	return peer;
P
Philipp Reisner 已提交
2996 2997
}

2998
static int receive_protocol(struct drbd_tconn *tconn, struct packet_info *pi)
P
Philipp Reisner 已提交
2999
{
3000
	struct p_protocol *p = pi->data;
3001 3002 3003 3004
	enum drbd_after_sb_p p_after_sb_0p, p_after_sb_1p, p_after_sb_2p;
	int p_proto, p_discard_my_data, p_two_primaries, cf;
	struct net_conf *nc, *old_net_conf, *new_net_conf = NULL;
	char integrity_alg[SHARED_SECRET_MAX] = "";
3005
	struct crypto_hash *peer_integrity_tfm = NULL, *integrity_tfm = NULL;
3006
	void *int_dig_in = NULL, *int_dig_vv = NULL;
P
Philipp Reisner 已提交
3007 3008 3009 3010 3011 3012

	p_proto		= be32_to_cpu(p->protocol);
	p_after_sb_0p	= be32_to_cpu(p->after_sb_0p);
	p_after_sb_1p	= be32_to_cpu(p->after_sb_1p);
	p_after_sb_2p	= be32_to_cpu(p->after_sb_2p);
	p_two_primaries = be32_to_cpu(p->two_primaries);
3013
	cf		= be32_to_cpu(p->conn_flags);
3014
	p_discard_my_data = cf & CF_DISCARD_MY_DATA;
3015

3016 3017 3018
	if (tconn->agreed_pro_version >= 87) {
		int err;

3019
		if (pi->size > sizeof(integrity_alg))
3020
			return -EIO;
3021
		err = drbd_recv_all(tconn, integrity_alg, pi->size);
3022 3023
		if (err)
			return err;
3024 3025
		integrity_alg[SHARED_SECRET_MAX - 1] = 0;
	}
3026

3027
	if (pi->cmd == P_PROTOCOL_UPDATE) {
3028
		if (integrity_alg[0]) {
3029 3030
			int hash_size;

3031 3032 3033
			peer_integrity_tfm = crypto_alloc_hash(integrity_alg, 0, CRYPTO_ALG_ASYNC);
			integrity_tfm = crypto_alloc_hash(integrity_alg, 0, CRYPTO_ALG_ASYNC);
			if (!(peer_integrity_tfm && integrity_tfm)) {
3034 3035 3036 3037
				conn_err(tconn, "peer data-integrity-alg %s not supported\n",
					 integrity_alg);
				goto disconnect;
			}
3038

3039
			hash_size = crypto_hash_digestsize(integrity_tfm);
3040 3041 3042
			int_dig_in = kmalloc(hash_size, GFP_KERNEL);
			int_dig_vv = kmalloc(hash_size, GFP_KERNEL);
			if (!(int_dig_in && int_dig_vv)) {
3043
				conn_err(tconn, "Allocation of buffers for data integrity checking failed\n");
3044 3045
				goto disconnect;
			}
3046
		}
3047

3048 3049 3050 3051 3052 3053 3054 3055 3056 3057 3058 3059 3060 3061 3062 3063 3064 3065 3066 3067
		new_net_conf = kmalloc(sizeof(struct net_conf), GFP_KERNEL);
		if (!new_net_conf) {
			conn_err(tconn, "Allocation of new net_conf failed\n");
			goto disconnect;
		}

		mutex_lock(&tconn->data.mutex);
		mutex_lock(&tconn->conf_update);
		old_net_conf = tconn->net_conf;
		*new_net_conf = *old_net_conf;

		new_net_conf->wire_protocol = p_proto;
		new_net_conf->after_sb_0p = convert_after_sb(p_after_sb_0p);
		new_net_conf->after_sb_1p = convert_after_sb(p_after_sb_1p);
		new_net_conf->after_sb_2p = convert_after_sb(p_after_sb_2p);
		new_net_conf->two_primaries = p_two_primaries;
		strcpy(new_net_conf->integrity_alg, integrity_alg);
		new_net_conf->integrity_alg_len = strlen(integrity_alg) + 1;

		crypto_free_hash(tconn->integrity_tfm);
3068
		tconn->integrity_tfm = integrity_tfm;
3069 3070 3071 3072 3073 3074

		rcu_assign_pointer(tconn->net_conf, new_net_conf);
		mutex_unlock(&tconn->conf_update);
		mutex_unlock(&tconn->data.mutex);

		crypto_free_hash(tconn->peer_integrity_tfm);
3075 3076
		kfree(tconn->int_dig_in);
		kfree(tconn->int_dig_vv);
3077
		tconn->peer_integrity_tfm = peer_integrity_tfm;
3078 3079
		tconn->int_dig_in = int_dig_in;
		tconn->int_dig_vv = int_dig_vv;
3080 3081 3082 3083 3084 3085

		if (strcmp(old_net_conf->integrity_alg, integrity_alg))
			conn_info(tconn, "peer data-integrity-alg: %s\n", integrity_alg);

		synchronize_rcu();
		kfree(old_net_conf);
3086 3087
	} else {
		clear_bit(CONN_DRY_RUN, &tconn->flags);
3088

3089 3090
		if (cf & CF_DRY_RUN)
			set_bit(CONN_DRY_RUN, &tconn->flags);
3091

3092 3093
		rcu_read_lock();
		nc = rcu_dereference(tconn->net_conf);
P
Philipp Reisner 已提交
3094

3095
		if (p_proto != nc->wire_protocol) {
3096
			conn_err(tconn, "incompatible %s settings\n", "protocol");
3097 3098
			goto disconnect_rcu_unlock;
		}
3099

3100
		if (convert_after_sb(p_after_sb_0p) != nc->after_sb_0p) {
3101
			conn_err(tconn, "incompatible %s settings\n", "after-sb-0pri");
3102 3103
			goto disconnect_rcu_unlock;
		}
P
Philipp Reisner 已提交
3104

3105
		if (convert_after_sb(p_after_sb_1p) != nc->after_sb_1p) {
3106
			conn_err(tconn, "incompatible %s settings\n", "after-sb-1pri");
3107 3108
			goto disconnect_rcu_unlock;
		}
P
Philipp Reisner 已提交
3109

3110
		if (convert_after_sb(p_after_sb_2p) != nc->after_sb_2p) {
3111
			conn_err(tconn, "incompatible %s settings\n", "after-sb-2pri");
3112 3113
			goto disconnect_rcu_unlock;
		}
P
Philipp Reisner 已提交
3114

3115
		if (p_discard_my_data && nc->discard_my_data) {
3116
			conn_err(tconn, "incompatible %s settings\n", "discard-my-data");
3117 3118
			goto disconnect_rcu_unlock;
		}
P
Philipp Reisner 已提交
3119

3120
		if (p_two_primaries != nc->two_primaries) {
3121
			conn_err(tconn, "incompatible %s settings\n", "allow-two-primaries");
3122 3123
			goto disconnect_rcu_unlock;
		}
P
Philipp Reisner 已提交
3124

3125
		if (strcmp(integrity_alg, nc->integrity_alg)) {
3126
			conn_err(tconn, "incompatible %s settings\n", "data-integrity-alg");
3127 3128
			goto disconnect_rcu_unlock;
		}
P
Philipp Reisner 已提交
3129

3130
		rcu_read_unlock();
3131
	}
3132
	return 0;
P
Philipp Reisner 已提交
3133

3134 3135
disconnect_rcu_unlock:
	rcu_read_unlock();
P
Philipp Reisner 已提交
3136
disconnect:
3137 3138
	crypto_free_hash(peer_integrity_tfm);
	crypto_free_hash(integrity_tfm);
3139 3140
	kfree(int_dig_in);
	kfree(int_dig_vv);
3141
	conn_request_state(tconn, NS(conn, C_DISCONNECTING), CS_HARD);
3142
	return -EIO;
P
Philipp Reisner 已提交
3143 3144 3145 3146 3147 3148 3149 3150 3151 3152 3153 3154 3155 3156 3157 3158 3159 3160 3161 3162 3163 3164 3165 3166
}

/* helper function
 * input: alg name, feature name
 * return: NULL (alg name was "")
 *         ERR_PTR(error) if something goes wrong
 *         or the crypto hash ptr, if it worked out ok. */
struct crypto_hash *drbd_crypto_alloc_digest_safe(const struct drbd_conf *mdev,
		const char *alg, const char *name)
{
	struct crypto_hash *tfm;

	if (!alg[0])
		return NULL;

	tfm = crypto_alloc_hash(alg, 0, CRYPTO_ALG_ASYNC);
	if (IS_ERR(tfm)) {
		dev_err(DEV, "Can not allocate \"%s\" as %s (reason: %ld)\n",
			alg, name, PTR_ERR(tfm));
		return tfm;
	}
	return tfm;
}

3167 3168 3169 3170 3171 3172 3173 3174 3175 3176 3177 3178 3179 3180 3181 3182 3183 3184 3185 3186 3187 3188 3189 3190 3191 3192 3193 3194 3195 3196 3197 3198 3199
static int ignore_remaining_packet(struct drbd_tconn *tconn, struct packet_info *pi)
{
	void *buffer = tconn->data.rbuf;
	int size = pi->size;

	while (size) {
		int s = min_t(int, size, DRBD_SOCKET_BUFFER_SIZE);
		s = drbd_recv(tconn, buffer, s);
		if (s <= 0) {
			if (s < 0)
				return s;
			break;
		}
		size -= s;
	}
	if (size)
		return -EIO;
	return 0;
}

/*
 * config_unknown_volume  -  device configuration command for unknown volume
 *
 * When a device is added to an existing connection, the node on which the
 * device is added first will send configuration commands to its peer but the
 * peer will not know about the device yet.  It will warn and ignore these
 * commands.  Once the device is added on the second node, the second node will
 * send the same device configuration commands, but in the other direction.
 *
 * (We can also end up here if drbd is misconfigured.)
 */
static int config_unknown_volume(struct drbd_tconn *tconn, struct packet_info *pi)
{
3200 3201
	conn_warn(tconn, "%s packet received for volume %u, which is not configured locally\n",
		  cmdname(pi->cmd), pi->vnr);
3202 3203 3204 3205
	return ignore_remaining_packet(tconn, pi);
}

static int receive_SyncParam(struct drbd_tconn *tconn, struct packet_info *pi)
P
Philipp Reisner 已提交
3206
{
3207
	struct drbd_conf *mdev;
3208
	struct p_rs_param_95 *p;
P
Philipp Reisner 已提交
3209 3210 3211
	unsigned int header_size, data_size, exp_max_sz;
	struct crypto_hash *verify_tfm = NULL;
	struct crypto_hash *csums_tfm = NULL;
3212
	struct net_conf *old_net_conf, *new_net_conf = NULL;
P
Philipp Reisner 已提交
3213
	struct disk_conf *old_disk_conf = NULL, *new_disk_conf = NULL;
3214
	const int apv = tconn->agreed_pro_version;
P
Philipp Reisner 已提交
3215
	struct fifo_buffer *old_plan = NULL, *new_plan = NULL;
3216
	int fifo_size = 0;
3217
	int err;
P
Philipp Reisner 已提交
3218

3219 3220 3221 3222
	mdev = vnr_to_mdev(tconn, pi->vnr);
	if (!mdev)
		return config_unknown_volume(tconn, pi);

P
Philipp Reisner 已提交
3223 3224 3225
	exp_max_sz  = apv <= 87 ? sizeof(struct p_rs_param)
		    : apv == 88 ? sizeof(struct p_rs_param)
					+ SHARED_SECRET_MAX
3226 3227
		    : apv <= 94 ? sizeof(struct p_rs_param_89)
		    : /* apv >= 95 */ sizeof(struct p_rs_param_95);
P
Philipp Reisner 已提交
3228

3229
	if (pi->size > exp_max_sz) {
P
Philipp Reisner 已提交
3230
		dev_err(DEV, "SyncParam packet too long: received %u, expected <= %u bytes\n",
3231
		    pi->size, exp_max_sz);
3232
		return -EIO;
P
Philipp Reisner 已提交
3233 3234 3235
	}

	if (apv <= 88) {
3236
		header_size = sizeof(struct p_rs_param);
3237
		data_size = pi->size - header_size;
3238
	} else if (apv <= 94) {
3239
		header_size = sizeof(struct p_rs_param_89);
3240
		data_size = pi->size - header_size;
P
Philipp Reisner 已提交
3241
		D_ASSERT(data_size == 0);
3242
	} else {
3243
		header_size = sizeof(struct p_rs_param_95);
3244
		data_size = pi->size - header_size;
P
Philipp Reisner 已提交
3245 3246 3247 3248
		D_ASSERT(data_size == 0);
	}

	/* initialize verify_alg and csums_alg */
3249
	p = pi->data;
P
Philipp Reisner 已提交
3250 3251
	memset(p->verify_alg, 0, 2 * SHARED_SECRET_MAX);

3252
	err = drbd_recv_all(mdev->tconn, p, header_size);
3253 3254
	if (err)
		return err;
P
Philipp Reisner 已提交
3255

P
Philipp Reisner 已提交
3256 3257
	mutex_lock(&mdev->tconn->conf_update);
	old_net_conf = mdev->tconn->net_conf;
P
Philipp Reisner 已提交
3258 3259 3260 3261 3262 3263 3264 3265
	if (get_ldev(mdev)) {
		new_disk_conf = kzalloc(sizeof(struct disk_conf), GFP_KERNEL);
		if (!new_disk_conf) {
			put_ldev(mdev);
			mutex_unlock(&mdev->tconn->conf_update);
			dev_err(DEV, "Allocation of new disk_conf failed\n");
			return -ENOMEM;
		}
P
Philipp Reisner 已提交
3266

P
Philipp Reisner 已提交
3267 3268 3269
		old_disk_conf = mdev->ldev->disk_conf;
		*new_disk_conf = *old_disk_conf;

3270
		new_disk_conf->resync_rate = be32_to_cpu(p->resync_rate);
P
Philipp Reisner 已提交
3271
	}
P
Philipp Reisner 已提交
3272

P
Philipp Reisner 已提交
3273 3274 3275 3276 3277 3278
	if (apv >= 88) {
		if (apv == 88) {
			if (data_size > SHARED_SECRET_MAX) {
				dev_err(DEV, "verify-alg too long, "
				    "peer wants %u, accepting only %u byte\n",
						data_size, SHARED_SECRET_MAX);
P
Philipp Reisner 已提交
3279 3280
				err = -EIO;
				goto reconnect;
P
Philipp Reisner 已提交
3281 3282
			}

3283
			err = drbd_recv_all(mdev->tconn, p->verify_alg, data_size);
P
Philipp Reisner 已提交
3284 3285
			if (err)
				goto reconnect;
P
Philipp Reisner 已提交
3286 3287 3288 3289 3290 3291 3292 3293 3294 3295 3296 3297 3298 3299
			/* we expect NUL terminated string */
			/* but just in case someone tries to be evil */
			D_ASSERT(p->verify_alg[data_size-1] == 0);
			p->verify_alg[data_size-1] = 0;

		} else /* apv >= 89 */ {
			/* we still expect NUL terminated strings */
			/* but just in case someone tries to be evil */
			D_ASSERT(p->verify_alg[SHARED_SECRET_MAX-1] == 0);
			D_ASSERT(p->csums_alg[SHARED_SECRET_MAX-1] == 0);
			p->verify_alg[SHARED_SECRET_MAX-1] = 0;
			p->csums_alg[SHARED_SECRET_MAX-1] = 0;
		}

3300
		if (strcmp(old_net_conf->verify_alg, p->verify_alg)) {
P
Philipp Reisner 已提交
3301 3302
			if (mdev->state.conn == C_WF_REPORT_PARAMS) {
				dev_err(DEV, "Different verify-alg settings. me=\"%s\" peer=\"%s\"\n",
3303
				    old_net_conf->verify_alg, p->verify_alg);
P
Philipp Reisner 已提交
3304 3305 3306 3307 3308 3309 3310 3311 3312 3313
				goto disconnect;
			}
			verify_tfm = drbd_crypto_alloc_digest_safe(mdev,
					p->verify_alg, "verify-alg");
			if (IS_ERR(verify_tfm)) {
				verify_tfm = NULL;
				goto disconnect;
			}
		}

3314
		if (apv >= 89 && strcmp(old_net_conf->csums_alg, p->csums_alg)) {
P
Philipp Reisner 已提交
3315 3316
			if (mdev->state.conn == C_WF_REPORT_PARAMS) {
				dev_err(DEV, "Different csums-alg settings. me=\"%s\" peer=\"%s\"\n",
3317
				    old_net_conf->csums_alg, p->csums_alg);
P
Philipp Reisner 已提交
3318 3319 3320 3321 3322 3323 3324 3325 3326 3327
				goto disconnect;
			}
			csums_tfm = drbd_crypto_alloc_digest_safe(mdev,
					p->csums_alg, "csums-alg");
			if (IS_ERR(csums_tfm)) {
				csums_tfm = NULL;
				goto disconnect;
			}
		}

P
Philipp Reisner 已提交
3328
		if (apv > 94 && new_disk_conf) {
P
Philipp Reisner 已提交
3329 3330 3331 3332
			new_disk_conf->c_plan_ahead = be32_to_cpu(p->c_plan_ahead);
			new_disk_conf->c_delay_target = be32_to_cpu(p->c_delay_target);
			new_disk_conf->c_fill_target = be32_to_cpu(p->c_fill_target);
			new_disk_conf->c_max_rate = be32_to_cpu(p->c_max_rate);
3333

P
Philipp Reisner 已提交
3334
			fifo_size = (new_disk_conf->c_plan_ahead * 10 * SLEEP_TIME) / HZ;
3335
			if (fifo_size != mdev->rs_plan_s->size) {
P
Philipp Reisner 已提交
3336 3337
				new_plan = fifo_alloc(fifo_size);
				if (!new_plan) {
3338
					dev_err(DEV, "kmalloc of fifo_buffer failed");
3339
					put_ldev(mdev);
3340 3341 3342
					goto disconnect;
				}
			}
3343
		}
P
Philipp Reisner 已提交
3344

3345
		if (verify_tfm || csums_tfm) {
3346 3347
			new_net_conf = kzalloc(sizeof(struct net_conf), GFP_KERNEL);
			if (!new_net_conf) {
3348 3349 3350 3351
				dev_err(DEV, "Allocation of new net_conf failed\n");
				goto disconnect;
			}

3352
			*new_net_conf = *old_net_conf;
3353 3354

			if (verify_tfm) {
3355 3356
				strcpy(new_net_conf->verify_alg, p->verify_alg);
				new_net_conf->verify_alg_len = strlen(p->verify_alg) + 1;
3357 3358 3359 3360 3361
				crypto_free_hash(mdev->tconn->verify_tfm);
				mdev->tconn->verify_tfm = verify_tfm;
				dev_info(DEV, "using verify-alg: \"%s\"\n", p->verify_alg);
			}
			if (csums_tfm) {
3362 3363
				strcpy(new_net_conf->csums_alg, p->csums_alg);
				new_net_conf->csums_alg_len = strlen(p->csums_alg) + 1;
3364 3365 3366 3367
				crypto_free_hash(mdev->tconn->csums_tfm);
				mdev->tconn->csums_tfm = csums_tfm;
				dev_info(DEV, "using csums-alg: \"%s\"\n", p->csums_alg);
			}
3368
			rcu_assign_pointer(tconn->net_conf, new_net_conf);
P
Philipp Reisner 已提交
3369
		}
P
Philipp Reisner 已提交
3370
	}
3371

P
Philipp Reisner 已提交
3372 3373 3374 3375 3376 3377 3378 3379
	if (new_disk_conf) {
		rcu_assign_pointer(mdev->ldev->disk_conf, new_disk_conf);
		put_ldev(mdev);
	}

	if (new_plan) {
		old_plan = mdev->rs_plan_s;
		rcu_assign_pointer(mdev->rs_plan_s, new_plan);
P
Philipp Reisner 已提交
3380
	}
P
Philipp Reisner 已提交
3381 3382 3383 3384 3385 3386

	mutex_unlock(&mdev->tconn->conf_update);
	synchronize_rcu();
	if (new_net_conf)
		kfree(old_net_conf);
	kfree(old_disk_conf);
P
Philipp Reisner 已提交
3387
	kfree(old_plan);
P
Philipp Reisner 已提交
3388

3389
	return 0;
P
Philipp Reisner 已提交
3390

P
Philipp Reisner 已提交
3391 3392 3393 3394 3395 3396 3397 3398
reconnect:
	if (new_disk_conf) {
		put_ldev(mdev);
		kfree(new_disk_conf);
	}
	mutex_unlock(&mdev->tconn->conf_update);
	return -EIO;

P
Philipp Reisner 已提交
3399
disconnect:
P
Philipp Reisner 已提交
3400 3401 3402 3403 3404
	kfree(new_plan);
	if (new_disk_conf) {
		put_ldev(mdev);
		kfree(new_disk_conf);
	}
3405
	mutex_unlock(&mdev->tconn->conf_update);
P
Philipp Reisner 已提交
3406 3407 3408 3409 3410
	/* just for completeness: actually not needed,
	 * as this is not reached if csums_tfm was ok. */
	crypto_free_hash(csums_tfm);
	/* but free the verify_tfm again, if csums_tfm did not work out */
	crypto_free_hash(verify_tfm);
3411
	conn_request_state(mdev->tconn, NS(conn, C_DISCONNECTING), CS_HARD);
3412
	return -EIO;
P
Philipp Reisner 已提交
3413 3414 3415 3416 3417 3418 3419 3420 3421 3422 3423 3424 3425 3426 3427
}

/* warn if the arguments differ by more than 12.5% */
static void warn_if_differ_considerably(struct drbd_conf *mdev,
	const char *s, sector_t a, sector_t b)
{
	sector_t d;
	if (a == 0 || b == 0)
		return;
	d = (a > b) ? (a - b) : (b - a);
	if (d > (a>>3) || d > (b>>3))
		dev_warn(DEV, "Considerable difference in %s: %llus vs. %llus\n", s,
		     (unsigned long long)a, (unsigned long long)b);
}

3428
static int receive_sizes(struct drbd_tconn *tconn, struct packet_info *pi)
P
Philipp Reisner 已提交
3429
{
3430
	struct drbd_conf *mdev;
3431
	struct p_sizes *p = pi->data;
P
Philipp Reisner 已提交
3432 3433 3434
	enum determine_dev_size dd = unchanged;
	sector_t p_size, p_usize, my_usize;
	int ldsc = 0; /* local disk size changed */
3435
	enum dds_flags ddsf;
P
Philipp Reisner 已提交
3436

3437 3438 3439 3440
	mdev = vnr_to_mdev(tconn, pi->vnr);
	if (!mdev)
		return config_unknown_volume(tconn, pi);

P
Philipp Reisner 已提交
3441 3442 3443 3444 3445 3446 3447 3448
	p_size = be64_to_cpu(p->d_size);
	p_usize = be64_to_cpu(p->u_size);

	/* just store the peer's disk size for now.
	 * we still need to figure out whether we accept that. */
	mdev->p_size = p_size;

	if (get_ldev(mdev)) {
P
Philipp Reisner 已提交
3449 3450 3451 3452
		rcu_read_lock();
		my_usize = rcu_dereference(mdev->ldev->disk_conf)->disk_size;
		rcu_read_unlock();

P
Philipp Reisner 已提交
3453 3454 3455
		warn_if_differ_considerably(mdev, "lower level device sizes",
			   p_size, drbd_get_max_capacity(mdev->ldev));
		warn_if_differ_considerably(mdev, "user requested size",
P
Philipp Reisner 已提交
3456
					    p_usize, my_usize);
P
Philipp Reisner 已提交
3457 3458 3459 3460

		/* if this is the first connect, or an otherwise expected
		 * param exchange, choose the minimum */
		if (mdev->state.conn == C_WF_REPORT_PARAMS)
P
Philipp Reisner 已提交
3461
			p_usize = min_not_zero(my_usize, p_usize);
P
Philipp Reisner 已提交
3462 3463 3464

		/* Never shrink a device with usable data during connect.
		   But allow online shrinking if we are connected. */
3465
		if (drbd_new_dev_size(mdev, mdev->ldev, p_usize, 0) <
P
Philipp Reisner 已提交
3466 3467 3468
		    drbd_get_capacity(mdev->this_bdev) &&
		    mdev->state.disk >= D_OUTDATED &&
		    mdev->state.conn < C_CONNECTED) {
P
Philipp Reisner 已提交
3469
			dev_err(DEV, "The peer's disk size is too small!\n");
3470
			conn_request_state(mdev->tconn, NS(conn, C_DISCONNECTING), CS_HARD);
P
Philipp Reisner 已提交
3471
			put_ldev(mdev);
3472
			return -EIO;
P
Philipp Reisner 已提交
3473
		}
P
Philipp Reisner 已提交
3474 3475 3476 3477 3478 3479 3480 3481 3482 3483 3484 3485 3486 3487 3488 3489 3490 3491 3492 3493 3494 3495 3496 3497 3498

		if (my_usize != p_usize) {
			struct disk_conf *old_disk_conf, *new_disk_conf = NULL;

			new_disk_conf = kzalloc(sizeof(struct disk_conf), GFP_KERNEL);
			if (!new_disk_conf) {
				dev_err(DEV, "Allocation of new disk_conf failed\n");
				put_ldev(mdev);
				return -ENOMEM;
			}

			mutex_lock(&mdev->tconn->conf_update);
			old_disk_conf = mdev->ldev->disk_conf;
			*new_disk_conf = *old_disk_conf;
			new_disk_conf->disk_size = p_usize;

			rcu_assign_pointer(mdev->ldev->disk_conf, new_disk_conf);
			mutex_unlock(&mdev->tconn->conf_update);
			synchronize_rcu();
			kfree(old_disk_conf);

			dev_info(DEV, "Peer sets u_size to %lu sectors\n",
				 (unsigned long)my_usize);
		}

P
Philipp Reisner 已提交
3499 3500 3501
		put_ldev(mdev);
	}

3502
	ddsf = be16_to_cpu(p->dds_flags);
P
Philipp Reisner 已提交
3503
	if (get_ldev(mdev)) {
B
Bart Van Assche 已提交
3504
		dd = drbd_determine_dev_size(mdev, ddsf);
P
Philipp Reisner 已提交
3505 3506
		put_ldev(mdev);
		if (dd == dev_size_error)
3507
			return -EIO;
P
Philipp Reisner 已提交
3508 3509 3510 3511 3512 3513
		drbd_md_sync(mdev);
	} else {
		/* I am diskless, need to accept the peer's size. */
		drbd_set_my_capacity(mdev, p_size);
	}

3514 3515 3516
	mdev->peer_max_bio_size = be32_to_cpu(p->max_bio_size);
	drbd_reconsider_max_bio_size(mdev);

P
Philipp Reisner 已提交
3517 3518 3519 3520 3521 3522 3523 3524 3525 3526 3527 3528 3529 3530
	if (get_ldev(mdev)) {
		if (mdev->ldev->known_size != drbd_get_capacity(mdev->ldev->backing_bdev)) {
			mdev->ldev->known_size = drbd_get_capacity(mdev->ldev->backing_bdev);
			ldsc = 1;
		}

		put_ldev(mdev);
	}

	if (mdev->state.conn > C_WF_REPORT_PARAMS) {
		if (be64_to_cpu(p->c_size) !=
		    drbd_get_capacity(mdev->this_bdev) || ldsc) {
			/* we have different sizes, probably peer
			 * needs to know my new size... */
3531
			drbd_send_sizes(mdev, 0, ddsf);
P
Philipp Reisner 已提交
3532 3533 3534 3535
		}
		if (test_and_clear_bit(RESIZE_PENDING, &mdev->flags) ||
		    (dd == grew && mdev->state.conn == C_CONNECTED)) {
			if (mdev->state.pdsk >= D_INCONSISTENT &&
3536 3537 3538 3539 3540 3541
			    mdev->state.disk >= D_INCONSISTENT) {
				if (ddsf & DDSF_NO_RESYNC)
					dev_info(DEV, "Resync of new storage suppressed with --assume-clean\n");
				else
					resync_after_online_grow(mdev);
			} else
P
Philipp Reisner 已提交
3542 3543 3544 3545
				set_bit(RESYNC_AFTER_NEG, &mdev->flags);
		}
	}

3546
	return 0;
P
Philipp Reisner 已提交
3547 3548
}

3549
static int receive_uuids(struct drbd_tconn *tconn, struct packet_info *pi)
P
Philipp Reisner 已提交
3550
{
3551
	struct drbd_conf *mdev;
3552
	struct p_uuids *p = pi->data;
P
Philipp Reisner 已提交
3553
	u64 *p_uuid;
3554
	int i, updated_uuids = 0;
P
Philipp Reisner 已提交
3555

3556 3557 3558 3559
	mdev = vnr_to_mdev(tconn, pi->vnr);
	if (!mdev)
		return config_unknown_volume(tconn, pi);

P
Philipp Reisner 已提交
3560 3561 3562 3563 3564 3565 3566 3567 3568 3569 3570 3571 3572 3573
	p_uuid = kmalloc(sizeof(u64)*UI_EXTENDED_SIZE, GFP_NOIO);

	for (i = UI_CURRENT; i < UI_EXTENDED_SIZE; i++)
		p_uuid[i] = be64_to_cpu(p->uuid[i]);

	kfree(mdev->p_uuid);
	mdev->p_uuid = p_uuid;

	if (mdev->state.conn < C_CONNECTED &&
	    mdev->state.disk < D_INCONSISTENT &&
	    mdev->state.role == R_PRIMARY &&
	    (mdev->ed_uuid & ~((u64)1)) != (p_uuid[UI_CURRENT] & ~((u64)1))) {
		dev_err(DEV, "Can only connect to data with current UUID=%016llX\n",
		    (unsigned long long)mdev->ed_uuid);
3574
		conn_request_state(mdev->tconn, NS(conn, C_DISCONNECTING), CS_HARD);
3575
		return -EIO;
P
Philipp Reisner 已提交
3576 3577 3578 3579 3580
	}

	if (get_ldev(mdev)) {
		int skip_initial_sync =
			mdev->state.conn == C_CONNECTED &&
3581
			mdev->tconn->agreed_pro_version >= 90 &&
P
Philipp Reisner 已提交
3582 3583 3584 3585 3586
			mdev->ldev->md.uuid[UI_CURRENT] == UUID_JUST_CREATED &&
			(p_uuid[UI_FLAGS] & 8);
		if (skip_initial_sync) {
			dev_info(DEV, "Accepted new current UUID, preparing to skip initial sync\n");
			drbd_bitmap_io(mdev, &drbd_bmio_clear_n_write,
3587 3588
					"clear_n_write from receive_uuids",
					BM_LOCKED_TEST_ALLOWED);
P
Philipp Reisner 已提交
3589 3590 3591 3592 3593
			_drbd_uuid_set(mdev, UI_CURRENT, p_uuid[UI_CURRENT]);
			_drbd_uuid_set(mdev, UI_BITMAP, 0);
			_drbd_set_state(_NS2(mdev, disk, D_UP_TO_DATE, pdsk, D_UP_TO_DATE),
					CS_VERBOSE, NULL);
			drbd_md_sync(mdev);
3594
			updated_uuids = 1;
P
Philipp Reisner 已提交
3595 3596
		}
		put_ldev(mdev);
3597 3598 3599 3600
	} else if (mdev->state.disk < D_INCONSISTENT &&
		   mdev->state.role == R_PRIMARY) {
		/* I am a diskless primary, the peer just created a new current UUID
		   for me. */
3601
		updated_uuids = drbd_set_ed_uuid(mdev, p_uuid[UI_CURRENT]);
P
Philipp Reisner 已提交
3602 3603 3604 3605 3606 3607
	}

	/* Before we test for the disk state, we should wait until an eventually
	   ongoing cluster wide state change is finished. That is important if
	   we are primary and are detaching from our disk. We need to see the
	   new disk state... */
3608 3609
	mutex_lock(mdev->state_mutex);
	mutex_unlock(mdev->state_mutex);
P
Philipp Reisner 已提交
3610
	if (mdev->state.conn >= C_CONNECTED && mdev->state.disk < D_INCONSISTENT)
3611 3612 3613 3614
		updated_uuids |= drbd_set_ed_uuid(mdev, p_uuid[UI_CURRENT]);

	if (updated_uuids)
		drbd_print_uuids(mdev, "receiver updated UUIDs to");
P
Philipp Reisner 已提交
3615

3616
	return 0;
P
Philipp Reisner 已提交
3617 3618 3619 3620 3621 3622 3623 3624 3625 3626 3627
}

/**
 * convert_state() - Converts the peer's view of the cluster state to our point of view
 * @ps:		The state as seen by the peer.
 */
static union drbd_state convert_state(union drbd_state ps)
{
	union drbd_state ms;

	static enum drbd_conns c_tab[] = {
3628
		[C_WF_REPORT_PARAMS] = C_WF_REPORT_PARAMS,
P
Philipp Reisner 已提交
3629 3630 3631 3632 3633 3634 3635 3636 3637 3638 3639 3640 3641 3642 3643 3644 3645 3646 3647 3648 3649
		[C_CONNECTED] = C_CONNECTED,

		[C_STARTING_SYNC_S] = C_STARTING_SYNC_T,
		[C_STARTING_SYNC_T] = C_STARTING_SYNC_S,
		[C_DISCONNECTING] = C_TEAR_DOWN, /* C_NETWORK_FAILURE, */
		[C_VERIFY_S]       = C_VERIFY_T,
		[C_MASK]   = C_MASK,
	};

	ms.i = ps.i;

	ms.conn = c_tab[ps.conn];
	ms.peer = ps.role;
	ms.role = ps.peer;
	ms.pdsk = ps.disk;
	ms.disk = ps.pdsk;
	ms.peer_isp = (ps.aftr_isp | ps.user_isp);

	return ms;
}

3650
static int receive_req_state(struct drbd_tconn *tconn, struct packet_info *pi)
P
Philipp Reisner 已提交
3651
{
3652
	struct drbd_conf *mdev;
3653
	struct p_req_state *p = pi->data;
P
Philipp Reisner 已提交
3654
	union drbd_state mask, val;
3655
	enum drbd_state_rv rv;
P
Philipp Reisner 已提交
3656

3657 3658 3659 3660
	mdev = vnr_to_mdev(tconn, pi->vnr);
	if (!mdev)
		return -EIO;

P
Philipp Reisner 已提交
3661 3662 3663
	mask.i = be32_to_cpu(p->mask);
	val.i = be32_to_cpu(p->val);

3664
	if (test_bit(DISCARD_CONCURRENT, &mdev->tconn->flags) &&
3665
	    mutex_is_locked(mdev->state_mutex)) {
P
Philipp Reisner 已提交
3666
		drbd_send_sr_reply(mdev, SS_CONCURRENT_ST_CHG);
3667
		return 0;
P
Philipp Reisner 已提交
3668 3669 3670 3671 3672
	}

	mask = convert_state(mask);
	val = convert_state(val);

3673 3674
	rv = drbd_change_state(mdev, CS_VERBOSE, mask, val);
	drbd_send_sr_reply(mdev, rv);
P
Philipp Reisner 已提交
3675 3676 3677

	drbd_md_sync(mdev);

3678
	return 0;
P
Philipp Reisner 已提交
3679 3680
}

3681
static int receive_req_conn_state(struct drbd_tconn *tconn, struct packet_info *pi)
3682
{
3683
	struct p_req_state *p = pi->data;
3684 3685 3686 3687 3688 3689 3690 3691 3692
	union drbd_state mask, val;
	enum drbd_state_rv rv;

	mask.i = be32_to_cpu(p->mask);
	val.i = be32_to_cpu(p->val);

	if (test_bit(DISCARD_CONCURRENT, &tconn->flags) &&
	    mutex_is_locked(&tconn->cstate_mutex)) {
		conn_send_sr_reply(tconn, SS_CONCURRENT_ST_CHG);
3693
		return 0;
3694 3695 3696 3697 3698
	}

	mask = convert_state(mask);
	val = convert_state(val);

3699
	rv = conn_request_state(tconn, mask, val, CS_VERBOSE | CS_LOCAL_ONLY | CS_IGN_OUTD_FAIL);
3700 3701
	conn_send_sr_reply(tconn, rv);

3702
	return 0;
3703 3704
}

3705
static int receive_state(struct drbd_tconn *tconn, struct packet_info *pi)
P
Philipp Reisner 已提交
3706
{
3707
	struct drbd_conf *mdev;
3708
	struct p_state *p = pi->data;
3709
	union drbd_state os, ns, peer_state;
P
Philipp Reisner 已提交
3710
	enum drbd_disk_state real_peer_disk;
3711
	enum chg_state_flags cs_flags;
P
Philipp Reisner 已提交
3712 3713
	int rv;

3714 3715 3716 3717
	mdev = vnr_to_mdev(tconn, pi->vnr);
	if (!mdev)
		return config_unknown_volume(tconn, pi);

P
Philipp Reisner 已提交
3718 3719 3720 3721 3722 3723 3724 3725
	peer_state.i = be32_to_cpu(p->state);

	real_peer_disk = peer_state.disk;
	if (peer_state.disk == D_NEGOTIATING) {
		real_peer_disk = mdev->p_uuid[UI_FLAGS] & 4 ? D_INCONSISTENT : D_CONSISTENT;
		dev_info(DEV, "real peer disk state = %s\n", drbd_disk_str(real_peer_disk));
	}

3726
	spin_lock_irq(&mdev->tconn->req_lock);
P
Philipp Reisner 已提交
3727
 retry:
3728
	os = ns = drbd_read_state(mdev);
3729
	spin_unlock_irq(&mdev->tconn->req_lock);
P
Philipp Reisner 已提交
3730

3731 3732 3733 3734 3735 3736 3737 3738 3739 3740 3741 3742 3743 3744 3745 3746 3747 3748 3749 3750 3751
	/* peer says his disk is uptodate, while we think it is inconsistent,
	 * and this happens while we think we have a sync going on. */
	if (os.pdsk == D_INCONSISTENT && real_peer_disk == D_UP_TO_DATE &&
	    os.conn > C_CONNECTED && os.disk == D_UP_TO_DATE) {
		/* If we are (becoming) SyncSource, but peer is still in sync
		 * preparation, ignore its uptodate-ness to avoid flapping, it
		 * will change to inconsistent once the peer reaches active
		 * syncing states.
		 * It may have changed syncer-paused flags, however, so we
		 * cannot ignore this completely. */
		if (peer_state.conn > C_CONNECTED &&
		    peer_state.conn < C_SYNC_SOURCE)
			real_peer_disk = D_INCONSISTENT;

		/* if peer_state changes to connected at the same time,
		 * it explicitly notifies us that it finished resync.
		 * Maybe we should finish it up, too? */
		else if (os.conn >= C_SYNC_SOURCE &&
			 peer_state.conn == C_CONNECTED) {
			if (drbd_bm_total_weight(mdev) <= mdev->rs_failed)
				drbd_resync_finished(mdev);
3752
			return 0;
3753 3754 3755 3756 3757 3758 3759 3760 3761 3762 3763 3764
		}
	}

	/* peer says his disk is inconsistent, while we think it is uptodate,
	 * and this happens while the peer still thinks we have a sync going on,
	 * but we think we are already done with the sync.
	 * We ignore this to avoid flapping pdsk.
	 * This should not happen, if the peer is a recent version of drbd. */
	if (os.pdsk == D_UP_TO_DATE && real_peer_disk == D_INCONSISTENT &&
	    os.conn == C_CONNECTED && peer_state.conn > C_SYNC_SOURCE)
		real_peer_disk = D_UP_TO_DATE;

3765 3766
	if (ns.conn == C_WF_REPORT_PARAMS)
		ns.conn = C_CONNECTED;
P
Philipp Reisner 已提交
3767

3768 3769 3770
	if (peer_state.conn == C_AHEAD)
		ns.conn = C_BEHIND;

P
Philipp Reisner 已提交
3771 3772 3773 3774 3775
	if (mdev->p_uuid && peer_state.disk >= D_NEGOTIATING &&
	    get_ldev_if_state(mdev, D_NEGOTIATING)) {
		int cr; /* consider resync */

		/* if we established a new connection */
3776
		cr  = (os.conn < C_CONNECTED);
P
Philipp Reisner 已提交
3777 3778
		/* if we had an established connection
		 * and one of the nodes newly attaches a disk */
3779
		cr |= (os.conn == C_CONNECTED &&
P
Philipp Reisner 已提交
3780
		       (peer_state.disk == D_NEGOTIATING ||
3781
			os.disk == D_NEGOTIATING));
P
Philipp Reisner 已提交
3782 3783 3784 3785 3786
		/* if we have both been inconsistent, and the peer has been
		 * forced to be UpToDate with --overwrite-data */
		cr |= test_bit(CONSIDER_RESYNC, &mdev->flags);
		/* if we had been plain connected, and the admin requested to
		 * start a sync by "invalidate" or "invalidate-remote" */
3787
		cr |= (os.conn == C_CONNECTED &&
P
Philipp Reisner 已提交
3788 3789 3790 3791
				(peer_state.conn >= C_STARTING_SYNC_S &&
				 peer_state.conn <= C_WF_BITMAP_T));

		if (cr)
3792
			ns.conn = drbd_sync_handshake(mdev, peer_state.role, real_peer_disk);
P
Philipp Reisner 已提交
3793 3794

		put_ldev(mdev);
3795 3796
		if (ns.conn == C_MASK) {
			ns.conn = C_CONNECTED;
P
Philipp Reisner 已提交
3797
			if (mdev->state.disk == D_NEGOTIATING) {
3798
				drbd_force_state(mdev, NS(disk, D_FAILED));
P
Philipp Reisner 已提交
3799 3800 3801
			} else if (peer_state.disk == D_NEGOTIATING) {
				dev_err(DEV, "Disk attach process on the peer node was aborted.\n");
				peer_state.disk = D_DISKLESS;
3802
				real_peer_disk = D_DISKLESS;
P
Philipp Reisner 已提交
3803
			} else {
3804
				if (test_and_clear_bit(CONN_DRY_RUN, &mdev->tconn->flags))
3805
					return -EIO;
3806
				D_ASSERT(os.conn == C_WF_REPORT_PARAMS);
3807
				conn_request_state(mdev->tconn, NS(conn, C_DISCONNECTING), CS_HARD);
3808
				return -EIO;
P
Philipp Reisner 已提交
3809 3810 3811 3812
			}
		}
	}

3813
	spin_lock_irq(&mdev->tconn->req_lock);
3814
	if (os.i != drbd_read_state(mdev).i)
P
Philipp Reisner 已提交
3815 3816 3817 3818 3819
		goto retry;
	clear_bit(CONSIDER_RESYNC, &mdev->flags);
	ns.peer = peer_state.role;
	ns.pdsk = real_peer_disk;
	ns.peer_isp = (peer_state.aftr_isp | peer_state.user_isp);
3820
	if ((ns.conn == C_CONNECTED || ns.conn == C_WF_BITMAP_S) && ns.disk == D_NEGOTIATING)
P
Philipp Reisner 已提交
3821
		ns.disk = mdev->new_state_tmp.disk;
3822
	cs_flags = CS_VERBOSE + (os.conn < C_CONNECTED && ns.conn >= C_CONNECTED ? 0 : CS_HARD);
3823
	if (ns.pdsk == D_CONSISTENT && drbd_suspended(mdev) && ns.conn == C_CONNECTED && os.conn < C_CONNECTED &&
3824
	    test_bit(NEW_CUR_UUID, &mdev->flags)) {
3825
		/* Do not allow tl_restart(RESEND) for a rebooted peer. We can only allow this
3826
		   for temporal network outages! */
3827
		spin_unlock_irq(&mdev->tconn->req_lock);
3828
		dev_err(DEV, "Aborting Connect, can not thaw IO with an only Consistent peer\n");
3829
		tl_clear(mdev->tconn);
3830 3831
		drbd_uuid_new_current(mdev);
		clear_bit(NEW_CUR_UUID, &mdev->flags);
3832
		conn_request_state(mdev->tconn, NS2(conn, C_PROTOCOL_ERROR, susp, 0), CS_HARD);
3833
		return -EIO;
3834
	}
3835
	rv = _drbd_set_state(mdev, ns, cs_flags, NULL);
3836
	ns = drbd_read_state(mdev);
3837
	spin_unlock_irq(&mdev->tconn->req_lock);
P
Philipp Reisner 已提交
3838 3839

	if (rv < SS_SUCCESS) {
3840
		conn_request_state(mdev->tconn, NS(conn, C_DISCONNECTING), CS_HARD);
3841
		return -EIO;
P
Philipp Reisner 已提交
3842 3843
	}

3844 3845
	if (os.conn > C_WF_REPORT_PARAMS) {
		if (ns.conn > C_CONNECTED && peer_state.conn <= C_CONNECTED &&
P
Philipp Reisner 已提交
3846 3847 3848 3849 3850 3851 3852 3853 3854
		    peer_state.disk != D_NEGOTIATING ) {
			/* we want resync, peer has not yet decided to sync... */
			/* Nowadays only used when forcing a node into primary role and
			   setting its disk to UpToDate with that */
			drbd_send_uuids(mdev);
			drbd_send_state(mdev);
		}
	}

3855
	mutex_lock(&mdev->tconn->conf_update);
3856
	mdev->tconn->net_conf->discard_my_data = 0; /* without copy; single bit op is atomic */
3857
	mutex_unlock(&mdev->tconn->conf_update);
P
Philipp Reisner 已提交
3858 3859 3860

	drbd_md_sync(mdev); /* update connected indicator, la_size, ... */

3861
	return 0;
P
Philipp Reisner 已提交
3862 3863
}

3864
static int receive_sync_uuid(struct drbd_tconn *tconn, struct packet_info *pi)
P
Philipp Reisner 已提交
3865
{
3866
	struct drbd_conf *mdev;
3867
	struct p_rs_uuid *p = pi->data;
3868 3869 3870 3871

	mdev = vnr_to_mdev(tconn, pi->vnr);
	if (!mdev)
		return -EIO;
P
Philipp Reisner 已提交
3872 3873 3874

	wait_event(mdev->misc_wait,
		   mdev->state.conn == C_WF_SYNC_UUID ||
3875
		   mdev->state.conn == C_BEHIND ||
P
Philipp Reisner 已提交
3876 3877 3878 3879 3880 3881 3882 3883 3884 3885 3886
		   mdev->state.conn < C_CONNECTED ||
		   mdev->state.disk < D_NEGOTIATING);

	/* D_ASSERT( mdev->state.conn == C_WF_SYNC_UUID ); */

	/* Here the _drbd_uuid_ functions are right, current should
	   _not_ be rotated into the history */
	if (get_ldev_if_state(mdev, D_NEGOTIATING)) {
		_drbd_uuid_set(mdev, UI_CURRENT, be64_to_cpu(p->uuid));
		_drbd_uuid_set(mdev, UI_BITMAP, 0UL);

3887
		drbd_print_uuids(mdev, "updated sync uuid");
P
Philipp Reisner 已提交
3888 3889 3890 3891 3892 3893
		drbd_start_resync(mdev, C_SYNC_TARGET);

		put_ldev(mdev);
	} else
		dev_err(DEV, "Ignoring SyncUUID packet!\n");

3894
	return 0;
P
Philipp Reisner 已提交
3895 3896
}

3897 3898 3899 3900 3901 3902 3903
/**
 * receive_bitmap_plain
 *
 * Return 0 when done, 1 when another iteration is needed, and a negative error
 * code upon failure.
 */
static int
3904
receive_bitmap_plain(struct drbd_conf *mdev, unsigned int size,
3905
		     unsigned long *p, struct bm_xfer_ctx *c)
P
Philipp Reisner 已提交
3906
{
3907 3908
	unsigned int data_size = DRBD_SOCKET_BUFFER_SIZE -
				 drbd_header_size(mdev->tconn);
3909
	unsigned int num_words = min_t(size_t, data_size / sizeof(*p),
3910
				       c->bm_words - c->word_offset);
3911
	unsigned int want = num_words * sizeof(*p);
3912
	int err;
P
Philipp Reisner 已提交
3913

3914 3915
	if (want != size) {
		dev_err(DEV, "%s:want (%u) != size (%u)\n", __func__, want, size);
3916
		return -EIO;
P
Philipp Reisner 已提交
3917 3918
	}
	if (want == 0)
3919
		return 0;
3920
	err = drbd_recv_all(mdev->tconn, p, want);
3921
	if (err)
3922
		return err;
P
Philipp Reisner 已提交
3923

3924
	drbd_bm_merge_lel(mdev, c->word_offset, num_words, p);
P
Philipp Reisner 已提交
3925 3926 3927 3928 3929 3930

	c->word_offset += num_words;
	c->bit_offset = c->word_offset * BITS_PER_LONG;
	if (c->bit_offset > c->bm_bits)
		c->bit_offset = c->bm_bits;

3931
	return 1;
P
Philipp Reisner 已提交
3932 3933
}

3934 3935 3936 3937 3938 3939 3940 3941 3942 3943 3944 3945 3946 3947 3948
static enum drbd_bitmap_code dcbp_get_code(struct p_compressed_bm *p)
{
	return (enum drbd_bitmap_code)(p->encoding & 0x0f);
}

static int dcbp_get_start(struct p_compressed_bm *p)
{
	return (p->encoding & 0x80) != 0;
}

static int dcbp_get_pad_bits(struct p_compressed_bm *p)
{
	return (p->encoding >> 4) & 0x7;
}

3949 3950 3951 3952 3953 3954 3955
/**
 * recv_bm_rle_bits
 *
 * Return 0 when done, 1 when another iteration is needed, and a negative error
 * code upon failure.
 */
static int
P
Philipp Reisner 已提交
3956 3957
recv_bm_rle_bits(struct drbd_conf *mdev,
		struct p_compressed_bm *p,
3958 3959
		 struct bm_xfer_ctx *c,
		 unsigned int len)
P
Philipp Reisner 已提交
3960 3961 3962 3963 3964 3965 3966
{
	struct bitstream bs;
	u64 look_ahead;
	u64 rl;
	u64 tmp;
	unsigned long s = c->bit_offset;
	unsigned long e;
3967
	int toggle = dcbp_get_start(p);
P
Philipp Reisner 已提交
3968 3969 3970
	int have;
	int bits;

3971
	bitstream_init(&bs, p->code, len, dcbp_get_pad_bits(p));
P
Philipp Reisner 已提交
3972 3973 3974

	bits = bitstream_get_bits(&bs, &look_ahead, 64);
	if (bits < 0)
3975
		return -EIO;
P
Philipp Reisner 已提交
3976 3977 3978 3979

	for (have = bits; have > 0; s += rl, toggle = !toggle) {
		bits = vli_decode_bits(&rl, look_ahead);
		if (bits <= 0)
3980
			return -EIO;
P
Philipp Reisner 已提交
3981 3982 3983 3984 3985

		if (toggle) {
			e = s + rl -1;
			if (e >= c->bm_bits) {
				dev_err(DEV, "bitmap overflow (e:%lu) while decoding bm RLE packet\n", e);
3986
				return -EIO;
P
Philipp Reisner 已提交
3987 3988 3989 3990 3991 3992 3993 3994 3995
			}
			_drbd_bm_set_bits(mdev, s, e);
		}

		if (have < bits) {
			dev_err(DEV, "bitmap decoding error: h:%d b:%d la:0x%08llx l:%u/%u\n",
				have, bits, look_ahead,
				(unsigned int)(bs.cur.b - p->code),
				(unsigned int)bs.buf_len);
3996
			return -EIO;
P
Philipp Reisner 已提交
3997 3998 3999 4000 4001 4002
		}
		look_ahead >>= bits;
		have -= bits;

		bits = bitstream_get_bits(&bs, &tmp, 64 - have);
		if (bits < 0)
4003
			return -EIO;
P
Philipp Reisner 已提交
4004 4005 4006 4007 4008 4009 4010
		look_ahead |= tmp << have;
		have += bits;
	}

	c->bit_offset = s;
	bm_xfer_ctx_bit_to_word_offset(c);

4011
	return (s != c->bm_bits);
P
Philipp Reisner 已提交
4012 4013
}

4014 4015 4016 4017 4018 4019 4020
/**
 * decode_bitmap_c
 *
 * Return 0 when done, 1 when another iteration is needed, and a negative error
 * code upon failure.
 */
static int
P
Philipp Reisner 已提交
4021 4022
decode_bitmap_c(struct drbd_conf *mdev,
		struct p_compressed_bm *p,
4023 4024
		struct bm_xfer_ctx *c,
		unsigned int len)
P
Philipp Reisner 已提交
4025
{
4026
	if (dcbp_get_code(p) == RLE_VLI_Bits)
4027
		return recv_bm_rle_bits(mdev, p, c, len - sizeof(*p));
P
Philipp Reisner 已提交
4028 4029 4030 4031 4032 4033

	/* other variants had been implemented for evaluation,
	 * but have been dropped as this one turned out to be "best"
	 * during all our tests. */

	dev_err(DEV, "receive_bitmap_c: unknown encoding %u\n", p->encoding);
4034
	conn_request_state(mdev->tconn, NS(conn, C_PROTOCOL_ERROR), CS_HARD);
4035
	return -EIO;
P
Philipp Reisner 已提交
4036 4037 4038 4039 4040 4041
}

void INFO_bm_xfer_stats(struct drbd_conf *mdev,
		const char *direction, struct bm_xfer_ctx *c)
{
	/* what would it take to transfer it "plaintext" */
4042 4043 4044 4045 4046 4047 4048
	unsigned int header_size = drbd_header_size(mdev->tconn);
	unsigned int data_size = DRBD_SOCKET_BUFFER_SIZE - header_size;
	unsigned int plain =
		header_size * (DIV_ROUND_UP(c->bm_words, data_size) + 1) +
		c->bm_words * sizeof(unsigned long);
	unsigned int total = c->bytes[0] + c->bytes[1];
	unsigned int r;
P
Philipp Reisner 已提交
4049 4050 4051 4052 4053 4054 4055 4056 4057 4058 4059 4060 4061 4062 4063 4064 4065 4066 4067 4068 4069 4070 4071 4072 4073 4074 4075 4076 4077 4078 4079 4080 4081

	/* total can not be zero. but just in case: */
	if (total == 0)
		return;

	/* don't report if not compressed */
	if (total >= plain)
		return;

	/* total < plain. check for overflow, still */
	r = (total > UINT_MAX/1000) ? (total / (plain/1000))
		                    : (1000 * total / plain);

	if (r > 1000)
		r = 1000;

	r = 1000 - r;
	dev_info(DEV, "%s bitmap stats [Bytes(packets)]: plain %u(%u), RLE %u(%u), "
	     "total %u; compression: %u.%u%%\n",
			direction,
			c->bytes[1], c->packets[1],
			c->bytes[0], c->packets[0],
			total, r/10, r % 10);
}

/* Since we are processing the bitfield from lower addresses to higher,
   it does not matter if the process it in 32 bit chunks or 64 bit
   chunks as long as it is little endian. (Understand it as byte stream,
   beginning with the lowest byte...) If we would use big endian
   we would need to process it from the highest address to the lowest,
   in order to be agnostic to the 32 vs 64 bits issue.

   returns 0 on failure, 1 if we successfully received it. */
4082
static int receive_bitmap(struct drbd_tconn *tconn, struct packet_info *pi)
P
Philipp Reisner 已提交
4083
{
4084
	struct drbd_conf *mdev;
P
Philipp Reisner 已提交
4085
	struct bm_xfer_ctx c;
4086
	int err;
4087 4088 4089 4090

	mdev = vnr_to_mdev(tconn, pi->vnr);
	if (!mdev)
		return -EIO;
P
Philipp Reisner 已提交
4091

4092 4093 4094
	drbd_bm_lock(mdev, "receive bitmap", BM_LOCKED_SET_ALLOWED);
	/* you are supposed to send additional out-of-sync information
	 * if you actually set bits during this phase */
P
Philipp Reisner 已提交
4095 4096 4097 4098 4099 4100

	c = (struct bm_xfer_ctx) {
		.bm_bits = drbd_bm_bits(mdev),
		.bm_words = drbd_bm_words(mdev),
	};

4101
	for(;;) {
4102 4103 4104
		if (pi->cmd == P_BITMAP)
			err = receive_bitmap_plain(mdev, pi->size, pi->data, &c);
		else if (pi->cmd == P_COMPRESSED_BITMAP) {
P
Philipp Reisner 已提交
4105 4106
			/* MAYBE: sanity check that we speak proto >= 90,
			 * and the feature is enabled! */
4107
			struct p_compressed_bm *p = pi->data;
P
Philipp Reisner 已提交
4108

4109
			if (pi->size > DRBD_SOCKET_BUFFER_SIZE - drbd_header_size(tconn)) {
P
Philipp Reisner 已提交
4110
				dev_err(DEV, "ReportCBitmap packet too large\n");
4111
				err = -EIO;
P
Philipp Reisner 已提交
4112 4113
				goto out;
			}
4114
			if (pi->size <= sizeof(*p)) {
4115
				dev_err(DEV, "ReportCBitmap packet too small (l:%u)\n", pi->size);
4116
				err = -EIO;
4117
				goto out;
P
Philipp Reisner 已提交
4118
			}
4119 4120 4121
			err = drbd_recv_all(mdev->tconn, p, pi->size);
			if (err)
			       goto out;
4122
			err = decode_bitmap_c(mdev, p, &c, pi->size);
P
Philipp Reisner 已提交
4123
		} else {
4124
			dev_warn(DEV, "receive_bitmap: cmd neither ReportBitMap nor ReportCBitMap (is 0x%x)", pi->cmd);
4125
			err = -EIO;
P
Philipp Reisner 已提交
4126 4127 4128
			goto out;
		}

4129
		c.packets[pi->cmd == P_BITMAP]++;
4130
		c.bytes[pi->cmd == P_BITMAP] += drbd_header_size(tconn) + pi->size;
P
Philipp Reisner 已提交
4131

4132 4133 4134
		if (err <= 0) {
			if (err < 0)
				goto out;
P
Philipp Reisner 已提交
4135
			break;
4136
		}
4137
		err = drbd_recv_header(mdev->tconn, pi);
4138
		if (err)
P
Philipp Reisner 已提交
4139
			goto out;
4140
	}
P
Philipp Reisner 已提交
4141 4142 4143 4144

	INFO_bm_xfer_stats(mdev, "receive", &c);

	if (mdev->state.conn == C_WF_BITMAP_T) {
4145 4146
		enum drbd_state_rv rv;

4147 4148
		err = drbd_send_bitmap(mdev);
		if (err)
P
Philipp Reisner 已提交
4149 4150
			goto out;
		/* Omit CS_ORDERED with this state transition to avoid deadlocks. */
4151 4152
		rv = _drbd_request_state(mdev, NS(conn, C_WF_SYNC_UUID), CS_VERBOSE);
		D_ASSERT(rv == SS_SUCCESS);
P
Philipp Reisner 已提交
4153 4154 4155 4156 4157 4158
	} else if (mdev->state.conn != C_WF_BITMAP_S) {
		/* admin may have requested C_DISCONNECTING,
		 * other threads may have noticed network errors */
		dev_info(DEV, "unexpected cstate (%s) in receive_bitmap\n",
		    drbd_conn_str(mdev->state.conn));
	}
4159
	err = 0;
P
Philipp Reisner 已提交
4160 4161

 out:
4162
	drbd_bm_unlock(mdev);
4163
	if (!err && mdev->state.conn == C_WF_BITMAP_S)
P
Philipp Reisner 已提交
4164
		drbd_start_resync(mdev, C_SYNC_SOURCE);
4165
	return err;
P
Philipp Reisner 已提交
4166 4167
}

4168
static int receive_skip(struct drbd_tconn *tconn, struct packet_info *pi)
P
Philipp Reisner 已提交
4169
{
4170
	conn_warn(tconn, "skipping unknown optional packet type %d, l: %d!\n",
4171
		 pi->cmd, pi->size);
4172

4173
	return ignore_remaining_packet(tconn, pi);
4174 4175
}

4176
static int receive_UnplugRemote(struct drbd_tconn *tconn, struct packet_info *pi)
4177
{
4178 4179
	/* Make sure we've acked all the TCP data associated
	 * with the data requests being unplugged */
4180
	drbd_tcp_quickack(tconn->data.socket);
4181

4182
	return 0;
4183 4184
}

4185
static int receive_out_of_sync(struct drbd_tconn *tconn, struct packet_info *pi)
4186
{
4187
	struct drbd_conf *mdev;
4188
	struct p_block_desc *p = pi->data;
4189 4190 4191 4192

	mdev = vnr_to_mdev(tconn, pi->vnr);
	if (!mdev)
		return -EIO;
4193

4194 4195 4196 4197 4198 4199 4200 4201 4202 4203
	switch (mdev->state.conn) {
	case C_WF_SYNC_UUID:
	case C_WF_BITMAP_T:
	case C_BEHIND:
			break;
	default:
		dev_err(DEV, "ASSERT FAILED cstate = %s, expected: WFSyncUUID|WFBitMapT|Behind\n",
				drbd_conn_str(mdev->state.conn));
	}

4204 4205
	drbd_set_out_of_sync(mdev, be64_to_cpu(p->sector), be32_to_cpu(p->blksize));

4206
	return 0;
4207 4208
}

4209 4210 4211
struct data_cmd {
	int expect_payload;
	size_t pkt_size;
4212
	int (*fn)(struct drbd_tconn *, struct packet_info *);
4213 4214 4215
};

static struct data_cmd drbd_cmd_handler[] = {
4216 4217 4218 4219
	[P_DATA]	    = { 1, sizeof(struct p_data), receive_Data },
	[P_DATA_REPLY]	    = { 1, sizeof(struct p_data), receive_DataReply },
	[P_RS_DATA_REPLY]   = { 1, sizeof(struct p_data), receive_RSDataReply } ,
	[P_BARRIER]	    = { 0, sizeof(struct p_barrier), receive_Barrier } ,
4220 4221 4222
	[P_BITMAP]	    = { 1, 0, receive_bitmap } ,
	[P_COMPRESSED_BITMAP] = { 1, 0, receive_bitmap } ,
	[P_UNPLUG_REMOTE]   = { 0, 0, receive_UnplugRemote },
4223 4224
	[P_DATA_REQUEST]    = { 0, sizeof(struct p_block_req), receive_DataRequest },
	[P_RS_DATA_REQUEST] = { 0, sizeof(struct p_block_req), receive_DataRequest },
4225 4226
	[P_SYNC_PARAM]	    = { 1, 0, receive_SyncParam },
	[P_SYNC_PARAM89]    = { 1, 0, receive_SyncParam },
4227 4228 4229 4230 4231 4232 4233 4234 4235 4236 4237 4238
	[P_PROTOCOL]        = { 1, sizeof(struct p_protocol), receive_protocol },
	[P_UUIDS]	    = { 0, sizeof(struct p_uuids), receive_uuids },
	[P_SIZES]	    = { 0, sizeof(struct p_sizes), receive_sizes },
	[P_STATE]	    = { 0, sizeof(struct p_state), receive_state },
	[P_STATE_CHG_REQ]   = { 0, sizeof(struct p_req_state), receive_req_state },
	[P_SYNC_UUID]       = { 0, sizeof(struct p_rs_uuid), receive_sync_uuid },
	[P_OV_REQUEST]      = { 0, sizeof(struct p_block_req), receive_DataRequest },
	[P_OV_REPLY]        = { 1, sizeof(struct p_block_req), receive_DataRequest },
	[P_CSUM_RS_REQUEST] = { 1, sizeof(struct p_block_req), receive_DataRequest },
	[P_DELAY_PROBE]     = { 0, sizeof(struct p_delay_probe93), receive_skip },
	[P_OUT_OF_SYNC]     = { 0, sizeof(struct p_block_desc), receive_out_of_sync },
	[P_CONN_ST_CHG_REQ] = { 0, sizeof(struct p_req_state), receive_req_conn_state },
4239
	[P_PROTOCOL_UPDATE] = { 1, sizeof(struct p_protocol), receive_protocol },
P
Philipp Reisner 已提交
4240 4241
};

4242
static void drbdd(struct drbd_tconn *tconn)
P
Philipp Reisner 已提交
4243
{
4244
	struct packet_info pi;
4245
	size_t shs; /* sub header size */
4246
	int err;
P
Philipp Reisner 已提交
4247

4248
	while (get_t_state(&tconn->receiver) == RUNNING) {
4249 4250
		struct data_cmd *cmd;

4251
		drbd_thread_current_set_cpu(&tconn->receiver);
4252
		if (drbd_recv_header(tconn, &pi))
4253
			goto err_out;
P
Philipp Reisner 已提交
4254

4255
		cmd = &drbd_cmd_handler[pi.cmd];
4256
		if (unlikely(pi.cmd >= ARRAY_SIZE(drbd_cmd_handler) || !cmd->fn)) {
4257 4258
			conn_err(tconn, "Unexpected data packet %s (0x%04x)",
				 cmdname(pi.cmd), pi.cmd);
4259
			goto err_out;
4260
		}
P
Philipp Reisner 已提交
4261

4262 4263
		shs = cmd->pkt_size;
		if (pi.size > shs && !cmd->expect_payload) {
4264 4265
			conn_err(tconn, "No payload expected %s l:%d\n",
				 cmdname(pi.cmd), pi.size);
4266
			goto err_out;
P
Philipp Reisner 已提交
4267 4268
		}

4269
		if (shs) {
4270
			err = drbd_recv_all_warn(tconn, pi.data, shs);
4271
			if (err)
4272
				goto err_out;
4273
			pi.size -= shs;
4274 4275
		}

4276 4277
		err = cmd->fn(tconn, &pi);
		if (err) {
4278 4279
			conn_err(tconn, "error receiving %s, e: %d l: %d!\n",
				 cmdname(pi.cmd), err, pi.size);
4280
			goto err_out;
P
Philipp Reisner 已提交
4281 4282
		}
	}
4283
	return;
P
Philipp Reisner 已提交
4284

4285 4286
    err_out:
	conn_request_state(tconn, NS(conn, C_PROTOCOL_ERROR), CS_HARD);
P
Philipp Reisner 已提交
4287 4288
}

4289
void conn_flush_workqueue(struct drbd_tconn *tconn)
P
Philipp Reisner 已提交
4290 4291 4292 4293
{
	struct drbd_wq_barrier barr;

	barr.w.cb = w_prev_work_done;
4294
	barr.w.tconn = tconn;
P
Philipp Reisner 已提交
4295
	init_completion(&barr.done);
4296
	drbd_queue_work(&tconn->data.work, &barr.w);
P
Philipp Reisner 已提交
4297 4298 4299
	wait_for_completion(&barr.done);
}

4300
static void conn_disconnect(struct drbd_tconn *tconn)
P
Philipp Reisner 已提交
4301
{
P
Philipp Reisner 已提交
4302
	struct drbd_conf *mdev;
4303
	enum drbd_conns oc;
P
Philipp Reisner 已提交
4304
	int vnr, rv = SS_UNKNOWN_ERROR;
P
Philipp Reisner 已提交
4305

4306
	if (tconn->cstate == C_STANDALONE)
P
Philipp Reisner 已提交
4307 4308 4309
		return;

	/* asender does not clean up anything. it must not interfere, either */
4310 4311 4312
	drbd_thread_stop(&tconn->asender);
	drbd_free_sock(tconn);

P
Philipp Reisner 已提交
4313 4314 4315 4316 4317 4318 4319 4320 4321 4322
	rcu_read_lock();
	idr_for_each_entry(&tconn->volumes, mdev, vnr) {
		kref_get(&mdev->kref);
		rcu_read_unlock();
		drbd_disconnected(mdev);
		kref_put(&mdev->kref, &drbd_minor_destroy);
		rcu_read_lock();
	}
	rcu_read_unlock();

4323 4324
	conn_info(tconn, "Connection closed\n");

4325 4326 4327
	if (conn_highest_role(tconn) == R_PRIMARY && conn_highest_pdsk(tconn) >= D_UNKNOWN)
		conn_try_outdate_peer_async(tconn);

4328
	spin_lock_irq(&tconn->req_lock);
4329 4330 4331 4332
	oc = tconn->cstate;
	if (oc >= C_UNCONNECTED)
		rv = _conn_request_state(tconn, NS(conn, C_UNCONNECTED), CS_VERBOSE);

4333 4334
	spin_unlock_irq(&tconn->req_lock);

4335
	if (oc == C_DISCONNECTING)
4336
		conn_request_state(tconn, NS(conn, C_STANDALONE), CS_VERBOSE | CS_HARD);
4337 4338
}

P
Philipp Reisner 已提交
4339
static int drbd_disconnected(struct drbd_conf *mdev)
4340 4341 4342
{
	enum drbd_fencing_p fp;
	unsigned int i;
P
Philipp Reisner 已提交
4343

4344
	/* wait for current activity to cease. */
4345
	spin_lock_irq(&mdev->tconn->req_lock);
P
Philipp Reisner 已提交
4346 4347 4348
	_drbd_wait_ee_list_empty(mdev, &mdev->active_ee);
	_drbd_wait_ee_list_empty(mdev, &mdev->sync_ee);
	_drbd_wait_ee_list_empty(mdev, &mdev->read_ee);
4349
	spin_unlock_irq(&mdev->tconn->req_lock);
P
Philipp Reisner 已提交
4350 4351 4352 4353 4354 4355 4356 4357 4358 4359 4360 4361 4362 4363 4364 4365 4366 4367 4368 4369 4370 4371 4372

	/* We do not have data structures that would allow us to
	 * get the rs_pending_cnt down to 0 again.
	 *  * On C_SYNC_TARGET we do not have any data structures describing
	 *    the pending RSDataRequest's we have sent.
	 *  * On C_SYNC_SOURCE there is no data structure that tracks
	 *    the P_RS_DATA_REPLY blocks that we sent to the SyncTarget.
	 *  And no, it is not the sum of the reference counts in the
	 *  resync_LRU. The resync_LRU tracks the whole operation including
	 *  the disk-IO, while the rs_pending_cnt only tracks the blocks
	 *  on the fly. */
	drbd_rs_cancel_all(mdev);
	mdev->rs_total = 0;
	mdev->rs_failed = 0;
	atomic_set(&mdev->rs_pending_cnt, 0);
	wake_up(&mdev->misc_wait);

	del_timer_sync(&mdev->resync_timer);
	resync_timer_fn((unsigned long)mdev);

	/* wait for all w_e_end_data_req, w_e_end_rsdata_req, w_send_barrier,
	 * w_make_resync_request etc. which may still be on the worker queue
	 * to be "canceled" */
4373
	drbd_flush_workqueue(mdev);
P
Philipp Reisner 已提交
4374

4375
	drbd_finish_peer_reqs(mdev);
P
Philipp Reisner 已提交
4376 4377 4378 4379

	kfree(mdev->p_uuid);
	mdev->p_uuid = NULL;

4380
	if (!drbd_suspended(mdev))
4381
		tl_clear(mdev->tconn);
P
Philipp Reisner 已提交
4382 4383 4384 4385 4386

	drbd_md_sync(mdev);

	fp = FP_DONT_CARE;
	if (get_ldev(mdev)) {
P
Philipp Reisner 已提交
4387 4388 4389
		rcu_read_lock();
		fp = rcu_dereference(mdev->ldev->disk_conf)->fencing;
		rcu_read_unlock();
P
Philipp Reisner 已提交
4390 4391 4392
		put_ldev(mdev);
	}

4393 4394 4395 4396
	/* serialize with bitmap writeout triggered by the state change,
	 * if any. */
	wait_event(mdev->misc_wait, !test_bit(BITMAP_IO, &mdev->flags));

P
Philipp Reisner 已提交
4397 4398 4399 4400 4401 4402 4403
	/* tcp_close and release of sendpage pages can be deferred.  I don't
	 * want to use SO_LINGER, because apparently it can be deferred for
	 * more than 20 seconds (longest time I checked).
	 *
	 * Actually we don't care for exactly when the network stack does its
	 * put_page(), but release our reference on these pages right here.
	 */
4404
	i = drbd_free_peer_reqs(mdev, &mdev->net_ee);
P
Philipp Reisner 已提交
4405 4406
	if (i)
		dev_info(DEV, "net_ee not empty, killed %u entries\n", i);
4407 4408 4409
	i = atomic_read(&mdev->pp_in_use_by_net);
	if (i)
		dev_info(DEV, "pp_in_use_by_net = %d, expected 0\n", i);
P
Philipp Reisner 已提交
4410 4411
	i = atomic_read(&mdev->pp_in_use);
	if (i)
4412
		dev_info(DEV, "pp_in_use = %d, expected 0\n", i);
P
Philipp Reisner 已提交
4413 4414 4415 4416 4417 4418 4419 4420 4421

	D_ASSERT(list_empty(&mdev->read_ee));
	D_ASSERT(list_empty(&mdev->active_ee));
	D_ASSERT(list_empty(&mdev->sync_ee));
	D_ASSERT(list_empty(&mdev->done_ee));

	/* ok, no more ee's on the fly, it is safe to reset the epoch_size */
	atomic_set(&mdev->current_epoch->epoch_size, 0);
	D_ASSERT(list_empty(&mdev->current_epoch->list));
4422 4423

	return 0;
P
Philipp Reisner 已提交
4424 4425 4426 4427 4428 4429 4430 4431 4432 4433 4434
}

/*
 * We support PRO_VERSION_MIN to PRO_VERSION_MAX. The protocol version
 * we can agree on is stored in agreed_pro_version.
 *
 * feature flags and the reserved array should be enough room for future
 * enhancements of the handshake protocol, and possible plugins...
 *
 * for now, they are expected to be zero, but ignored.
 */
4435
static int drbd_send_features(struct drbd_tconn *tconn)
P
Philipp Reisner 已提交
4436
{
4437 4438
	struct drbd_socket *sock;
	struct p_connection_features *p;
P
Philipp Reisner 已提交
4439

4440 4441 4442
	sock = &tconn->data;
	p = conn_prepare_command(tconn, sock);
	if (!p)
4443
		return -EIO;
P
Philipp Reisner 已提交
4444 4445 4446
	memset(p, 0, sizeof(*p));
	p->protocol_min = cpu_to_be32(PRO_VERSION_MIN);
	p->protocol_max = cpu_to_be32(PRO_VERSION_MAX);
4447
	return conn_send_command(tconn, sock, P_CONNECTION_FEATURES, sizeof(*p), NULL, 0);
P
Philipp Reisner 已提交
4448 4449 4450 4451 4452 4453 4454 4455 4456
}

/*
 * return values:
 *   1 yes, we have a valid connection
 *   0 oops, did not work out, please try again
 *  -1 peer talks different language,
 *     no point in trying again, please go standalone.
 */
4457
static int drbd_do_features(struct drbd_tconn *tconn)
P
Philipp Reisner 已提交
4458
{
4459
	/* ASSERT current == tconn->receiver ... */
4460 4461
	struct p_connection_features *p;
	const int expect = sizeof(struct p_connection_features);
4462
	struct packet_info pi;
4463
	int err;
P
Philipp Reisner 已提交
4464

4465
	err = drbd_send_features(tconn);
4466
	if (err)
P
Philipp Reisner 已提交
4467 4468
		return 0;

4469 4470
	err = drbd_recv_header(tconn, &pi);
	if (err)
P
Philipp Reisner 已提交
4471 4472
		return 0;

4473 4474
	if (pi.cmd != P_CONNECTION_FEATURES) {
		conn_err(tconn, "expected ConnectionFeatures packet, received: %s (0x%04x)\n",
4475
			 cmdname(pi.cmd), pi.cmd);
P
Philipp Reisner 已提交
4476 4477 4478
		return -1;
	}

4479
	if (pi.size != expect) {
4480
		conn_err(tconn, "expected ConnectionFeatures length: %u, received: %u\n",
4481
		     expect, pi.size);
P
Philipp Reisner 已提交
4482 4483 4484
		return -1;
	}

4485 4486
	p = pi.data;
	err = drbd_recv_all_warn(tconn, p, expect);
4487
	if (err)
P
Philipp Reisner 已提交
4488 4489 4490 4491 4492 4493 4494 4495 4496 4497 4498
		return 0;

	p->protocol_min = be32_to_cpu(p->protocol_min);
	p->protocol_max = be32_to_cpu(p->protocol_max);
	if (p->protocol_max == 0)
		p->protocol_max = p->protocol_min;

	if (PRO_VERSION_MAX < p->protocol_min ||
	    PRO_VERSION_MIN > p->protocol_max)
		goto incompat;

4499
	tconn->agreed_pro_version = min_t(int, PRO_VERSION_MAX, p->protocol_max);
P
Philipp Reisner 已提交
4500

4501 4502
	conn_info(tconn, "Handshake successful: "
	     "Agreed network protocol version %d\n", tconn->agreed_pro_version);
P
Philipp Reisner 已提交
4503 4504 4505 4506

	return 1;

 incompat:
4507
	conn_err(tconn, "incompatible DRBD dialects: "
P
Philipp Reisner 已提交
4508 4509 4510 4511 4512 4513 4514
	    "I support %d-%d, peer supports %d-%d\n",
	    PRO_VERSION_MIN, PRO_VERSION_MAX,
	    p->protocol_min, p->protocol_max);
	return -1;
}

#if !defined(CONFIG_CRYPTO_HMAC) && !defined(CONFIG_CRYPTO_HMAC_MODULE)
4515
static int drbd_do_auth(struct drbd_tconn *tconn)
P
Philipp Reisner 已提交
4516 4517 4518
{
	dev_err(DEV, "This kernel was build without CONFIG_CRYPTO_HMAC.\n");
	dev_err(DEV, "You need to disable 'cram-hmac-alg' in drbd.conf.\n");
4519
	return -1;
P
Philipp Reisner 已提交
4520 4521 4522
}
#else
#define CHALLENGE_LEN 64
4523 4524 4525 4526 4527 4528 4529

/* Return value:
	1 - auth succeeded,
	0 - failed, try again (network error),
	-1 - auth failed, don't try again.
*/

4530
static int drbd_do_auth(struct drbd_tconn *tconn)
P
Philipp Reisner 已提交
4531
{
4532
	struct drbd_socket *sock;
P
Philipp Reisner 已提交
4533 4534 4535 4536 4537
	char my_challenge[CHALLENGE_LEN];  /* 64 Bytes... */
	struct scatterlist sg;
	char *response = NULL;
	char *right_response = NULL;
	char *peers_ch = NULL;
4538 4539
	unsigned int key_len;
	char secret[SHARED_SECRET_MAX]; /* 64 byte */
P
Philipp Reisner 已提交
4540 4541
	unsigned int resp_size;
	struct hash_desc desc;
4542
	struct packet_info pi;
4543
	struct net_conf *nc;
4544
	int err, rv;
P
Philipp Reisner 已提交
4545

4546 4547
	/* FIXME: Put the challenge/response into the preallocated socket buffer.  */

4548 4549 4550 4551 4552 4553
	rcu_read_lock();
	nc = rcu_dereference(tconn->net_conf);
	key_len = strlen(nc->shared_secret);
	memcpy(secret, nc->shared_secret, key_len);
	rcu_read_unlock();

4554
	desc.tfm = tconn->cram_hmac_tfm;
P
Philipp Reisner 已提交
4555 4556
	desc.flags = 0;

4557
	rv = crypto_hash_setkey(tconn->cram_hmac_tfm, (u8 *)secret, key_len);
P
Philipp Reisner 已提交
4558
	if (rv) {
4559
		conn_err(tconn, "crypto_hash_setkey() failed with %d\n", rv);
4560
		rv = -1;
P
Philipp Reisner 已提交
4561 4562 4563 4564 4565
		goto fail;
	}

	get_random_bytes(my_challenge, CHALLENGE_LEN);

4566 4567 4568 4569 4570
	sock = &tconn->data;
	if (!conn_prepare_command(tconn, sock)) {
		rv = 0;
		goto fail;
	}
4571
	rv = !conn_send_command(tconn, sock, P_AUTH_CHALLENGE, 0,
4572
				my_challenge, CHALLENGE_LEN);
P
Philipp Reisner 已提交
4573 4574 4575
	if (!rv)
		goto fail;

4576 4577 4578
	err = drbd_recv_header(tconn, &pi);
	if (err) {
		rv = 0;
P
Philipp Reisner 已提交
4579
		goto fail;
4580
	}
P
Philipp Reisner 已提交
4581

4582
	if (pi.cmd != P_AUTH_CHALLENGE) {
4583
		conn_err(tconn, "expected AuthChallenge packet, received: %s (0x%04x)\n",
4584
			 cmdname(pi.cmd), pi.cmd);
P
Philipp Reisner 已提交
4585 4586 4587 4588
		rv = 0;
		goto fail;
	}

4589
	if (pi.size > CHALLENGE_LEN * 2) {
4590
		conn_err(tconn, "expected AuthChallenge payload too big.\n");
4591
		rv = -1;
P
Philipp Reisner 已提交
4592 4593 4594
		goto fail;
	}

4595
	peers_ch = kmalloc(pi.size, GFP_NOIO);
P
Philipp Reisner 已提交
4596
	if (peers_ch == NULL) {
4597
		conn_err(tconn, "kmalloc of peers_ch failed\n");
4598
		rv = -1;
P
Philipp Reisner 已提交
4599 4600 4601
		goto fail;
	}

4602 4603
	err = drbd_recv_all_warn(tconn, peers_ch, pi.size);
	if (err) {
P
Philipp Reisner 已提交
4604 4605 4606 4607
		rv = 0;
		goto fail;
	}

4608
	resp_size = crypto_hash_digestsize(tconn->cram_hmac_tfm);
P
Philipp Reisner 已提交
4609 4610
	response = kmalloc(resp_size, GFP_NOIO);
	if (response == NULL) {
4611
		conn_err(tconn, "kmalloc of response failed\n");
4612
		rv = -1;
P
Philipp Reisner 已提交
4613 4614 4615 4616
		goto fail;
	}

	sg_init_table(&sg, 1);
4617
	sg_set_buf(&sg, peers_ch, pi.size);
P
Philipp Reisner 已提交
4618 4619 4620

	rv = crypto_hash_digest(&desc, &sg, sg.length, response);
	if (rv) {
4621
		conn_err(tconn, "crypto_hash_digest() failed with %d\n", rv);
4622
		rv = -1;
P
Philipp Reisner 已提交
4623 4624 4625
		goto fail;
	}

4626 4627 4628 4629
	if (!conn_prepare_command(tconn, sock)) {
		rv = 0;
		goto fail;
	}
4630
	rv = !conn_send_command(tconn, sock, P_AUTH_RESPONSE, 0,
4631
				response, resp_size);
P
Philipp Reisner 已提交
4632 4633 4634
	if (!rv)
		goto fail;

4635 4636 4637
	err = drbd_recv_header(tconn, &pi);
	if (err) {
		rv = 0;
P
Philipp Reisner 已提交
4638
		goto fail;
4639
	}
P
Philipp Reisner 已提交
4640

4641
	if (pi.cmd != P_AUTH_RESPONSE) {
4642
		conn_err(tconn, "expected AuthResponse packet, received: %s (0x%04x)\n",
4643
			 cmdname(pi.cmd), pi.cmd);
P
Philipp Reisner 已提交
4644 4645 4646 4647
		rv = 0;
		goto fail;
	}

4648
	if (pi.size != resp_size) {
4649
		conn_err(tconn, "expected AuthResponse payload of wrong size\n");
P
Philipp Reisner 已提交
4650 4651 4652 4653
		rv = 0;
		goto fail;
	}

4654 4655
	err = drbd_recv_all_warn(tconn, response , resp_size);
	if (err) {
P
Philipp Reisner 已提交
4656 4657 4658 4659 4660
		rv = 0;
		goto fail;
	}

	right_response = kmalloc(resp_size, GFP_NOIO);
4661
	if (right_response == NULL) {
4662
		conn_err(tconn, "kmalloc of right_response failed\n");
4663
		rv = -1;
P
Philipp Reisner 已提交
4664 4665 4666 4667 4668 4669 4670
		goto fail;
	}

	sg_set_buf(&sg, my_challenge, CHALLENGE_LEN);

	rv = crypto_hash_digest(&desc, &sg, sg.length, right_response);
	if (rv) {
4671
		conn_err(tconn, "crypto_hash_digest() failed with %d\n", rv);
4672
		rv = -1;
P
Philipp Reisner 已提交
4673 4674 4675 4676 4677 4678
		goto fail;
	}

	rv = !memcmp(response, right_response, resp_size);

	if (rv)
4679 4680
		conn_info(tconn, "Peer authenticated using %d bytes HMAC\n",
		     resp_size);
4681 4682
	else
		rv = -1;
P
Philipp Reisner 已提交
4683 4684 4685 4686 4687 4688 4689 4690 4691 4692 4693 4694

 fail:
	kfree(peers_ch);
	kfree(response);
	kfree(right_response);

	return rv;
}
#endif

int drbdd_init(struct drbd_thread *thi)
{
4695
	struct drbd_tconn *tconn = thi->tconn;
P
Philipp Reisner 已提交
4696 4697
	int h;

4698
	conn_info(tconn, "receiver (re)started\n");
P
Philipp Reisner 已提交
4699 4700

	do {
4701
		h = conn_connect(tconn);
P
Philipp Reisner 已提交
4702
		if (h == 0) {
4703
			conn_disconnect(tconn);
4704
			schedule_timeout_interruptible(HZ);
P
Philipp Reisner 已提交
4705 4706
		}
		if (h == -1) {
4707
			conn_warn(tconn, "Discarding network configuration.\n");
4708
			conn_request_state(tconn, NS(conn, C_DISCONNECTING), CS_HARD);
P
Philipp Reisner 已提交
4709 4710 4711
		}
	} while (h == 0);

4712 4713
	if (h > 0)
		drbdd(tconn);
P
Philipp Reisner 已提交
4714

4715
	conn_disconnect(tconn);
P
Philipp Reisner 已提交
4716

4717
	conn_info(tconn, "receiver terminated\n");
P
Philipp Reisner 已提交
4718 4719 4720 4721 4722
	return 0;
}

/* ********* acknowledge sender ******** */

4723
static int got_conn_RqSReply(struct drbd_tconn *tconn, struct packet_info *pi)
4724
{
4725
	struct p_req_state_reply *p = pi->data;
4726 4727 4728 4729 4730 4731 4732 4733 4734 4735 4736
	int retcode = be32_to_cpu(p->retcode);

	if (retcode >= SS_SUCCESS) {
		set_bit(CONN_WD_ST_CHG_OKAY, &tconn->flags);
	} else {
		set_bit(CONN_WD_ST_CHG_FAIL, &tconn->flags);
		conn_err(tconn, "Requested state change failed by peer: %s (%d)\n",
			 drbd_set_st_err_str(retcode), retcode);
	}
	wake_up(&tconn->ping_wait);

4737
	return 0;
4738 4739
}

4740
static int got_RqSReply(struct drbd_tconn *tconn, struct packet_info *pi)
P
Philipp Reisner 已提交
4741
{
4742
	struct drbd_conf *mdev;
4743
	struct p_req_state_reply *p = pi->data;
P
Philipp Reisner 已提交
4744 4745
	int retcode = be32_to_cpu(p->retcode);

4746 4747
	mdev = vnr_to_mdev(tconn, pi->vnr);
	if (!mdev)
4748
		return -EIO;
4749

4750 4751 4752 4753 4754 4755
	if (retcode >= SS_SUCCESS) {
		set_bit(CL_ST_CHG_SUCCESS, &mdev->flags);
	} else {
		set_bit(CL_ST_CHG_FAIL, &mdev->flags);
		dev_err(DEV, "Requested state change failed by peer: %s (%d)\n",
			drbd_set_st_err_str(retcode), retcode);
P
Philipp Reisner 已提交
4756
	}
4757 4758
	wake_up(&mdev->state_wait);

4759
	return 0;
P
Philipp Reisner 已提交
4760 4761
}

4762
static int got_Ping(struct drbd_tconn *tconn, struct packet_info *pi)
P
Philipp Reisner 已提交
4763
{
4764
	return drbd_send_ping_ack(tconn);
P
Philipp Reisner 已提交
4765 4766 4767

}

4768
static int got_PingAck(struct drbd_tconn *tconn, struct packet_info *pi)
P
Philipp Reisner 已提交
4769 4770
{
	/* restore idle timeout */
4771 4772 4773
	tconn->meta.socket->sk->sk_rcvtimeo = tconn->net_conf->ping_int*HZ;
	if (!test_and_set_bit(GOT_PING_ACK, &tconn->flags))
		wake_up(&tconn->ping_wait);
P
Philipp Reisner 已提交
4774

4775
	return 0;
P
Philipp Reisner 已提交
4776 4777
}

4778
static int got_IsInSync(struct drbd_tconn *tconn, struct packet_info *pi)
P
Philipp Reisner 已提交
4779
{
4780
	struct drbd_conf *mdev;
4781
	struct p_block_ack *p = pi->data;
P
Philipp Reisner 已提交
4782 4783 4784
	sector_t sector = be64_to_cpu(p->sector);
	int blksize = be32_to_cpu(p->blksize);

4785 4786
	mdev = vnr_to_mdev(tconn, pi->vnr);
	if (!mdev)
4787
		return -EIO;
4788

4789
	D_ASSERT(mdev->tconn->agreed_pro_version >= 89);
P
Philipp Reisner 已提交
4790 4791 4792

	update_peer_seq(mdev, be32_to_cpu(p->seq_num));

4793 4794 4795 4796 4797 4798 4799
	if (get_ldev(mdev)) {
		drbd_rs_complete_io(mdev, sector);
		drbd_set_in_sync(mdev, sector, blksize);
		/* rs_same_csums is supposed to count in units of BM_BLOCK_SIZE */
		mdev->rs_same_csum += (blksize >> BM_BLOCK_SHIFT);
		put_ldev(mdev);
	}
P
Philipp Reisner 已提交
4800
	dec_rs_pending(mdev);
4801
	atomic_add(blksize >> 9, &mdev->rs_sect_in);
P
Philipp Reisner 已提交
4802

4803
	return 0;
P
Philipp Reisner 已提交
4804 4805
}

4806 4807 4808 4809
static int
validate_req_change_req_state(struct drbd_conf *mdev, u64 id, sector_t sector,
			      struct rb_root *root, const char *func,
			      enum drbd_req_event what, bool missing_ok)
P
Philipp Reisner 已提交
4810 4811 4812 4813
{
	struct drbd_request *req;
	struct bio_and_error m;

4814
	spin_lock_irq(&mdev->tconn->req_lock);
4815
	req = find_request(mdev, root, id, sector, missing_ok, func);
P
Philipp Reisner 已提交
4816
	if (unlikely(!req)) {
4817
		spin_unlock_irq(&mdev->tconn->req_lock);
4818
		return -EIO;
P
Philipp Reisner 已提交
4819 4820
	}
	__req_mod(req, what, &m);
4821
	spin_unlock_irq(&mdev->tconn->req_lock);
P
Philipp Reisner 已提交
4822 4823 4824

	if (m.bio)
		complete_master_bio(mdev, &m);
4825
	return 0;
P
Philipp Reisner 已提交
4826 4827
}

4828
static int got_BlockAck(struct drbd_tconn *tconn, struct packet_info *pi)
P
Philipp Reisner 已提交
4829
{
4830
	struct drbd_conf *mdev;
4831
	struct p_block_ack *p = pi->data;
P
Philipp Reisner 已提交
4832 4833 4834 4835
	sector_t sector = be64_to_cpu(p->sector);
	int blksize = be32_to_cpu(p->blksize);
	enum drbd_req_event what;

4836 4837
	mdev = vnr_to_mdev(tconn, pi->vnr);
	if (!mdev)
4838
		return -EIO;
4839

P
Philipp Reisner 已提交
4840 4841
	update_peer_seq(mdev, be32_to_cpu(p->seq_num));

4842
	if (p->block_id == ID_SYNCER) {
P
Philipp Reisner 已提交
4843 4844
		drbd_set_in_sync(mdev, sector, blksize);
		dec_rs_pending(mdev);
4845
		return 0;
P
Philipp Reisner 已提交
4846
	}
4847
	switch (pi->cmd) {
P
Philipp Reisner 已提交
4848
	case P_RS_WRITE_ACK:
4849
		what = WRITE_ACKED_BY_PEER_AND_SIS;
P
Philipp Reisner 已提交
4850 4851
		break;
	case P_WRITE_ACK:
4852
		what = WRITE_ACKED_BY_PEER;
P
Philipp Reisner 已提交
4853 4854
		break;
	case P_RECV_ACK:
4855
		what = RECV_ACKED_BY_PEER;
P
Philipp Reisner 已提交
4856
		break;
4857 4858 4859 4860 4861
	case P_DISCARD_WRITE:
		what = DISCARD_WRITE;
		break;
	case P_RETRY_WRITE:
		what = POSTPONE_WRITE;
P
Philipp Reisner 已提交
4862 4863
		break;
	default:
4864
		BUG();
P
Philipp Reisner 已提交
4865 4866
	}

4867 4868 4869
	return validate_req_change_req_state(mdev, p->block_id, sector,
					     &mdev->write_requests, __func__,
					     what, false);
P
Philipp Reisner 已提交
4870 4871
}

4872
static int got_NegAck(struct drbd_tconn *tconn, struct packet_info *pi)
P
Philipp Reisner 已提交
4873
{
4874
	struct drbd_conf *mdev;
4875
	struct p_block_ack *p = pi->data;
P
Philipp Reisner 已提交
4876
	sector_t sector = be64_to_cpu(p->sector);
4877
	int size = be32_to_cpu(p->blksize);
4878
	int err;
P
Philipp Reisner 已提交
4879

4880 4881
	mdev = vnr_to_mdev(tconn, pi->vnr);
	if (!mdev)
4882
		return -EIO;
4883

P
Philipp Reisner 已提交
4884 4885
	update_peer_seq(mdev, be32_to_cpu(p->seq_num));

4886
	if (p->block_id == ID_SYNCER) {
P
Philipp Reisner 已提交
4887 4888
		dec_rs_pending(mdev);
		drbd_rs_failed_io(mdev, sector, size);
4889
		return 0;
P
Philipp Reisner 已提交
4890
	}
4891

4892 4893
	err = validate_req_change_req_state(mdev, p->block_id, sector,
					    &mdev->write_requests, __func__,
4894
					    NEG_ACKED, true);
4895
	if (err) {
4896 4897 4898 4899 4900 4901
		/* Protocol A has no P_WRITE_ACKs, but has P_NEG_ACKs.
		   The master bio might already be completed, therefore the
		   request is no longer in the collision hash. */
		/* In Protocol B we might already have got a P_RECV_ACK
		   but then get a P_NEG_ACK afterwards. */
		drbd_set_out_of_sync(mdev, sector, size);
4902
	}
4903
	return 0;
P
Philipp Reisner 已提交
4904 4905
}

4906
static int got_NegDReply(struct drbd_tconn *tconn, struct packet_info *pi)
P
Philipp Reisner 已提交
4907
{
4908
	struct drbd_conf *mdev;
4909
	struct p_block_ack *p = pi->data;
P
Philipp Reisner 已提交
4910 4911
	sector_t sector = be64_to_cpu(p->sector);

4912 4913
	mdev = vnr_to_mdev(tconn, pi->vnr);
	if (!mdev)
4914
		return -EIO;
4915

P
Philipp Reisner 已提交
4916
	update_peer_seq(mdev, be32_to_cpu(p->seq_num));
4917

P
Philipp Reisner 已提交
4918 4919 4920
	dev_err(DEV, "Got NegDReply; Sector %llus, len %u; Fail original request.\n",
	    (unsigned long long)sector, be32_to_cpu(p->blksize));

4921 4922 4923
	return validate_req_change_req_state(mdev, p->block_id, sector,
					     &mdev->read_requests, __func__,
					     NEG_ACKED, false);
P
Philipp Reisner 已提交
4924 4925
}

4926
static int got_NegRSDReply(struct drbd_tconn *tconn, struct packet_info *pi)
P
Philipp Reisner 已提交
4927
{
4928
	struct drbd_conf *mdev;
P
Philipp Reisner 已提交
4929 4930
	sector_t sector;
	int size;
4931
	struct p_block_ack *p = pi->data;
4932 4933 4934

	mdev = vnr_to_mdev(tconn, pi->vnr);
	if (!mdev)
4935
		return -EIO;
P
Philipp Reisner 已提交
4936 4937 4938 4939 4940 4941 4942 4943 4944 4945

	sector = be64_to_cpu(p->sector);
	size = be32_to_cpu(p->blksize);

	update_peer_seq(mdev, be32_to_cpu(p->seq_num));

	dec_rs_pending(mdev);

	if (get_ldev_if_state(mdev, D_FAILED)) {
		drbd_rs_complete_io(mdev, sector);
4946
		switch (pi->cmd) {
4947 4948 4949 4950 4951
		case P_NEG_RS_DREPLY:
			drbd_rs_failed_io(mdev, sector, size);
		case P_RS_CANCEL:
			break;
		default:
4952
			BUG();
4953
		}
P
Philipp Reisner 已提交
4954 4955 4956
		put_ldev(mdev);
	}

4957
	return 0;
P
Philipp Reisner 已提交
4958 4959
}

4960
static int got_BarrierAck(struct drbd_tconn *tconn, struct packet_info *pi)
P
Philipp Reisner 已提交
4961
{
4962
	struct drbd_conf *mdev;
4963
	struct p_barrier_ack *p = pi->data;
4964 4965 4966

	mdev = vnr_to_mdev(tconn, pi->vnr);
	if (!mdev)
4967
		return -EIO;
P
Philipp Reisner 已提交
4968

4969
	tl_release(mdev->tconn, p->barrier, be32_to_cpu(p->set_size));
P
Philipp Reisner 已提交
4970

4971 4972
	if (mdev->state.conn == C_AHEAD &&
	    atomic_read(&mdev->ap_in_flight) == 0 &&
4973 4974 4975
	    !test_and_set_bit(AHEAD_TO_SYNC_SOURCE, &mdev->current_epoch->flags)) {
		mdev->start_resync_timer.expires = jiffies + HZ;
		add_timer(&mdev->start_resync_timer);
4976 4977
	}

4978
	return 0;
P
Philipp Reisner 已提交
4979 4980
}

4981
static int got_OVResult(struct drbd_tconn *tconn, struct packet_info *pi)
P
Philipp Reisner 已提交
4982
{
4983
	struct drbd_conf *mdev;
4984
	struct p_block_ack *p = pi->data;
P
Philipp Reisner 已提交
4985 4986 4987 4988
	struct drbd_work *w;
	sector_t sector;
	int size;

4989 4990
	mdev = vnr_to_mdev(tconn, pi->vnr);
	if (!mdev)
4991
		return -EIO;
4992

P
Philipp Reisner 已提交
4993 4994 4995 4996 4997 4998
	sector = be64_to_cpu(p->sector);
	size = be32_to_cpu(p->blksize);

	update_peer_seq(mdev, be32_to_cpu(p->seq_num));

	if (be64_to_cpu(p->block_id) == ID_OUT_OF_SYNC)
4999
		drbd_ov_out_of_sync_found(mdev, sector, size);
P
Philipp Reisner 已提交
5000
	else
5001
		ov_out_of_sync_print(mdev);
P
Philipp Reisner 已提交
5002

5003
	if (!get_ldev(mdev))
5004
		return 0;
5005

P
Philipp Reisner 已提交
5006 5007 5008
	drbd_rs_complete_io(mdev, sector);
	dec_rs_pending(mdev);

5009 5010 5011 5012 5013 5014 5015
	--mdev->ov_left;

	/* let's advance progress step marks only for every other megabyte */
	if ((mdev->ov_left & 0x200) == 0x200)
		drbd_advance_rs_marks(mdev, mdev->ov_left);

	if (mdev->ov_left == 0) {
P
Philipp Reisner 已提交
5016 5017 5018
		w = kmalloc(sizeof(*w), GFP_NOIO);
		if (w) {
			w->cb = w_ov_finished;
5019
			w->mdev = mdev;
5020
			drbd_queue_work_front(&mdev->tconn->data.work, w);
P
Philipp Reisner 已提交
5021 5022
		} else {
			dev_err(DEV, "kmalloc(w) failed.");
5023
			ov_out_of_sync_print(mdev);
P
Philipp Reisner 已提交
5024 5025 5026
			drbd_resync_finished(mdev);
		}
	}
5027
	put_ldev(mdev);
5028
	return 0;
P
Philipp Reisner 已提交
5029 5030
}

5031
static int got_skip(struct drbd_tconn *tconn, struct packet_info *pi)
5032
{
5033
	return 0;
5034 5035
}

5036
static int tconn_finish_peer_reqs(struct drbd_tconn *tconn)
5037
{
5038
	struct drbd_conf *mdev;
P
Philipp Reisner 已提交
5039
	int vnr, not_empty = 0;
5040 5041 5042 5043

	do {
		clear_bit(SIGNAL_ASENDER, &tconn->flags);
		flush_signals(current);
P
Philipp Reisner 已提交
5044 5045 5046 5047 5048

		rcu_read_lock();
		idr_for_each_entry(&tconn->volumes, mdev, vnr) {
			kref_get(&mdev->kref);
			rcu_read_unlock();
5049
			if (drbd_finish_peer_reqs(mdev)) {
P
Philipp Reisner 已提交
5050 5051
				kref_put(&mdev->kref, &drbd_minor_destroy);
				return 1;
5052
			}
P
Philipp Reisner 已提交
5053 5054
			kref_put(&mdev->kref, &drbd_minor_destroy);
			rcu_read_lock();
5055
		}
5056
		set_bit(SIGNAL_ASENDER, &tconn->flags);
5057 5058

		spin_lock_irq(&tconn->req_lock);
P
Philipp Reisner 已提交
5059
		idr_for_each_entry(&tconn->volumes, mdev, vnr) {
5060 5061 5062 5063 5064
			not_empty = !list_empty(&mdev->done_ee);
			if (not_empty)
				break;
		}
		spin_unlock_irq(&tconn->req_lock);
P
Philipp Reisner 已提交
5065
		rcu_read_unlock();
5066 5067 5068 5069 5070
	} while (not_empty);

	return 0;
}

5071 5072
struct asender_cmd {
	size_t pkt_size;
5073
	int (*fn)(struct drbd_tconn *tconn, struct packet_info *);
5074 5075 5076
};

static struct asender_cmd asender_tbl[] = {
5077 5078
	[P_PING]	    = { 0, got_Ping },
	[P_PING_ACK]	    = { 0, got_PingAck },
5079 5080 5081 5082 5083 5084 5085 5086 5087 5088 5089 5090 5091 5092 5093
	[P_RECV_ACK]	    = { sizeof(struct p_block_ack), got_BlockAck },
	[P_WRITE_ACK]	    = { sizeof(struct p_block_ack), got_BlockAck },
	[P_RS_WRITE_ACK]    = { sizeof(struct p_block_ack), got_BlockAck },
	[P_DISCARD_WRITE]   = { sizeof(struct p_block_ack), got_BlockAck },
	[P_NEG_ACK]	    = { sizeof(struct p_block_ack), got_NegAck },
	[P_NEG_DREPLY]	    = { sizeof(struct p_block_ack), got_NegDReply },
	[P_NEG_RS_DREPLY]   = { sizeof(struct p_block_ack), got_NegRSDReply },
	[P_OV_RESULT]	    = { sizeof(struct p_block_ack), got_OVResult },
	[P_BARRIER_ACK]	    = { sizeof(struct p_barrier_ack), got_BarrierAck },
	[P_STATE_CHG_REPLY] = { sizeof(struct p_req_state_reply), got_RqSReply },
	[P_RS_IS_IN_SYNC]   = { sizeof(struct p_block_ack), got_IsInSync },
	[P_DELAY_PROBE]     = { sizeof(struct p_delay_probe93), got_skip },
	[P_RS_CANCEL]       = { sizeof(struct p_block_ack), got_NegRSDReply },
	[P_CONN_ST_CHG_REPLY]={ sizeof(struct p_req_state_reply), got_conn_RqSReply },
	[P_RETRY_WRITE]	    = { sizeof(struct p_block_ack), got_BlockAck },
5094 5095
};

P
Philipp Reisner 已提交
5096 5097
int drbd_asender(struct drbd_thread *thi)
{
5098
	struct drbd_tconn *tconn = thi->tconn;
P
Philipp Reisner 已提交
5099
	struct asender_cmd *cmd = NULL;
5100
	struct packet_info pi;
5101
	int rv;
5102
	void *buf    = tconn->meta.rbuf;
P
Philipp Reisner 已提交
5103
	int received = 0;
5104 5105
	unsigned int header_size = drbd_header_size(tconn);
	int expect   = header_size;
5106 5107
	bool ping_timeout_active = false;
	struct net_conf *nc;
5108
	int ping_timeo, tcp_cork, ping_int;
P
Philipp Reisner 已提交
5109 5110 5111 5112

	current->policy = SCHED_RR;  /* Make this a realtime task! */
	current->rt_priority = 2;    /* more important than all other tasks */

5113
	while (get_t_state(thi) == RUNNING) {
5114
		drbd_thread_current_set_cpu(thi);
5115 5116 5117 5118

		rcu_read_lock();
		nc = rcu_dereference(tconn->net_conf);
		ping_timeo = nc->ping_timeo;
5119
		tcp_cork = nc->tcp_cork;
5120 5121 5122
		ping_int = nc->ping_int;
		rcu_read_unlock();

5123
		if (test_and_clear_bit(SEND_PING, &tconn->flags)) {
5124
			if (drbd_send_ping(tconn)) {
5125
				conn_err(tconn, "drbd_send_ping has failed\n");
5126 5127
				goto reconnect;
			}
5128 5129
			tconn->meta.socket->sk->sk_rcvtimeo = ping_timeo * HZ / 10;
			ping_timeout_active = true;
P
Philipp Reisner 已提交
5130 5131
		}

5132 5133
		/* TODO: conditionally cork; it may hurt latency if we cork without
		   much to send */
5134
		if (tcp_cork)
5135
			drbd_tcp_cork(tconn->meta.socket);
5136 5137
		if (tconn_finish_peer_reqs(tconn)) {
			conn_err(tconn, "tconn_finish_peer_reqs() failed\n");
5138
			goto reconnect;
5139
		}
P
Philipp Reisner 已提交
5140
		/* but unconditionally uncork unless disabled */
5141
		if (tcp_cork)
5142
			drbd_tcp_uncork(tconn->meta.socket);
P
Philipp Reisner 已提交
5143 5144 5145 5146 5147

		/* short circuit, recv_msg would return EINTR anyways. */
		if (signal_pending(current))
			continue;

5148 5149
		rv = drbd_recv_short(tconn->meta.socket, buf, expect-received, 0);
		clear_bit(SIGNAL_ASENDER, &tconn->flags);
P
Philipp Reisner 已提交
5150 5151 5152 5153 5154 5155 5156 5157 5158 5159 5160 5161 5162 5163 5164 5165 5166

		flush_signals(current);

		/* Note:
		 * -EINTR	 (on meta) we got a signal
		 * -EAGAIN	 (on meta) rcvtimeo expired
		 * -ECONNRESET	 other side closed the connection
		 * -ERESTARTSYS  (on data) we got a signal
		 * rv <  0	 other than above: unexpected error!
		 * rv == expected: full header or command
		 * rv <  expected: "woken" by signal during receive
		 * rv == 0	 : "connection shut down by peer"
		 */
		if (likely(rv > 0)) {
			received += rv;
			buf	 += rv;
		} else if (rv == 0) {
5167
			conn_err(tconn, "meta connection shut down by peer.\n");
P
Philipp Reisner 已提交
5168 5169
			goto reconnect;
		} else if (rv == -EAGAIN) {
5170 5171
			/* If the data socket received something meanwhile,
			 * that is good enough: peer is still alive. */
5172 5173
			if (time_after(tconn->last_received,
				jiffies - tconn->meta.socket->sk->sk_rcvtimeo))
5174
				continue;
5175
			if (ping_timeout_active) {
5176
				conn_err(tconn, "PingAck did not arrive in time.\n");
P
Philipp Reisner 已提交
5177 5178
				goto reconnect;
			}
5179
			set_bit(SEND_PING, &tconn->flags);
P
Philipp Reisner 已提交
5180 5181 5182 5183
			continue;
		} else if (rv == -EINTR) {
			continue;
		} else {
5184
			conn_err(tconn, "sock_recvmsg returned %d\n", rv);
P
Philipp Reisner 已提交
5185 5186 5187 5188
			goto reconnect;
		}

		if (received == expect && cmd == NULL) {
5189
			if (decode_header(tconn, tconn->meta.rbuf, &pi))
P
Philipp Reisner 已提交
5190
				goto reconnect;
5191
			cmd = &asender_tbl[pi.cmd];
5192
			if (pi.cmd >= ARRAY_SIZE(asender_tbl) || !cmd->fn) {
5193 5194
				conn_err(tconn, "Unexpected meta packet %s (0x%04x)\n",
					 cmdname(pi.cmd), pi.cmd);
P
Philipp Reisner 已提交
5195 5196
				goto disconnect;
			}
5197
			expect = header_size + cmd->pkt_size;
5198
			if (pi.size != expect - header_size) {
5199
				conn_err(tconn, "Wrong packet size on meta (c: %d, l: %d)\n",
5200
					pi.cmd, pi.size);
P
Philipp Reisner 已提交
5201
				goto reconnect;
5202
			}
P
Philipp Reisner 已提交
5203 5204
		}
		if (received == expect) {
5205
			bool err;
5206

5207 5208
			err = cmd->fn(tconn, &pi);
			if (err) {
5209
				conn_err(tconn, "%pf failed\n", cmd->fn);
P
Philipp Reisner 已提交
5210
				goto reconnect;
5211
			}
P
Philipp Reisner 已提交
5212

5213 5214
			tconn->last_received = jiffies;

5215 5216 5217 5218 5219
			if (cmd == &asender_tbl[P_PING_ACK]) {
				/* restore idle timeout */
				tconn->meta.socket->sk->sk_rcvtimeo = ping_int * HZ;
				ping_timeout_active = false;
			}
5220

5221
			buf	 = tconn->meta.rbuf;
P
Philipp Reisner 已提交
5222
			received = 0;
5223
			expect	 = header_size;
P
Philipp Reisner 已提交
5224 5225 5226 5227 5228 5229
			cmd	 = NULL;
		}
	}

	if (0) {
reconnect:
5230
		conn_request_state(tconn, NS(conn, C_NETWORK_FAILURE), CS_HARD);
P
Philipp Reisner 已提交
5231 5232 5233
	}
	if (0) {
disconnect:
5234
		conn_request_state(tconn, NS(conn, C_DISCONNECTING), CS_HARD);
P
Philipp Reisner 已提交
5235
	}
5236
	clear_bit(SIGNAL_ASENDER, &tconn->flags);
P
Philipp Reisner 已提交
5237

5238
	conn_info(tconn, "asender terminated\n");
P
Philipp Reisner 已提交
5239 5240 5241

	return 0;
}