drbd: More random to the connect logic
[firefly-linux-kernel-4.4.55.git] / drivers / block / drbd / drbd_receiver.c
1 /*
2    drbd_receiver.c
3
4    This file is part of DRBD by Philipp Reisner and Lars Ellenberg.
5
6    Copyright (C) 2001-2008, LINBIT Information Technologies GmbH.
7    Copyright (C) 1999-2008, Philipp Reisner <philipp.reisner@linbit.com>.
8    Copyright (C) 2002-2008, Lars Ellenberg <lars.ellenberg@linbit.com>.
9
10    drbd is free software; you can redistribute it and/or modify
11    it under the terms of the GNU General Public License as published by
12    the Free Software Foundation; either version 2, or (at your option)
13    any later version.
14
15    drbd is distributed in the hope that it will be useful,
16    but WITHOUT ANY WARRANTY; without even the implied warranty of
17    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
18    GNU General Public License for more details.
19
20    You should have received a copy of the GNU General Public License
21    along with drbd; see the file COPYING.  If not, write to
22    the Free Software Foundation, 675 Mass Ave, Cambridge, MA 02139, USA.
23  */
24
25
26 #include <linux/module.h>
27
28 #include <asm/uaccess.h>
29 #include <net/sock.h>
30
31 #include <linux/drbd.h>
32 #include <linux/fs.h>
33 #include <linux/file.h>
34 #include <linux/in.h>
35 #include <linux/mm.h>
36 #include <linux/memcontrol.h>
37 #include <linux/mm_inline.h>
38 #include <linux/slab.h>
39 #include <linux/pkt_sched.h>
40 #define __KERNEL_SYSCALLS__
41 #include <linux/unistd.h>
42 #include <linux/vmalloc.h>
43 #include <linux/random.h>
44 #include <linux/string.h>
45 #include <linux/scatterlist.h>
46 #include "drbd_int.h"
47 #include "drbd_req.h"
48
49 #include "drbd_vli.h"
50
51 struct packet_info {
52         enum drbd_packet cmd;
53         unsigned int size;
54         unsigned int vnr;
55         void *data;
56 };
57
58 enum finish_epoch {
59         FE_STILL_LIVE,
60         FE_DESTROYED,
61         FE_RECYCLED,
62 };
63
64 static int drbd_do_features(struct drbd_tconn *tconn);
65 static int drbd_do_auth(struct drbd_tconn *tconn);
66 static int drbd_disconnected(struct drbd_conf *mdev);
67
68 static enum finish_epoch drbd_may_finish_epoch(struct drbd_tconn *, struct drbd_epoch *, enum epoch_event);
69 static int e_end_block(struct drbd_work *, int);
70
71
72 #define GFP_TRY (__GFP_HIGHMEM | __GFP_NOWARN)
73
74 /*
75  * some helper functions to deal with single linked page lists,
76  * page->private being our "next" pointer.
77  */
78
79 /* If at least n pages are linked at head, get n pages off.
80  * Otherwise, don't modify head, and return NULL.
81  * Locking is the responsibility of the caller.
82  */
83 static struct page *page_chain_del(struct page **head, int n)
84 {
85         struct page *page;
86         struct page *tmp;
87
88         BUG_ON(!n);
89         BUG_ON(!head);
90
91         page = *head;
92
93         if (!page)
94                 return NULL;
95
96         while (page) {
97                 tmp = page_chain_next(page);
98                 if (--n == 0)
99                         break; /* found sufficient pages */
100                 if (tmp == NULL)
101                         /* insufficient pages, don't use any of them. */
102                         return NULL;
103                 page = tmp;
104         }
105
106         /* add end of list marker for the returned list */
107         set_page_private(page, 0);
108         /* actual return value, and adjustment of head */
109         page = *head;
110         *head = tmp;
111         return page;
112 }
113
114 /* may be used outside of locks to find the tail of a (usually short)
115  * "private" page chain, before adding it back to a global chain head
116  * with page_chain_add() under a spinlock. */
117 static struct page *page_chain_tail(struct page *page, int *len)
118 {
119         struct page *tmp;
120         int i = 1;
121         while ((tmp = page_chain_next(page)))
122                 ++i, page = tmp;
123         if (len)
124                 *len = i;
125         return page;
126 }
127
128 static int page_chain_free(struct page *page)
129 {
130         struct page *tmp;
131         int i = 0;
132         page_chain_for_each_safe(page, tmp) {
133                 put_page(page);
134                 ++i;
135         }
136         return i;
137 }
138
139 static void page_chain_add(struct page **head,
140                 struct page *chain_first, struct page *chain_last)
141 {
142 #if 1
143         struct page *tmp;
144         tmp = page_chain_tail(chain_first, NULL);
145         BUG_ON(tmp != chain_last);
146 #endif
147
148         /* add chain to head */
149         set_page_private(chain_last, (unsigned long)*head);
150         *head = chain_first;
151 }
152
153 static struct page *__drbd_alloc_pages(struct drbd_conf *mdev,
154                                        unsigned int number)
155 {
156         struct page *page = NULL;
157         struct page *tmp = NULL;
158         unsigned int i = 0;
159
160         /* Yes, testing drbd_pp_vacant outside the lock is racy.
161          * So what. It saves a spin_lock. */
162         if (drbd_pp_vacant >= number) {
163                 spin_lock(&drbd_pp_lock);
164                 page = page_chain_del(&drbd_pp_pool, number);
165                 if (page)
166                         drbd_pp_vacant -= number;
167                 spin_unlock(&drbd_pp_lock);
168                 if (page)
169                         return page;
170         }
171
172         /* GFP_TRY, because we must not cause arbitrary write-out: in a DRBD
173          * "criss-cross" setup, that might cause write-out on some other DRBD,
174          * which in turn might block on the other node at this very place.  */
175         for (i = 0; i < number; i++) {
176                 tmp = alloc_page(GFP_TRY);
177                 if (!tmp)
178                         break;
179                 set_page_private(tmp, (unsigned long)page);
180                 page = tmp;
181         }
182
183         if (i == number)
184                 return page;
185
186         /* Not enough pages immediately available this time.
187          * No need to jump around here, drbd_alloc_pages will retry this
188          * function "soon". */
189         if (page) {
190                 tmp = page_chain_tail(page, NULL);
191                 spin_lock(&drbd_pp_lock);
192                 page_chain_add(&drbd_pp_pool, page, tmp);
193                 drbd_pp_vacant += i;
194                 spin_unlock(&drbd_pp_lock);
195         }
196         return NULL;
197 }
198
199 static void reclaim_finished_net_peer_reqs(struct drbd_conf *mdev,
200                                            struct list_head *to_be_freed)
201 {
202         struct drbd_peer_request *peer_req;
203         struct list_head *le, *tle;
204
205         /* The EEs are always appended to the end of the list. Since
206            they are sent in order over the wire, they have to finish
207            in order. As soon as we see the first not finished we can
208            stop to examine the list... */
209
210         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))
213                         break;
214                 list_move(le, to_be_freed);
215         }
216 }
217
218 static void drbd_kick_lo_and_reclaim_net(struct drbd_conf *mdev)
219 {
220         LIST_HEAD(reclaimed);
221         struct drbd_peer_request *peer_req, *t;
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);
226
227         list_for_each_entry_safe(peer_req, t, &reclaimed, w.list)
228                 drbd_free_net_peer_req(mdev, peer_req);
229 }
230
231 /**
232  * drbd_alloc_pages() - Returns @number pages, retries forever (or until signalled)
233  * @mdev:       DRBD device.
234  * @number:     number of pages requested
235  * @retry:      whether to retry, if not enough pages are available right now
236  *
237  * Tries to allocate number pages, first from our own page pool, then from
238  * the kernel, unless this allocation would exceed the max_buffers setting.
239  * Possibly retry until DRBD frees sufficient pages somewhere else.
240  *
241  * Returns a page chain linked via page->private.
242  */
243 struct page *drbd_alloc_pages(struct drbd_conf *mdev, unsigned int number,
244                               bool retry)
245 {
246         struct page *page = NULL;
247         struct net_conf *nc;
248         DEFINE_WAIT(wait);
249         int mxb;
250
251         /* Yes, we may run up to @number over max_buffers. If we
252          * follow it strictly, the admin will get it wrong anyways. */
253         rcu_read_lock();
254         nc = rcu_dereference(mdev->tconn->net_conf);
255         mxb = nc ? nc->max_buffers : 1000000;
256         rcu_read_unlock();
257
258         if (atomic_read(&mdev->pp_in_use) < mxb)
259                 page = __drbd_alloc_pages(mdev, number);
260
261         while (page == NULL) {
262                 prepare_to_wait(&drbd_pp_wait, &wait, TASK_INTERRUPTIBLE);
263
264                 drbd_kick_lo_and_reclaim_net(mdev);
265
266                 if (atomic_read(&mdev->pp_in_use) < mxb) {
267                         page = __drbd_alloc_pages(mdev, number);
268                         if (page)
269                                 break;
270                 }
271
272                 if (!retry)
273                         break;
274
275                 if (signal_pending(current)) {
276                         dev_warn(DEV, "drbd_alloc_pages interrupted!\n");
277                         break;
278                 }
279
280                 schedule();
281         }
282         finish_wait(&drbd_pp_wait, &wait);
283
284         if (page)
285                 atomic_add(number, &mdev->pp_in_use);
286         return page;
287 }
288
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  * Either links the page chain back to the global pool,
292  * or returns all pages to the system. */
293 static void drbd_free_pages(struct drbd_conf *mdev, struct page *page, int is_net)
294 {
295         atomic_t *a = is_net ? &mdev->pp_in_use_by_net : &mdev->pp_in_use;
296         int i;
297
298         if (page == NULL)
299                 return;
300
301         if (drbd_pp_vacant > (DRBD_MAX_BIO_SIZE/PAGE_SIZE) * minor_count)
302                 i = page_chain_free(page);
303         else {
304                 struct page *tmp;
305                 tmp = page_chain_tail(page, &i);
306                 spin_lock(&drbd_pp_lock);
307                 page_chain_add(&drbd_pp_pool, page, tmp);
308                 drbd_pp_vacant += i;
309                 spin_unlock(&drbd_pp_lock);
310         }
311         i = atomic_sub_return(i, a);
312         if (i < 0)
313                 dev_warn(DEV, "ASSERTION FAILED: %s: %d < 0\n",
314                         is_net ? "pp_in_use_by_net" : "pp_in_use", i);
315         wake_up(&drbd_pp_wait);
316 }
317
318 /*
319 You need to hold the req_lock:
320  _drbd_wait_ee_list_empty()
321
322 You must not have the req_lock:
323  drbd_free_peer_req()
324  drbd_alloc_peer_req()
325  drbd_free_peer_reqs()
326  drbd_ee_fix_bhs()
327  drbd_finish_peer_reqs()
328  drbd_clear_done_ee()
329  drbd_wait_ee_list_empty()
330 */
331
332 struct drbd_peer_request *
333 drbd_alloc_peer_req(struct drbd_conf *mdev, u64 id, sector_t sector,
334                     unsigned int data_size, gfp_t gfp_mask) __must_hold(local)
335 {
336         struct drbd_peer_request *peer_req;
337         struct page *page = NULL;
338         unsigned nr_pages = (data_size + PAGE_SIZE -1) >> PAGE_SHIFT;
339
340         if (drbd_insert_fault(mdev, DRBD_FAULT_AL_EE))
341                 return NULL;
342
343         peer_req = mempool_alloc(drbd_ee_mempool, gfp_mask & ~__GFP_HIGHMEM);
344         if (!peer_req) {
345                 if (!(gfp_mask & __GFP_NOWARN))
346                         dev_err(DEV, "%s: allocation failed\n", __func__);
347                 return NULL;
348         }
349
350         if (data_size) {
351                 page = drbd_alloc_pages(mdev, nr_pages, (gfp_mask & __GFP_WAIT));
352                 if (!page)
353                         goto fail;
354         }
355
356         drbd_clear_interval(&peer_req->i);
357         peer_req->i.size = data_size;
358         peer_req->i.sector = sector;
359         peer_req->i.local = false;
360         peer_req->i.waiting = false;
361
362         peer_req->epoch = NULL;
363         peer_req->w.mdev = mdev;
364         peer_req->pages = page;
365         atomic_set(&peer_req->pending_bios, 0);
366         peer_req->flags = 0;
367         /*
368          * The block_id is opaque to the receiver.  It is not endianness
369          * converted, and sent back to the sender unchanged.
370          */
371         peer_req->block_id = id;
372
373         return peer_req;
374
375  fail:
376         mempool_free(peer_req, drbd_ee_mempool);
377         return NULL;
378 }
379
380 void __drbd_free_peer_req(struct drbd_conf *mdev, struct drbd_peer_request *peer_req,
381                        int is_net)
382 {
383         if (peer_req->flags & EE_HAS_DIGEST)
384                 kfree(peer_req->digest);
385         drbd_free_pages(mdev, peer_req->pages, is_net);
386         D_ASSERT(atomic_read(&peer_req->pending_bios) == 0);
387         D_ASSERT(drbd_interval_empty(&peer_req->i));
388         mempool_free(peer_req, drbd_ee_mempool);
389 }
390
391 int drbd_free_peer_reqs(struct drbd_conf *mdev, struct list_head *list)
392 {
393         LIST_HEAD(work_list);
394         struct drbd_peer_request *peer_req, *t;
395         int count = 0;
396         int is_net = list == &mdev->net_ee;
397
398         spin_lock_irq(&mdev->tconn->req_lock);
399         list_splice_init(list, &work_list);
400         spin_unlock_irq(&mdev->tconn->req_lock);
401
402         list_for_each_entry_safe(peer_req, t, &work_list, w.list) {
403                 __drbd_free_peer_req(mdev, peer_req, is_net);
404                 count++;
405         }
406         return count;
407 }
408
409 /*
410  * See also comments in _req_mod(,BARRIER_ACKED) and receive_Barrier.
411  */
412 static int drbd_finish_peer_reqs(struct drbd_conf *mdev)
413 {
414         LIST_HEAD(work_list);
415         LIST_HEAD(reclaimed);
416         struct drbd_peer_request *peer_req, *t;
417         int err = 0;
418
419         spin_lock_irq(&mdev->tconn->req_lock);
420         reclaim_finished_net_peer_reqs(mdev, &reclaimed);
421         list_splice_init(&mdev->done_ee, &work_list);
422         spin_unlock_irq(&mdev->tconn->req_lock);
423
424         list_for_each_entry_safe(peer_req, t, &reclaimed, w.list)
425                 drbd_free_net_peer_req(mdev, peer_req);
426
427         /* possible callbacks here:
428          * e_end_block, and e_end_resync_block, e_send_discard_write.
429          * all ignore the last argument.
430          */
431         list_for_each_entry_safe(peer_req, t, &work_list, w.list) {
432                 int err2;
433
434                 /* list_del not necessary, next/prev members not touched */
435                 err2 = peer_req->w.cb(&peer_req->w, !!err);
436                 if (!err)
437                         err = err2;
438                 drbd_free_peer_req(mdev, peer_req);
439         }
440         wake_up(&mdev->ee_wait);
441
442         return err;
443 }
444
445 static void _drbd_wait_ee_list_empty(struct drbd_conf *mdev,
446                                      struct list_head *head)
447 {
448         DEFINE_WAIT(wait);
449
450         /* avoids spin_lock/unlock
451          * and calling prepare_to_wait in the fast path */
452         while (!list_empty(head)) {
453                 prepare_to_wait(&mdev->ee_wait, &wait, TASK_UNINTERRUPTIBLE);
454                 spin_unlock_irq(&mdev->tconn->req_lock);
455                 io_schedule();
456                 finish_wait(&mdev->ee_wait, &wait);
457                 spin_lock_irq(&mdev->tconn->req_lock);
458         }
459 }
460
461 static void drbd_wait_ee_list_empty(struct drbd_conf *mdev,
462                                     struct list_head *head)
463 {
464         spin_lock_irq(&mdev->tconn->req_lock);
465         _drbd_wait_ee_list_empty(mdev, head);
466         spin_unlock_irq(&mdev->tconn->req_lock);
467 }
468
469 static int drbd_recv_short(struct socket *sock, void *buf, size_t size, int flags)
470 {
471         mm_segment_t oldfs;
472         struct kvec iov = {
473                 .iov_base = buf,
474                 .iov_len = size,
475         };
476         struct msghdr msg = {
477                 .msg_iovlen = 1,
478                 .msg_iov = (struct iovec *)&iov,
479                 .msg_flags = (flags ? flags : MSG_WAITALL | MSG_NOSIGNAL)
480         };
481         int rv;
482
483         oldfs = get_fs();
484         set_fs(KERNEL_DS);
485         rv = sock_recvmsg(sock, &msg, size, msg.msg_flags);
486         set_fs(oldfs);
487
488         return rv;
489 }
490
491 static int drbd_recv(struct drbd_tconn *tconn, void *buf, size_t size)
492 {
493         mm_segment_t oldfs;
494         struct kvec iov = {
495                 .iov_base = buf,
496                 .iov_len = size,
497         };
498         struct msghdr msg = {
499                 .msg_iovlen = 1,
500                 .msg_iov = (struct iovec *)&iov,
501                 .msg_flags = MSG_WAITALL | MSG_NOSIGNAL
502         };
503         int rv;
504
505         oldfs = get_fs();
506         set_fs(KERNEL_DS);
507
508         for (;;) {
509                 rv = sock_recvmsg(tconn->data.socket, &msg, size, msg.msg_flags);
510                 if (rv == size)
511                         break;
512
513                 /* Note:
514                  * ECONNRESET   other side closed the connection
515                  * ERESTARTSYS  (on  sock) we got a signal
516                  */
517
518                 if (rv < 0) {
519                         if (rv == -ECONNRESET)
520                                 conn_info(tconn, "sock was reset by peer\n");
521                         else if (rv != -ERESTARTSYS)
522                                 conn_err(tconn, "sock_recvmsg returned %d\n", rv);
523                         break;
524                 } else if (rv == 0) {
525                         conn_info(tconn, "sock was shut down by peer\n");
526                         break;
527                 } else  {
528                         /* signal came in, or peer/link went down,
529                          * after we read a partial message
530                          */
531                         /* D_ASSERT(signal_pending(current)); */
532                         break;
533                 }
534         };
535
536         set_fs(oldfs);
537
538         if (rv != size)
539                 conn_request_state(tconn, NS(conn, C_BROKEN_PIPE), CS_HARD);
540
541         return rv;
542 }
543
544 static int drbd_recv_all(struct drbd_tconn *tconn, void *buf, size_t size)
545 {
546         int err;
547
548         err = drbd_recv(tconn, buf, size);
549         if (err != size) {
550                 if (err >= 0)
551                         err = -EIO;
552         } else
553                 err = 0;
554         return err;
555 }
556
557 static int drbd_recv_all_warn(struct drbd_tconn *tconn, void *buf, size_t size)
558 {
559         int err;
560
561         err = drbd_recv_all(tconn, buf, size);
562         if (err && !signal_pending(current))
563                 conn_warn(tconn, "short read (expected size %d)\n", (int)size);
564         return err;
565 }
566
567 /* quoting tcp(7):
568  *   On individual connections, the socket buffer size must be set prior to the
569  *   listen(2) or connect(2) calls in order to have it take effect.
570  * This is our wrapper to do so.
571  */
572 static void drbd_setbufsize(struct socket *sock, unsigned int snd,
573                 unsigned int rcv)
574 {
575         /* open coded SO_SNDBUF, SO_RCVBUF */
576         if (snd) {
577                 sock->sk->sk_sndbuf = snd;
578                 sock->sk->sk_userlocks |= SOCK_SNDBUF_LOCK;
579         }
580         if (rcv) {
581                 sock->sk->sk_rcvbuf = rcv;
582                 sock->sk->sk_userlocks |= SOCK_RCVBUF_LOCK;
583         }
584 }
585
586 static struct socket *drbd_try_connect(struct drbd_tconn *tconn)
587 {
588         const char *what;
589         struct socket *sock;
590         struct sockaddr_in6 src_in6;
591         struct sockaddr_in6 peer_in6;
592         struct net_conf *nc;
593         int err, peer_addr_len, my_addr_len;
594         int sndbuf_size, rcvbuf_size, connect_int;
595         int disconnect_on_error = 1;
596
597         rcu_read_lock();
598         nc = rcu_dereference(tconn->net_conf);
599         if (!nc) {
600                 rcu_read_unlock();
601                 return NULL;
602         }
603         sndbuf_size = nc->sndbuf_size;
604         rcvbuf_size = nc->rcvbuf_size;
605         connect_int = nc->connect_int;
606         rcu_read_unlock();
607
608         my_addr_len = min_t(int, tconn->my_addr_len, sizeof(src_in6));
609         memcpy(&src_in6, &tconn->my_addr, my_addr_len);
610
611         if (((struct sockaddr *)&tconn->my_addr)->sa_family == AF_INET6)
612                 src_in6.sin6_port = 0;
613         else
614                 ((struct sockaddr_in *)&src_in6)->sin_port = 0; /* AF_INET & AF_SCI */
615
616         peer_addr_len = min_t(int, tconn->peer_addr_len, sizeof(src_in6));
617         memcpy(&peer_in6, &tconn->peer_addr, peer_addr_len);
618
619         what = "sock_create_kern";
620         err = sock_create_kern(((struct sockaddr *)&src_in6)->sa_family,
621                                SOCK_STREAM, IPPROTO_TCP, &sock);
622         if (err < 0) {
623                 sock = NULL;
624                 goto out;
625         }
626
627         sock->sk->sk_rcvtimeo =
628         sock->sk->sk_sndtimeo = connect_int * HZ;
629         drbd_setbufsize(sock, sndbuf_size, rcvbuf_size);
630
631        /* explicitly bind to the configured IP as source IP
632         *  for the outgoing connections.
633         *  This is needed for multihomed hosts and to be
634         *  able to use lo: interfaces for drbd.
635         * Make sure to use 0 as port number, so linux selects
636         *  a free one dynamically.
637         */
638         what = "bind before connect";
639         err = sock->ops->bind(sock, (struct sockaddr *) &src_in6, my_addr_len);
640         if (err < 0)
641                 goto out;
642
643         /* connect may fail, peer not yet available.
644          * stay C_WF_CONNECTION, don't go Disconnecting! */
645         disconnect_on_error = 0;
646         what = "connect";
647         err = sock->ops->connect(sock, (struct sockaddr *) &peer_in6, peer_addr_len, 0);
648
649 out:
650         if (err < 0) {
651                 if (sock) {
652                         sock_release(sock);
653                         sock = NULL;
654                 }
655                 switch (-err) {
656                         /* timeout, busy, signal pending */
657                 case ETIMEDOUT: case EAGAIN: case EINPROGRESS:
658                 case EINTR: case ERESTARTSYS:
659                         /* peer not (yet) available, network problem */
660                 case ECONNREFUSED: case ENETUNREACH:
661                 case EHOSTDOWN:    case EHOSTUNREACH:
662                         disconnect_on_error = 0;
663                         break;
664                 default:
665                         conn_err(tconn, "%s failed, err = %d\n", what, err);
666                 }
667                 if (disconnect_on_error)
668                         conn_request_state(tconn, NS(conn, C_DISCONNECTING), CS_HARD);
669         }
670
671         return sock;
672 }
673
674 struct accept_wait_data {
675         struct drbd_tconn *tconn;
676         struct socket *s_listen;
677         struct completion door_bell;
678         void (*original_sk_state_change)(struct sock *sk);
679
680 };
681
682 static void incomming_connection(struct sock *sk)
683 {
684         struct accept_wait_data *ad = sk->sk_user_data;
685         struct drbd_tconn *tconn = ad->tconn;
686
687         if (sk->sk_state != TCP_ESTABLISHED)
688                 conn_warn(tconn, "unexpected tcp state change. sk_state = %d\n", sk->sk_state);
689
690         write_lock_bh(&sk->sk_callback_lock);
691         sk->sk_state_change = ad->original_sk_state_change;
692         sk->sk_user_data = NULL;
693         write_unlock_bh(&sk->sk_callback_lock);
694
695         sk->sk_state_change(sk);
696         complete(&ad->door_bell);
697 }
698
699 static int prepare_listen_socket(struct drbd_tconn *tconn, struct accept_wait_data *ad)
700 {
701         int err, sndbuf_size, rcvbuf_size, my_addr_len;
702         struct sockaddr_in6 my_addr;
703         struct socket *s_listen;
704         struct net_conf *nc;
705         const char *what;
706
707         rcu_read_lock();
708         nc = rcu_dereference(tconn->net_conf);
709         if (!nc) {
710                 rcu_read_unlock();
711                 return -EIO;
712         }
713         sndbuf_size = nc->sndbuf_size;
714         rcvbuf_size = nc->rcvbuf_size;
715         rcu_read_unlock();
716
717         my_addr_len = min_t(int, tconn->my_addr_len, sizeof(struct sockaddr_in6));
718         memcpy(&my_addr, &tconn->my_addr, my_addr_len);
719
720         what = "sock_create_kern";
721         err = sock_create_kern(((struct sockaddr *)&my_addr)->sa_family,
722                                SOCK_STREAM, IPPROTO_TCP, &s_listen);
723         if (err) {
724                 s_listen = NULL;
725                 goto out;
726         }
727
728         s_listen->sk->sk_reuse = 1; /* SO_REUSEADDR */
729         drbd_setbufsize(s_listen, sndbuf_size, rcvbuf_size);
730
731         what = "bind before listen";
732         err = s_listen->ops->bind(s_listen, (struct sockaddr *)&my_addr, my_addr_len);
733         if (err < 0)
734                 goto out;
735
736         ad->s_listen = s_listen;
737         write_lock_bh(&s_listen->sk->sk_callback_lock);
738         ad->original_sk_state_change = s_listen->sk->sk_state_change;
739         s_listen->sk->sk_state_change = incomming_connection;
740         s_listen->sk->sk_user_data = ad;
741         write_unlock_bh(&s_listen->sk->sk_callback_lock);
742
743         what = "listen";
744         err = s_listen->ops->listen(s_listen, 5);
745         if (err < 0)
746                 goto out;
747
748         return 0;
749 out:
750         if (s_listen)
751                 sock_release(s_listen);
752         if (err < 0) {
753                 if (err != -EAGAIN && err != -EINTR && err != -ERESTARTSYS) {
754                         conn_err(tconn, "%s failed, err = %d\n", what, err);
755                         conn_request_state(tconn, NS(conn, C_DISCONNECTING), CS_HARD);
756                 }
757         }
758
759         return -EIO;
760 }
761
762 static struct socket *drbd_wait_for_connect(struct drbd_tconn *tconn, struct accept_wait_data *ad)
763 {
764         int timeo, connect_int, err = 0;
765         struct socket *s_estab = NULL;
766         struct net_conf *nc;
767
768         rcu_read_lock();
769         nc = rcu_dereference(tconn->net_conf);
770         if (!nc) {
771                 rcu_read_unlock();
772                 return NULL;
773         }
774         connect_int = nc->connect_int;
775         rcu_read_unlock();
776
777         timeo = connect_int * HZ;
778         timeo += (random32() & 1) ? timeo / 7 : -timeo / 7; /* 28.5% random jitter */
779
780         err = wait_for_completion_interruptible_timeout(&ad->door_bell, timeo);
781         if (err <= 0)
782                 return NULL;
783
784         err = kernel_accept(ad->s_listen, &s_estab, 0);
785         if (err < 0) {
786                 if (err != -EAGAIN && err != -EINTR && err != -ERESTARTSYS) {
787                         conn_err(tconn, "accept failed, err = %d\n", err);
788                         conn_request_state(tconn, NS(conn, C_DISCONNECTING), CS_HARD);
789                 }
790         }
791
792         return s_estab;
793 }
794
795 static int decode_header(struct drbd_tconn *, void *, struct packet_info *);
796
797 static int send_first_packet(struct drbd_tconn *tconn, struct drbd_socket *sock,
798                              enum drbd_packet cmd)
799 {
800         if (!conn_prepare_command(tconn, sock))
801                 return -EIO;
802         return conn_send_command(tconn, sock, cmd, 0, NULL, 0);
803 }
804
805 static int receive_first_packet(struct drbd_tconn *tconn, struct socket *sock)
806 {
807         unsigned int header_size = drbd_header_size(tconn);
808         struct packet_info pi;
809         int err;
810
811         err = drbd_recv_short(sock, tconn->data.rbuf, header_size, 0);
812         if (err != header_size) {
813                 if (err >= 0)
814                         err = -EIO;
815                 return err;
816         }
817         err = decode_header(tconn, tconn->data.rbuf, &pi);
818         if (err)
819                 return err;
820         return pi.cmd;
821 }
822
823 /**
824  * drbd_socket_okay() - Free the socket if its connection is not okay
825  * @sock:       pointer to the pointer to the socket.
826  */
827 static int drbd_socket_okay(struct socket **sock)
828 {
829         int rr;
830         char tb[4];
831
832         if (!*sock)
833                 return false;
834
835         rr = drbd_recv_short(*sock, tb, 4, MSG_DONTWAIT | MSG_PEEK);
836
837         if (rr > 0 || rr == -EAGAIN) {
838                 return true;
839         } else {
840                 sock_release(*sock);
841                 *sock = NULL;
842                 return false;
843         }
844 }
845 /* Gets called if a connection is established, or if a new minor gets created
846    in a connection */
847 int drbd_connected(struct drbd_conf *mdev)
848 {
849         int err;
850
851         atomic_set(&mdev->packet_seq, 0);
852         mdev->peer_seq = 0;
853
854         mdev->state_mutex = mdev->tconn->agreed_pro_version < 100 ?
855                 &mdev->tconn->cstate_mutex :
856                 &mdev->own_state_mutex;
857
858         err = drbd_send_sync_param(mdev);
859         if (!err)
860                 err = drbd_send_sizes(mdev, 0, 0);
861         if (!err)
862                 err = drbd_send_uuids(mdev);
863         if (!err)
864                 err = drbd_send_current_state(mdev);
865         clear_bit(USE_DEGR_WFC_T, &mdev->flags);
866         clear_bit(RESIZE_PENDING, &mdev->flags);
867         mod_timer(&mdev->request_timer, jiffies + HZ); /* just start it here. */
868         return err;
869 }
870
871 /*
872  * return values:
873  *   1 yes, we have a valid connection
874  *   0 oops, did not work out, please try again
875  *  -1 peer talks different language,
876  *     no point in trying again, please go standalone.
877  *  -2 We do not have a network config...
878  */
879 static int conn_connect(struct drbd_tconn *tconn)
880 {
881         struct drbd_socket sock, msock;
882         struct drbd_conf *mdev;
883         struct net_conf *nc;
884         int vnr, timeout, h, ok;
885         bool discard_my_data;
886         enum drbd_state_rv rv;
887         struct accept_wait_data ad = {
888                 .tconn = tconn,
889                 .door_bell = COMPLETION_INITIALIZER_ONSTACK(ad.door_bell),
890         };
891
892         if (conn_request_state(tconn, NS(conn, C_WF_CONNECTION), CS_VERBOSE) < SS_SUCCESS)
893                 return -2;
894
895         mutex_init(&sock.mutex);
896         sock.sbuf = tconn->data.sbuf;
897         sock.rbuf = tconn->data.rbuf;
898         sock.socket = NULL;
899         mutex_init(&msock.mutex);
900         msock.sbuf = tconn->meta.sbuf;
901         msock.rbuf = tconn->meta.rbuf;
902         msock.socket = NULL;
903
904         clear_bit(DISCARD_CONCURRENT, &tconn->flags);
905
906         /* Assume that the peer only understands protocol 80 until we know better.  */
907         tconn->agreed_pro_version = 80;
908
909         if (prepare_listen_socket(tconn, &ad))
910                 return 0;
911
912         do {
913                 struct socket *s;
914
915                 s = drbd_try_connect(tconn);
916                 if (s) {
917                         if (!sock.socket) {
918                                 sock.socket = s;
919                                 send_first_packet(tconn, &sock, P_INITIAL_DATA);
920                         } else if (!msock.socket) {
921                                 msock.socket = s;
922                                 send_first_packet(tconn, &msock, P_INITIAL_META);
923                         } else {
924                                 conn_err(tconn, "Logic error in conn_connect()\n");
925                                 goto out_release_sockets;
926                         }
927                 }
928
929                 if (sock.socket && msock.socket) {
930                         rcu_read_lock();
931                         nc = rcu_dereference(tconn->net_conf);
932                         timeout = nc->ping_timeo * HZ / 10;
933                         rcu_read_unlock();
934                         schedule_timeout_interruptible(timeout);
935                         ok = drbd_socket_okay(&sock.socket);
936                         ok = drbd_socket_okay(&msock.socket) && ok;
937                         if (ok)
938                                 break;
939                 }
940
941 retry:
942                 s = drbd_wait_for_connect(tconn, &ad);
943                 if (s) {
944                         int fp = receive_first_packet(tconn, s);
945                         drbd_socket_okay(&sock.socket);
946                         drbd_socket_okay(&msock.socket);
947                         switch (fp) {
948                         case P_INITIAL_DATA:
949                                 if (sock.socket) {
950                                         conn_warn(tconn, "initial packet S crossed\n");
951                                         sock_release(sock.socket);
952                                         sock.socket = s;
953                                         goto randomize;
954                                 }
955                                 sock.socket = s;
956                                 break;
957                         case P_INITIAL_META:
958                                 set_bit(DISCARD_CONCURRENT, &tconn->flags);
959                                 if (msock.socket) {
960                                         conn_warn(tconn, "initial packet M crossed\n");
961                                         sock_release(msock.socket);
962                                         msock.socket = s;
963                                         goto randomize;
964                                 }
965                                 msock.socket = s;
966                                 break;
967                         default:
968                                 conn_warn(tconn, "Error receiving initial packet\n");
969                                 sock_release(s);
970 randomize:
971                                 if (random32() & 1)
972                                         goto retry;
973                         }
974                 }
975
976                 if (tconn->cstate <= C_DISCONNECTING)
977                         goto out_release_sockets;
978                 if (signal_pending(current)) {
979                         flush_signals(current);
980                         smp_rmb();
981                         if (get_t_state(&tconn->receiver) == EXITING)
982                                 goto out_release_sockets;
983                 }
984
985                 ok = drbd_socket_okay(&sock.socket);
986                 ok = drbd_socket_okay(&msock.socket) && ok;
987         } while (!ok);
988
989         if (ad.s_listen)
990                 sock_release(ad.s_listen);
991
992         sock.socket->sk->sk_reuse = 1; /* SO_REUSEADDR */
993         msock.socket->sk->sk_reuse = 1; /* SO_REUSEADDR */
994
995         sock.socket->sk->sk_allocation = GFP_NOIO;
996         msock.socket->sk->sk_allocation = GFP_NOIO;
997
998         sock.socket->sk->sk_priority = TC_PRIO_INTERACTIVE_BULK;
999         msock.socket->sk->sk_priority = TC_PRIO_INTERACTIVE;
1000
1001         /* NOT YET ...
1002          * sock.socket->sk->sk_sndtimeo = tconn->net_conf->timeout*HZ/10;
1003          * sock.socket->sk->sk_rcvtimeo = MAX_SCHEDULE_TIMEOUT;
1004          * first set it to the P_CONNECTION_FEATURES timeout,
1005          * which we set to 4x the configured ping_timeout. */
1006         rcu_read_lock();
1007         nc = rcu_dereference(tconn->net_conf);
1008
1009         sock.socket->sk->sk_sndtimeo =
1010         sock.socket->sk->sk_rcvtimeo = nc->ping_timeo*4*HZ/10;
1011
1012         msock.socket->sk->sk_rcvtimeo = nc->ping_int*HZ;
1013         timeout = nc->timeout * HZ / 10;
1014         discard_my_data = nc->discard_my_data;
1015         rcu_read_unlock();
1016
1017         msock.socket->sk->sk_sndtimeo = timeout;
1018
1019         /* we don't want delays.
1020          * we use TCP_CORK where appropriate, though */
1021         drbd_tcp_nodelay(sock.socket);
1022         drbd_tcp_nodelay(msock.socket);
1023
1024         tconn->data.socket = sock.socket;
1025         tconn->meta.socket = msock.socket;
1026         tconn->last_received = jiffies;
1027
1028         h = drbd_do_features(tconn);
1029         if (h <= 0)
1030                 return h;
1031
1032         if (tconn->cram_hmac_tfm) {
1033                 /* drbd_request_state(mdev, NS(conn, WFAuth)); */
1034                 switch (drbd_do_auth(tconn)) {
1035                 case -1:
1036                         conn_err(tconn, "Authentication of peer failed\n");
1037                         return -1;
1038                 case 0:
1039                         conn_err(tconn, "Authentication of peer failed, trying again.\n");
1040                         return 0;
1041                 }
1042         }
1043
1044         tconn->data.socket->sk->sk_sndtimeo = timeout;
1045         tconn->data.socket->sk->sk_rcvtimeo = MAX_SCHEDULE_TIMEOUT;
1046
1047         if (drbd_send_protocol(tconn) == -EOPNOTSUPP)
1048                 return -1;
1049
1050         set_bit(STATE_SENT, &tconn->flags);
1051
1052         rcu_read_lock();
1053         idr_for_each_entry(&tconn->volumes, mdev, vnr) {
1054                 kref_get(&mdev->kref);
1055                 rcu_read_unlock();
1056
1057                 if (discard_my_data)
1058                         set_bit(DISCARD_MY_DATA, &mdev->flags);
1059                 else
1060                         clear_bit(DISCARD_MY_DATA, &mdev->flags);
1061
1062                 drbd_connected(mdev);
1063                 kref_put(&mdev->kref, &drbd_minor_destroy);
1064                 rcu_read_lock();
1065         }
1066         rcu_read_unlock();
1067
1068         rv = conn_request_state(tconn, NS(conn, C_WF_REPORT_PARAMS), CS_VERBOSE);
1069         if (rv < SS_SUCCESS) {
1070                 clear_bit(STATE_SENT, &tconn->flags);
1071                 return 0;
1072         }
1073
1074         drbd_thread_start(&tconn->asender);
1075
1076         mutex_lock(&tconn->conf_update);
1077         /* The discard_my_data flag is a single-shot modifier to the next
1078          * connection attempt, the handshake of which is now well underway.
1079          * No need for rcu style copying of the whole struct
1080          * just to clear a single value. */
1081         tconn->net_conf->discard_my_data = 0;
1082         mutex_unlock(&tconn->conf_update);
1083
1084         return h;
1085
1086 out_release_sockets:
1087         if (ad.s_listen)
1088                 sock_release(ad.s_listen);
1089         if (sock.socket)
1090                 sock_release(sock.socket);
1091         if (msock.socket)
1092                 sock_release(msock.socket);
1093         return -1;
1094 }
1095
1096 static int decode_header(struct drbd_tconn *tconn, void *header, struct packet_info *pi)
1097 {
1098         unsigned int header_size = drbd_header_size(tconn);
1099
1100         if (header_size == sizeof(struct p_header100) &&
1101             *(__be32 *)header == cpu_to_be32(DRBD_MAGIC_100)) {
1102                 struct p_header100 *h = header;
1103                 if (h->pad != 0) {
1104                         conn_err(tconn, "Header padding is not zero\n");
1105                         return -EINVAL;
1106                 }
1107                 pi->vnr = be16_to_cpu(h->volume);
1108                 pi->cmd = be16_to_cpu(h->command);
1109                 pi->size = be32_to_cpu(h->length);
1110         } else if (header_size == sizeof(struct p_header95) &&
1111                    *(__be16 *)header == cpu_to_be16(DRBD_MAGIC_BIG)) {
1112                 struct p_header95 *h = header;
1113                 pi->cmd = be16_to_cpu(h->command);
1114                 pi->size = be32_to_cpu(h->length);
1115                 pi->vnr = 0;
1116         } else if (header_size == sizeof(struct p_header80) &&
1117                    *(__be32 *)header == cpu_to_be32(DRBD_MAGIC)) {
1118                 struct p_header80 *h = header;
1119                 pi->cmd = be16_to_cpu(h->command);
1120                 pi->size = be16_to_cpu(h->length);
1121                 pi->vnr = 0;
1122         } else {
1123                 conn_err(tconn, "Wrong magic value 0x%08x in protocol version %d\n",
1124                          be32_to_cpu(*(__be32 *)header),
1125                          tconn->agreed_pro_version);
1126                 return -EINVAL;
1127         }
1128         pi->data = header + header_size;
1129         return 0;
1130 }
1131
1132 static int drbd_recv_header(struct drbd_tconn *tconn, struct packet_info *pi)
1133 {
1134         void *buffer = tconn->data.rbuf;
1135         int err;
1136
1137         err = drbd_recv_all_warn(tconn, buffer, drbd_header_size(tconn));
1138         if (err)
1139                 return err;
1140
1141         err = decode_header(tconn, buffer, pi);
1142         tconn->last_received = jiffies;
1143
1144         return err;
1145 }
1146
1147 static void drbd_flush(struct drbd_tconn *tconn)
1148 {
1149         int rv;
1150         struct drbd_conf *mdev;
1151         int vnr;
1152
1153         if (tconn->write_ordering >= WO_bdev_flush) {
1154                 rcu_read_lock();
1155                 idr_for_each_entry(&tconn->volumes, mdev, vnr) {
1156                         if (!get_ldev(mdev))
1157                                 continue;
1158                         kref_get(&mdev->kref);
1159                         rcu_read_unlock();
1160
1161                         rv = blkdev_issue_flush(mdev->ldev->backing_bdev,
1162                                         GFP_NOIO, NULL);
1163                         if (rv) {
1164                                 dev_info(DEV, "local disk flush failed with status %d\n", rv);
1165                                 /* would rather check on EOPNOTSUPP, but that is not reliable.
1166                                  * don't try again for ANY return value != 0
1167                                  * if (rv == -EOPNOTSUPP) */
1168                                 drbd_bump_write_ordering(tconn, WO_drain_io);
1169                         }
1170                         put_ldev(mdev);
1171                         kref_put(&mdev->kref, &drbd_minor_destroy);
1172
1173                         rcu_read_lock();
1174                         if (rv)
1175                                 break;
1176                 }
1177                 rcu_read_unlock();
1178         }
1179 }
1180
1181 /**
1182  * drbd_may_finish_epoch() - Applies an epoch_event to the epoch's state, eventually finishes it.
1183  * @mdev:       DRBD device.
1184  * @epoch:      Epoch object.
1185  * @ev:         Epoch event.
1186  */
1187 static enum finish_epoch drbd_may_finish_epoch(struct drbd_tconn *tconn,
1188                                                struct drbd_epoch *epoch,
1189                                                enum epoch_event ev)
1190 {
1191         int epoch_size;
1192         struct drbd_epoch *next_epoch;
1193         enum finish_epoch rv = FE_STILL_LIVE;
1194
1195         spin_lock(&tconn->epoch_lock);
1196         do {
1197                 next_epoch = NULL;
1198
1199                 epoch_size = atomic_read(&epoch->epoch_size);
1200
1201                 switch (ev & ~EV_CLEANUP) {
1202                 case EV_PUT:
1203                         atomic_dec(&epoch->active);
1204                         break;
1205                 case EV_GOT_BARRIER_NR:
1206                         set_bit(DE_HAVE_BARRIER_NUMBER, &epoch->flags);
1207                         break;
1208                 case EV_BECAME_LAST:
1209                         /* nothing to do*/
1210                         break;
1211                 }
1212
1213                 if (epoch_size != 0 &&
1214                     atomic_read(&epoch->active) == 0 &&
1215                     (test_bit(DE_HAVE_BARRIER_NUMBER, &epoch->flags) || ev & EV_CLEANUP)) {
1216                         if (!(ev & EV_CLEANUP)) {
1217                                 spin_unlock(&tconn->epoch_lock);
1218                                 drbd_send_b_ack(epoch->tconn, epoch->barrier_nr, epoch_size);
1219                                 spin_lock(&tconn->epoch_lock);
1220                         }
1221 #if 0
1222                         /* FIXME: dec unacked on connection, once we have
1223                          * something to count pending connection packets in. */
1224                         if (test_bit(DE_HAVE_BARRIER_NUMBER, &epoch->flags))
1225                                 dec_unacked(epoch->tconn);
1226 #endif
1227
1228                         if (tconn->current_epoch != epoch) {
1229                                 next_epoch = list_entry(epoch->list.next, struct drbd_epoch, list);
1230                                 list_del(&epoch->list);
1231                                 ev = EV_BECAME_LAST | (ev & EV_CLEANUP);
1232                                 tconn->epochs--;
1233                                 kfree(epoch);
1234
1235                                 if (rv == FE_STILL_LIVE)
1236                                         rv = FE_DESTROYED;
1237                         } else {
1238                                 epoch->flags = 0;
1239                                 atomic_set(&epoch->epoch_size, 0);
1240                                 /* atomic_set(&epoch->active, 0); is already zero */
1241                                 if (rv == FE_STILL_LIVE)
1242                                         rv = FE_RECYCLED;
1243                         }
1244                 }
1245
1246                 if (!next_epoch)
1247                         break;
1248
1249                 epoch = next_epoch;
1250         } while (1);
1251
1252         spin_unlock(&tconn->epoch_lock);
1253
1254         return rv;
1255 }
1256
1257 /**
1258  * drbd_bump_write_ordering() - Fall back to an other write ordering method
1259  * @tconn:      DRBD connection.
1260  * @wo:         Write ordering method to try.
1261  */
1262 void drbd_bump_write_ordering(struct drbd_tconn *tconn, enum write_ordering_e wo)
1263 {
1264         struct disk_conf *dc;
1265         struct drbd_conf *mdev;
1266         enum write_ordering_e pwo;
1267         int vnr;
1268         static char *write_ordering_str[] = {
1269                 [WO_none] = "none",
1270                 [WO_drain_io] = "drain",
1271                 [WO_bdev_flush] = "flush",
1272         };
1273
1274         pwo = tconn->write_ordering;
1275         wo = min(pwo, wo);
1276         rcu_read_lock();
1277         idr_for_each_entry(&tconn->volumes, mdev, vnr) {
1278                 if (!get_ldev_if_state(mdev, D_ATTACHING))
1279                         continue;
1280                 dc = rcu_dereference(mdev->ldev->disk_conf);
1281
1282                 if (wo == WO_bdev_flush && !dc->disk_flushes)
1283                         wo = WO_drain_io;
1284                 if (wo == WO_drain_io && !dc->disk_drain)
1285                         wo = WO_none;
1286                 put_ldev(mdev);
1287         }
1288         rcu_read_unlock();
1289         tconn->write_ordering = wo;
1290         if (pwo != tconn->write_ordering || wo == WO_bdev_flush)
1291                 conn_info(tconn, "Method to ensure write ordering: %s\n", write_ordering_str[tconn->write_ordering]);
1292 }
1293
1294 /**
1295  * drbd_submit_peer_request()
1296  * @mdev:       DRBD device.
1297  * @peer_req:   peer request
1298  * @rw:         flag field, see bio->bi_rw
1299  *
1300  * May spread the pages to multiple bios,
1301  * depending on bio_add_page restrictions.
1302  *
1303  * Returns 0 if all bios have been submitted,
1304  * -ENOMEM if we could not allocate enough bios,
1305  * -ENOSPC (any better suggestion?) if we have not been able to bio_add_page a
1306  *  single page to an empty bio (which should never happen and likely indicates
1307  *  that the lower level IO stack is in some way broken). This has been observed
1308  *  on certain Xen deployments.
1309  */
1310 /* TODO allocate from our own bio_set. */
1311 int drbd_submit_peer_request(struct drbd_conf *mdev,
1312                              struct drbd_peer_request *peer_req,
1313                              const unsigned rw, const int fault_type)
1314 {
1315         struct bio *bios = NULL;
1316         struct bio *bio;
1317         struct page *page = peer_req->pages;
1318         sector_t sector = peer_req->i.sector;
1319         unsigned ds = peer_req->i.size;
1320         unsigned n_bios = 0;
1321         unsigned nr_pages = (ds + PAGE_SIZE -1) >> PAGE_SHIFT;
1322         int err = -ENOMEM;
1323
1324         /* In most cases, we will only need one bio.  But in case the lower
1325          * level restrictions happen to be different at this offset on this
1326          * side than those of the sending peer, we may need to submit the
1327          * request in more than one bio.
1328          *
1329          * Plain bio_alloc is good enough here, this is no DRBD internally
1330          * generated bio, but a bio allocated on behalf of the peer.
1331          */
1332 next_bio:
1333         bio = bio_alloc(GFP_NOIO, nr_pages);
1334         if (!bio) {
1335                 dev_err(DEV, "submit_ee: Allocation of a bio failed\n");
1336                 goto fail;
1337         }
1338         /* > peer_req->i.sector, unless this is the first bio */
1339         bio->bi_sector = sector;
1340         bio->bi_bdev = mdev->ldev->backing_bdev;
1341         bio->bi_rw = rw;
1342         bio->bi_private = peer_req;
1343         bio->bi_end_io = drbd_peer_request_endio;
1344
1345         bio->bi_next = bios;
1346         bios = bio;
1347         ++n_bios;
1348
1349         page_chain_for_each(page) {
1350                 unsigned len = min_t(unsigned, ds, PAGE_SIZE);
1351                 if (!bio_add_page(bio, page, len, 0)) {
1352                         /* A single page must always be possible!
1353                          * But in case it fails anyways,
1354                          * we deal with it, and complain (below). */
1355                         if (bio->bi_vcnt == 0) {
1356                                 dev_err(DEV,
1357                                         "bio_add_page failed for len=%u, "
1358                                         "bi_vcnt=0 (bi_sector=%llu)\n",
1359                                         len, (unsigned long long)bio->bi_sector);
1360                                 err = -ENOSPC;
1361                                 goto fail;
1362                         }
1363                         goto next_bio;
1364                 }
1365                 ds -= len;
1366                 sector += len >> 9;
1367                 --nr_pages;
1368         }
1369         D_ASSERT(page == NULL);
1370         D_ASSERT(ds == 0);
1371
1372         atomic_set(&peer_req->pending_bios, n_bios);
1373         do {
1374                 bio = bios;
1375                 bios = bios->bi_next;
1376                 bio->bi_next = NULL;
1377
1378                 drbd_generic_make_request(mdev, fault_type, bio);
1379         } while (bios);
1380         return 0;
1381
1382 fail:
1383         while (bios) {
1384                 bio = bios;
1385                 bios = bios->bi_next;
1386                 bio_put(bio);
1387         }
1388         return err;
1389 }
1390
1391 static void drbd_remove_epoch_entry_interval(struct drbd_conf *mdev,
1392                                              struct drbd_peer_request *peer_req)
1393 {
1394         struct drbd_interval *i = &peer_req->i;
1395
1396         drbd_remove_interval(&mdev->write_requests, i);
1397         drbd_clear_interval(i);
1398
1399         /* Wake up any processes waiting for this peer request to complete.  */
1400         if (i->waiting)
1401                 wake_up(&mdev->misc_wait);
1402 }
1403
1404 void conn_wait_active_ee_empty(struct drbd_tconn *tconn)
1405 {
1406         struct drbd_conf *mdev;
1407         int vnr;
1408
1409         rcu_read_lock();
1410         idr_for_each_entry(&tconn->volumes, mdev, vnr) {
1411                 kref_get(&mdev->kref);
1412                 rcu_read_unlock();
1413                 drbd_wait_ee_list_empty(mdev, &mdev->active_ee);
1414                 kref_put(&mdev->kref, &drbd_minor_destroy);
1415                 rcu_read_lock();
1416         }
1417         rcu_read_unlock();
1418 }
1419
1420 static int receive_Barrier(struct drbd_tconn *tconn, struct packet_info *pi)
1421 {
1422         int rv;
1423         struct p_barrier *p = pi->data;
1424         struct drbd_epoch *epoch;
1425
1426         /* FIXME these are unacked on connection,
1427          * not a specific (peer)device.
1428          */
1429         tconn->current_epoch->barrier_nr = p->barrier;
1430         tconn->current_epoch->tconn = tconn;
1431         rv = drbd_may_finish_epoch(tconn, tconn->current_epoch, EV_GOT_BARRIER_NR);
1432
1433         /* P_BARRIER_ACK may imply that the corresponding extent is dropped from
1434          * the activity log, which means it would not be resynced in case the
1435          * R_PRIMARY crashes now.
1436          * Therefore we must send the barrier_ack after the barrier request was
1437          * completed. */
1438         switch (tconn->write_ordering) {
1439         case WO_none:
1440                 if (rv == FE_RECYCLED)
1441                         return 0;
1442
1443                 /* receiver context, in the writeout path of the other node.
1444                  * avoid potential distributed deadlock */
1445                 epoch = kmalloc(sizeof(struct drbd_epoch), GFP_NOIO);
1446                 if (epoch)
1447                         break;
1448                 else
1449                         conn_warn(tconn, "Allocation of an epoch failed, slowing down\n");
1450                         /* Fall through */
1451
1452         case WO_bdev_flush:
1453         case WO_drain_io:
1454                 conn_wait_active_ee_empty(tconn);
1455                 drbd_flush(tconn);
1456
1457                 if (atomic_read(&tconn->current_epoch->epoch_size)) {
1458                         epoch = kmalloc(sizeof(struct drbd_epoch), GFP_NOIO);
1459                         if (epoch)
1460                                 break;
1461                 }
1462
1463                 return 0;
1464         default:
1465                 conn_err(tconn, "Strangeness in tconn->write_ordering %d\n", tconn->write_ordering);
1466                 return -EIO;
1467         }
1468
1469         epoch->flags = 0;
1470         atomic_set(&epoch->epoch_size, 0);
1471         atomic_set(&epoch->active, 0);
1472
1473         spin_lock(&tconn->epoch_lock);
1474         if (atomic_read(&tconn->current_epoch->epoch_size)) {
1475                 list_add(&epoch->list, &tconn->current_epoch->list);
1476                 tconn->current_epoch = epoch;
1477                 tconn->epochs++;
1478         } else {
1479                 /* The current_epoch got recycled while we allocated this one... */
1480                 kfree(epoch);
1481         }
1482         spin_unlock(&tconn->epoch_lock);
1483
1484         return 0;
1485 }
1486
1487 /* used from receive_RSDataReply (recv_resync_read)
1488  * and from receive_Data */
1489 static struct drbd_peer_request *
1490 read_in_block(struct drbd_conf *mdev, u64 id, sector_t sector,
1491               int data_size) __must_hold(local)
1492 {
1493         const sector_t capacity = drbd_get_capacity(mdev->this_bdev);
1494         struct drbd_peer_request *peer_req;
1495         struct page *page;
1496         int dgs, ds, err;
1497         void *dig_in = mdev->tconn->int_dig_in;
1498         void *dig_vv = mdev->tconn->int_dig_vv;
1499         unsigned long *data;
1500
1501         dgs = 0;
1502         if (mdev->tconn->peer_integrity_tfm) {
1503                 dgs = crypto_hash_digestsize(mdev->tconn->peer_integrity_tfm);
1504                 /*
1505                  * FIXME: Receive the incoming digest into the receive buffer
1506                  *        here, together with its struct p_data?
1507                  */
1508                 err = drbd_recv_all_warn(mdev->tconn, dig_in, dgs);
1509                 if (err)
1510                         return NULL;
1511                 data_size -= dgs;
1512         }
1513
1514         if (!expect(IS_ALIGNED(data_size, 512)))
1515                 return NULL;
1516         if (!expect(data_size <= DRBD_MAX_BIO_SIZE))
1517                 return NULL;
1518
1519         /* even though we trust out peer,
1520          * we sometimes have to double check. */
1521         if (sector + (data_size>>9) > capacity) {
1522                 dev_err(DEV, "request from peer beyond end of local disk: "
1523                         "capacity: %llus < sector: %llus + size: %u\n",
1524                         (unsigned long long)capacity,
1525                         (unsigned long long)sector, data_size);
1526                 return NULL;
1527         }
1528
1529         /* GFP_NOIO, because we must not cause arbitrary write-out: in a DRBD
1530          * "criss-cross" setup, that might cause write-out on some other DRBD,
1531          * which in turn might block on the other node at this very place.  */
1532         peer_req = drbd_alloc_peer_req(mdev, id, sector, data_size, GFP_NOIO);
1533         if (!peer_req)
1534                 return NULL;
1535
1536         if (!data_size)
1537                 return peer_req;
1538
1539         ds = data_size;
1540         page = peer_req->pages;
1541         page_chain_for_each(page) {
1542                 unsigned len = min_t(int, ds, PAGE_SIZE);
1543                 data = kmap(page);
1544                 err = drbd_recv_all_warn(mdev->tconn, data, len);
1545                 if (drbd_insert_fault(mdev, DRBD_FAULT_RECEIVE)) {
1546                         dev_err(DEV, "Fault injection: Corrupting data on receive\n");
1547                         data[0] = data[0] ^ (unsigned long)-1;
1548                 }
1549                 kunmap(page);
1550                 if (err) {
1551                         drbd_free_peer_req(mdev, peer_req);
1552                         return NULL;
1553                 }
1554                 ds -= len;
1555         }
1556
1557         if (dgs) {
1558                 drbd_csum_ee(mdev, mdev->tconn->peer_integrity_tfm, peer_req, dig_vv);
1559                 if (memcmp(dig_in, dig_vv, dgs)) {
1560                         dev_err(DEV, "Digest integrity check FAILED: %llus +%u\n",
1561                                 (unsigned long long)sector, data_size);
1562                         drbd_free_peer_req(mdev, peer_req);
1563                         return NULL;
1564                 }
1565         }
1566         mdev->recv_cnt += data_size>>9;
1567         return peer_req;
1568 }
1569
1570 /* drbd_drain_block() just takes a data block
1571  * out of the socket input buffer, and discards it.
1572  */
1573 static int drbd_drain_block(struct drbd_conf *mdev, int data_size)
1574 {
1575         struct page *page;
1576         int err = 0;
1577         void *data;
1578
1579         if (!data_size)
1580                 return 0;
1581
1582         page = drbd_alloc_pages(mdev, 1, 1);
1583
1584         data = kmap(page);
1585         while (data_size) {
1586                 unsigned int len = min_t(int, data_size, PAGE_SIZE);
1587
1588                 err = drbd_recv_all_warn(mdev->tconn, data, len);
1589                 if (err)
1590                         break;
1591                 data_size -= len;
1592         }
1593         kunmap(page);
1594         drbd_free_pages(mdev, page, 0);
1595         return err;
1596 }
1597
1598 static int recv_dless_read(struct drbd_conf *mdev, struct drbd_request *req,
1599                            sector_t sector, int data_size)
1600 {
1601         struct bio_vec *bvec;
1602         struct bio *bio;
1603         int dgs, err, i, expect;
1604         void *dig_in = mdev->tconn->int_dig_in;
1605         void *dig_vv = mdev->tconn->int_dig_vv;
1606
1607         dgs = 0;
1608         if (mdev->tconn->peer_integrity_tfm) {
1609                 dgs = crypto_hash_digestsize(mdev->tconn->peer_integrity_tfm);
1610                 err = drbd_recv_all_warn(mdev->tconn, dig_in, dgs);
1611                 if (err)
1612                         return err;
1613                 data_size -= dgs;
1614         }
1615
1616         /* optimistically update recv_cnt.  if receiving fails below,
1617          * we disconnect anyways, and counters will be reset. */
1618         mdev->recv_cnt += data_size>>9;
1619
1620         bio = req->master_bio;
1621         D_ASSERT(sector == bio->bi_sector);
1622
1623         bio_for_each_segment(bvec, bio, i) {
1624                 void *mapped = kmap(bvec->bv_page) + bvec->bv_offset;
1625                 expect = min_t(int, data_size, bvec->bv_len);
1626                 err = drbd_recv_all_warn(mdev->tconn, mapped, expect);
1627                 kunmap(bvec->bv_page);
1628                 if (err)
1629                         return err;
1630                 data_size -= expect;
1631         }
1632
1633         if (dgs) {
1634                 drbd_csum_bio(mdev, mdev->tconn->peer_integrity_tfm, bio, dig_vv);
1635                 if (memcmp(dig_in, dig_vv, dgs)) {
1636                         dev_err(DEV, "Digest integrity check FAILED. Broken NICs?\n");
1637                         return -EINVAL;
1638                 }
1639         }
1640
1641         D_ASSERT(data_size == 0);
1642         return 0;
1643 }
1644
1645 /*
1646  * e_end_resync_block() is called in asender context via
1647  * drbd_finish_peer_reqs().
1648  */
1649 static int e_end_resync_block(struct drbd_work *w, int unused)
1650 {
1651         struct drbd_peer_request *peer_req =
1652                 container_of(w, struct drbd_peer_request, w);
1653         struct drbd_conf *mdev = w->mdev;
1654         sector_t sector = peer_req->i.sector;
1655         int err;
1656
1657         D_ASSERT(drbd_interval_empty(&peer_req->i));
1658
1659         if (likely((peer_req->flags & EE_WAS_ERROR) == 0)) {
1660                 drbd_set_in_sync(mdev, sector, peer_req->i.size);
1661                 err = drbd_send_ack(mdev, P_RS_WRITE_ACK, peer_req);
1662         } else {
1663                 /* Record failure to sync */
1664                 drbd_rs_failed_io(mdev, sector, peer_req->i.size);
1665
1666                 err  = drbd_send_ack(mdev, P_NEG_ACK, peer_req);
1667         }
1668         dec_unacked(mdev);
1669
1670         return err;
1671 }
1672
1673 static int recv_resync_read(struct drbd_conf *mdev, sector_t sector, int data_size) __releases(local)
1674 {
1675         struct drbd_peer_request *peer_req;
1676
1677         peer_req = read_in_block(mdev, ID_SYNCER, sector, data_size);
1678         if (!peer_req)
1679                 goto fail;
1680
1681         dec_rs_pending(mdev);
1682
1683         inc_unacked(mdev);
1684         /* corresponding dec_unacked() in e_end_resync_block()
1685          * respective _drbd_clear_done_ee */
1686
1687         peer_req->w.cb = e_end_resync_block;
1688
1689         spin_lock_irq(&mdev->tconn->req_lock);
1690         list_add(&peer_req->w.list, &mdev->sync_ee);
1691         spin_unlock_irq(&mdev->tconn->req_lock);
1692
1693         atomic_add(data_size >> 9, &mdev->rs_sect_ev);
1694         if (drbd_submit_peer_request(mdev, peer_req, WRITE, DRBD_FAULT_RS_WR) == 0)
1695                 return 0;
1696
1697         /* don't care for the reason here */
1698         dev_err(DEV, "submit failed, triggering re-connect\n");
1699         spin_lock_irq(&mdev->tconn->req_lock);
1700         list_del(&peer_req->w.list);
1701         spin_unlock_irq(&mdev->tconn->req_lock);
1702
1703         drbd_free_peer_req(mdev, peer_req);
1704 fail:
1705         put_ldev(mdev);
1706         return -EIO;
1707 }
1708
1709 static struct drbd_request *
1710 find_request(struct drbd_conf *mdev, struct rb_root *root, u64 id,
1711              sector_t sector, bool missing_ok, const char *func)
1712 {
1713         struct drbd_request *req;
1714
1715         /* Request object according to our peer */
1716         req = (struct drbd_request *)(unsigned long)id;
1717         if (drbd_contains_interval(root, sector, &req->i) && req->i.local)
1718                 return req;
1719         if (!missing_ok) {
1720                 dev_err(DEV, "%s: failed to find request 0x%lx, sector %llus\n", func,
1721                         (unsigned long)id, (unsigned long long)sector);
1722         }
1723         return NULL;
1724 }
1725
1726 static int receive_DataReply(struct drbd_tconn *tconn, struct packet_info *pi)
1727 {
1728         struct drbd_conf *mdev;
1729         struct drbd_request *req;
1730         sector_t sector;
1731         int err;
1732         struct p_data *p = pi->data;
1733
1734         mdev = vnr_to_mdev(tconn, pi->vnr);
1735         if (!mdev)
1736                 return -EIO;
1737
1738         sector = be64_to_cpu(p->sector);
1739
1740         spin_lock_irq(&mdev->tconn->req_lock);
1741         req = find_request(mdev, &mdev->read_requests, p->block_id, sector, false, __func__);
1742         spin_unlock_irq(&mdev->tconn->req_lock);
1743         if (unlikely(!req))
1744                 return -EIO;
1745
1746         /* hlist_del(&req->collision) is done in _req_may_be_done, to avoid
1747          * special casing it there for the various failure cases.
1748          * still no race with drbd_fail_pending_reads */
1749         err = recv_dless_read(mdev, req, sector, pi->size);
1750         if (!err)
1751                 req_mod(req, DATA_RECEIVED);
1752         /* else: nothing. handled from drbd_disconnect...
1753          * I don't think we may complete this just yet
1754          * in case we are "on-disconnect: freeze" */
1755
1756         return err;
1757 }
1758
1759 static int receive_RSDataReply(struct drbd_tconn *tconn, struct packet_info *pi)
1760 {
1761         struct drbd_conf *mdev;
1762         sector_t sector;
1763         int err;
1764         struct p_data *p = pi->data;
1765
1766         mdev = vnr_to_mdev(tconn, pi->vnr);
1767         if (!mdev)
1768                 return -EIO;
1769
1770         sector = be64_to_cpu(p->sector);
1771         D_ASSERT(p->block_id == ID_SYNCER);
1772
1773         if (get_ldev(mdev)) {
1774                 /* data is submitted to disk within recv_resync_read.
1775                  * corresponding put_ldev done below on error,
1776                  * or in drbd_peer_request_endio. */
1777                 err = recv_resync_read(mdev, sector, pi->size);
1778         } else {
1779                 if (__ratelimit(&drbd_ratelimit_state))
1780                         dev_err(DEV, "Can not write resync data to local disk.\n");
1781
1782                 err = drbd_drain_block(mdev, pi->size);
1783
1784                 drbd_send_ack_dp(mdev, P_NEG_ACK, p, pi->size);
1785         }
1786
1787         atomic_add(pi->size >> 9, &mdev->rs_sect_in);
1788
1789         return err;
1790 }
1791
1792 static void restart_conflicting_writes(struct drbd_conf *mdev,
1793                                        sector_t sector, int size)
1794 {
1795         struct drbd_interval *i;
1796         struct drbd_request *req;
1797
1798         drbd_for_each_overlap(i, &mdev->write_requests, sector, size) {
1799                 if (!i->local)
1800                         continue;
1801                 req = container_of(i, struct drbd_request, i);
1802                 if (req->rq_state & RQ_LOCAL_PENDING ||
1803                     !(req->rq_state & RQ_POSTPONED))
1804                         continue;
1805                 /* as it is RQ_POSTPONED, this will cause it to
1806                  * be queued on the retry workqueue. */
1807                 __req_mod(req, DISCARD_WRITE, NULL);
1808         }
1809 }
1810
1811 /*
1812  * e_end_block() is called in asender context via drbd_finish_peer_reqs().
1813  */
1814 static int e_end_block(struct drbd_work *w, int cancel)
1815 {
1816         struct drbd_peer_request *peer_req =
1817                 container_of(w, struct drbd_peer_request, w);
1818         struct drbd_conf *mdev = w->mdev;
1819         sector_t sector = peer_req->i.sector;
1820         int err = 0, pcmd;
1821
1822         if (peer_req->flags & EE_SEND_WRITE_ACK) {
1823                 if (likely((peer_req->flags & EE_WAS_ERROR) == 0)) {
1824                         pcmd = (mdev->state.conn >= C_SYNC_SOURCE &&
1825                                 mdev->state.conn <= C_PAUSED_SYNC_T &&
1826                                 peer_req->flags & EE_MAY_SET_IN_SYNC) ?
1827                                 P_RS_WRITE_ACK : P_WRITE_ACK;
1828                         err = drbd_send_ack(mdev, pcmd, peer_req);
1829                         if (pcmd == P_RS_WRITE_ACK)
1830                                 drbd_set_in_sync(mdev, sector, peer_req->i.size);
1831                 } else {
1832                         err = drbd_send_ack(mdev, P_NEG_ACK, peer_req);
1833                         /* we expect it to be marked out of sync anyways...
1834                          * maybe assert this?  */
1835                 }
1836                 dec_unacked(mdev);
1837         }
1838         /* we delete from the conflict detection hash _after_ we sent out the
1839          * P_WRITE_ACK / P_NEG_ACK, to get the sequence number right.  */
1840         if (peer_req->flags & EE_IN_INTERVAL_TREE) {
1841                 spin_lock_irq(&mdev->tconn->req_lock);
1842                 D_ASSERT(!drbd_interval_empty(&peer_req->i));
1843                 drbd_remove_epoch_entry_interval(mdev, peer_req);
1844                 if (peer_req->flags & EE_RESTART_REQUESTS)
1845                         restart_conflicting_writes(mdev, sector, peer_req->i.size);
1846                 spin_unlock_irq(&mdev->tconn->req_lock);
1847         } else
1848                 D_ASSERT(drbd_interval_empty(&peer_req->i));
1849
1850         drbd_may_finish_epoch(mdev->tconn, peer_req->epoch, EV_PUT + (cancel ? EV_CLEANUP : 0));
1851
1852         return err;
1853 }
1854
1855 static int e_send_ack(struct drbd_work *w, enum drbd_packet ack)
1856 {
1857         struct drbd_conf *mdev = w->mdev;
1858         struct drbd_peer_request *peer_req =
1859                 container_of(w, struct drbd_peer_request, w);
1860         int err;
1861
1862         err = drbd_send_ack(mdev, ack, peer_req);
1863         dec_unacked(mdev);
1864
1865         return err;
1866 }
1867
1868 static int e_send_discard_write(struct drbd_work *w, int unused)
1869 {
1870         return e_send_ack(w, P_DISCARD_WRITE);
1871 }
1872
1873 static int e_send_retry_write(struct drbd_work *w, int unused)
1874 {
1875         struct drbd_tconn *tconn = w->mdev->tconn;
1876
1877         return e_send_ack(w, tconn->agreed_pro_version >= 100 ?
1878                              P_RETRY_WRITE : P_DISCARD_WRITE);
1879 }
1880
1881 static bool seq_greater(u32 a, u32 b)
1882 {
1883         /*
1884          * We assume 32-bit wrap-around here.
1885          * For 24-bit wrap-around, we would have to shift:
1886          *  a <<= 8; b <<= 8;
1887          */
1888         return (s32)a - (s32)b > 0;
1889 }
1890
1891 static u32 seq_max(u32 a, u32 b)
1892 {
1893         return seq_greater(a, b) ? a : b;
1894 }
1895
1896 static bool need_peer_seq(struct drbd_conf *mdev)
1897 {
1898         struct drbd_tconn *tconn = mdev->tconn;
1899         int tp;
1900
1901         /*
1902          * We only need to keep track of the last packet_seq number of our peer
1903          * if we are in dual-primary mode and we have the discard flag set; see
1904          * handle_write_conflicts().
1905          */
1906
1907         rcu_read_lock();
1908         tp = rcu_dereference(mdev->tconn->net_conf)->two_primaries;
1909         rcu_read_unlock();
1910
1911         return tp && test_bit(DISCARD_CONCURRENT, &tconn->flags);
1912 }
1913
1914 static void update_peer_seq(struct drbd_conf *mdev, unsigned int peer_seq)
1915 {
1916         unsigned int newest_peer_seq;
1917
1918         if (need_peer_seq(mdev)) {
1919                 spin_lock(&mdev->peer_seq_lock);
1920                 newest_peer_seq = seq_max(mdev->peer_seq, peer_seq);
1921                 mdev->peer_seq = newest_peer_seq;
1922                 spin_unlock(&mdev->peer_seq_lock);
1923                 /* wake up only if we actually changed mdev->peer_seq */
1924                 if (peer_seq == newest_peer_seq)
1925                         wake_up(&mdev->seq_wait);
1926         }
1927 }
1928
1929 static inline int overlaps(sector_t s1, int l1, sector_t s2, int l2)
1930 {
1931         return !((s1 + (l1>>9) <= s2) || (s1 >= s2 + (l2>>9)));
1932 }
1933
1934 /* maybe change sync_ee into interval trees as well? */
1935 static bool overlapping_resync_write(struct drbd_conf *mdev, struct drbd_peer_request *peer_req)
1936 {
1937         struct drbd_peer_request *rs_req;
1938         bool rv = 0;
1939
1940         spin_lock_irq(&mdev->tconn->req_lock);
1941         list_for_each_entry(rs_req, &mdev->sync_ee, w.list) {
1942                 if (overlaps(peer_req->i.sector, peer_req->i.size,
1943                              rs_req->i.sector, rs_req->i.size)) {
1944                         rv = 1;
1945                         break;
1946                 }
1947         }
1948         spin_unlock_irq(&mdev->tconn->req_lock);
1949
1950         return rv;
1951 }
1952
1953 /* Called from receive_Data.
1954  * Synchronize packets on sock with packets on msock.
1955  *
1956  * This is here so even when a P_DATA packet traveling via sock overtook an Ack
1957  * packet traveling on msock, they are still processed in the order they have
1958  * been sent.
1959  *
1960  * Note: we don't care for Ack packets overtaking P_DATA packets.
1961  *
1962  * In case packet_seq is larger than mdev->peer_seq number, there are
1963  * outstanding packets on the msock. We wait for them to arrive.
1964  * In case we are the logically next packet, we update mdev->peer_seq
1965  * ourselves. Correctly handles 32bit wrap around.
1966  *
1967  * Assume we have a 10 GBit connection, that is about 1<<30 byte per second,
1968  * about 1<<21 sectors per second. So "worst" case, we have 1<<3 == 8 seconds
1969  * for the 24bit wrap (historical atomic_t guarantee on some archs), and we have
1970  * 1<<9 == 512 seconds aka ages for the 32bit wrap around...
1971  *
1972  * returns 0 if we may process the packet,
1973  * -ERESTARTSYS if we were interrupted (by disconnect signal). */
1974 static int wait_for_and_update_peer_seq(struct drbd_conf *mdev, const u32 peer_seq)
1975 {
1976         DEFINE_WAIT(wait);
1977         long timeout;
1978         int ret;
1979
1980         if (!need_peer_seq(mdev))
1981                 return 0;
1982
1983         spin_lock(&mdev->peer_seq_lock);
1984         for (;;) {
1985                 if (!seq_greater(peer_seq - 1, mdev->peer_seq)) {
1986                         mdev->peer_seq = seq_max(mdev->peer_seq, peer_seq);
1987                         ret = 0;
1988                         break;
1989                 }
1990                 if (signal_pending(current)) {
1991                         ret = -ERESTARTSYS;
1992                         break;
1993                 }
1994                 prepare_to_wait(&mdev->seq_wait, &wait, TASK_INTERRUPTIBLE);
1995                 spin_unlock(&mdev->peer_seq_lock);
1996                 rcu_read_lock();
1997                 timeout = rcu_dereference(mdev->tconn->net_conf)->ping_timeo*HZ/10;
1998                 rcu_read_unlock();
1999                 timeout = schedule_timeout(timeout);
2000                 spin_lock(&mdev->peer_seq_lock);
2001                 if (!timeout) {
2002                         ret = -ETIMEDOUT;
2003                         dev_err(DEV, "Timed out waiting for missing ack packets; disconnecting\n");
2004                         break;
2005                 }
2006         }
2007         spin_unlock(&mdev->peer_seq_lock);
2008         finish_wait(&mdev->seq_wait, &wait);
2009         return ret;
2010 }
2011
2012 /* see also bio_flags_to_wire()
2013  * DRBD_REQ_*, because we need to semantically map the flags to data packet
2014  * flags and back. We may replicate to other kernel versions. */
2015 static unsigned long wire_flags_to_bio(struct drbd_conf *mdev, u32 dpf)
2016 {
2017         return  (dpf & DP_RW_SYNC ? REQ_SYNC : 0) |
2018                 (dpf & DP_FUA ? REQ_FUA : 0) |
2019                 (dpf & DP_FLUSH ? REQ_FLUSH : 0) |
2020                 (dpf & DP_DISCARD ? REQ_DISCARD : 0);
2021 }
2022
2023 static void fail_postponed_requests(struct drbd_conf *mdev, sector_t sector,
2024                                     unsigned int size)
2025 {
2026         struct drbd_interval *i;
2027
2028     repeat:
2029         drbd_for_each_overlap(i, &mdev->write_requests, sector, size) {
2030                 struct drbd_request *req;
2031                 struct bio_and_error m;
2032
2033                 if (!i->local)
2034                         continue;
2035                 req = container_of(i, struct drbd_request, i);
2036                 if (!(req->rq_state & RQ_POSTPONED))
2037                         continue;
2038                 req->rq_state &= ~RQ_POSTPONED;
2039                 __req_mod(req, NEG_ACKED, &m);
2040                 spin_unlock_irq(&mdev->tconn->req_lock);
2041                 if (m.bio)
2042                         complete_master_bio(mdev, &m);
2043                 spin_lock_irq(&mdev->tconn->req_lock);
2044                 goto repeat;
2045         }
2046 }
2047
2048 static int handle_write_conflicts(struct drbd_conf *mdev,
2049                                   struct drbd_peer_request *peer_req)
2050 {
2051         struct drbd_tconn *tconn = mdev->tconn;
2052         bool resolve_conflicts = test_bit(DISCARD_CONCURRENT, &tconn->flags);
2053         sector_t sector = peer_req->i.sector;
2054         const unsigned int size = peer_req->i.size;
2055         struct drbd_interval *i;
2056         bool equal;
2057         int err;
2058
2059         /*
2060          * Inserting the peer request into the write_requests tree will prevent
2061          * new conflicting local requests from being added.
2062          */
2063         drbd_insert_interval(&mdev->write_requests, &peer_req->i);
2064
2065     repeat:
2066         drbd_for_each_overlap(i, &mdev->write_requests, sector, size) {
2067                 if (i == &peer_req->i)
2068                         continue;
2069
2070                 if (!i->local) {
2071                         /*
2072                          * Our peer has sent a conflicting remote request; this
2073                          * should not happen in a two-node setup.  Wait for the
2074                          * earlier peer request to complete.
2075                          */
2076                         err = drbd_wait_misc(mdev, i);
2077                         if (err)
2078                                 goto out;
2079                         goto repeat;
2080                 }
2081
2082                 equal = i->sector == sector && i->size == size;
2083                 if (resolve_conflicts) {
2084                         /*
2085                          * If the peer request is fully contained within the
2086                          * overlapping request, it can be discarded; otherwise,
2087                          * it will be retried once all overlapping requests
2088                          * have completed.
2089                          */
2090                         bool discard = i->sector <= sector && i->sector +
2091                                        (i->size >> 9) >= sector + (size >> 9);
2092
2093                         if (!equal)
2094                                 dev_alert(DEV, "Concurrent writes detected: "
2095                                                "local=%llus +%u, remote=%llus +%u, "
2096                                                "assuming %s came first\n",
2097                                           (unsigned long long)i->sector, i->size,
2098                                           (unsigned long long)sector, size,
2099                                           discard ? "local" : "remote");
2100
2101                         inc_unacked(mdev);
2102                         peer_req->w.cb = discard ? e_send_discard_write :
2103                                                    e_send_retry_write;
2104                         list_add_tail(&peer_req->w.list, &mdev->done_ee);
2105                         wake_asender(mdev->tconn);
2106
2107                         err = -ENOENT;
2108                         goto out;
2109                 } else {
2110                         struct drbd_request *req =
2111                                 container_of(i, struct drbd_request, i);
2112
2113                         if (!equal)
2114                                 dev_alert(DEV, "Concurrent writes detected: "
2115                                                "local=%llus +%u, remote=%llus +%u\n",
2116                                           (unsigned long long)i->sector, i->size,
2117                                           (unsigned long long)sector, size);
2118
2119                         if (req->rq_state & RQ_LOCAL_PENDING ||
2120                             !(req->rq_state & RQ_POSTPONED)) {
2121                                 /*
2122                                  * Wait for the node with the discard flag to
2123                                  * decide if this request will be discarded or
2124                                  * retried.  Requests that are discarded will
2125                                  * disappear from the write_requests tree.
2126                                  *
2127                                  * In addition, wait for the conflicting
2128                                  * request to finish locally before submitting
2129                                  * the conflicting peer request.
2130                                  */
2131                                 err = drbd_wait_misc(mdev, &req->i);
2132                                 if (err) {
2133                                         _conn_request_state(mdev->tconn,
2134                                                             NS(conn, C_TIMEOUT),
2135                                                             CS_HARD);
2136                                         fail_postponed_requests(mdev, sector, size);
2137                                         goto out;
2138                                 }
2139                                 goto repeat;
2140                         }
2141                         /*
2142                          * Remember to restart the conflicting requests after
2143                          * the new peer request has completed.
2144                          */
2145                         peer_req->flags |= EE_RESTART_REQUESTS;
2146                 }
2147         }
2148         err = 0;
2149
2150     out:
2151         if (err)
2152                 drbd_remove_epoch_entry_interval(mdev, peer_req);
2153         return err;
2154 }
2155
2156 /* mirrored write */
2157 static int receive_Data(struct drbd_tconn *tconn, struct packet_info *pi)
2158 {
2159         struct drbd_conf *mdev;
2160         sector_t sector;
2161         struct drbd_peer_request *peer_req;
2162         struct p_data *p = pi->data;
2163         u32 peer_seq = be32_to_cpu(p->seq_num);
2164         int rw = WRITE;
2165         u32 dp_flags;
2166         int err, tp;
2167
2168         mdev = vnr_to_mdev(tconn, pi->vnr);
2169         if (!mdev)
2170                 return -EIO;
2171
2172         if (!get_ldev(mdev)) {
2173                 int err2;
2174
2175                 err = wait_for_and_update_peer_seq(mdev, peer_seq);
2176                 drbd_send_ack_dp(mdev, P_NEG_ACK, p, pi->size);
2177                 atomic_inc(&tconn->current_epoch->epoch_size);
2178                 err2 = drbd_drain_block(mdev, pi->size);
2179                 if (!err)
2180                         err = err2;
2181                 return err;
2182         }
2183
2184         /*
2185          * Corresponding put_ldev done either below (on various errors), or in
2186          * drbd_peer_request_endio, if we successfully submit the data at the
2187          * end of this function.
2188          */
2189
2190         sector = be64_to_cpu(p->sector);
2191         peer_req = read_in_block(mdev, p->block_id, sector, pi->size);
2192         if (!peer_req) {
2193                 put_ldev(mdev);
2194                 return -EIO;
2195         }
2196
2197         peer_req->w.cb = e_end_block;
2198
2199         dp_flags = be32_to_cpu(p->dp_flags);
2200         rw |= wire_flags_to_bio(mdev, dp_flags);
2201         if (peer_req->pages == NULL) {
2202                 D_ASSERT(peer_req->i.size == 0);
2203                 D_ASSERT(dp_flags & DP_FLUSH);
2204         }
2205
2206         if (dp_flags & DP_MAY_SET_IN_SYNC)
2207                 peer_req->flags |= EE_MAY_SET_IN_SYNC;
2208
2209         spin_lock(&tconn->epoch_lock);
2210         peer_req->epoch = tconn->current_epoch;
2211         atomic_inc(&peer_req->epoch->epoch_size);
2212         atomic_inc(&peer_req->epoch->active);
2213         spin_unlock(&tconn->epoch_lock);
2214
2215         rcu_read_lock();
2216         tp = rcu_dereference(mdev->tconn->net_conf)->two_primaries;
2217         rcu_read_unlock();
2218         if (tp) {
2219                 peer_req->flags |= EE_IN_INTERVAL_TREE;
2220                 err = wait_for_and_update_peer_seq(mdev, peer_seq);
2221                 if (err)
2222                         goto out_interrupted;
2223                 spin_lock_irq(&mdev->tconn->req_lock);
2224                 err = handle_write_conflicts(mdev, peer_req);
2225                 if (err) {
2226                         spin_unlock_irq(&mdev->tconn->req_lock);
2227                         if (err == -ENOENT) {
2228                                 put_ldev(mdev);
2229                                 return 0;
2230                         }
2231                         goto out_interrupted;
2232                 }
2233         } else
2234                 spin_lock_irq(&mdev->tconn->req_lock);
2235         list_add(&peer_req->w.list, &mdev->active_ee);
2236         spin_unlock_irq(&mdev->tconn->req_lock);
2237
2238         if (mdev->state.conn == C_SYNC_TARGET)
2239                 wait_event(mdev->ee_wait, !overlapping_resync_write(mdev, peer_req));
2240
2241         if (mdev->tconn->agreed_pro_version < 100) {
2242                 rcu_read_lock();
2243                 switch (rcu_dereference(mdev->tconn->net_conf)->wire_protocol) {
2244                 case DRBD_PROT_C:
2245                         dp_flags |= DP_SEND_WRITE_ACK;
2246                         break;
2247                 case DRBD_PROT_B:
2248                         dp_flags |= DP_SEND_RECEIVE_ACK;
2249                         break;
2250                 }
2251                 rcu_read_unlock();
2252         }
2253
2254         if (dp_flags & DP_SEND_WRITE_ACK) {
2255                 peer_req->flags |= EE_SEND_WRITE_ACK;
2256                 inc_unacked(mdev);
2257                 /* corresponding dec_unacked() in e_end_block()
2258                  * respective _drbd_clear_done_ee */
2259         }
2260
2261         if (dp_flags & DP_SEND_RECEIVE_ACK) {
2262                 /* I really don't like it that the receiver thread
2263                  * sends on the msock, but anyways */
2264                 drbd_send_ack(mdev, P_RECV_ACK, peer_req);
2265         }
2266
2267         if (mdev->state.pdsk < D_INCONSISTENT) {
2268                 /* In case we have the only disk of the cluster, */
2269                 drbd_set_out_of_sync(mdev, peer_req->i.sector, peer_req->i.size);
2270                 peer_req->flags |= EE_CALL_AL_COMPLETE_IO;
2271                 peer_req->flags &= ~EE_MAY_SET_IN_SYNC;
2272                 drbd_al_begin_io(mdev, &peer_req->i);
2273         }
2274
2275         err = drbd_submit_peer_request(mdev, peer_req, rw, DRBD_FAULT_DT_WR);
2276         if (!err)
2277                 return 0;
2278
2279         /* don't care for the reason here */
2280         dev_err(DEV, "submit failed, triggering re-connect\n");
2281         spin_lock_irq(&mdev->tconn->req_lock);
2282         list_del(&peer_req->w.list);
2283         drbd_remove_epoch_entry_interval(mdev, peer_req);
2284         spin_unlock_irq(&mdev->tconn->req_lock);
2285         if (peer_req->flags & EE_CALL_AL_COMPLETE_IO)
2286                 drbd_al_complete_io(mdev, &peer_req->i);
2287
2288 out_interrupted:
2289         drbd_may_finish_epoch(tconn, peer_req->epoch, EV_PUT + EV_CLEANUP);
2290         put_ldev(mdev);
2291         drbd_free_peer_req(mdev, peer_req);
2292         return err;
2293 }
2294
2295 /* We may throttle resync, if the lower device seems to be busy,
2296  * and current sync rate is above c_min_rate.
2297  *
2298  * To decide whether or not the lower device is busy, we use a scheme similar
2299  * to MD RAID is_mddev_idle(): if the partition stats reveal "significant"
2300  * (more than 64 sectors) of activity we cannot account for with our own resync
2301  * activity, it obviously is "busy".
2302  *
2303  * The current sync rate used here uses only the most recent two step marks,
2304  * to have a short time average so we can react faster.
2305  */
2306 int drbd_rs_should_slow_down(struct drbd_conf *mdev, sector_t sector)
2307 {
2308         struct gendisk *disk = mdev->ldev->backing_bdev->bd_contains->bd_disk;
2309         unsigned long db, dt, dbdt;
2310         struct lc_element *tmp;
2311         int curr_events;
2312         int throttle = 0;
2313         unsigned int c_min_rate;
2314
2315         rcu_read_lock();
2316         c_min_rate = rcu_dereference(mdev->ldev->disk_conf)->c_min_rate;
2317         rcu_read_unlock();
2318
2319         /* feature disabled? */
2320         if (c_min_rate == 0)
2321                 return 0;
2322
2323         spin_lock_irq(&mdev->al_lock);
2324         tmp = lc_find(mdev->resync, BM_SECT_TO_EXT(sector));
2325         if (tmp) {
2326                 struct bm_extent *bm_ext = lc_entry(tmp, struct bm_extent, lce);
2327                 if (test_bit(BME_PRIORITY, &bm_ext->flags)) {
2328                         spin_unlock_irq(&mdev->al_lock);
2329                         return 0;
2330                 }
2331                 /* Do not slow down if app IO is already waiting for this extent */
2332         }
2333         spin_unlock_irq(&mdev->al_lock);
2334
2335         curr_events = (int)part_stat_read(&disk->part0, sectors[0]) +
2336                       (int)part_stat_read(&disk->part0, sectors[1]) -
2337                         atomic_read(&mdev->rs_sect_ev);
2338
2339         if (!mdev->rs_last_events || curr_events - mdev->rs_last_events > 64) {
2340                 unsigned long rs_left;
2341                 int i;
2342
2343                 mdev->rs_last_events = curr_events;
2344
2345                 /* sync speed average over the last 2*DRBD_SYNC_MARK_STEP,
2346                  * approx. */
2347                 i = (mdev->rs_last_mark + DRBD_SYNC_MARKS-1) % DRBD_SYNC_MARKS;
2348
2349                 if (mdev->state.conn == C_VERIFY_S || mdev->state.conn == C_VERIFY_T)
2350                         rs_left = mdev->ov_left;
2351                 else
2352                         rs_left = drbd_bm_total_weight(mdev) - mdev->rs_failed;
2353
2354                 dt = ((long)jiffies - (long)mdev->rs_mark_time[i]) / HZ;
2355                 if (!dt)
2356                         dt++;
2357                 db = mdev->rs_mark_left[i] - rs_left;
2358                 dbdt = Bit2KB(db/dt);
2359
2360                 if (dbdt > c_min_rate)
2361                         throttle = 1;
2362         }
2363         return throttle;
2364 }
2365
2366
2367 static int receive_DataRequest(struct drbd_tconn *tconn, struct packet_info *pi)
2368 {
2369         struct drbd_conf *mdev;
2370         sector_t sector;
2371         sector_t capacity;
2372         struct drbd_peer_request *peer_req;
2373         struct digest_info *di = NULL;
2374         int size, verb;
2375         unsigned int fault_type;
2376         struct p_block_req *p = pi->data;
2377
2378         mdev = vnr_to_mdev(tconn, pi->vnr);
2379         if (!mdev)
2380                 return -EIO;
2381         capacity = drbd_get_capacity(mdev->this_bdev);
2382
2383         sector = be64_to_cpu(p->sector);
2384         size   = be32_to_cpu(p->blksize);
2385
2386         if (size <= 0 || !IS_ALIGNED(size, 512) || size > DRBD_MAX_BIO_SIZE) {
2387                 dev_err(DEV, "%s:%d: sector: %llus, size: %u\n", __FILE__, __LINE__,
2388                                 (unsigned long long)sector, size);
2389                 return -EINVAL;
2390         }
2391         if (sector + (size>>9) > capacity) {
2392                 dev_err(DEV, "%s:%d: sector: %llus, size: %u\n", __FILE__, __LINE__,
2393                                 (unsigned long long)sector, size);
2394                 return -EINVAL;
2395         }
2396
2397         if (!get_ldev_if_state(mdev, D_UP_TO_DATE)) {
2398                 verb = 1;
2399                 switch (pi->cmd) {
2400                 case P_DATA_REQUEST:
2401                         drbd_send_ack_rp(mdev, P_NEG_DREPLY, p);
2402                         break;
2403                 case P_RS_DATA_REQUEST:
2404                 case P_CSUM_RS_REQUEST:
2405                 case P_OV_REQUEST:
2406                         drbd_send_ack_rp(mdev, P_NEG_RS_DREPLY , p);
2407                         break;
2408                 case P_OV_REPLY:
2409                         verb = 0;
2410                         dec_rs_pending(mdev);
2411                         drbd_send_ack_ex(mdev, P_OV_RESULT, sector, size, ID_IN_SYNC);
2412                         break;
2413                 default:
2414                         BUG();
2415                 }
2416                 if (verb && __ratelimit(&drbd_ratelimit_state))
2417                         dev_err(DEV, "Can not satisfy peer's read request, "
2418                             "no local data.\n");
2419
2420                 /* drain possibly payload */
2421                 return drbd_drain_block(mdev, pi->size);
2422         }
2423
2424         /* GFP_NOIO, because we must not cause arbitrary write-out: in a DRBD
2425          * "criss-cross" setup, that might cause write-out on some other DRBD,
2426          * which in turn might block on the other node at this very place.  */
2427         peer_req = drbd_alloc_peer_req(mdev, p->block_id, sector, size, GFP_NOIO);
2428         if (!peer_req) {
2429                 put_ldev(mdev);
2430                 return -ENOMEM;
2431         }
2432
2433         switch (pi->cmd) {
2434         case P_DATA_REQUEST:
2435                 peer_req->w.cb = w_e_end_data_req;
2436                 fault_type = DRBD_FAULT_DT_RD;
2437                 /* application IO, don't drbd_rs_begin_io */
2438                 goto submit;
2439
2440         case P_RS_DATA_REQUEST:
2441                 peer_req->w.cb = w_e_end_rsdata_req;
2442                 fault_type = DRBD_FAULT_RS_RD;
2443                 /* used in the sector offset progress display */
2444                 mdev->bm_resync_fo = BM_SECT_TO_BIT(sector);
2445                 break;
2446
2447         case P_OV_REPLY:
2448         case P_CSUM_RS_REQUEST:
2449                 fault_type = DRBD_FAULT_RS_RD;
2450                 di = kmalloc(sizeof(*di) + pi->size, GFP_NOIO);
2451                 if (!di)
2452                         goto out_free_e;
2453
2454                 di->digest_size = pi->size;
2455                 di->digest = (((char *)di)+sizeof(struct digest_info));
2456
2457                 peer_req->digest = di;
2458                 peer_req->flags |= EE_HAS_DIGEST;
2459
2460                 if (drbd_recv_all(mdev->tconn, di->digest, pi->size))
2461                         goto out_free_e;
2462
2463                 if (pi->cmd == P_CSUM_RS_REQUEST) {
2464                         D_ASSERT(mdev->tconn->agreed_pro_version >= 89);
2465                         peer_req->w.cb = w_e_end_csum_rs_req;
2466                         /* used in the sector offset progress display */
2467                         mdev->bm_resync_fo = BM_SECT_TO_BIT(sector);
2468                 } else if (pi->cmd == P_OV_REPLY) {
2469                         /* track progress, we may need to throttle */
2470                         atomic_add(size >> 9, &mdev->rs_sect_in);
2471                         peer_req->w.cb = w_e_end_ov_reply;
2472                         dec_rs_pending(mdev);
2473                         /* drbd_rs_begin_io done when we sent this request,
2474                          * but accounting still needs to be done. */
2475                         goto submit_for_resync;
2476                 }
2477                 break;
2478
2479         case P_OV_REQUEST:
2480                 if (mdev->ov_start_sector == ~(sector_t)0 &&
2481                     mdev->tconn->agreed_pro_version >= 90) {
2482                         unsigned long now = jiffies;
2483                         int i;
2484                         mdev->ov_start_sector = sector;
2485                         mdev->ov_position = sector;
2486                         mdev->ov_left = drbd_bm_bits(mdev) - BM_SECT_TO_BIT(sector);
2487                         mdev->rs_total = mdev->ov_left;
2488                         for (i = 0; i < DRBD_SYNC_MARKS; i++) {
2489                                 mdev->rs_mark_left[i] = mdev->ov_left;
2490                                 mdev->rs_mark_time[i] = now;
2491                         }
2492                         dev_info(DEV, "Online Verify start sector: %llu\n",
2493                                         (unsigned long long)sector);
2494                 }
2495                 peer_req->w.cb = w_e_end_ov_req;
2496                 fault_type = DRBD_FAULT_RS_RD;
2497                 break;
2498
2499         default:
2500                 BUG();
2501         }
2502
2503         /* Throttle, drbd_rs_begin_io and submit should become asynchronous
2504          * wrt the receiver, but it is not as straightforward as it may seem.
2505          * Various places in the resync start and stop logic assume resync
2506          * requests are processed in order, requeuing this on the worker thread
2507          * introduces a bunch of new code for synchronization between threads.
2508          *
2509          * Unlimited throttling before drbd_rs_begin_io may stall the resync
2510          * "forever", throttling after drbd_rs_begin_io will lock that extent
2511          * for application writes for the same time.  For now, just throttle
2512          * here, where the rest of the code expects the receiver to sleep for
2513          * a while, anyways.
2514          */
2515
2516         /* Throttle before drbd_rs_begin_io, as that locks out application IO;
2517          * this defers syncer requests for some time, before letting at least
2518          * on request through.  The resync controller on the receiving side
2519          * will adapt to the incoming rate accordingly.
2520          *
2521          * We cannot throttle here if remote is Primary/SyncTarget:
2522          * we would also throttle its application reads.
2523          * In that case, throttling is done on the SyncTarget only.
2524          */
2525         if (mdev->state.peer != R_PRIMARY && drbd_rs_should_slow_down(mdev, sector))
2526                 schedule_timeout_uninterruptible(HZ/10);
2527         if (drbd_rs_begin_io(mdev, sector))
2528                 goto out_free_e;
2529
2530 submit_for_resync:
2531         atomic_add(size >> 9, &mdev->rs_sect_ev);
2532
2533 submit:
2534         inc_unacked(mdev);
2535         spin_lock_irq(&mdev->tconn->req_lock);
2536         list_add_tail(&peer_req->w.list, &mdev->read_ee);
2537         spin_unlock_irq(&mdev->tconn->req_lock);
2538
2539         if (drbd_submit_peer_request(mdev, peer_req, READ, fault_type) == 0)
2540                 return 0;
2541
2542         /* don't care for the reason here */
2543         dev_err(DEV, "submit failed, triggering re-connect\n");
2544         spin_lock_irq(&mdev->tconn->req_lock);
2545         list_del(&peer_req->w.list);
2546         spin_unlock_irq(&mdev->tconn->req_lock);
2547         /* no drbd_rs_complete_io(), we are dropping the connection anyways */
2548
2549 out_free_e:
2550         put_ldev(mdev);
2551         drbd_free_peer_req(mdev, peer_req);
2552         return -EIO;
2553 }
2554
2555 static int drbd_asb_recover_0p(struct drbd_conf *mdev) __must_hold(local)
2556 {
2557         int self, peer, rv = -100;
2558         unsigned long ch_self, ch_peer;
2559         enum drbd_after_sb_p after_sb_0p;
2560
2561         self = mdev->ldev->md.uuid[UI_BITMAP] & 1;
2562         peer = mdev->p_uuid[UI_BITMAP] & 1;
2563
2564         ch_peer = mdev->p_uuid[UI_SIZE];
2565         ch_self = mdev->comm_bm_set;
2566
2567         rcu_read_lock();
2568         after_sb_0p = rcu_dereference(mdev->tconn->net_conf)->after_sb_0p;
2569         rcu_read_unlock();
2570         switch (after_sb_0p) {
2571         case ASB_CONSENSUS:
2572         case ASB_DISCARD_SECONDARY:
2573         case ASB_CALL_HELPER:
2574         case ASB_VIOLENTLY:
2575                 dev_err(DEV, "Configuration error.\n");
2576                 break;
2577         case ASB_DISCONNECT:
2578                 break;
2579         case ASB_DISCARD_YOUNGER_PRI:
2580                 if (self == 0 && peer == 1) {
2581                         rv = -1;
2582                         break;
2583                 }
2584                 if (self == 1 && peer == 0) {
2585                         rv =  1;
2586                         break;
2587                 }
2588                 /* Else fall through to one of the other strategies... */
2589         case ASB_DISCARD_OLDER_PRI:
2590                 if (self == 0 && peer == 1) {
2591                         rv = 1;
2592                         break;
2593                 }
2594                 if (self == 1 && peer == 0) {
2595                         rv = -1;
2596                         break;
2597                 }
2598                 /* Else fall through to one of the other strategies... */
2599                 dev_warn(DEV, "Discard younger/older primary did not find a decision\n"
2600                      "Using discard-least-changes instead\n");
2601         case ASB_DISCARD_ZERO_CHG:
2602                 if (ch_peer == 0 && ch_self == 0) {
2603                         rv = test_bit(DISCARD_CONCURRENT, &mdev->tconn->flags)
2604                                 ? -1 : 1;
2605                         break;
2606                 } else {
2607                         if (ch_peer == 0) { rv =  1; break; }
2608                         if (ch_self == 0) { rv = -1; break; }
2609                 }
2610                 if (after_sb_0p == ASB_DISCARD_ZERO_CHG)
2611                         break;
2612         case ASB_DISCARD_LEAST_CHG:
2613                 if      (ch_self < ch_peer)
2614                         rv = -1;
2615                 else if (ch_self > ch_peer)
2616                         rv =  1;
2617                 else /* ( ch_self == ch_peer ) */
2618                      /* Well, then use something else. */
2619                         rv = test_bit(DISCARD_CONCURRENT, &mdev->tconn->flags)
2620                                 ? -1 : 1;
2621                 break;
2622         case ASB_DISCARD_LOCAL:
2623                 rv = -1;
2624                 break;
2625         case ASB_DISCARD_REMOTE:
2626                 rv =  1;
2627         }
2628
2629         return rv;
2630 }
2631
2632 static int drbd_asb_recover_1p(struct drbd_conf *mdev) __must_hold(local)
2633 {
2634         int hg, rv = -100;
2635         enum drbd_after_sb_p after_sb_1p;
2636
2637         rcu_read_lock();
2638         after_sb_1p = rcu_dereference(mdev->tconn->net_conf)->after_sb_1p;
2639         rcu_read_unlock();
2640         switch (after_sb_1p) {
2641         case ASB_DISCARD_YOUNGER_PRI:
2642         case ASB_DISCARD_OLDER_PRI:
2643         case ASB_DISCARD_LEAST_CHG:
2644         case ASB_DISCARD_LOCAL:
2645         case ASB_DISCARD_REMOTE:
2646         case ASB_DISCARD_ZERO_CHG:
2647                 dev_err(DEV, "Configuration error.\n");
2648                 break;
2649         case ASB_DISCONNECT:
2650                 break;
2651         case ASB_CONSENSUS:
2652                 hg = drbd_asb_recover_0p(mdev);
2653                 if (hg == -1 && mdev->state.role == R_SECONDARY)
2654                         rv = hg;
2655                 if (hg == 1  && mdev->state.role == R_PRIMARY)
2656                         rv = hg;
2657                 break;
2658         case ASB_VIOLENTLY:
2659                 rv = drbd_asb_recover_0p(mdev);
2660                 break;
2661         case ASB_DISCARD_SECONDARY:
2662                 return mdev->state.role == R_PRIMARY ? 1 : -1;
2663         case ASB_CALL_HELPER:
2664                 hg = drbd_asb_recover_0p(mdev);
2665                 if (hg == -1 && mdev->state.role == R_PRIMARY) {
2666                         enum drbd_state_rv rv2;
2667
2668                         drbd_set_role(mdev, R_SECONDARY, 0);
2669                          /* drbd_change_state() does not sleep while in SS_IN_TRANSIENT_STATE,
2670                           * we might be here in C_WF_REPORT_PARAMS which is transient.
2671                           * we do not need to wait for the after state change work either. */
2672                         rv2 = drbd_change_state(mdev, CS_VERBOSE, NS(role, R_SECONDARY));
2673                         if (rv2 != SS_SUCCESS) {
2674                                 drbd_khelper(mdev, "pri-lost-after-sb");
2675                         } else {
2676                                 dev_warn(DEV, "Successfully gave up primary role.\n");
2677                                 rv = hg;
2678                         }
2679                 } else
2680                         rv = hg;
2681         }
2682
2683         return rv;
2684 }
2685
2686 static int drbd_asb_recover_2p(struct drbd_conf *mdev) __must_hold(local)
2687 {
2688         int hg, rv = -100;
2689         enum drbd_after_sb_p after_sb_2p;
2690
2691         rcu_read_lock();
2692         after_sb_2p = rcu_dereference(mdev->tconn->net_conf)->after_sb_2p;
2693         rcu_read_unlock();
2694         switch (after_sb_2p) {
2695         case ASB_DISCARD_YOUNGER_PRI:
2696         case ASB_DISCARD_OLDER_PRI:
2697         case ASB_DISCARD_LEAST_CHG:
2698         case ASB_DISCARD_LOCAL:
2699         case ASB_DISCARD_REMOTE:
2700         case ASB_CONSENSUS:
2701         case ASB_DISCARD_SECONDARY:
2702         case ASB_DISCARD_ZERO_CHG:
2703                 dev_err(DEV, "Configuration error.\n");
2704                 break;
2705         case ASB_VIOLENTLY:
2706                 rv = drbd_asb_recover_0p(mdev);
2707                 break;
2708         case ASB_DISCONNECT:
2709                 break;
2710         case ASB_CALL_HELPER:
2711                 hg = drbd_asb_recover_0p(mdev);
2712                 if (hg == -1) {
2713                         enum drbd_state_rv rv2;
2714
2715                          /* drbd_change_state() does not sleep while in SS_IN_TRANSIENT_STATE,
2716                           * we might be here in C_WF_REPORT_PARAMS which is transient.
2717                           * we do not need to wait for the after state change work either. */
2718                         rv2 = drbd_change_state(mdev, CS_VERBOSE, NS(role, R_SECONDARY));
2719                         if (rv2 != SS_SUCCESS) {
2720                                 drbd_khelper(mdev, "pri-lost-after-sb");
2721                         } else {
2722                                 dev_warn(DEV, "Successfully gave up primary role.\n");
2723                                 rv = hg;
2724                         }
2725                 } else
2726                         rv = hg;
2727         }
2728
2729         return rv;
2730 }
2731
2732 static void drbd_uuid_dump(struct drbd_conf *mdev, char *text, u64 *uuid,
2733                            u64 bits, u64 flags)
2734 {
2735         if (!uuid) {
2736                 dev_info(DEV, "%s uuid info vanished while I was looking!\n", text);
2737                 return;
2738         }
2739         dev_info(DEV, "%s %016llX:%016llX:%016llX:%016llX bits:%llu flags:%llX\n",
2740              text,
2741              (unsigned long long)uuid[UI_CURRENT],
2742              (unsigned long long)uuid[UI_BITMAP],
2743              (unsigned long long)uuid[UI_HISTORY_START],
2744              (unsigned long long)uuid[UI_HISTORY_END],
2745              (unsigned long long)bits,
2746              (unsigned long long)flags);
2747 }
2748
2749 /*
2750   100   after split brain try auto recover
2751     2   C_SYNC_SOURCE set BitMap
2752     1   C_SYNC_SOURCE use BitMap
2753     0   no Sync
2754    -1   C_SYNC_TARGET use BitMap
2755    -2   C_SYNC_TARGET set BitMap
2756  -100   after split brain, disconnect
2757 -1000   unrelated data
2758 -1091   requires proto 91
2759 -1096   requires proto 96
2760  */
2761 static int drbd_uuid_compare(struct drbd_conf *mdev, int *rule_nr) __must_hold(local)
2762 {
2763         u64 self, peer;
2764         int i, j;
2765
2766         self = mdev->ldev->md.uuid[UI_CURRENT] & ~((u64)1);
2767         peer = mdev->p_uuid[UI_CURRENT] & ~((u64)1);
2768
2769         *rule_nr = 10;
2770         if (self == UUID_JUST_CREATED && peer == UUID_JUST_CREATED)
2771                 return 0;
2772
2773         *rule_nr = 20;
2774         if ((self == UUID_JUST_CREATED || self == (u64)0) &&
2775              peer != UUID_JUST_CREATED)
2776                 return -2;
2777
2778         *rule_nr = 30;
2779         if (self != UUID_JUST_CREATED &&
2780             (peer == UUID_JUST_CREATED || peer == (u64)0))
2781                 return 2;
2782
2783         if (self == peer) {
2784                 int rct, dc; /* roles at crash time */
2785
2786                 if (mdev->p_uuid[UI_BITMAP] == (u64)0 && mdev->ldev->md.uuid[UI_BITMAP] != (u64)0) {
2787
2788                         if (mdev->tconn->agreed_pro_version < 91)
2789                                 return -1091;
2790
2791                         if ((mdev->ldev->md.uuid[UI_BITMAP] & ~((u64)1)) == (mdev->p_uuid[UI_HISTORY_START] & ~((u64)1)) &&
2792                             (mdev->ldev->md.uuid[UI_HISTORY_START] & ~((u64)1)) == (mdev->p_uuid[UI_HISTORY_START + 1] & ~((u64)1))) {
2793                                 dev_info(DEV, "was SyncSource, missed the resync finished event, corrected myself:\n");
2794                                 drbd_uuid_set_bm(mdev, 0UL);
2795
2796                                 drbd_uuid_dump(mdev, "self", mdev->ldev->md.uuid,
2797                                                mdev->state.disk >= D_NEGOTIATING ? drbd_bm_total_weight(mdev) : 0, 0);
2798                                 *rule_nr = 34;
2799                         } else {
2800                                 dev_info(DEV, "was SyncSource (peer failed to write sync_uuid)\n");
2801                                 *rule_nr = 36;
2802                         }
2803
2804                         return 1;
2805                 }
2806
2807                 if (mdev->ldev->md.uuid[UI_BITMAP] == (u64)0 && mdev->p_uuid[UI_BITMAP] != (u64)0) {
2808
2809                         if (mdev->tconn->agreed_pro_version < 91)
2810                                 return -1091;
2811
2812                         if ((mdev->ldev->md.uuid[UI_HISTORY_START] & ~((u64)1)) == (mdev->p_uuid[UI_BITMAP] & ~((u64)1)) &&
2813                             (mdev->ldev->md.uuid[UI_HISTORY_START + 1] & ~((u64)1)) == (mdev->p_uuid[UI_HISTORY_START] & ~((u64)1))) {
2814                                 dev_info(DEV, "was SyncTarget, peer missed the resync finished event, corrected peer:\n");
2815
2816                                 mdev->p_uuid[UI_HISTORY_START + 1] = mdev->p_uuid[UI_HISTORY_START];
2817                                 mdev->p_uuid[UI_HISTORY_START] = mdev->p_uuid[UI_BITMAP];
2818                                 mdev->p_uuid[UI_BITMAP] = 0UL;
2819
2820                                 drbd_uuid_dump(mdev, "peer", mdev->p_uuid, mdev->p_uuid[UI_SIZE], mdev->p_uuid[UI_FLAGS]);
2821                                 *rule_nr = 35;
2822                         } else {
2823                                 dev_info(DEV, "was SyncTarget (failed to write sync_uuid)\n");
2824                                 *rule_nr = 37;
2825                         }
2826
2827                         return -1;
2828                 }
2829
2830                 /* Common power [off|failure] */
2831                 rct = (test_bit(CRASHED_PRIMARY, &mdev->flags) ? 1 : 0) +
2832                         (mdev->p_uuid[UI_FLAGS] & 2);
2833                 /* lowest bit is set when we were primary,
2834                  * next bit (weight 2) is set when peer was primary */
2835                 *rule_nr = 40;
2836
2837                 switch (rct) {
2838                 case 0: /* !self_pri && !peer_pri */ return 0;
2839                 case 1: /*  self_pri && !peer_pri */ return 1;
2840                 case 2: /* !self_pri &&  peer_pri */ return -1;
2841                 case 3: /*  self_pri &&  peer_pri */
2842                         dc = test_bit(DISCARD_CONCURRENT, &mdev->tconn->flags);
2843                         return dc ? -1 : 1;
2844                 }
2845         }
2846
2847         *rule_nr = 50;
2848         peer = mdev->p_uuid[UI_BITMAP] & ~((u64)1);
2849         if (self == peer)
2850                 return -1;
2851
2852         *rule_nr = 51;
2853         peer = mdev->p_uuid[UI_HISTORY_START] & ~((u64)1);
2854         if (self == peer) {
2855                 if (mdev->tconn->agreed_pro_version < 96 ?
2856                     (mdev->ldev->md.uuid[UI_HISTORY_START] & ~((u64)1)) ==
2857                     (mdev->p_uuid[UI_HISTORY_START + 1] & ~((u64)1)) :
2858                     peer + UUID_NEW_BM_OFFSET == (mdev->p_uuid[UI_BITMAP] & ~((u64)1))) {
2859                         /* The last P_SYNC_UUID did not get though. Undo the last start of
2860                            resync as sync source modifications of the peer's UUIDs. */
2861
2862                         if (mdev->tconn->agreed_pro_version < 91)
2863                                 return -1091;
2864
2865                         mdev->p_uuid[UI_BITMAP] = mdev->p_uuid[UI_HISTORY_START];
2866                         mdev->p_uuid[UI_HISTORY_START] = mdev->p_uuid[UI_HISTORY_START + 1];
2867
2868                         dev_info(DEV, "Lost last syncUUID packet, corrected:\n");
2869                         drbd_uuid_dump(mdev, "peer", mdev->p_uuid, mdev->p_uuid[UI_SIZE], mdev->p_uuid[UI_FLAGS]);
2870
2871                         return -1;
2872                 }
2873         }
2874
2875         *rule_nr = 60;
2876         self = mdev->ldev->md.uuid[UI_CURRENT] & ~((u64)1);
2877         for (i = UI_HISTORY_START; i <= UI_HISTORY_END; i++) {
2878                 peer = mdev->p_uuid[i] & ~((u64)1);
2879                 if (self == peer)
2880                         return -2;
2881         }
2882
2883         *rule_nr = 70;
2884         self = mdev->ldev->md.uuid[UI_BITMAP] & ~((u64)1);
2885         peer = mdev->p_uuid[UI_CURRENT] & ~((u64)1);
2886         if (self == peer)
2887                 return 1;
2888
2889         *rule_nr = 71;
2890         self = mdev->ldev->md.uuid[UI_HISTORY_START] & ~((u64)1);
2891         if (self == peer) {
2892                 if (mdev->tconn->agreed_pro_version < 96 ?
2893                     (mdev->ldev->md.uuid[UI_HISTORY_START + 1] & ~((u64)1)) ==
2894                     (mdev->p_uuid[UI_HISTORY_START] & ~((u64)1)) :
2895                     self + UUID_NEW_BM_OFFSET == (mdev->ldev->md.uuid[UI_BITMAP] & ~((u64)1))) {
2896                         /* The last P_SYNC_UUID did not get though. Undo the last start of
2897                            resync as sync source modifications of our UUIDs. */
2898
2899                         if (mdev->tconn->agreed_pro_version < 91)
2900                                 return -1091;
2901
2902                         _drbd_uuid_set(mdev, UI_BITMAP, mdev->ldev->md.uuid[UI_HISTORY_START]);
2903                         _drbd_uuid_set(mdev, UI_HISTORY_START, mdev->ldev->md.uuid[UI_HISTORY_START + 1]);
2904
2905                         dev_info(DEV, "Last syncUUID did not get through, corrected:\n");
2906                         drbd_uuid_dump(mdev, "self", mdev->ldev->md.uuid,
2907                                        mdev->state.disk >= D_NEGOTIATING ? drbd_bm_total_weight(mdev) : 0, 0);
2908
2909                         return 1;
2910                 }
2911         }
2912
2913
2914         *rule_nr = 80;
2915         peer = mdev->p_uuid[UI_CURRENT] & ~((u64)1);
2916         for (i = UI_HISTORY_START; i <= UI_HISTORY_END; i++) {
2917                 self = mdev->ldev->md.uuid[i] & ~((u64)1);
2918                 if (self == peer)
2919                         return 2;
2920         }
2921
2922         *rule_nr = 90;
2923         self = mdev->ldev->md.uuid[UI_BITMAP] & ~((u64)1);
2924         peer = mdev->p_uuid[UI_BITMAP] & ~((u64)1);
2925         if (self == peer && self != ((u64)0))
2926                 return 100;
2927
2928         *rule_nr = 100;
2929         for (i = UI_HISTORY_START; i <= UI_HISTORY_END; i++) {
2930                 self = mdev->ldev->md.uuid[i] & ~((u64)1);
2931                 for (j = UI_HISTORY_START; j <= UI_HISTORY_END; j++) {
2932                         peer = mdev->p_uuid[j] & ~((u64)1);
2933                         if (self == peer)
2934                                 return -100;
2935                 }
2936         }
2937
2938         return -1000;
2939 }
2940
2941 /* drbd_sync_handshake() returns the new conn state on success, or
2942    CONN_MASK (-1) on failure.
2943  */
2944 static enum drbd_conns drbd_sync_handshake(struct drbd_conf *mdev, enum drbd_role peer_role,
2945                                            enum drbd_disk_state peer_disk) __must_hold(local)
2946 {
2947         enum drbd_conns rv = C_MASK;
2948         enum drbd_disk_state mydisk;
2949         struct net_conf *nc;
2950         int hg, rule_nr, rr_conflict, tentative;
2951
2952         mydisk = mdev->state.disk;
2953         if (mydisk == D_NEGOTIATING)
2954                 mydisk = mdev->new_state_tmp.disk;
2955
2956         dev_info(DEV, "drbd_sync_handshake:\n");
2957         drbd_uuid_dump(mdev, "self", mdev->ldev->md.uuid, mdev->comm_bm_set, 0);
2958         drbd_uuid_dump(mdev, "peer", mdev->p_uuid,
2959                        mdev->p_uuid[UI_SIZE], mdev->p_uuid[UI_FLAGS]);
2960
2961         hg = drbd_uuid_compare(mdev, &rule_nr);
2962
2963         dev_info(DEV, "uuid_compare()=%d by rule %d\n", hg, rule_nr);
2964
2965         if (hg == -1000) {
2966                 dev_alert(DEV, "Unrelated data, aborting!\n");
2967                 return C_MASK;
2968         }
2969         if (hg < -1000) {
2970                 dev_alert(DEV, "To resolve this both sides have to support at least protocol %d\n", -hg - 1000);
2971                 return C_MASK;
2972         }
2973
2974         if    ((mydisk == D_INCONSISTENT && peer_disk > D_INCONSISTENT) ||
2975             (peer_disk == D_INCONSISTENT && mydisk    > D_INCONSISTENT)) {
2976                 int f = (hg == -100) || abs(hg) == 2;
2977                 hg = mydisk > D_INCONSISTENT ? 1 : -1;
2978                 if (f)
2979                         hg = hg*2;
2980                 dev_info(DEV, "Becoming sync %s due to disk states.\n",
2981                      hg > 0 ? "source" : "target");
2982         }
2983
2984         if (abs(hg) == 100)
2985                 drbd_khelper(mdev, "initial-split-brain");
2986
2987         rcu_read_lock();
2988         nc = rcu_dereference(mdev->tconn->net_conf);
2989
2990         if (hg == 100 || (hg == -100 && nc->always_asbp)) {
2991                 int pcount = (mdev->state.role == R_PRIMARY)
2992                            + (peer_role == R_PRIMARY);
2993                 int forced = (hg == -100);
2994
2995                 switch (pcount) {
2996                 case 0:
2997                         hg = drbd_asb_recover_0p(mdev);
2998                         break;
2999                 case 1:
3000                         hg = drbd_asb_recover_1p(mdev);
3001                         break;
3002                 case 2:
3003                         hg = drbd_asb_recover_2p(mdev);
3004                         break;
3005                 }
3006                 if (abs(hg) < 100) {
3007                         dev_warn(DEV, "Split-Brain detected, %d primaries, "
3008                              "automatically solved. Sync from %s node\n",
3009                              pcount, (hg < 0) ? "peer" : "this");
3010                         if (forced) {
3011                                 dev_warn(DEV, "Doing a full sync, since"
3012                                      " UUIDs where ambiguous.\n");
3013                                 hg = hg*2;
3014                         }
3015                 }
3016         }
3017
3018         if (hg == -100) {
3019                 if (test_bit(DISCARD_MY_DATA, &mdev->flags) && !(mdev->p_uuid[UI_FLAGS]&1))
3020                         hg = -1;
3021                 if (!test_bit(DISCARD_MY_DATA, &mdev->flags) && (mdev->p_uuid[UI_FLAGS]&1))
3022                         hg = 1;
3023
3024                 if (abs(hg) < 100)
3025                         dev_warn(DEV, "Split-Brain detected, manually solved. "
3026                              "Sync from %s node\n",
3027                              (hg < 0) ? "peer" : "this");
3028         }
3029         rr_conflict = nc->rr_conflict;
3030         tentative = nc->tentative;
3031         rcu_read_unlock();
3032
3033         if (hg == -100) {
3034                 /* FIXME this log message is not correct if we end up here
3035                  * after an attempted attach on a diskless node.
3036                  * We just refuse to attach -- well, we drop the "connection"
3037                  * to that disk, in a way... */
3038                 dev_alert(DEV, "Split-Brain detected but unresolved, dropping connection!\n");
3039                 drbd_khelper(mdev, "split-brain");
3040                 return C_MASK;
3041         }
3042
3043         if (hg > 0 && mydisk <= D_INCONSISTENT) {
3044                 dev_err(DEV, "I shall become SyncSource, but I am inconsistent!\n");
3045                 return C_MASK;
3046         }
3047
3048         if (hg < 0 && /* by intention we do not use mydisk here. */
3049             mdev->state.role == R_PRIMARY && mdev->state.disk >= D_CONSISTENT) {
3050                 switch (rr_conflict) {
3051                 case ASB_CALL_HELPER:
3052                         drbd_khelper(mdev, "pri-lost");
3053                         /* fall through */
3054                 case ASB_DISCONNECT:
3055                         dev_err(DEV, "I shall become SyncTarget, but I am primary!\n");
3056                         return C_MASK;
3057                 case ASB_VIOLENTLY:
3058                         dev_warn(DEV, "Becoming SyncTarget, violating the stable-data"
3059                              "assumption\n");
3060                 }
3061         }
3062
3063         if (tentative || test_bit(CONN_DRY_RUN, &mdev->tconn->flags)) {
3064                 if (hg == 0)
3065                         dev_info(DEV, "dry-run connect: No resync, would become Connected immediately.\n");
3066                 else
3067                         dev_info(DEV, "dry-run connect: Would become %s, doing a %s resync.",
3068                                  drbd_conn_str(hg > 0 ? C_SYNC_SOURCE : C_SYNC_TARGET),
3069                                  abs(hg) >= 2 ? "full" : "bit-map based");
3070                 return C_MASK;
3071         }
3072
3073         if (abs(hg) >= 2) {
3074                 dev_info(DEV, "Writing the whole bitmap, full sync required after drbd_sync_handshake.\n");
3075                 if (drbd_bitmap_io(mdev, &drbd_bmio_set_n_write, "set_n_write from sync_handshake",
3076                                         BM_LOCKED_SET_ALLOWED))
3077                         return C_MASK;
3078         }
3079
3080         if (hg > 0) { /* become sync source. */
3081                 rv = C_WF_BITMAP_S;
3082         } else if (hg < 0) { /* become sync target */
3083                 rv = C_WF_BITMAP_T;
3084         } else {
3085                 rv = C_CONNECTED;
3086                 if (drbd_bm_total_weight(mdev)) {
3087                         dev_info(DEV, "No resync, but %lu bits in bitmap!\n",
3088                              drbd_bm_total_weight(mdev));
3089                 }
3090         }
3091
3092         return rv;
3093 }
3094
3095 static enum drbd_after_sb_p convert_after_sb(enum drbd_after_sb_p peer)
3096 {
3097         /* ASB_DISCARD_REMOTE - ASB_DISCARD_LOCAL is valid */
3098         if (peer == ASB_DISCARD_REMOTE)
3099                 return ASB_DISCARD_LOCAL;
3100
3101         /* any other things with ASB_DISCARD_REMOTE or ASB_DISCARD_LOCAL are invalid */
3102         if (peer == ASB_DISCARD_LOCAL)
3103                 return ASB_DISCARD_REMOTE;
3104
3105         /* everything else is valid if they are equal on both sides. */
3106         return peer;
3107 }
3108
3109 static int receive_protocol(struct drbd_tconn *tconn, struct packet_info *pi)
3110 {
3111         struct p_protocol *p = pi->data;
3112         enum drbd_after_sb_p p_after_sb_0p, p_after_sb_1p, p_after_sb_2p;
3113         int p_proto, p_discard_my_data, p_two_primaries, cf;
3114         struct net_conf *nc, *old_net_conf, *new_net_conf = NULL;
3115         char integrity_alg[SHARED_SECRET_MAX] = "";
3116         struct crypto_hash *peer_integrity_tfm = NULL;
3117         void *int_dig_in = NULL, *int_dig_vv = NULL;
3118
3119         p_proto         = be32_to_cpu(p->protocol);
3120         p_after_sb_0p   = be32_to_cpu(p->after_sb_0p);
3121         p_after_sb_1p   = be32_to_cpu(p->after_sb_1p);
3122         p_after_sb_2p   = be32_to_cpu(p->after_sb_2p);
3123         p_two_primaries = be32_to_cpu(p->two_primaries);
3124         cf              = be32_to_cpu(p->conn_flags);
3125         p_discard_my_data = cf & CF_DISCARD_MY_DATA;
3126
3127         if (tconn->agreed_pro_version >= 87) {
3128                 int err;
3129
3130                 if (pi->size > sizeof(integrity_alg))
3131                         return -EIO;
3132                 err = drbd_recv_all(tconn, integrity_alg, pi->size);
3133                 if (err)
3134                         return err;
3135                 integrity_alg[SHARED_SECRET_MAX - 1] = 0;
3136         }
3137
3138         if (pi->cmd != P_PROTOCOL_UPDATE) {
3139                 clear_bit(CONN_DRY_RUN, &tconn->flags);
3140
3141                 if (cf & CF_DRY_RUN)
3142                         set_bit(CONN_DRY_RUN, &tconn->flags);
3143
3144                 rcu_read_lock();
3145                 nc = rcu_dereference(tconn->net_conf);
3146
3147                 if (p_proto != nc->wire_protocol) {
3148                         conn_err(tconn, "incompatible %s settings\n", "protocol");
3149                         goto disconnect_rcu_unlock;
3150                 }
3151
3152                 if (convert_after_sb(p_after_sb_0p) != nc->after_sb_0p) {
3153                         conn_err(tconn, "incompatible %s settings\n", "after-sb-0pri");
3154                         goto disconnect_rcu_unlock;
3155                 }
3156
3157                 if (convert_after_sb(p_after_sb_1p) != nc->after_sb_1p) {
3158                         conn_err(tconn, "incompatible %s settings\n", "after-sb-1pri");
3159                         goto disconnect_rcu_unlock;
3160                 }
3161
3162                 if (convert_after_sb(p_after_sb_2p) != nc->after_sb_2p) {
3163                         conn_err(tconn, "incompatible %s settings\n", "after-sb-2pri");
3164                         goto disconnect_rcu_unlock;
3165                 }
3166
3167                 if (p_discard_my_data && nc->discard_my_data) {
3168                         conn_err(tconn, "incompatible %s settings\n", "discard-my-data");
3169                         goto disconnect_rcu_unlock;
3170                 }
3171
3172                 if (p_two_primaries != nc->two_primaries) {
3173                         conn_err(tconn, "incompatible %s settings\n", "allow-two-primaries");
3174                         goto disconnect_rcu_unlock;
3175                 }
3176
3177                 if (strcmp(integrity_alg, nc->integrity_alg)) {
3178                         conn_err(tconn, "incompatible %s settings\n", "data-integrity-alg");
3179                         goto disconnect_rcu_unlock;
3180                 }
3181
3182                 rcu_read_unlock();
3183         }
3184
3185         if (integrity_alg[0]) {
3186                 int hash_size;
3187
3188                 /*
3189                  * We can only change the peer data integrity algorithm
3190                  * here.  Changing our own data integrity algorithm
3191                  * requires that we send a P_PROTOCOL_UPDATE packet at
3192                  * the same time; otherwise, the peer has no way to
3193                  * tell between which packets the algorithm should
3194                  * change.
3195                  */
3196
3197                 peer_integrity_tfm = crypto_alloc_hash(integrity_alg, 0, CRYPTO_ALG_ASYNC);
3198                 if (!peer_integrity_tfm) {
3199                         conn_err(tconn, "peer data-integrity-alg %s not supported\n",
3200                                  integrity_alg);
3201                         goto disconnect;
3202                 }
3203
3204                 hash_size = crypto_hash_digestsize(peer_integrity_tfm);
3205                 int_dig_in = kmalloc(hash_size, GFP_KERNEL);
3206                 int_dig_vv = kmalloc(hash_size, GFP_KERNEL);
3207                 if (!(int_dig_in && int_dig_vv)) {
3208                         conn_err(tconn, "Allocation of buffers for data integrity checking failed\n");
3209                         goto disconnect;
3210                 }
3211         }
3212
3213         new_net_conf = kmalloc(sizeof(struct net_conf), GFP_KERNEL);
3214         if (!new_net_conf) {
3215                 conn_err(tconn, "Allocation of new net_conf failed\n");
3216                 goto disconnect;
3217         }
3218
3219         mutex_lock(&tconn->data.mutex);
3220         mutex_lock(&tconn->conf_update);
3221         old_net_conf = tconn->net_conf;
3222         *new_net_conf = *old_net_conf;
3223
3224         new_net_conf->wire_protocol = p_proto;
3225         new_net_conf->after_sb_0p = convert_after_sb(p_after_sb_0p);
3226         new_net_conf->after_sb_1p = convert_after_sb(p_after_sb_1p);
3227         new_net_conf->after_sb_2p = convert_after_sb(p_after_sb_2p);
3228         new_net_conf->two_primaries = p_two_primaries;
3229
3230         rcu_assign_pointer(tconn->net_conf, new_net_conf);
3231         mutex_unlock(&tconn->conf_update);
3232         mutex_unlock(&tconn->data.mutex);
3233
3234         crypto_free_hash(tconn->peer_integrity_tfm);
3235         kfree(tconn->int_dig_in);
3236         kfree(tconn->int_dig_vv);
3237         tconn->peer_integrity_tfm = peer_integrity_tfm;
3238         tconn->int_dig_in = int_dig_in;
3239         tconn->int_dig_vv = int_dig_vv;
3240
3241         if (strcmp(old_net_conf->integrity_alg, integrity_alg))
3242                 conn_info(tconn, "peer data-integrity-alg: %s\n",
3243                           integrity_alg[0] ? integrity_alg : "(none)");
3244
3245         synchronize_rcu();
3246         kfree(old_net_conf);
3247         return 0;
3248
3249 disconnect_rcu_unlock:
3250         rcu_read_unlock();
3251 disconnect:
3252         crypto_free_hash(peer_integrity_tfm);
3253         kfree(int_dig_in);
3254         kfree(int_dig_vv);
3255         conn_request_state(tconn, NS(conn, C_DISCONNECTING), CS_HARD);
3256         return -EIO;
3257 }
3258
3259 /* helper function
3260  * input: alg name, feature name
3261  * return: NULL (alg name was "")
3262  *         ERR_PTR(error) if something goes wrong
3263  *         or the crypto hash ptr, if it worked out ok. */
3264 struct crypto_hash *drbd_crypto_alloc_digest_safe(const struct drbd_conf *mdev,
3265                 const char *alg, const char *name)
3266 {
3267         struct crypto_hash *tfm;
3268
3269         if (!alg[0])
3270                 return NULL;
3271
3272         tfm = crypto_alloc_hash(alg, 0, CRYPTO_ALG_ASYNC);
3273         if (IS_ERR(tfm)) {
3274                 dev_err(DEV, "Can not allocate \"%s\" as %s (reason: %ld)\n",
3275                         alg, name, PTR_ERR(tfm));
3276                 return tfm;
3277         }
3278         return tfm;
3279 }
3280
3281 static int ignore_remaining_packet(struct drbd_tconn *tconn, struct packet_info *pi)
3282 {
3283         void *buffer = tconn->data.rbuf;
3284         int size = pi->size;
3285
3286         while (size) {
3287                 int s = min_t(int, size, DRBD_SOCKET_BUFFER_SIZE);
3288                 s = drbd_recv(tconn, buffer, s);
3289                 if (s <= 0) {
3290                         if (s < 0)
3291                                 return s;
3292                         break;
3293                 }
3294                 size -= s;
3295         }
3296         if (size)
3297                 return -EIO;
3298         return 0;
3299 }
3300
3301 /*
3302  * config_unknown_volume  -  device configuration command for unknown volume
3303  *
3304  * When a device is added to an existing connection, the node on which the
3305  * device is added first will send configuration commands to its peer but the
3306  * peer will not know about the device yet.  It will warn and ignore these
3307  * commands.  Once the device is added on the second node, the second node will
3308  * send the same device configuration commands, but in the other direction.
3309  *
3310  * (We can also end up here if drbd is misconfigured.)
3311  */
3312 static int config_unknown_volume(struct drbd_tconn *tconn, struct packet_info *pi)
3313 {
3314         conn_warn(tconn, "%s packet received for volume %u, which is not configured locally\n",
3315                   cmdname(pi->cmd), pi->vnr);
3316         return ignore_remaining_packet(tconn, pi);
3317 }
3318
3319 static int receive_SyncParam(struct drbd_tconn *tconn, struct packet_info *pi)
3320 {
3321         struct drbd_conf *mdev;
3322         struct p_rs_param_95 *p;
3323         unsigned int header_size, data_size, exp_max_sz;
3324         struct crypto_hash *verify_tfm = NULL;
3325         struct crypto_hash *csums_tfm = NULL;
3326         struct net_conf *old_net_conf, *new_net_conf = NULL;
3327         struct disk_conf *old_disk_conf = NULL, *new_disk_conf = NULL;
3328         const int apv = tconn->agreed_pro_version;
3329         struct fifo_buffer *old_plan = NULL, *new_plan = NULL;
3330         int fifo_size = 0;
3331         int err;
3332
3333         mdev = vnr_to_mdev(tconn, pi->vnr);
3334         if (!mdev)
3335                 return config_unknown_volume(tconn, pi);
3336
3337         exp_max_sz  = apv <= 87 ? sizeof(struct p_rs_param)
3338                     : apv == 88 ? sizeof(struct p_rs_param)
3339                                         + SHARED_SECRET_MAX
3340                     : apv <= 94 ? sizeof(struct p_rs_param_89)
3341                     : /* apv >= 95 */ sizeof(struct p_rs_param_95);
3342
3343         if (pi->size > exp_max_sz) {
3344                 dev_err(DEV, "SyncParam packet too long: received %u, expected <= %u bytes\n",
3345                     pi->size, exp_max_sz);
3346                 return -EIO;
3347         }
3348
3349         if (apv <= 88) {
3350                 header_size = sizeof(struct p_rs_param);
3351                 data_size = pi->size - header_size;
3352         } else if (apv <= 94) {
3353                 header_size = sizeof(struct p_rs_param_89);
3354                 data_size = pi->size - header_size;
3355                 D_ASSERT(data_size == 0);
3356         } else {
3357                 header_size = sizeof(struct p_rs_param_95);
3358                 data_size = pi->size - header_size;
3359                 D_ASSERT(data_size == 0);
3360         }
3361
3362         /* initialize verify_alg and csums_alg */
3363         p = pi->data;
3364         memset(p->verify_alg, 0, 2 * SHARED_SECRET_MAX);
3365
3366         err = drbd_recv_all(mdev->tconn, p, header_size);
3367         if (err)
3368                 return err;
3369
3370         mutex_lock(&mdev->tconn->conf_update);
3371         old_net_conf = mdev->tconn->net_conf;
3372         if (get_ldev(mdev)) {
3373                 new_disk_conf = kzalloc(sizeof(struct disk_conf), GFP_KERNEL);
3374                 if (!new_disk_conf) {
3375                         put_ldev(mdev);
3376                         mutex_unlock(&mdev->tconn->conf_update);
3377                         dev_err(DEV, "Allocation of new disk_conf failed\n");
3378                         return -ENOMEM;
3379                 }
3380
3381                 old_disk_conf = mdev->ldev->disk_conf;
3382                 *new_disk_conf = *old_disk_conf;
3383
3384                 new_disk_conf->resync_rate = be32_to_cpu(p->resync_rate);
3385         }
3386
3387         if (apv >= 88) {
3388                 if (apv == 88) {
3389                         if (data_size > SHARED_SECRET_MAX || data_size == 0) {
3390                                 dev_err(DEV, "verify-alg of wrong size, "
3391                                         "peer wants %u, accepting only up to %u byte\n",
3392                                         data_size, SHARED_SECRET_MAX);
3393                                 err = -EIO;
3394                                 goto reconnect;
3395                         }
3396
3397                         err = drbd_recv_all(mdev->tconn, p->verify_alg, data_size);
3398                         if (err)
3399                                 goto reconnect;
3400                         /* we expect NUL terminated string */
3401                         /* but just in case someone tries to be evil */
3402                         D_ASSERT(p->verify_alg[data_size-1] == 0);
3403                         p->verify_alg[data_size-1] = 0;
3404
3405                 } else /* apv >= 89 */ {
3406                         /* we still expect NUL terminated strings */
3407                         /* but just in case someone tries to be evil */
3408                         D_ASSERT(p->verify_alg[SHARED_SECRET_MAX-1] == 0);
3409                         D_ASSERT(p->csums_alg[SHARED_SECRET_MAX-1] == 0);
3410                         p->verify_alg[SHARED_SECRET_MAX-1] = 0;
3411                         p->csums_alg[SHARED_SECRET_MAX-1] = 0;
3412                 }
3413
3414                 if (strcmp(old_net_conf->verify_alg, p->verify_alg)) {
3415                         if (mdev->state.conn == C_WF_REPORT_PARAMS) {
3416                                 dev_err(DEV, "Different verify-alg settings. me=\"%s\" peer=\"%s\"\n",
3417                                     old_net_conf->verify_alg, p->verify_alg);
3418                                 goto disconnect;
3419                         }
3420                         verify_tfm = drbd_crypto_alloc_digest_safe(mdev,
3421                                         p->verify_alg, "verify-alg");
3422                         if (IS_ERR(verify_tfm)) {
3423                                 verify_tfm = NULL;
3424                                 goto disconnect;
3425                         }
3426                 }
3427
3428                 if (apv >= 89 && strcmp(old_net_conf->csums_alg, p->csums_alg)) {
3429                         if (mdev->state.conn == C_WF_REPORT_PARAMS) {
3430                                 dev_err(DEV, "Different csums-alg settings. me=\"%s\" peer=\"%s\"\n",
3431                                     old_net_conf->csums_alg, p->csums_alg);
3432                                 goto disconnect;
3433                         }
3434                         csums_tfm = drbd_crypto_alloc_digest_safe(mdev,
3435                                         p->csums_alg, "csums-alg");
3436                         if (IS_ERR(csums_tfm)) {
3437                                 csums_tfm = NULL;
3438                                 goto disconnect;
3439                         }
3440                 }
3441
3442                 if (apv > 94 && new_disk_conf) {
3443                         new_disk_conf->c_plan_ahead = be32_to_cpu(p->c_plan_ahead);
3444                         new_disk_conf->c_delay_target = be32_to_cpu(p->c_delay_target);
3445                         new_disk_conf->c_fill_target = be32_to_cpu(p->c_fill_target);
3446                         new_disk_conf->c_max_rate = be32_to_cpu(p->c_max_rate);
3447
3448                         fifo_size = (new_disk_conf->c_plan_ahead * 10 * SLEEP_TIME) / HZ;
3449                         if (fifo_size != mdev->rs_plan_s->size) {
3450                                 new_plan = fifo_alloc(fifo_size);
3451                                 if (!new_plan) {
3452                                         dev_err(DEV, "kmalloc of fifo_buffer failed");
3453                                         put_ldev(mdev);
3454                                         goto disconnect;
3455                                 }
3456                         }
3457                 }
3458
3459                 if (verify_tfm || csums_tfm) {
3460                         new_net_conf = kzalloc(sizeof(struct net_conf), GFP_KERNEL);
3461                         if (!new_net_conf) {
3462                                 dev_err(DEV, "Allocation of new net_conf failed\n");
3463                                 goto disconnect;
3464                         }
3465
3466                         *new_net_conf = *old_net_conf;
3467
3468                         if (verify_tfm) {
3469                                 strcpy(new_net_conf->verify_alg, p->verify_alg);
3470                                 new_net_conf->verify_alg_len = strlen(p->verify_alg) + 1;
3471                                 crypto_free_hash(mdev->tconn->verify_tfm);
3472                                 mdev->tconn->verify_tfm = verify_tfm;
3473                                 dev_info(DEV, "using verify-alg: \"%s\"\n", p->verify_alg);
3474                         }
3475                         if (csums_tfm) {
3476                                 strcpy(new_net_conf->csums_alg, p->csums_alg);
3477                                 new_net_conf->csums_alg_len = strlen(p->csums_alg) + 1;
3478                                 crypto_free_hash(mdev->tconn->csums_tfm);
3479                                 mdev->tconn->csums_tfm = csums_tfm;
3480                                 dev_info(DEV, "using csums-alg: \"%s\"\n", p->csums_alg);
3481                         }
3482                         rcu_assign_pointer(tconn->net_conf, new_net_conf);
3483                 }
3484         }
3485
3486         if (new_disk_conf) {
3487                 rcu_assign_pointer(mdev->ldev->disk_conf, new_disk_conf);
3488                 put_ldev(mdev);
3489         }
3490
3491         if (new_plan) {
3492                 old_plan = mdev->rs_plan_s;
3493                 rcu_assign_pointer(mdev->rs_plan_s, new_plan);
3494         }
3495
3496         mutex_unlock(&mdev->tconn->conf_update);
3497         synchronize_rcu();
3498         if (new_net_conf)
3499                 kfree(old_net_conf);
3500         kfree(old_disk_conf);
3501         kfree(old_plan);
3502
3503         return 0;
3504
3505 reconnect:
3506         if (new_disk_conf) {
3507                 put_ldev(mdev);
3508                 kfree(new_disk_conf);
3509         }
3510         mutex_unlock(&mdev->tconn->conf_update);
3511         return -EIO;
3512
3513 disconnect:
3514         kfree(new_plan);
3515         if (new_disk_conf) {
3516                 put_ldev(mdev);
3517                 kfree(new_disk_conf);
3518         }
3519         mutex_unlock(&mdev->tconn->conf_update);
3520         /* just for completeness: actually not needed,
3521          * as this is not reached if csums_tfm was ok. */
3522         crypto_free_hash(csums_tfm);
3523         /* but free the verify_tfm again, if csums_tfm did not work out */
3524         crypto_free_hash(verify_tfm);
3525         conn_request_state(mdev->tconn, NS(conn, C_DISCONNECTING), CS_HARD);
3526         return -EIO;
3527 }
3528
3529 /* warn if the arguments differ by more than 12.5% */
3530 static void warn_if_differ_considerably(struct drbd_conf *mdev,
3531         const char *s, sector_t a, sector_t b)
3532 {
3533         sector_t d;
3534         if (a == 0 || b == 0)
3535                 return;
3536         d = (a > b) ? (a - b) : (b - a);
3537         if (d > (a>>3) || d > (b>>3))
3538                 dev_warn(DEV, "Considerable difference in %s: %llus vs. %llus\n", s,
3539                      (unsigned long long)a, (unsigned long long)b);
3540 }
3541
3542 static int receive_sizes(struct drbd_tconn *tconn, struct packet_info *pi)
3543 {
3544         struct drbd_conf *mdev;
3545         struct p_sizes *p = pi->data;
3546         enum determine_dev_size dd = unchanged;
3547         sector_t p_size, p_usize, my_usize;
3548         int ldsc = 0; /* local disk size changed */
3549         enum dds_flags ddsf;
3550
3551         mdev = vnr_to_mdev(tconn, pi->vnr);
3552         if (!mdev)
3553                 return config_unknown_volume(tconn, pi);
3554
3555         p_size = be64_to_cpu(p->d_size);
3556         p_usize = be64_to_cpu(p->u_size);
3557
3558         /* just store the peer's disk size for now.
3559          * we still need to figure out whether we accept that. */
3560         mdev->p_size = p_size;
3561
3562         if (get_ldev(mdev)) {
3563                 rcu_read_lock();
3564                 my_usize = rcu_dereference(mdev->ldev->disk_conf)->disk_size;
3565                 rcu_read_unlock();
3566
3567                 warn_if_differ_considerably(mdev, "lower level device sizes",
3568                            p_size, drbd_get_max_capacity(mdev->ldev));
3569                 warn_if_differ_considerably(mdev, "user requested size",
3570                                             p_usize, my_usize);
3571
3572                 /* if this is the first connect, or an otherwise expected
3573                  * param exchange, choose the minimum */
3574                 if (mdev->state.conn == C_WF_REPORT_PARAMS)
3575                         p_usize = min_not_zero(my_usize, p_usize);
3576
3577                 /* Never shrink a device with usable data during connect.
3578                    But allow online shrinking if we are connected. */
3579                 if (drbd_new_dev_size(mdev, mdev->ldev, p_usize, 0) <
3580                     drbd_get_capacity(mdev->this_bdev) &&
3581                     mdev->state.disk >= D_OUTDATED &&
3582                     mdev->state.conn < C_CONNECTED) {
3583                         dev_err(DEV, "The peer's disk size is too small!\n");
3584                         conn_request_state(mdev->tconn, NS(conn, C_DISCONNECTING), CS_HARD);
3585                         put_ldev(mdev);
3586                         return -EIO;
3587                 }
3588
3589                 if (my_usize != p_usize) {
3590                         struct disk_conf *old_disk_conf, *new_disk_conf = NULL;
3591
3592                         new_disk_conf = kzalloc(sizeof(struct disk_conf), GFP_KERNEL);
3593                         if (!new_disk_conf) {
3594                                 dev_err(DEV, "Allocation of new disk_conf failed\n");
3595                                 put_ldev(mdev);
3596                                 return -ENOMEM;
3597                         }
3598
3599                         mutex_lock(&mdev->tconn->conf_update);
3600                         old_disk_conf = mdev->ldev->disk_conf;
3601                         *new_disk_conf = *old_disk_conf;
3602                         new_disk_conf->disk_size = p_usize;
3603
3604                         rcu_assign_pointer(mdev->ldev->disk_conf, new_disk_conf);
3605                         mutex_unlock(&mdev->tconn->conf_update);
3606                         synchronize_rcu();
3607                         kfree(old_disk_conf);
3608
3609                         dev_info(DEV, "Peer sets u_size to %lu sectors\n",
3610                                  (unsigned long)my_usize);
3611                 }
3612
3613                 put_ldev(mdev);
3614         }
3615
3616         ddsf = be16_to_cpu(p->dds_flags);
3617         if (get_ldev(mdev)) {
3618                 dd = drbd_determine_dev_size(mdev, ddsf);
3619                 put_ldev(mdev);
3620                 if (dd == dev_size_error)
3621                         return -EIO;
3622                 drbd_md_sync(mdev);
3623         } else {
3624                 /* I am diskless, need to accept the peer's size. */
3625                 drbd_set_my_capacity(mdev, p_size);
3626         }
3627
3628         mdev->peer_max_bio_size = be32_to_cpu(p->max_bio_size);
3629         drbd_reconsider_max_bio_size(mdev);
3630
3631         if (get_ldev(mdev)) {
3632                 if (mdev->ldev->known_size != drbd_get_capacity(mdev->ldev->backing_bdev)) {
3633                         mdev->ldev->known_size = drbd_get_capacity(mdev->ldev->backing_bdev);
3634                         ldsc = 1;
3635                 }
3636
3637                 put_ldev(mdev);
3638         }
3639
3640         if (mdev->state.conn > C_WF_REPORT_PARAMS) {
3641                 if (be64_to_cpu(p->c_size) !=
3642                     drbd_get_capacity(mdev->this_bdev) || ldsc) {
3643                         /* we have different sizes, probably peer
3644                          * needs to know my new size... */
3645                         drbd_send_sizes(mdev, 0, ddsf);
3646                 }
3647                 if (test_and_clear_bit(RESIZE_PENDING, &mdev->flags) ||
3648                     (dd == grew && mdev->state.conn == C_CONNECTED)) {
3649                         if (mdev->state.pdsk >= D_INCONSISTENT &&
3650                             mdev->state.disk >= D_INCONSISTENT) {
3651                                 if (ddsf & DDSF_NO_RESYNC)
3652                                         dev_info(DEV, "Resync of new storage suppressed with --assume-clean\n");
3653                                 else
3654                                         resync_after_online_grow(mdev);
3655                         } else
3656                                 set_bit(RESYNC_AFTER_NEG, &mdev->flags);
3657                 }
3658         }
3659
3660         return 0;
3661 }
3662
3663 static int receive_uuids(struct drbd_tconn *tconn, struct packet_info *pi)
3664 {
3665         struct drbd_conf *mdev;
3666         struct p_uuids *p = pi->data;
3667         u64 *p_uuid;
3668         int i, updated_uuids = 0;
3669
3670         mdev = vnr_to_mdev(tconn, pi->vnr);
3671         if (!mdev)
3672                 return config_unknown_volume(tconn, pi);
3673
3674         p_uuid = kmalloc(sizeof(u64)*UI_EXTENDED_SIZE, GFP_NOIO);
3675
3676         for (i = UI_CURRENT; i < UI_EXTENDED_SIZE; i++)
3677                 p_uuid[i] = be64_to_cpu(p->uuid[i]);
3678
3679         kfree(mdev->p_uuid);
3680         mdev->p_uuid = p_uuid;
3681
3682         if (mdev->state.conn < C_CONNECTED &&
3683             mdev->state.disk < D_INCONSISTENT &&
3684             mdev->state.role == R_PRIMARY &&
3685             (mdev->ed_uuid & ~((u64)1)) != (p_uuid[UI_CURRENT] & ~((u64)1))) {
3686                 dev_err(DEV, "Can only connect to data with current UUID=%016llX\n",
3687                     (unsigned long long)mdev->ed_uuid);
3688                 conn_request_state(mdev->tconn, NS(conn, C_DISCONNECTING), CS_HARD);
3689                 return -EIO;
3690         }
3691
3692         if (get_ldev(mdev)) {
3693                 int skip_initial_sync =
3694                         mdev->state.conn == C_CONNECTED &&
3695                         mdev->tconn->agreed_pro_version >= 90 &&
3696                         mdev->ldev->md.uuid[UI_CURRENT] == UUID_JUST_CREATED &&
3697                         (p_uuid[UI_FLAGS] & 8);
3698                 if (skip_initial_sync) {
3699                         dev_info(DEV, "Accepted new current UUID, preparing to skip initial sync\n");
3700                         drbd_bitmap_io(mdev, &drbd_bmio_clear_n_write,
3701                                         "clear_n_write from receive_uuids",
3702                                         BM_LOCKED_TEST_ALLOWED);
3703                         _drbd_uuid_set(mdev, UI_CURRENT, p_uuid[UI_CURRENT]);
3704                         _drbd_uuid_set(mdev, UI_BITMAP, 0);
3705                         _drbd_set_state(_NS2(mdev, disk, D_UP_TO_DATE, pdsk, D_UP_TO_DATE),
3706                                         CS_VERBOSE, NULL);
3707                         drbd_md_sync(mdev);
3708                         updated_uuids = 1;
3709                 }
3710                 put_ldev(mdev);
3711         } else if (mdev->state.disk < D_INCONSISTENT &&
3712                    mdev->state.role == R_PRIMARY) {
3713                 /* I am a diskless primary, the peer just created a new current UUID
3714                    for me. */
3715                 updated_uuids = drbd_set_ed_uuid(mdev, p_uuid[UI_CURRENT]);
3716         }
3717
3718         /* Before we test for the disk state, we should wait until an eventually
3719            ongoing cluster wide state change is finished. That is important if
3720            we are primary and are detaching from our disk. We need to see the
3721            new disk state... */
3722         mutex_lock(mdev->state_mutex);
3723         mutex_unlock(mdev->state_mutex);
3724         if (mdev->state.conn >= C_CONNECTED && mdev->state.disk < D_INCONSISTENT)
3725                 updated_uuids |= drbd_set_ed_uuid(mdev, p_uuid[UI_CURRENT]);
3726
3727         if (updated_uuids)
3728                 drbd_print_uuids(mdev, "receiver updated UUIDs to");
3729
3730         return 0;
3731 }
3732
3733 /**
3734  * convert_state() - Converts the peer's view of the cluster state to our point of view
3735  * @ps:         The state as seen by the peer.
3736  */
3737 static union drbd_state convert_state(union drbd_state ps)
3738 {
3739         union drbd_state ms;
3740
3741         static enum drbd_conns c_tab[] = {
3742                 [C_WF_REPORT_PARAMS] = C_WF_REPORT_PARAMS,
3743                 [C_CONNECTED] = C_CONNECTED,
3744
3745                 [C_STARTING_SYNC_S] = C_STARTING_SYNC_T,
3746                 [C_STARTING_SYNC_T] = C_STARTING_SYNC_S,
3747                 [C_DISCONNECTING] = C_TEAR_DOWN, /* C_NETWORK_FAILURE, */
3748                 [C_VERIFY_S]       = C_VERIFY_T,
3749                 [C_MASK]   = C_MASK,
3750         };
3751
3752         ms.i = ps.i;
3753
3754         ms.conn = c_tab[ps.conn];
3755         ms.peer = ps.role;
3756         ms.role = ps.peer;
3757         ms.pdsk = ps.disk;
3758         ms.disk = ps.pdsk;
3759         ms.peer_isp = (ps.aftr_isp | ps.user_isp);
3760
3761         return ms;
3762 }
3763
3764 static int receive_req_state(struct drbd_tconn *tconn, struct packet_info *pi)
3765 {
3766         struct drbd_conf *mdev;
3767         struct p_req_state *p = pi->data;
3768         union drbd_state mask, val;
3769         enum drbd_state_rv rv;
3770
3771         mdev = vnr_to_mdev(tconn, pi->vnr);
3772         if (!mdev)
3773                 return -EIO;
3774
3775         mask.i = be32_to_cpu(p->mask);
3776         val.i = be32_to_cpu(p->val);
3777
3778         if (test_bit(DISCARD_CONCURRENT, &mdev->tconn->flags) &&
3779             mutex_is_locked(mdev->state_mutex)) {
3780                 drbd_send_sr_reply(mdev, SS_CONCURRENT_ST_CHG);
3781                 return 0;
3782         }
3783
3784         mask = convert_state(mask);
3785         val = convert_state(val);
3786
3787         rv = drbd_change_state(mdev, CS_VERBOSE, mask, val);
3788         drbd_send_sr_reply(mdev, rv);
3789
3790         drbd_md_sync(mdev);
3791
3792         return 0;
3793 }
3794
3795 static int receive_req_conn_state(struct drbd_tconn *tconn, struct packet_info *pi)
3796 {
3797         struct p_req_state *p = pi->data;
3798         union drbd_state mask, val;
3799         enum drbd_state_rv rv;
3800
3801         mask.i = be32_to_cpu(p->mask);
3802         val.i = be32_to_cpu(p->val);
3803
3804         if (test_bit(DISCARD_CONCURRENT, &tconn->flags) &&
3805             mutex_is_locked(&tconn->cstate_mutex)) {
3806                 conn_send_sr_reply(tconn, SS_CONCURRENT_ST_CHG);
3807                 return 0;
3808         }
3809
3810         mask = convert_state(mask);
3811         val = convert_state(val);
3812
3813         rv = conn_request_state(tconn, mask, val, CS_VERBOSE | CS_LOCAL_ONLY | CS_IGN_OUTD_FAIL);
3814         conn_send_sr_reply(tconn, rv);
3815
3816         return 0;
3817 }
3818
3819 static int receive_state(struct drbd_tconn *tconn, struct packet_info *pi)
3820 {
3821         struct drbd_conf *mdev;
3822         struct p_state *p = pi->data;
3823         union drbd_state os, ns, peer_state;
3824         enum drbd_disk_state real_peer_disk;
3825         enum chg_state_flags cs_flags;
3826         int rv;
3827
3828         mdev = vnr_to_mdev(tconn, pi->vnr);
3829         if (!mdev)
3830                 return config_unknown_volume(tconn, pi);
3831
3832         peer_state.i = be32_to_cpu(p->state);
3833
3834         real_peer_disk = peer_state.disk;
3835         if (peer_state.disk == D_NEGOTIATING) {
3836                 real_peer_disk = mdev->p_uuid[UI_FLAGS] & 4 ? D_INCONSISTENT : D_CONSISTENT;
3837                 dev_info(DEV, "real peer disk state = %s\n", drbd_disk_str(real_peer_disk));
3838         }
3839
3840         spin_lock_irq(&mdev->tconn->req_lock);
3841  retry:
3842         os = ns = drbd_read_state(mdev);
3843         spin_unlock_irq(&mdev->tconn->req_lock);
3844
3845         /* If some other part of the code (asender thread, timeout)
3846          * already decided to close the connection again,
3847          * we must not "re-establish" it here. */
3848         if (os.conn <= C_TEAR_DOWN)
3849                 return -ECONNRESET;
3850
3851         /* If this is the "end of sync" confirmation, usually the peer disk
3852          * transitions from D_INCONSISTENT to D_UP_TO_DATE. For empty (0 bits
3853          * set) resync started in PausedSyncT, or if the timing of pause-/
3854          * unpause-sync events has been "just right", the peer disk may
3855          * transition from D_CONSISTENT to D_UP_TO_DATE as well.
3856          */
3857         if ((os.pdsk == D_INCONSISTENT || os.pdsk == D_CONSISTENT) &&
3858             real_peer_disk == D_UP_TO_DATE &&
3859             os.conn > C_CONNECTED && os.disk == D_UP_TO_DATE) {
3860                 /* If we are (becoming) SyncSource, but peer is still in sync
3861                  * preparation, ignore its uptodate-ness to avoid flapping, it
3862                  * will change to inconsistent once the peer reaches active
3863                  * syncing states.
3864                  * It may have changed syncer-paused flags, however, so we
3865                  * cannot ignore this completely. */
3866                 if (peer_state.conn > C_CONNECTED &&
3867                     peer_state.conn < C_SYNC_SOURCE)
3868                         real_peer_disk = D_INCONSISTENT;
3869
3870                 /* if peer_state changes to connected at the same time,
3871                  * it explicitly notifies us that it finished resync.
3872                  * Maybe we should finish it up, too? */
3873                 else if (os.conn >= C_SYNC_SOURCE &&
3874                          peer_state.conn == C_CONNECTED) {
3875                         if (drbd_bm_total_weight(mdev) <= mdev->rs_failed)
3876                                 drbd_resync_finished(mdev);
3877                         return 0;
3878                 }
3879         }
3880
3881         /* explicit verify finished notification, stop sector reached. */
3882         if (os.conn == C_VERIFY_T && os.disk == D_UP_TO_DATE &&
3883             peer_state.conn == C_CONNECTED && real_peer_disk == D_UP_TO_DATE) {
3884                 ov_out_of_sync_print(mdev);
3885                 drbd_resync_finished(mdev);
3886                 return 0;
3887         }
3888
3889         /* peer says his disk is inconsistent, while we think it is uptodate,
3890          * and this happens while the peer still thinks we have a sync going on,
3891          * but we think we are already done with the sync.
3892          * We ignore this to avoid flapping pdsk.
3893          * This should not happen, if the peer is a recent version of drbd. */
3894         if (os.pdsk == D_UP_TO_DATE && real_peer_disk == D_INCONSISTENT &&
3895             os.conn == C_CONNECTED && peer_state.conn > C_SYNC_SOURCE)
3896                 real_peer_disk = D_UP_TO_DATE;
3897
3898         if (ns.conn == C_WF_REPORT_PARAMS)
3899                 ns.conn = C_CONNECTED;
3900
3901         if (peer_state.conn == C_AHEAD)
3902                 ns.conn = C_BEHIND;
3903
3904         if (mdev->p_uuid && peer_state.disk >= D_NEGOTIATING &&
3905             get_ldev_if_state(mdev, D_NEGOTIATING)) {
3906                 int cr; /* consider resync */
3907
3908                 /* if we established a new connection */
3909                 cr  = (os.conn < C_CONNECTED);
3910                 /* if we had an established connection
3911                  * and one of the nodes newly attaches a disk */
3912                 cr |= (os.conn == C_CONNECTED &&
3913                        (peer_state.disk == D_NEGOTIATING ||
3914                         os.disk == D_NEGOTIATING));
3915                 /* if we have both been inconsistent, and the peer has been
3916                  * forced to be UpToDate with --overwrite-data */
3917                 cr |= test_bit(CONSIDER_RESYNC, &mdev->flags);
3918                 /* if we had been plain connected, and the admin requested to
3919                  * start a sync by "invalidate" or "invalidate-remote" */
3920                 cr |= (os.conn == C_CONNECTED &&
3921                                 (peer_state.conn >= C_STARTING_SYNC_S &&
3922                                  peer_state.conn <= C_WF_BITMAP_T));
3923
3924                 if (cr)
3925                         ns.conn = drbd_sync_handshake(mdev, peer_state.role, real_peer_disk);
3926
3927                 put_ldev(mdev);
3928                 if (ns.conn == C_MASK) {
3929                         ns.conn = C_CONNECTED;
3930                         if (mdev->state.disk == D_NEGOTIATING) {
3931                                 drbd_force_state(mdev, NS(disk, D_FAILED));
3932                         } else if (peer_state.disk == D_NEGOTIATING) {
3933                                 dev_err(DEV, "Disk attach process on the peer node was aborted.\n");
3934                                 peer_state.disk = D_DISKLESS;
3935                                 real_peer_disk = D_DISKLESS;
3936                         } else {
3937                                 if (test_and_clear_bit(CONN_DRY_RUN, &mdev->tconn->flags))
3938                                         return -EIO;
3939                                 D_ASSERT(os.conn == C_WF_REPORT_PARAMS);
3940                                 conn_request_state(mdev->tconn, NS(conn, C_DISCONNECTING), CS_HARD);
3941                                 return -EIO;
3942                         }
3943                 }
3944         }
3945
3946         spin_lock_irq(&mdev->tconn->req_lock);
3947         if (os.i != drbd_read_state(mdev).i)
3948                 goto retry;
3949         clear_bit(CONSIDER_RESYNC, &mdev->flags);
3950         ns.peer = peer_state.role;
3951         ns.pdsk = real_peer_disk;
3952         ns.peer_isp = (peer_state.aftr_isp | peer_state.user_isp);
3953         if ((ns.conn == C_CONNECTED || ns.conn == C_WF_BITMAP_S) && ns.disk == D_NEGOTIATING)
3954                 ns.disk = mdev->new_state_tmp.disk;
3955         cs_flags = CS_VERBOSE + (os.conn < C_CONNECTED && ns.conn >= C_CONNECTED ? 0 : CS_HARD);
3956         if (ns.pdsk == D_CONSISTENT && drbd_suspended(mdev) && ns.conn == C_CONNECTED && os.conn < C_CONNECTED &&
3957             test_bit(NEW_CUR_UUID, &mdev->flags)) {
3958                 /* Do not allow tl_restart(RESEND) for a rebooted peer. We can only allow this
3959                    for temporal network outages! */
3960                 spin_unlock_irq(&mdev->tconn->req_lock);
3961                 dev_err(DEV, "Aborting Connect, can not thaw IO with an only Consistent peer\n");
3962                 tl_clear(mdev->tconn);
3963                 drbd_uuid_new_current(mdev);
3964                 clear_bit(NEW_CUR_UUID, &mdev->flags);
3965                 conn_request_state(mdev->tconn, NS2(conn, C_PROTOCOL_ERROR, susp, 0), CS_HARD);
3966                 return -EIO;
3967         }
3968         rv = _drbd_set_state(mdev, ns, cs_flags, NULL);
3969         ns = drbd_read_state(mdev);
3970         spin_unlock_irq(&mdev->tconn->req_lock);
3971
3972         if (rv < SS_SUCCESS) {
3973                 conn_request_state(mdev->tconn, NS(conn, C_DISCONNECTING), CS_HARD);
3974                 return -EIO;
3975         }
3976
3977         if (os.conn > C_WF_REPORT_PARAMS) {
3978                 if (ns.conn > C_CONNECTED && peer_state.conn <= C_CONNECTED &&
3979                     peer_state.disk != D_NEGOTIATING ) {
3980                         /* we want resync, peer has not yet decided to sync... */
3981                         /* Nowadays only used when forcing a node into primary role and
3982                            setting its disk to UpToDate with that */
3983                         drbd_send_uuids(mdev);
3984                         drbd_send_current_state(mdev);
3985                 }
3986         }
3987
3988         clear_bit(DISCARD_MY_DATA, &mdev->flags);
3989
3990         drbd_md_sync(mdev); /* update connected indicator, la_size, ... */
3991
3992         return 0;
3993 }
3994
3995 static int receive_sync_uuid(struct drbd_tconn *tconn, struct packet_info *pi)
3996 {
3997         struct drbd_conf *mdev;
3998         struct p_rs_uuid *p = pi->data;
3999
4000         mdev = vnr_to_mdev(tconn, pi->vnr);
4001         if (!mdev)
4002                 return -EIO;
4003
4004         wait_event(mdev->misc_wait,
4005                    mdev->state.conn == C_WF_SYNC_UUID ||
4006                    mdev->state.conn == C_BEHIND ||
4007                    mdev->state.conn < C_CONNECTED ||
4008                    mdev->state.disk < D_NEGOTIATING);
4009
4010         /* D_ASSERT( mdev->state.conn == C_WF_SYNC_UUID ); */
4011
4012         /* Here the _drbd_uuid_ functions are right, current should
4013            _not_ be rotated into the history */
4014         if (get_ldev_if_state(mdev, D_NEGOTIATING)) {
4015                 _drbd_uuid_set(mdev, UI_CURRENT, be64_to_cpu(p->uuid));
4016                 _drbd_uuid_set(mdev, UI_BITMAP, 0UL);
4017
4018                 drbd_print_uuids(mdev, "updated sync uuid");
4019                 drbd_start_resync(mdev, C_SYNC_TARGET);
4020
4021                 put_ldev(mdev);
4022         } else
4023                 dev_err(DEV, "Ignoring SyncUUID packet!\n");
4024
4025         return 0;
4026 }
4027
4028 /**
4029  * receive_bitmap_plain
4030  *
4031  * Return 0 when done, 1 when another iteration is needed, and a negative error
4032  * code upon failure.
4033  */
4034 static int
4035 receive_bitmap_plain(struct drbd_conf *mdev, unsigned int size,
4036                      unsigned long *p, struct bm_xfer_ctx *c)
4037 {
4038         unsigned int data_size = DRBD_SOCKET_BUFFER_SIZE -
4039                                  drbd_header_size(mdev->tconn);
4040         unsigned int num_words = min_t(size_t, data_size / sizeof(*p),
4041                                        c->bm_words - c->word_offset);
4042         unsigned int want = num_words * sizeof(*p);
4043         int err;
4044
4045         if (want != size) {
4046                 dev_err(DEV, "%s:want (%u) != size (%u)\n", __func__, want, size);
4047                 return -EIO;
4048         }
4049         if (want == 0)
4050                 return 0;
4051         err = drbd_recv_all(mdev->tconn, p, want);
4052         if (err)
4053                 return err;
4054
4055         drbd_bm_merge_lel(mdev, c->word_offset, num_words, p);
4056
4057         c->word_offset += num_words;
4058         c->bit_offset = c->word_offset * BITS_PER_LONG;
4059         if (c->bit_offset > c->bm_bits)
4060                 c->bit_offset = c->bm_bits;
4061
4062         return 1;
4063 }
4064
4065 static enum drbd_bitmap_code dcbp_get_code(struct p_compressed_bm *p)
4066 {
4067         return (enum drbd_bitmap_code)(p->encoding & 0x0f);
4068 }
4069
4070 static int dcbp_get_start(struct p_compressed_bm *p)
4071 {
4072         return (p->encoding & 0x80) != 0;
4073 }
4074
4075 static int dcbp_get_pad_bits(struct p_compressed_bm *p)
4076 {
4077         return (p->encoding >> 4) & 0x7;
4078 }
4079
4080 /**
4081  * recv_bm_rle_bits
4082  *
4083  * Return 0 when done, 1 when another iteration is needed, and a negative error
4084  * code upon failure.
4085  */
4086 static int
4087 recv_bm_rle_bits(struct drbd_conf *mdev,
4088                 struct p_compressed_bm *p,
4089                  struct bm_xfer_ctx *c,
4090                  unsigned int len)
4091 {
4092         struct bitstream bs;
4093         u64 look_ahead;
4094         u64 rl;
4095         u64 tmp;
4096         unsigned long s = c->bit_offset;
4097         unsigned long e;
4098         int toggle = dcbp_get_start(p);
4099         int have;
4100         int bits;
4101
4102         bitstream_init(&bs, p->code, len, dcbp_get_pad_bits(p));
4103
4104         bits = bitstream_get_bits(&bs, &look_ahead, 64);
4105         if (bits < 0)
4106                 return -EIO;
4107
4108         for (have = bits; have > 0; s += rl, toggle = !toggle) {
4109                 bits = vli_decode_bits(&rl, look_ahead);
4110                 if (bits <= 0)
4111                         return -EIO;
4112
4113                 if (toggle) {
4114                         e = s + rl -1;
4115                         if (e >= c->bm_bits) {
4116                                 dev_err(DEV, "bitmap overflow (e:%lu) while decoding bm RLE packet\n", e);
4117                                 return -EIO;
4118                         }
4119                         _drbd_bm_set_bits(mdev, s, e);
4120                 }
4121
4122                 if (have < bits) {
4123                         dev_err(DEV, "bitmap decoding error: h:%d b:%d la:0x%08llx l:%u/%u\n",
4124                                 have, bits, look_ahead,
4125                                 (unsigned int)(bs.cur.b - p->code),
4126                                 (unsigned int)bs.buf_len);
4127                         return -EIO;
4128                 }
4129                 look_ahead >>= bits;
4130                 have -= bits;
4131
4132                 bits = bitstream_get_bits(&bs, &tmp, 64 - have);
4133                 if (bits < 0)
4134                         return -EIO;
4135                 look_ahead |= tmp << have;
4136                 have += bits;
4137         }
4138
4139         c->bit_offset = s;
4140         bm_xfer_ctx_bit_to_word_offset(c);
4141
4142         return (s != c->bm_bits);
4143 }
4144
4145 /**
4146  * decode_bitmap_c
4147  *
4148  * Return 0 when done, 1 when another iteration is needed, and a negative error
4149  * code upon failure.
4150  */
4151 static int
4152 decode_bitmap_c(struct drbd_conf *mdev,
4153                 struct p_compressed_bm *p,
4154                 struct bm_xfer_ctx *c,
4155                 unsigned int len)
4156 {
4157         if (dcbp_get_code(p) == RLE_VLI_Bits)
4158                 return recv_bm_rle_bits(mdev, p, c, len - sizeof(*p));
4159
4160         /* other variants had been implemented for evaluation,
4161          * but have been dropped as this one turned out to be "best"
4162          * during all our tests. */
4163
4164         dev_err(DEV, "receive_bitmap_c: unknown encoding %u\n", p->encoding);
4165         conn_request_state(mdev->tconn, NS(conn, C_PROTOCOL_ERROR), CS_HARD);
4166         return -EIO;
4167 }
4168
4169 void INFO_bm_xfer_stats(struct drbd_conf *mdev,
4170                 const char *direction, struct bm_xfer_ctx *c)
4171 {
4172         /* what would it take to transfer it "plaintext" */
4173         unsigned int header_size = drbd_header_size(mdev->tconn);
4174         unsigned int data_size = DRBD_SOCKET_BUFFER_SIZE - header_size;
4175         unsigned int plain =
4176                 header_size * (DIV_ROUND_UP(c->bm_words, data_size) + 1) +
4177                 c->bm_words * sizeof(unsigned long);
4178         unsigned int total = c->bytes[0] + c->bytes[1];
4179         unsigned int r;
4180
4181         /* total can not be zero. but just in case: */
4182         if (total == 0)
4183                 return;
4184
4185         /* don't report if not compressed */
4186         if (total >= plain)
4187                 return;
4188
4189         /* total < plain. check for overflow, still */
4190         r = (total > UINT_MAX/1000) ? (total / (plain/1000))
4191                                     : (1000 * total / plain);
4192
4193         if (r > 1000)
4194                 r = 1000;
4195
4196         r = 1000 - r;
4197         dev_info(DEV, "%s bitmap stats [Bytes(packets)]: plain %u(%u), RLE %u(%u), "
4198              "total %u; compression: %u.%u%%\n",
4199                         direction,
4200                         c->bytes[1], c->packets[1],
4201                         c->bytes[0], c->packets[0],
4202                         total, r/10, r % 10);
4203 }
4204
4205 /* Since we are processing the bitfield from lower addresses to higher,
4206    it does not matter if the process it in 32 bit chunks or 64 bit
4207    chunks as long as it is little endian. (Understand it as byte stream,
4208    beginning with the lowest byte...) If we would use big endian
4209    we would need to process it from the highest address to the lowest,
4210    in order to be agnostic to the 32 vs 64 bits issue.
4211
4212    returns 0 on failure, 1 if we successfully received it. */
4213 static int receive_bitmap(struct drbd_tconn *tconn, struct packet_info *pi)
4214 {
4215         struct drbd_conf *mdev;
4216         struct bm_xfer_ctx c;
4217         int err;
4218
4219         mdev = vnr_to_mdev(tconn, pi->vnr);
4220         if (!mdev)
4221                 return -EIO;
4222
4223         drbd_bm_lock(mdev, "receive bitmap", BM_LOCKED_SET_ALLOWED);
4224         /* you are supposed to send additional out-of-sync information
4225          * if you actually set bits during this phase */
4226
4227         c = (struct bm_xfer_ctx) {
4228                 .bm_bits = drbd_bm_bits(mdev),
4229                 .bm_words = drbd_bm_words(mdev),
4230         };
4231
4232         for(;;) {
4233                 if (pi->cmd == P_BITMAP)
4234                         err = receive_bitmap_plain(mdev, pi->size, pi->data, &c);
4235                 else if (pi->cmd == P_COMPRESSED_BITMAP) {
4236                         /* MAYBE: sanity check that we speak proto >= 90,
4237                          * and the feature is enabled! */
4238                         struct p_compressed_bm *p = pi->data;
4239
4240                         if (pi->size > DRBD_SOCKET_BUFFER_SIZE - drbd_header_size(tconn)) {
4241                                 dev_err(DEV, "ReportCBitmap packet too large\n");
4242                                 err = -EIO;
4243                                 goto out;
4244                         }
4245                         if (pi->size <= sizeof(*p)) {
4246                                 dev_err(DEV, "ReportCBitmap packet too small (l:%u)\n", pi->size);
4247                                 err = -EIO;
4248                                 goto out;
4249                         }
4250                         err = drbd_recv_all(mdev->tconn, p, pi->size);
4251                         if (err)
4252                                goto out;
4253                         err = decode_bitmap_c(mdev, p, &c, pi->size);
4254                 } else {
4255                         dev_warn(DEV, "receive_bitmap: cmd neither ReportBitMap nor ReportCBitMap (is 0x%x)", pi->cmd);
4256                         err = -EIO;
4257                         goto out;
4258                 }
4259
4260                 c.packets[pi->cmd == P_BITMAP]++;
4261                 c.bytes[pi->cmd == P_BITMAP] += drbd_header_size(tconn) + pi->size;
4262
4263                 if (err <= 0) {
4264                         if (err < 0)
4265                                 goto out;
4266                         break;
4267                 }
4268                 err = drbd_recv_header(mdev->tconn, pi);
4269                 if (err)
4270                         goto out;
4271         }
4272
4273         INFO_bm_xfer_stats(mdev, "receive", &c);
4274
4275         if (mdev->state.conn == C_WF_BITMAP_T) {
4276                 enum drbd_state_rv rv;
4277
4278                 err = drbd_send_bitmap(mdev);
4279                 if (err)
4280                         goto out;
4281                 /* Omit CS_ORDERED with this state transition to avoid deadlocks. */
4282                 rv = _drbd_request_state(mdev, NS(conn, C_WF_SYNC_UUID), CS_VERBOSE);
4283                 D_ASSERT(rv == SS_SUCCESS);
4284         } else if (mdev->state.conn != C_WF_BITMAP_S) {
4285                 /* admin may have requested C_DISCONNECTING,
4286                  * other threads may have noticed network errors */
4287                 dev_info(DEV, "unexpected cstate (%s) in receive_bitmap\n",
4288                     drbd_conn_str(mdev->state.conn));
4289         }
4290         err = 0;
4291
4292  out:
4293         drbd_bm_unlock(mdev);
4294         if (!err && mdev->state.conn == C_WF_BITMAP_S)
4295                 drbd_start_resync(mdev, C_SYNC_SOURCE);
4296         return err;
4297 }
4298
4299 static int receive_skip(struct drbd_tconn *tconn, struct packet_info *pi)
4300 {
4301         conn_warn(tconn, "skipping unknown optional packet type %d, l: %d!\n",
4302                  pi->cmd, pi->size);
4303
4304         return ignore_remaining_packet(tconn, pi);
4305 }
4306
4307 static int receive_UnplugRemote(struct drbd_tconn *tconn, struct packet_info *pi)
4308 {
4309         /* Make sure we've acked all the TCP data associated
4310          * with the data requests being unplugged */
4311         drbd_tcp_quickack(tconn->data.socket);
4312
4313         return 0;
4314 }
4315
4316 static int receive_out_of_sync(struct drbd_tconn *tconn, struct packet_info *pi)
4317 {
4318         struct drbd_conf *mdev;
4319         struct p_block_desc *p = pi->data;
4320
4321         mdev = vnr_to_mdev(tconn, pi->vnr);
4322         if (!mdev)
4323                 return -EIO;
4324
4325         switch (mdev->state.conn) {
4326         case C_WF_SYNC_UUID:
4327         case C_WF_BITMAP_T:
4328         case C_BEHIND:
4329                         break;
4330         default:
4331                 dev_err(DEV, "ASSERT FAILED cstate = %s, expected: WFSyncUUID|WFBitMapT|Behind\n",
4332                                 drbd_conn_str(mdev->state.conn));
4333         }
4334
4335         drbd_set_out_of_sync(mdev, be64_to_cpu(p->sector), be32_to_cpu(p->blksize));
4336
4337         return 0;
4338 }
4339
4340 struct data_cmd {
4341         int expect_payload;
4342         size_t pkt_size;
4343         int (*fn)(struct drbd_tconn *, struct packet_info *);
4344 };
4345
4346 static struct data_cmd drbd_cmd_handler[] = {
4347         [P_DATA]            = { 1, sizeof(struct p_data), receive_Data },
4348         [P_DATA_REPLY]      = { 1, sizeof(struct p_data), receive_DataReply },
4349         [P_RS_DATA_REPLY]   = { 1, sizeof(struct p_data), receive_RSDataReply } ,
4350         [P_BARRIER]         = { 0, sizeof(struct p_barrier), receive_Barrier } ,
4351         [P_BITMAP]          = { 1, 0, receive_bitmap } ,
4352         [P_COMPRESSED_BITMAP] = { 1, 0, receive_bitmap } ,
4353         [P_UNPLUG_REMOTE]   = { 0, 0, receive_UnplugRemote },
4354         [P_DATA_REQUEST]    = { 0, sizeof(struct p_block_req), receive_DataRequest },
4355         [P_RS_DATA_REQUEST] = { 0, sizeof(struct p_block_req), receive_DataRequest },
4356         [P_SYNC_PARAM]      = { 1, 0, receive_SyncParam },
4357         [P_SYNC_PARAM89]    = { 1, 0, receive_SyncParam },
4358         [P_PROTOCOL]        = { 1, sizeof(struct p_protocol), receive_protocol },
4359         [P_UUIDS]           = { 0, sizeof(struct p_uuids), receive_uuids },
4360         [P_SIZES]           = { 0, sizeof(struct p_sizes), receive_sizes },
4361         [P_STATE]           = { 0, sizeof(struct p_state), receive_state },
4362         [P_STATE_CHG_REQ]   = { 0, sizeof(struct p_req_state), receive_req_state },
4363         [P_SYNC_UUID]       = { 0, sizeof(struct p_rs_uuid), receive_sync_uuid },
4364         [P_OV_REQUEST]      = { 0, sizeof(struct p_block_req), receive_DataRequest },
4365         [P_OV_REPLY]        = { 1, sizeof(struct p_block_req), receive_DataRequest },
4366         [P_CSUM_RS_REQUEST] = { 1, sizeof(struct p_block_req), receive_DataRequest },
4367         [P_DELAY_PROBE]     = { 0, sizeof(struct p_delay_probe93), receive_skip },
4368         [P_OUT_OF_SYNC]     = { 0, sizeof(struct p_block_desc), receive_out_of_sync },
4369         [P_CONN_ST_CHG_REQ] = { 0, sizeof(struct p_req_state), receive_req_conn_state },
4370         [P_PROTOCOL_UPDATE] = { 1, sizeof(struct p_protocol), receive_protocol },
4371 };
4372
4373 static void drbdd(struct drbd_tconn *tconn)
4374 {
4375         struct packet_info pi;
4376         size_t shs; /* sub header size */
4377         int err;
4378
4379         while (get_t_state(&tconn->receiver) == RUNNING) {
4380                 struct data_cmd *cmd;
4381
4382                 drbd_thread_current_set_cpu(&tconn->receiver);
4383                 if (drbd_recv_header(tconn, &pi))
4384                         goto err_out;
4385
4386                 cmd = &drbd_cmd_handler[pi.cmd];
4387                 if (unlikely(pi.cmd >= ARRAY_SIZE(drbd_cmd_handler) || !cmd->fn)) {
4388                         conn_err(tconn, "Unexpected data packet %s (0x%04x)",
4389                                  cmdname(pi.cmd), pi.cmd);
4390                         goto err_out;
4391                 }
4392
4393                 shs = cmd->pkt_size;
4394                 if (pi.size > shs && !cmd->expect_payload) {
4395                         conn_err(tconn, "No payload expected %s l:%d\n",
4396                                  cmdname(pi.cmd), pi.size);
4397                         goto err_out;
4398                 }
4399
4400                 if (shs) {
4401                         err = drbd_recv_all_warn(tconn, pi.data, shs);
4402                         if (err)
4403                                 goto err_out;
4404                         pi.size -= shs;
4405                 }
4406
4407                 err = cmd->fn(tconn, &pi);
4408                 if (err) {
4409                         conn_err(tconn, "error receiving %s, e: %d l: %d!\n",
4410                                  cmdname(pi.cmd), err, pi.size);
4411                         goto err_out;
4412                 }
4413         }
4414         return;
4415
4416     err_out:
4417         conn_request_state(tconn, NS(conn, C_PROTOCOL_ERROR), CS_HARD);
4418 }
4419
4420 void conn_flush_workqueue(struct drbd_tconn *tconn)
4421 {
4422         struct drbd_wq_barrier barr;
4423
4424         barr.w.cb = w_prev_work_done;
4425         barr.w.tconn = tconn;
4426         init_completion(&barr.done);
4427         drbd_queue_work(&tconn->sender_work, &barr.w);
4428         wait_for_completion(&barr.done);
4429 }
4430
4431 static void conn_disconnect(struct drbd_tconn *tconn)
4432 {
4433         struct drbd_conf *mdev;
4434         enum drbd_conns oc;
4435         int vnr;
4436
4437         if (tconn->cstate == C_STANDALONE)
4438                 return;
4439
4440         /* We are about to start the cleanup after connection loss.
4441          * Make sure drbd_make_request knows about that.
4442          * Usually we should be in some network failure state already,
4443          * but just in case we are not, we fix it up here.
4444          */
4445         conn_request_state(tconn, NS(conn, C_NETWORK_FAILURE), CS_HARD);
4446
4447         /* asender does not clean up anything. it must not interfere, either */
4448         drbd_thread_stop(&tconn->asender);
4449         drbd_free_sock(tconn);
4450
4451         rcu_read_lock();
4452         idr_for_each_entry(&tconn->volumes, mdev, vnr) {
4453                 kref_get(&mdev->kref);
4454                 rcu_read_unlock();
4455                 drbd_disconnected(mdev);
4456                 kref_put(&mdev->kref, &drbd_minor_destroy);
4457                 rcu_read_lock();
4458         }
4459         rcu_read_unlock();
4460
4461         if (!list_empty(&tconn->current_epoch->list))
4462                 conn_err(tconn, "ASSERTION FAILED: tconn->current_epoch->list not empty\n");
4463         /* ok, no more ee's on the fly, it is safe to reset the epoch_size */
4464         atomic_set(&tconn->current_epoch->epoch_size, 0);
4465         tconn->send.seen_any_write_yet = false;
4466
4467         conn_info(tconn, "Connection closed\n");
4468
4469         if (conn_highest_role(tconn) == R_PRIMARY && conn_highest_pdsk(tconn) >= D_UNKNOWN)
4470                 conn_try_outdate_peer_async(tconn);
4471
4472         spin_lock_irq(&tconn->req_lock);
4473         oc = tconn->cstate;
4474         if (oc >= C_UNCONNECTED)
4475                 _conn_request_state(tconn, NS(conn, C_UNCONNECTED), CS_VERBOSE);
4476
4477         spin_unlock_irq(&tconn->req_lock);
4478
4479         if (oc == C_DISCONNECTING)
4480                 conn_request_state(tconn, NS(conn, C_STANDALONE), CS_VERBOSE | CS_HARD);
4481 }
4482
4483 static int drbd_disconnected(struct drbd_conf *mdev)
4484 {
4485         unsigned int i;
4486
4487         /* wait for current activity to cease. */
4488         spin_lock_irq(&mdev->tconn->req_lock);
4489         _drbd_wait_ee_list_empty(mdev, &mdev->active_ee);
4490         _drbd_wait_ee_list_empty(mdev, &mdev->sync_ee);
4491         _drbd_wait_ee_list_empty(mdev, &mdev->read_ee);
4492         spin_unlock_irq(&mdev->tconn->req_lock);
4493
4494         /* We do not have data structures that would allow us to
4495          * get the rs_pending_cnt down to 0 again.
4496          *  * On C_SYNC_TARGET we do not have any data structures describing
4497          *    the pending RSDataRequest's we have sent.
4498          *  * On C_SYNC_SOURCE there is no data structure that tracks
4499          *    the P_RS_DATA_REPLY blocks that we sent to the SyncTarget.
4500          *  And no, it is not the sum of the reference counts in the
4501          *  resync_LRU. The resync_LRU tracks the whole operation including
4502          *  the disk-IO, while the rs_pending_cnt only tracks the blocks
4503          *  on the fly. */
4504         drbd_rs_cancel_all(mdev);
4505         mdev->rs_total = 0;
4506         mdev->rs_failed = 0;
4507         atomic_set(&mdev->rs_pending_cnt, 0);
4508         wake_up(&mdev->misc_wait);
4509
4510         del_timer_sync(&mdev->resync_timer);
4511         resync_timer_fn((unsigned long)mdev);
4512
4513         /* wait for all w_e_end_data_req, w_e_end_rsdata_req, w_send_barrier,
4514          * w_make_resync_request etc. which may still be on the worker queue
4515          * to be "canceled" */
4516         drbd_flush_workqueue(mdev);
4517
4518         drbd_finish_peer_reqs(mdev);
4519
4520         /* This second workqueue flush is necessary, since drbd_finish_peer_reqs()
4521            might have issued a work again. The one before drbd_finish_peer_reqs() is
4522            necessary to reclain net_ee in drbd_finish_peer_reqs(). */
4523         drbd_flush_workqueue(mdev);
4524
4525         kfree(mdev->p_uuid);
4526         mdev->p_uuid = NULL;
4527
4528         if (!drbd_suspended(mdev))
4529                 tl_clear(mdev->tconn);
4530
4531         drbd_md_sync(mdev);
4532
4533         /* serialize with bitmap writeout triggered by the state change,
4534          * if any. */
4535         wait_event(mdev->misc_wait, !test_bit(BITMAP_IO, &mdev->flags));
4536
4537         /* tcp_close and release of sendpage pages can be deferred.  I don't
4538          * want to use SO_LINGER, because apparently it can be deferred for
4539          * more than 20 seconds (longest time I checked).
4540          *
4541          * Actually we don't care for exactly when the network stack does its
4542          * put_page(), but release our reference on these pages right here.
4543          */
4544         i = drbd_free_peer_reqs(mdev, &mdev->net_ee);
4545         if (i)
4546                 dev_info(DEV, "net_ee not empty, killed %u entries\n", i);
4547         i = atomic_read(&mdev->pp_in_use_by_net);
4548         if (i)
4549                 dev_info(DEV, "pp_in_use_by_net = %d, expected 0\n", i);
4550         i = atomic_read(&mdev->pp_in_use);
4551         if (i)
4552                 dev_info(DEV, "pp_in_use = %d, expected 0\n", i);
4553
4554         D_ASSERT(list_empty(&mdev->read_ee));
4555         D_ASSERT(list_empty(&mdev->active_ee));
4556         D_ASSERT(list_empty(&mdev->sync_ee));
4557         D_ASSERT(list_empty(&mdev->done_ee));
4558
4559         return 0;
4560 }
4561
4562 /*
4563  * We support PRO_VERSION_MIN to PRO_VERSION_MAX. The protocol version
4564  * we can agree on is stored in agreed_pro_version.
4565  *
4566  * feature flags and the reserved array should be enough room for future
4567  * enhancements of the handshake protocol, and possible plugins...
4568  *
4569  * for now, they are expected to be zero, but ignored.
4570  */
4571 static int drbd_send_features(struct drbd_tconn *tconn)
4572 {
4573         struct drbd_socket *sock;
4574         struct p_connection_features *p;
4575
4576         sock = &tconn->data;
4577         p = conn_prepare_command(tconn, sock);
4578         if (!p)
4579                 return -EIO;
4580         memset(p, 0, sizeof(*p));
4581         p->protocol_min = cpu_to_be32(PRO_VERSION_MIN);
4582         p->protocol_max = cpu_to_be32(PRO_VERSION_MAX);
4583         return conn_send_command(tconn, sock, P_CONNECTION_FEATURES, sizeof(*p), NULL, 0);
4584 }
4585
4586 /*
4587  * return values:
4588  *   1 yes, we have a valid connection
4589  *   0 oops, did not work out, please try again
4590  *  -1 peer talks different language,
4591  *     no point in trying again, please go standalone.
4592  */
4593 static int drbd_do_features(struct drbd_tconn *tconn)
4594 {
4595         /* ASSERT current == tconn->receiver ... */
4596         struct p_connection_features *p;
4597         const int expect = sizeof(struct p_connection_features);
4598         struct packet_info pi;
4599         int err;
4600
4601         err = drbd_send_features(tconn);
4602         if (err)
4603                 return 0;
4604
4605         err = drbd_recv_header(tconn, &pi);
4606         if (err)
4607                 return 0;
4608
4609         if (pi.cmd != P_CONNECTION_FEATURES) {
4610                 conn_err(tconn, "expected ConnectionFeatures packet, received: %s (0x%04x)\n",
4611                          cmdname(pi.cmd), pi.cmd);
4612                 return -1;
4613         }
4614
4615         if (pi.size != expect) {
4616                 conn_err(tconn, "expected ConnectionFeatures length: %u, received: %u\n",
4617                      expect, pi.size);
4618                 return -1;
4619         }
4620
4621         p = pi.data;
4622         err = drbd_recv_all_warn(tconn, p, expect);
4623         if (err)
4624                 return 0;
4625
4626         p->protocol_min = be32_to_cpu(p->protocol_min);
4627         p->protocol_max = be32_to_cpu(p->protocol_max);
4628         if (p->protocol_max == 0)
4629                 p->protocol_max = p->protocol_min;
4630
4631         if (PRO_VERSION_MAX < p->protocol_min ||
4632             PRO_VERSION_MIN > p->protocol_max)
4633                 goto incompat;
4634
4635         tconn->agreed_pro_version = min_t(int, PRO_VERSION_MAX, p->protocol_max);
4636
4637         conn_info(tconn, "Handshake successful: "
4638              "Agreed network protocol version %d\n", tconn->agreed_pro_version);
4639
4640         return 1;
4641
4642  incompat:
4643         conn_err(tconn, "incompatible DRBD dialects: "
4644             "I support %d-%d, peer supports %d-%d\n",
4645             PRO_VERSION_MIN, PRO_VERSION_MAX,
4646             p->protocol_min, p->protocol_max);
4647         return -1;
4648 }
4649
4650 #if !defined(CONFIG_CRYPTO_HMAC) && !defined(CONFIG_CRYPTO_HMAC_MODULE)
4651 static int drbd_do_auth(struct drbd_tconn *tconn)
4652 {
4653         dev_err(DEV, "This kernel was build without CONFIG_CRYPTO_HMAC.\n");
4654         dev_err(DEV, "You need to disable 'cram-hmac-alg' in drbd.conf.\n");
4655         return -1;
4656 }
4657 #else
4658 #define CHALLENGE_LEN 64
4659
4660 /* Return value:
4661         1 - auth succeeded,
4662         0 - failed, try again (network error),
4663         -1 - auth failed, don't try again.
4664 */
4665
4666 static int drbd_do_auth(struct drbd_tconn *tconn)
4667 {
4668         struct drbd_socket *sock;
4669         char my_challenge[CHALLENGE_LEN];  /* 64 Bytes... */
4670         struct scatterlist sg;
4671         char *response = NULL;
4672         char *right_response = NULL;
4673         char *peers_ch = NULL;
4674         unsigned int key_len;
4675         char secret[SHARED_SECRET_MAX]; /* 64 byte */
4676         unsigned int resp_size;
4677         struct hash_desc desc;
4678         struct packet_info pi;
4679         struct net_conf *nc;
4680         int err, rv;
4681
4682         /* FIXME: Put the challenge/response into the preallocated socket buffer.  */
4683
4684         rcu_read_lock();
4685         nc = rcu_dereference(tconn->net_conf);
4686         key_len = strlen(nc->shared_secret);
4687         memcpy(secret, nc->shared_secret, key_len);
4688         rcu_read_unlock();
4689
4690         desc.tfm = tconn->cram_hmac_tfm;
4691         desc.flags = 0;
4692
4693         rv = crypto_hash_setkey(tconn->cram_hmac_tfm, (u8 *)secret, key_len);
4694         if (rv) {
4695                 conn_err(tconn, "crypto_hash_setkey() failed with %d\n", rv);
4696                 rv = -1;
4697                 goto fail;
4698         }
4699
4700         get_random_bytes(my_challenge, CHALLENGE_LEN);
4701
4702         sock = &tconn->data;
4703         if (!conn_prepare_command(tconn, sock)) {
4704                 rv = 0;
4705                 goto fail;
4706         }
4707         rv = !conn_send_command(tconn, sock, P_AUTH_CHALLENGE, 0,
4708                                 my_challenge, CHALLENGE_LEN);
4709         if (!rv)
4710                 goto fail;
4711
4712         err = drbd_recv_header(tconn, &pi);
4713         if (err) {
4714                 rv = 0;
4715                 goto fail;
4716         }
4717
4718         if (pi.cmd != P_AUTH_CHALLENGE) {
4719                 conn_err(tconn, "expected AuthChallenge packet, received: %s (0x%04x)\n",
4720                          cmdname(pi.cmd), pi.cmd);
4721                 rv = 0;
4722                 goto fail;
4723         }
4724
4725         if (pi.size > CHALLENGE_LEN * 2) {
4726                 conn_err(tconn, "expected AuthChallenge payload too big.\n");
4727                 rv = -1;
4728                 goto fail;
4729         }
4730
4731         peers_ch = kmalloc(pi.size, GFP_NOIO);
4732         if (peers_ch == NULL) {
4733                 conn_err(tconn, "kmalloc of peers_ch failed\n");
4734                 rv = -1;
4735                 goto fail;
4736         }
4737
4738         err = drbd_recv_all_warn(tconn, peers_ch, pi.size);
4739         if (err) {
4740                 rv = 0;
4741                 goto fail;
4742         }
4743
4744         resp_size = crypto_hash_digestsize(tconn->cram_hmac_tfm);
4745         response = kmalloc(resp_size, GFP_NOIO);
4746         if (response == NULL) {
4747                 conn_err(tconn, "kmalloc of response failed\n");
4748                 rv = -1;
4749                 goto fail;
4750         }
4751
4752         sg_init_table(&sg, 1);
4753         sg_set_buf(&sg, peers_ch, pi.size);
4754
4755         rv = crypto_hash_digest(&desc, &sg, sg.length, response);
4756         if (rv) {
4757                 conn_err(tconn, "crypto_hash_digest() failed with %d\n", rv);
4758                 rv = -1;
4759                 goto fail;
4760         }
4761
4762         if (!conn_prepare_command(tconn, sock)) {
4763                 rv = 0;
4764                 goto fail;
4765         }
4766         rv = !conn_send_command(tconn, sock, P_AUTH_RESPONSE, 0,
4767                                 response, resp_size);
4768         if (!rv)
4769                 goto fail;
4770
4771         err = drbd_recv_header(tconn, &pi);
4772         if (err) {
4773                 rv = 0;
4774                 goto fail;
4775         }
4776
4777         if (pi.cmd != P_AUTH_RESPONSE) {
4778                 conn_err(tconn, "expected AuthResponse packet, received: %s (0x%04x)\n",
4779                          cmdname(pi.cmd), pi.cmd);
4780                 rv = 0;
4781                 goto fail;
4782         }
4783
4784         if (pi.size != resp_size) {
4785                 conn_err(tconn, "expected AuthResponse payload of wrong size\n");
4786                 rv = 0;
4787                 goto fail;
4788         }
4789
4790         err = drbd_recv_all_warn(tconn, response , resp_size);
4791         if (err) {
4792                 rv = 0;
4793                 goto fail;
4794         }
4795
4796         right_response = kmalloc(resp_size, GFP_NOIO);
4797         if (right_response == NULL) {
4798                 conn_err(tconn, "kmalloc of right_response failed\n");
4799                 rv = -1;
4800                 goto fail;
4801         }
4802
4803         sg_set_buf(&sg, my_challenge, CHALLENGE_LEN);
4804
4805         rv = crypto_hash_digest(&desc, &sg, sg.length, right_response);
4806         if (rv) {
4807                 conn_err(tconn, "crypto_hash_digest() failed with %d\n", rv);
4808                 rv = -1;
4809                 goto fail;
4810         }
4811
4812         rv = !memcmp(response, right_response, resp_size);
4813
4814         if (rv)
4815                 conn_info(tconn, "Peer authenticated using %d bytes HMAC\n",
4816                      resp_size);
4817         else
4818                 rv = -1;
4819
4820  fail:
4821         kfree(peers_ch);
4822         kfree(response);
4823         kfree(right_response);
4824
4825         return rv;
4826 }
4827 #endif
4828
4829 int drbdd_init(struct drbd_thread *thi)
4830 {
4831         struct drbd_tconn *tconn = thi->tconn;
4832         int h;
4833
4834         conn_info(tconn, "receiver (re)started\n");
4835
4836         do {
4837                 h = conn_connect(tconn);
4838                 if (h == 0) {
4839                         conn_disconnect(tconn);
4840                         schedule_timeout_interruptible(HZ);
4841                 }
4842                 if (h == -1) {
4843                         conn_warn(tconn, "Discarding network configuration.\n");
4844                         conn_request_state(tconn, NS(conn, C_DISCONNECTING), CS_HARD);
4845                 }
4846         } while (h == 0);
4847
4848         if (h > 0)
4849                 drbdd(tconn);
4850
4851         conn_disconnect(tconn);
4852
4853         conn_info(tconn, "receiver terminated\n");
4854         return 0;
4855 }
4856
4857 /* ********* acknowledge sender ******** */
4858
4859 static int got_conn_RqSReply(struct drbd_tconn *tconn, struct packet_info *pi)
4860 {
4861         struct p_req_state_reply *p = pi->data;
4862         int retcode = be32_to_cpu(p->retcode);
4863
4864         if (retcode >= SS_SUCCESS) {
4865                 set_bit(CONN_WD_ST_CHG_OKAY, &tconn->flags);
4866         } else {
4867                 set_bit(CONN_WD_ST_CHG_FAIL, &tconn->flags);
4868                 conn_err(tconn, "Requested state change failed by peer: %s (%d)\n",
4869                          drbd_set_st_err_str(retcode), retcode);
4870         }
4871         wake_up(&tconn->ping_wait);
4872
4873         return 0;
4874 }
4875
4876 static int got_RqSReply(struct drbd_tconn *tconn, struct packet_info *pi)
4877 {
4878         struct drbd_conf *mdev;
4879         struct p_req_state_reply *p = pi->data;
4880         int retcode = be32_to_cpu(p->retcode);
4881
4882         mdev = vnr_to_mdev(tconn, pi->vnr);
4883         if (!mdev)
4884                 return -EIO;
4885
4886         if (test_bit(CONN_WD_ST_CHG_REQ, &tconn->flags)) {
4887                 D_ASSERT(tconn->agreed_pro_version < 100);
4888                 return got_conn_RqSReply(tconn, pi);
4889         }
4890
4891         if (retcode >= SS_SUCCESS) {
4892                 set_bit(CL_ST_CHG_SUCCESS, &mdev->flags);
4893         } else {
4894                 set_bit(CL_ST_CHG_FAIL, &mdev->flags);
4895                 dev_err(DEV, "Requested state change failed by peer: %s (%d)\n",
4896                         drbd_set_st_err_str(retcode), retcode);
4897         }
4898         wake_up(&mdev->state_wait);
4899
4900         return 0;
4901 }
4902
4903 static int got_Ping(struct drbd_tconn *tconn, struct packet_info *pi)
4904 {
4905         return drbd_send_ping_ack(tconn);
4906
4907 }
4908
4909 static int got_PingAck(struct drbd_tconn *tconn, struct packet_info *pi)
4910 {
4911         /* restore idle timeout */
4912         tconn->meta.socket->sk->sk_rcvtimeo = tconn->net_conf->ping_int*HZ;
4913         if (!test_and_set_bit(GOT_PING_ACK, &tconn->flags))
4914                 wake_up(&tconn->ping_wait);
4915
4916         return 0;
4917 }
4918
4919 static int got_IsInSync(struct drbd_tconn *tconn, struct packet_info *pi)
4920 {
4921         struct drbd_conf *mdev;
4922         struct p_block_ack *p = pi->data;
4923         sector_t sector = be64_to_cpu(p->sector);
4924         int blksize = be32_to_cpu(p->blksize);
4925
4926         mdev = vnr_to_mdev(tconn, pi->vnr);
4927         if (!mdev)
4928                 return -EIO;
4929
4930         D_ASSERT(mdev->tconn->agreed_pro_version >= 89);
4931
4932         update_peer_seq(mdev, be32_to_cpu(p->seq_num));
4933
4934         if (get_ldev(mdev)) {
4935                 drbd_rs_complete_io(mdev, sector);
4936                 drbd_set_in_sync(mdev, sector, blksize);
4937                 /* rs_same_csums is supposed to count in units of BM_BLOCK_SIZE */
4938                 mdev->rs_same_csum += (blksize >> BM_BLOCK_SHIFT);
4939                 put_ldev(mdev);
4940         }
4941         dec_rs_pending(mdev);
4942         atomic_add(blksize >> 9, &mdev->rs_sect_in);
4943
4944         return 0;
4945 }
4946
4947 static int
4948 validate_req_change_req_state(struct drbd_conf *mdev, u64 id, sector_t sector,
4949                               struct rb_root *root, const char *func,
4950                               enum drbd_req_event what, bool missing_ok)
4951 {
4952         struct drbd_request *req;
4953         struct bio_and_error m;
4954
4955         spin_lock_irq(&mdev->tconn->req_lock);
4956         req = find_request(mdev, root, id, sector, missing_ok, func);
4957         if (unlikely(!req)) {
4958                 spin_unlock_irq(&mdev->tconn->req_lock);
4959                 return -EIO;
4960         }
4961         __req_mod(req, what, &m);
4962         spin_unlock_irq(&mdev->tconn->req_lock);
4963
4964         if (m.bio)
4965                 complete_master_bio(mdev, &m);
4966         return 0;
4967 }
4968
4969 static int got_BlockAck(struct drbd_tconn *tconn, struct packet_info *pi)
4970 {
4971         struct drbd_conf *mdev;
4972         struct p_block_ack *p = pi->data;
4973         sector_t sector = be64_to_cpu(p->sector);
4974         int blksize = be32_to_cpu(p->blksize);
4975         enum drbd_req_event what;
4976
4977         mdev = vnr_to_mdev(tconn, pi->vnr);
4978         if (!mdev)
4979                 return -EIO;
4980
4981         update_peer_seq(mdev, be32_to_cpu(p->seq_num));
4982
4983         if (p->block_id == ID_SYNCER) {
4984                 drbd_set_in_sync(mdev, sector, blksize);
4985                 dec_rs_pending(mdev);
4986                 return 0;
4987         }
4988         switch (pi->cmd) {
4989         case P_RS_WRITE_ACK:
4990                 what = WRITE_ACKED_BY_PEER_AND_SIS;
4991                 break;
4992         case P_WRITE_ACK:
4993                 what = WRITE_ACKED_BY_PEER;
4994                 break;
4995         case P_RECV_ACK:
4996                 what = RECV_ACKED_BY_PEER;
4997                 break;
4998         case P_DISCARD_WRITE:
4999                 what = DISCARD_WRITE;
5000                 break;
5001         case P_RETRY_WRITE:
5002                 what = POSTPONE_WRITE;
5003                 break;
5004         default:
5005                 BUG();
5006         }
5007
5008         return validate_req_change_req_state(mdev, p->block_id, sector,
5009                                              &mdev->write_requests, __func__,
5010                                              what, false);
5011 }
5012
5013 static int got_NegAck(struct drbd_tconn *tconn, struct packet_info *pi)
5014 {
5015         struct drbd_conf *mdev;
5016         struct p_block_ack *p = pi->data;
5017         sector_t sector = be64_to_cpu(p->sector);
5018         int size = be32_to_cpu(p->blksize);
5019         int err;
5020
5021         mdev = vnr_to_mdev(tconn, pi->vnr);
5022         if (!mdev)
5023                 return -EIO;
5024
5025         update_peer_seq(mdev, be32_to_cpu(p->seq_num));
5026
5027         if (p->block_id == ID_SYNCER) {
5028                 dec_rs_pending(mdev);
5029                 drbd_rs_failed_io(mdev, sector, size);
5030                 return 0;
5031         }
5032
5033         err = validate_req_change_req_state(mdev, p->block_id, sector,
5034                                             &mdev->write_requests, __func__,
5035                                             NEG_ACKED, true);
5036         if (err) {
5037                 /* Protocol A has no P_WRITE_ACKs, but has P_NEG_ACKs.
5038                    The master bio might already be completed, therefore the
5039                    request is no longer in the collision hash. */
5040                 /* In Protocol B we might already have got a P_RECV_ACK
5041                    but then get a P_NEG_ACK afterwards. */
5042                 drbd_set_out_of_sync(mdev, sector, size);
5043         }
5044         return 0;
5045 }
5046
5047 static int got_NegDReply(struct drbd_tconn *tconn, struct packet_info *pi)
5048 {
5049         struct drbd_conf *mdev;
5050         struct p_block_ack *p = pi->data;
5051         sector_t sector = be64_to_cpu(p->sector);
5052
5053         mdev = vnr_to_mdev(tconn, pi->vnr);
5054         if (!mdev)
5055                 return -EIO;
5056
5057         update_peer_seq(mdev, be32_to_cpu(p->seq_num));
5058
5059         dev_err(DEV, "Got NegDReply; Sector %llus, len %u.\n",
5060             (unsigned long long)sector, be32_to_cpu(p->blksize));
5061
5062         return validate_req_change_req_state(mdev, p->block_id, sector,
5063                                              &mdev->read_requests, __func__,
5064                                              NEG_ACKED, false);
5065 }
5066
5067 static int got_NegRSDReply(struct drbd_tconn *tconn, struct packet_info *pi)
5068 {
5069         struct drbd_conf *mdev;
5070         sector_t sector;
5071         int size;
5072         struct p_block_ack *p = pi->data;
5073
5074         mdev = vnr_to_mdev(tconn, pi->vnr);
5075         if (!mdev)
5076                 return -EIO;
5077
5078         sector = be64_to_cpu(p->sector);
5079         size = be32_to_cpu(p->blksize);
5080
5081         update_peer_seq(mdev, be32_to_cpu(p->seq_num));
5082
5083         dec_rs_pending(mdev);
5084
5085         if (get_ldev_if_state(mdev, D_FAILED)) {
5086                 drbd_rs_complete_io(mdev, sector);
5087                 switch (pi->cmd) {
5088                 case P_NEG_RS_DREPLY:
5089                         drbd_rs_failed_io(mdev, sector, size);
5090                 case P_RS_CANCEL:
5091                         break;
5092                 default:
5093                         BUG();
5094                 }
5095                 put_ldev(mdev);
5096         }
5097
5098         return 0;
5099 }
5100
5101 static int got_BarrierAck(struct drbd_tconn *tconn, struct packet_info *pi)
5102 {
5103         struct p_barrier_ack *p = pi->data;
5104         struct drbd_conf *mdev;
5105         int vnr;
5106
5107         tl_release(tconn, p->barrier, be32_to_cpu(p->set_size));
5108
5109         rcu_read_lock();
5110         idr_for_each_entry(&tconn->volumes, mdev, vnr) {
5111                 if (mdev->state.conn == C_AHEAD &&
5112                     atomic_read(&mdev->ap_in_flight) == 0 &&
5113                     !test_and_set_bit(AHEAD_TO_SYNC_SOURCE, &mdev->flags)) {
5114                         mdev->start_resync_timer.expires = jiffies + HZ;
5115                         add_timer(&mdev->start_resync_timer);
5116                 }
5117         }
5118         rcu_read_unlock();
5119
5120         return 0;
5121 }
5122
5123 static int got_OVResult(struct drbd_tconn *tconn, struct packet_info *pi)
5124 {
5125         struct drbd_conf *mdev;
5126         struct p_block_ack *p = pi->data;
5127         struct drbd_work *w;
5128         sector_t sector;
5129         int size;
5130
5131         mdev = vnr_to_mdev(tconn, pi->vnr);
5132         if (!mdev)
5133                 return -EIO;
5134
5135         sector = be64_to_cpu(p->sector);
5136         size = be32_to_cpu(p->blksize);
5137
5138         update_peer_seq(mdev, be32_to_cpu(p->seq_num));
5139
5140         if (be64_to_cpu(p->block_id) == ID_OUT_OF_SYNC)
5141                 drbd_ov_out_of_sync_found(mdev, sector, size);
5142         else
5143                 ov_out_of_sync_print(mdev);
5144
5145         if (!get_ldev(mdev))
5146                 return 0;
5147
5148         drbd_rs_complete_io(mdev, sector);
5149         dec_rs_pending(mdev);
5150
5151         --mdev->ov_left;
5152
5153         /* let's advance progress step marks only for every other megabyte */
5154         if ((mdev->ov_left & 0x200) == 0x200)
5155                 drbd_advance_rs_marks(mdev, mdev->ov_left);
5156
5157         if (mdev->ov_left == 0) {
5158                 w = kmalloc(sizeof(*w), GFP_NOIO);
5159                 if (w) {
5160                         w->cb = w_ov_finished;
5161                         w->mdev = mdev;
5162                         drbd_queue_work(&mdev->tconn->sender_work, w);
5163                 } else {
5164                         dev_err(DEV, "kmalloc(w) failed.");
5165                         ov_out_of_sync_print(mdev);
5166                         drbd_resync_finished(mdev);
5167                 }
5168         }
5169         put_ldev(mdev);
5170         return 0;
5171 }
5172
5173 static int got_skip(struct drbd_tconn *tconn, struct packet_info *pi)
5174 {
5175         return 0;
5176 }
5177
5178 static int tconn_finish_peer_reqs(struct drbd_tconn *tconn)
5179 {
5180         struct drbd_conf *mdev;
5181         int vnr, not_empty = 0;
5182
5183         do {
5184                 clear_bit(SIGNAL_ASENDER, &tconn->flags);
5185                 flush_signals(current);
5186
5187                 rcu_read_lock();
5188                 idr_for_each_entry(&tconn->volumes, mdev, vnr) {
5189                         kref_get(&mdev->kref);
5190                         rcu_read_unlock();
5191                         if (drbd_finish_peer_reqs(mdev)) {
5192                                 kref_put(&mdev->kref, &drbd_minor_destroy);
5193                                 return 1;
5194                         }
5195                         kref_put(&mdev->kref, &drbd_minor_destroy);
5196                         rcu_read_lock();
5197                 }
5198                 set_bit(SIGNAL_ASENDER, &tconn->flags);
5199
5200                 spin_lock_irq(&tconn->req_lock);
5201                 idr_for_each_entry(&tconn->volumes, mdev, vnr) {
5202                         not_empty = !list_empty(&mdev->done_ee);
5203                         if (not_empty)
5204                                 break;
5205                 }
5206                 spin_unlock_irq(&tconn->req_lock);
5207                 rcu_read_unlock();
5208         } while (not_empty);
5209
5210         return 0;
5211 }
5212
5213 struct asender_cmd {
5214         size_t pkt_size;
5215         int (*fn)(struct drbd_tconn *tconn, struct packet_info *);
5216 };
5217
5218 static struct asender_cmd asender_tbl[] = {
5219         [P_PING]            = { 0, got_Ping },
5220         [P_PING_ACK]        = { 0, got_PingAck },
5221         [P_RECV_ACK]        = { sizeof(struct p_block_ack), got_BlockAck },
5222         [P_WRITE_ACK]       = { sizeof(struct p_block_ack), got_BlockAck },
5223         [P_RS_WRITE_ACK]    = { sizeof(struct p_block_ack), got_BlockAck },
5224         [P_DISCARD_WRITE]   = { sizeof(struct p_block_ack), got_BlockAck },
5225         [P_NEG_ACK]         = { sizeof(struct p_block_ack), got_NegAck },
5226         [P_NEG_DREPLY]      = { sizeof(struct p_block_ack), got_NegDReply },
5227         [P_NEG_RS_DREPLY]   = { sizeof(struct p_block_ack), got_NegRSDReply },
5228         [P_OV_RESULT]       = { sizeof(struct p_block_ack), got_OVResult },
5229         [P_BARRIER_ACK]     = { sizeof(struct p_barrier_ack), got_BarrierAck },
5230         [P_STATE_CHG_REPLY] = { sizeof(struct p_req_state_reply), got_RqSReply },
5231         [P_RS_IS_IN_SYNC]   = { sizeof(struct p_block_ack), got_IsInSync },
5232         [P_DELAY_PROBE]     = { sizeof(struct p_delay_probe93), got_skip },
5233         [P_RS_CANCEL]       = { sizeof(struct p_block_ack), got_NegRSDReply },
5234         [P_CONN_ST_CHG_REPLY]={ sizeof(struct p_req_state_reply), got_conn_RqSReply },
5235         [P_RETRY_WRITE]     = { sizeof(struct p_block_ack), got_BlockAck },
5236 };
5237
5238 int drbd_asender(struct drbd_thread *thi)
5239 {
5240         struct drbd_tconn *tconn = thi->tconn;
5241         struct asender_cmd *cmd = NULL;
5242         struct packet_info pi;
5243         int rv;
5244         void *buf    = tconn->meta.rbuf;
5245         int received = 0;
5246         unsigned int header_size = drbd_header_size(tconn);
5247         int expect   = header_size;
5248         bool ping_timeout_active = false;
5249         struct net_conf *nc;
5250         int ping_timeo, tcp_cork, ping_int;
5251
5252         current->policy = SCHED_RR;  /* Make this a realtime task! */
5253         current->rt_priority = 2;    /* more important than all other tasks */
5254
5255         while (get_t_state(thi) == RUNNING) {
5256                 drbd_thread_current_set_cpu(thi);
5257
5258                 rcu_read_lock();
5259                 nc = rcu_dereference(tconn->net_conf);
5260                 ping_timeo = nc->ping_timeo;
5261                 tcp_cork = nc->tcp_cork;
5262                 ping_int = nc->ping_int;
5263                 rcu_read_unlock();
5264
5265                 if (test_and_clear_bit(SEND_PING, &tconn->flags)) {
5266                         if (drbd_send_ping(tconn)) {
5267                                 conn_err(tconn, "drbd_send_ping has failed\n");
5268                                 goto reconnect;
5269                         }
5270                         tconn->meta.socket->sk->sk_rcvtimeo = ping_timeo * HZ / 10;
5271                         ping_timeout_active = true;
5272                 }
5273
5274                 /* TODO: conditionally cork; it may hurt latency if we cork without
5275                    much to send */
5276                 if (tcp_cork)
5277                         drbd_tcp_cork(tconn->meta.socket);
5278                 if (tconn_finish_peer_reqs(tconn)) {
5279                         conn_err(tconn, "tconn_finish_peer_reqs() failed\n");
5280                         goto reconnect;
5281                 }
5282                 /* but unconditionally uncork unless disabled */
5283                 if (tcp_cork)
5284                         drbd_tcp_uncork(tconn->meta.socket);
5285
5286                 /* short circuit, recv_msg would return EINTR anyways. */
5287                 if (signal_pending(current))
5288                         continue;
5289
5290                 rv = drbd_recv_short(tconn->meta.socket, buf, expect-received, 0);
5291                 clear_bit(SIGNAL_ASENDER, &tconn->flags);
5292
5293                 flush_signals(current);
5294
5295                 /* Note:
5296                  * -EINTR        (on meta) we got a signal
5297                  * -EAGAIN       (on meta) rcvtimeo expired
5298                  * -ECONNRESET   other side closed the connection
5299                  * -ERESTARTSYS  (on data) we got a signal
5300                  * rv <  0       other than above: unexpected error!
5301                  * rv == expected: full header or command
5302                  * rv <  expected: "woken" by signal during receive
5303                  * rv == 0       : "connection shut down by peer"
5304                  */
5305                 if (likely(rv > 0)) {
5306                         received += rv;
5307                         buf      += rv;
5308                 } else if (rv == 0) {
5309                         conn_err(tconn, "meta connection shut down by peer.\n");
5310                         goto reconnect;
5311                 } else if (rv == -EAGAIN) {
5312                         /* If the data socket received something meanwhile,
5313                          * that is good enough: peer is still alive. */
5314                         if (time_after(tconn->last_received,
5315                                 jiffies - tconn->meta.socket->sk->sk_rcvtimeo))
5316                                 continue;
5317                         if (ping_timeout_active) {
5318                                 conn_err(tconn, "PingAck did not arrive in time.\n");
5319                                 goto reconnect;
5320                         }
5321                         set_bit(SEND_PING, &tconn->flags);
5322                         continue;
5323                 } else if (rv == -EINTR) {
5324                         continue;
5325                 } else {
5326                         conn_err(tconn, "sock_recvmsg returned %d\n", rv);
5327                         goto reconnect;
5328                 }
5329
5330                 if (received == expect && cmd == NULL) {
5331                         if (decode_header(tconn, tconn->meta.rbuf, &pi))
5332                                 goto reconnect;
5333                         cmd = &asender_tbl[pi.cmd];
5334                         if (pi.cmd >= ARRAY_SIZE(asender_tbl) || !cmd->fn) {
5335                                 conn_err(tconn, "Unexpected meta packet %s (0x%04x)\n",
5336                                          cmdname(pi.cmd), pi.cmd);
5337                                 goto disconnect;
5338                         }
5339                         expect = header_size + cmd->pkt_size;
5340                         if (pi.size != expect - header_size) {
5341                                 conn_err(tconn, "Wrong packet size on meta (c: %d, l: %d)\n",
5342                                         pi.cmd, pi.size);
5343                                 goto reconnect;
5344                         }
5345                 }
5346                 if (received == expect) {
5347                         bool err;
5348
5349                         err = cmd->fn(tconn, &pi);
5350                         if (err) {
5351                                 conn_err(tconn, "%pf failed\n", cmd->fn);
5352                                 goto reconnect;
5353                         }
5354
5355                         tconn->last_received = jiffies;
5356
5357                         if (cmd == &asender_tbl[P_PING_ACK]) {
5358                                 /* restore idle timeout */
5359                                 tconn->meta.socket->sk->sk_rcvtimeo = ping_int * HZ;
5360                                 ping_timeout_active = false;
5361                         }
5362
5363                         buf      = tconn->meta.rbuf;
5364                         received = 0;
5365                         expect   = header_size;
5366                         cmd      = NULL;
5367                 }
5368         }
5369
5370         if (0) {
5371 reconnect:
5372                 conn_request_state(tconn, NS(conn, C_NETWORK_FAILURE), CS_HARD);
5373         }
5374         if (0) {
5375 disconnect:
5376                 conn_request_state(tconn, NS(conn, C_DISCONNECTING), CS_HARD);
5377         }
5378         clear_bit(SIGNAL_ASENDER, &tconn->flags);
5379
5380         conn_info(tconn, "asender terminated\n");
5381
5382         return 0;
5383 }