Whamcloud - gitweb
LU-14390 gnilnd: Use DIV_ROUND_UP to calculate niov
[fs/lustre-release.git] / lnet / klnds / gnilnd / gnilnd_cb.c
1 /*
2  * Copyright (C) 2004 Cluster File Systems, Inc.
3  *
4  * Copyright (C) 2009-2012 Cray, Inc.
5  *
6  *   Derived from work by Eric Barton <eric@bartonsoftware.com>
7  *   Author: James Shimek <jshimek@cray.com>
8  *   Author: Nic Henke <nic@cray.com>
9  *
10  *   This file is part of Lustre, http://www.lustre.org.
11  *
12  *   Lustre is free software; you can redistribute it and/or
13  *   modify it under the terms of version 2 of the GNU General Public
14  *   License as published by the Free Software Foundation.
15  *
16  *   Lustre is distributed in the hope that it will be useful,
17  *   but WITHOUT ANY WARRANTY; without even the implied warranty of
18  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
19  *   GNU General Public License for more details.
20  *
21  *   You should have received a copy of the GNU General Public License
22  *   along with Lustre; if not, write to the Free Software
23  *   Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
24  *
25  */
26
27 #include <asm/page.h>
28 #include <linux/nmi.h>
29 #include <linux/pagemap.h>
30
31 #include <libcfs/linux/linux-mem.h>
32
33 #include "gnilnd.h"
34
35 /* this is useful when needed to debug wire corruption. */
36 static void
37 kgnilnd_dump_blob(int level, char *prefix, void *buf, int len) {
38         __u64 *ptr;
39
40         ptr = (__u64 *) buf;
41
42         while (len > 0) {
43                 if (len >= 32) {
44                         CDEBUG(level,
45                                "%s 0x%p: 0x%16.16llx 0x%16.16llx 0x%16.16llx 0x%16.16llx\n",
46                                prefix, ptr, *(ptr), *(ptr + 1), *(ptr + 2), *(ptr + 3));
47                         ptr += 4;
48                         len -= 32;
49                 } else if (len >= 16) {
50                         CDEBUG(level,
51                                "%s 0x%p: 0x%16.16llx 0x%16.16llx\n",
52                                prefix, ptr, *(ptr), *(ptr + 1));
53                         ptr += 2;
54                         len -= 16;
55                 } else {
56                         CDEBUG(level, "%s 0x%p: 0x%16.16llx\n",
57                                prefix, ptr, *(ptr));
58                         ptr++;
59                         len -= 8;
60                 }
61         }
62 }
63
64 static void
65 kgnilnd_dump_msg(int mask, kgn_msg_t *msg)
66 {
67         CDEBUG(mask, "0x%8.8x 0x%4.4x 0x%4.4x 0x%16.16llx"
68                 " 0x%16.16llx 0x%8.8x 0x%4.4x 0x%4.4x 0x%8.8x\n",
69                 msg->gnm_magic, msg->gnm_version,
70                 msg->gnm_type, msg->gnm_srcnid,
71                 msg->gnm_connstamp, msg->gnm_seq,
72                 msg->gnm_cksum, msg->gnm_payload_cksum,
73                 msg->gnm_payload_len);
74 }
75
76 void
77 kgnilnd_schedule_device(kgn_device_t *dev)
78 {
79         short         already_live = 0;
80
81         /* we'll only want to wake if the scheduler thread
82          * has come around and set ready to zero */
83         already_live = cmpxchg(&dev->gnd_ready, GNILND_DEV_IDLE, GNILND_DEV_IRQ);
84
85         if (!already_live) {
86                 wake_up_all(&dev->gnd_waitq);
87         }
88 }
89
90 void kgnilnd_schedule_device_timer(cfs_timer_cb_arg_t data)
91 {
92         kgn_device_t *dev = cfs_from_timer(dev, data, gnd_map_timer);
93
94         kgnilnd_schedule_device(dev);
95 }
96
97 void kgnilnd_schedule_device_timer_rd(cfs_timer_cb_arg_t data)
98 {
99         kgn_device_t *dev = cfs_from_timer(dev, data, gnd_rdmaq_timer);
100
101         kgnilnd_schedule_device(dev);
102 }
103
104 void
105 kgnilnd_device_callback(__u32 devid, __u64 arg)
106 {
107         kgn_device_t *dev;
108         int           index = (int) arg;
109
110         if (index >= kgnilnd_data.kgn_ndevs) {
111                 /* use _EMERG instead of an LBUG to prevent LBUG'ing in
112                  * interrupt context. */
113                 LCONSOLE_EMERG("callback for unknown device %d->%d\n",
114                                 devid, index);
115                 return;
116         }
117
118         dev = &kgnilnd_data.kgn_devices[index];
119         /* just basic sanity */
120         if (dev->gnd_id == devid) {
121                 kgnilnd_schedule_device(dev);
122         } else {
123                 LCONSOLE_EMERG("callback for bad device %d devid %d\n",
124                                 dev->gnd_id, devid);
125         }
126 }
127
128 /* sched_intent values:
129  * < 0 : do not reschedule under any circumstances
130  * == 0: reschedule if someone marked him WANTS_SCHED
131  * > 0 : force a reschedule */
132 /* Return code 0 means it did not schedule the conn, 1
133  * means it successfully scheduled the conn.
134  */
135
136 int
137 kgnilnd_schedule_process_conn(kgn_conn_t *conn, int sched_intent)
138 {
139         int     conn_sched;
140
141         /* move back to IDLE but save previous state.
142          * if we see WANTS_SCHED, we'll call kgnilnd_schedule_conn and
143          * let the xchg there handle any racing callers to get it
144          * onto gnd_ready_conns */
145
146         conn_sched = xchg(&conn->gnc_scheduled, GNILND_CONN_IDLE);
147         LASSERTF(conn_sched == GNILND_CONN_WANTS_SCHED ||
148                  conn_sched == GNILND_CONN_PROCESS,
149                  "conn %p after process in bad state: %d\n",
150                  conn, conn_sched);
151
152         if (sched_intent >= 0) {
153                 if ((sched_intent > 0 || (conn_sched == GNILND_CONN_WANTS_SCHED))) {
154                         return kgnilnd_schedule_conn_refheld(conn, 1);
155                 }
156         }
157         return 0;
158 }
159
160 /* Return of 0 for conn not scheduled, 1 returned if conn was scheduled or marked
161  * as scheduled */
162
163 int
164 _kgnilnd_schedule_conn(kgn_conn_t *conn, const char *caller, int line, int refheld, int lock_held)
165 {
166         kgn_device_t        *dev = conn->gnc_device;
167         int                  sched;
168         int                  rc;
169
170         sched = xchg(&conn->gnc_scheduled, GNILND_CONN_WANTS_SCHED);
171         /* we only care about the last person who marked want_sched since they
172          * are most likely the culprit
173          */
174         memcpy(conn->gnc_sched_caller, caller, sizeof(conn->gnc_sched_caller));
175         conn->gnc_sched_line = line;
176         /* if we are IDLE, add to list - only one guy sees IDLE and "wins"
177          * the chance to put it onto gnd_ready_conns.
178          * otherwise, leave marked as WANTS_SCHED and the thread that "owns"
179          *  the conn in process_conns will take care of moving it back to
180          *  SCHED when it is done processing */
181
182         if (sched == GNILND_CONN_IDLE) {
183                 /* if the conn is already scheduled, we've already requested
184                  * the scheduler thread wakeup */
185                 if (!refheld) {
186                         /* Add a reference to the conn if we are not holding a reference
187                          * already from the exisiting scheduler. We now use the same
188                          * reference if we need to reschedule a conn while in a scheduler
189                          * thread.
190                          */
191                         kgnilnd_conn_addref(conn);
192                 }
193                 LASSERTF(list_empty(&conn->gnc_schedlist), "conn %p already sched state %d\n",
194                          conn, sched);
195
196                 CDEBUG(D_INFO, "scheduling conn 0x%p caller %s:%d\n", conn, caller, line);
197                 if (!lock_held)
198                         spin_lock(&dev->gnd_lock);
199                 list_add_tail(&conn->gnc_schedlist, &dev->gnd_ready_conns);
200                 if (!lock_held)
201                         spin_unlock(&dev->gnd_lock);
202                 set_mb(conn->gnc_last_sched_ask, jiffies);
203                 rc = 1;
204         } else {
205                 CDEBUG(D_INFO, "not scheduling conn 0x%p: %d caller %s:%d\n", conn, sched, caller, line);
206                 rc = 0;
207         }
208
209         /* make sure thread(s) going to process conns - but let it make
210          * separate decision from conn schedule */
211         if (!lock_held)
212                 kgnilnd_schedule_device(dev);
213         return rc;
214 }
215
216 int
217 _kgnilnd_schedule_delay_conn(kgn_conn_t *conn)
218 {
219         kgn_device_t    *dev = conn->gnc_device;
220         int rc = 0;
221         spin_lock(&dev->gnd_lock);
222         if (list_empty(&conn->gnc_delaylist)) {
223                 list_add_tail(&conn->gnc_delaylist, &dev->gnd_delay_conns);
224                 rc = 1;
225         }
226         spin_unlock(&dev->gnd_lock);
227
228         kgnilnd_schedule_device(dev);
229         return rc;
230 }
231
232 void
233 kgnilnd_schedule_dgram(kgn_device_t *dev)
234 {
235         int                  wake;
236
237         wake = xchg(&dev->gnd_dgram_ready, GNILND_DGRAM_SCHED);
238         if (wake != GNILND_DGRAM_SCHED)  {
239                 wake_up(&dev->gnd_dgram_waitq);
240         } else {
241                 CDEBUG(D_NETTRACE, "not waking: %d\n", wake);
242         }
243 }
244
245 void
246 kgnilnd_free_tx(kgn_tx_t *tx)
247 {
248         /* taken from kgnilnd_tx_add_state_locked */
249
250         LASSERTF((tx->tx_list_p == NULL &&
251                   tx->tx_list_state == GNILND_TX_ALLOCD) &&
252                 list_empty(&tx->tx_list),
253                 "tx %p with bad state %s (list_p %p) tx_list %s\n",
254                 tx, kgnilnd_tx_state2str(tx->tx_list_state), tx->tx_list_p,
255                 list_empty(&tx->tx_list) ? "empty" : "not empty");
256
257         atomic_dec(&kgnilnd_data.kgn_ntx);
258
259         /* we only allocate this if we need to */
260         if (tx->tx_phys != NULL) {
261                 kmem_cache_free(kgnilnd_data.kgn_tx_phys_cache, tx->tx_phys);
262                 CDEBUG(D_MALLOC, "slab-freed 'tx_phys': %lu at %p.\n",
263                        LNET_MAX_IOV * sizeof(gni_mem_segment_t), tx->tx_phys);
264         }
265
266         /* Only free the buffer if we used it */
267         if (tx->tx_buffer_copy != NULL) {
268                 kgnilnd_vfree(tx->tx_buffer_copy, tx->tx_rdma_desc.length);
269                 tx->tx_buffer_copy = NULL;
270                 CDEBUG(D_MALLOC, "vfreed buffer2\n");
271         }
272 #if 0
273         KGNILND_POISON(tx, 0x5a, sizeof(kgn_tx_t));
274 #endif
275         CDEBUG(D_MALLOC, "slab-freed 'tx': %lu at %p.\n", sizeof(*tx), tx);
276         kmem_cache_free(kgnilnd_data.kgn_tx_cache, tx);
277 }
278
279 kgn_tx_t *
280 kgnilnd_alloc_tx (void)
281 {
282         kgn_tx_t        *tx = NULL;
283
284         if (CFS_FAIL_CHECK(CFS_FAIL_GNI_ALLOC_TX))
285                 return tx;
286
287         tx = kmem_cache_zalloc(kgnilnd_data.kgn_tx_cache, GFP_ATOMIC);
288         if (tx == NULL) {
289                 CERROR("failed to allocate tx\n");
290                 return NULL;
291         }
292         CDEBUG(D_MALLOC, "slab-alloced 'tx': %lu at %p.\n",
293                sizeof(*tx), tx);
294
295         /* setup everything here to minimize time under the lock */
296         tx->tx_buftype = GNILND_BUF_NONE;
297         tx->tx_msg.gnm_type = GNILND_MSG_NONE;
298         INIT_LIST_HEAD(&tx->tx_list);
299         INIT_LIST_HEAD(&tx->tx_map_list);
300         tx->tx_list_state = GNILND_TX_ALLOCD;
301
302         atomic_inc(&kgnilnd_data.kgn_ntx);
303
304         return tx;
305 }
306
307 /* csum_fold needs to be run on the return value before shipping over the wire */
308 #define _kgnilnd_cksum(seed, ptr, nob)  csum_partial(ptr, nob, seed)
309
310 /* we don't use offset as every one is passing a buffer reference that already
311  * includes the offset into the base address.
312  */
313 static inline __u16
314 kgnilnd_cksum(void *ptr, size_t nob)
315 {
316         __u16   sum;
317
318         sum = csum_fold(_kgnilnd_cksum(0, ptr, nob));
319
320         /* don't use magic 'no checksum' value */
321         if (sum == 0)
322                 sum = 1;
323
324         CDEBUG(D_INFO, "cksum 0x%x for ptr 0x%p sz %zu\n",
325                sum, ptr, nob);
326
327         return sum;
328 }
329
330 __u16
331 kgnilnd_cksum_kiov(unsigned int nkiov, struct bio_vec *kiov,
332                    unsigned int offset, unsigned int nob, int dump_blob)
333 {
334         __wsum             cksum = 0;
335         __wsum             tmpck;
336         __u16              retsum;
337         void              *addr;
338         unsigned int       fraglen;
339         int                i, odd;
340
341         LASSERT(nkiov > 0);
342         LASSERT(nob > 0);
343
344         CDEBUG(D_BUFFS, "calc cksum for kiov 0x%p nkiov %u offset %u nob %u, dump %d\n",
345                kiov, nkiov, offset, nob, dump_blob);
346
347         /* if loops changes, please change kgnilnd_setup_phys_buffer */
348
349         while (offset >= kiov->bv_len) {
350                 offset -= kiov->bv_len;
351                 nkiov--;
352                 kiov++;
353                 LASSERT(nkiov > 0);
354         }
355
356         /* ignore nob here, if nob < (bv_len - offset), kiov == 1 */
357         odd = (unsigned long) (kiov[0].bv_len - offset) & 1;
358
359         if ((odd || *kgnilnd_tunables.kgn_vmap_cksum) && nkiov > 1) {
360                 struct page **pages = kgnilnd_data.kgn_cksum_map_pages[get_cpu()];
361
362                 LASSERTF(pages != NULL, "NULL pages for cpu %d map_pages 0x%p\n",
363                          get_cpu(), kgnilnd_data.kgn_cksum_map_pages);
364
365                 CDEBUG(D_BUFFS, "odd %d len %u offset %u nob %u\n",
366                        odd, kiov[0].bv_len, offset, nob);
367
368                 for (i = 0; i < nkiov; i++) {
369                         pages[i] = kiov[i].bv_page;
370                 }
371
372                 addr = vmap(pages, nkiov, VM_MAP, PAGE_KERNEL);
373                 if (addr == NULL) {
374                         CNETERR("Couldn't vmap %d frags on %d bytes to avoid odd length fragment in cksum\n",
375                                 nkiov, nob);
376                         /* return zero to avoid killing tx - we'll just get warning on console
377                          * when remote end sees zero checksum */
378                         RETURN(0);
379                 }
380                 atomic_inc(&kgnilnd_data.kgn_nvmap_cksum);
381
382                 tmpck = _kgnilnd_cksum(0, ((void *) addr + kiov[0].bv_offset +
383                                            offset), nob);
384                 cksum = tmpck;
385
386                 if (dump_blob) {
387                         kgnilnd_dump_blob(D_BUFFS, "flat kiov RDMA payload",
388                                           (void *)addr + kiov[0].bv_offset +
389                                           offset, nob);
390                 }
391                 CDEBUG(D_BUFFS, "cksum 0x%x (+0x%x) for addr 0x%p+%u len %u offset %u\n",
392                        cksum, tmpck, addr, kiov[0].bv_offset, nob, offset);
393                 vunmap(addr);
394         } else {
395                 do {
396                         fraglen = min(kiov->bv_len - offset, nob);
397
398                         /* make dang sure we don't send a bogus checksum if somehow we get
399                          * an odd length fragment on anything but the last entry in a kiov  -
400                          * we know from kgnilnd_setup_rdma_buffer that we can't have non
401                          * PAGE_SIZE pages in the middle, so if nob < PAGE_SIZE, it is the last one */
402                         LASSERTF(!(fraglen&1) || (nob < PAGE_SIZE),
403                                  "odd fraglen %u on nkiov %d, nob %u bv_len %u offset %u kiov 0x%p\n",
404                                  fraglen, nkiov, nob, kiov->bv_len,
405                                  offset, kiov);
406
407                         addr = (void *)kmap(kiov->bv_page) + kiov->bv_offset +
408                                 offset;
409                         tmpck = _kgnilnd_cksum(cksum, addr, fraglen);
410
411                         CDEBUG(D_BUFFS,
412                                "cksum 0x%x (+0x%x) for page 0x%p+%u (0x%p) len %u offset %u\n",
413                                cksum, tmpck, kiov->bv_page, kiov->bv_offset,
414                                addr, fraglen, offset);
415
416                         cksum = tmpck;
417
418                         if (dump_blob)
419                                 kgnilnd_dump_blob(D_BUFFS, "kiov cksum", addr, fraglen);
420
421                         kunmap(kiov->bv_page);
422
423                         kiov++;
424                         nkiov--;
425                         nob -= fraglen;
426                         offset = 0;
427
428                         /* iov must not run out before end of data */
429                         LASSERTF(nob == 0 || nkiov > 0, "nob %u nkiov %u\n", nob, nkiov);
430
431                 } while (nob > 0);
432         }
433
434         retsum = csum_fold(cksum);
435
436         /* don't use magic 'no checksum' value */
437         if (retsum == 0)
438                 retsum = 1;
439
440         CDEBUG(D_BUFFS, "retsum 0x%x from cksum 0x%x\n", retsum, cksum);
441
442         return retsum;
443 }
444
445 void
446 kgnilnd_init_msg(kgn_msg_t *msg, int type, lnet_nid_t source)
447 {
448         msg->gnm_magic = GNILND_MSG_MAGIC;
449         msg->gnm_version = GNILND_MSG_VERSION;
450         msg->gnm_type = type;
451         msg->gnm_payload_len = 0;
452         msg->gnm_srcnid = source;
453         /* gnm_connstamp gets set when FMA is sent */
454         /* gnm_srcnid is set on creation via function argument
455          * The right interface/net and nid is passed in when the message
456          * is created.
457          */
458 }
459
460 kgn_tx_t *
461 kgnilnd_new_tx_msg(int type, lnet_nid_t source)
462 {
463         kgn_tx_t *tx = kgnilnd_alloc_tx();
464
465         if (tx != NULL) {
466                 kgnilnd_init_msg(&tx->tx_msg, type, source);
467         } else {
468                 CERROR("couldn't allocate new tx type %s!\n",
469                        kgnilnd_msgtype2str(type));
470         }
471
472         return tx;
473 }
474
475 static void
476 kgnilnd_nak_rdma(kgn_conn_t *conn, int rx_type, int error, __u64 cookie, lnet_nid_t source) {
477         kgn_tx_t        *tx;
478
479         int             nak_type;
480
481         switch (rx_type) {
482         case GNILND_MSG_GET_REQ:
483         case GNILND_MSG_GET_DONE:
484                 nak_type = GNILND_MSG_GET_NAK;
485                 break;
486         case GNILND_MSG_PUT_REQ:
487         case GNILND_MSG_PUT_ACK:
488         case GNILND_MSG_PUT_DONE:
489                 nak_type = GNILND_MSG_PUT_NAK;
490                 break;
491         case GNILND_MSG_PUT_REQ_REV:
492         case GNILND_MSG_PUT_DONE_REV:
493                 nak_type = GNILND_MSG_PUT_NAK_REV;
494                 break;
495         case GNILND_MSG_GET_REQ_REV:
496         case GNILND_MSG_GET_ACK_REV:
497         case GNILND_MSG_GET_DONE_REV:
498                 nak_type = GNILND_MSG_GET_NAK_REV;
499                 break;
500         default:
501                 CERROR("invalid msg type %s (%d)\n",
502                         kgnilnd_msgtype2str(rx_type), rx_type);
503                 LBUG();
504         }
505         /* only allow NAK on error and truncate to zero */
506         LASSERTF(error <= 0, "error %d conn 0x%p, cookie %llu\n",
507                  error, conn, cookie);
508
509         tx = kgnilnd_new_tx_msg(nak_type, source);
510         if (tx == NULL) {
511                 CNETERR("can't get TX to NAK RDMA to %s\n",
512                         libcfs_nid2str(conn->gnc_peer->gnp_nid));
513                 return;
514         }
515
516         tx->tx_msg.gnm_u.completion.gncm_retval = error;
517         tx->tx_msg.gnm_u.completion.gncm_cookie = cookie;
518         kgnilnd_queue_tx(conn, tx);
519 }
520
521 static int
522 kgnilnd_setup_immediate_buffer(kgn_tx_t *tx, unsigned int niov,
523                                struct bio_vec *kiov,
524                                unsigned int offset, unsigned int nob)
525 {
526         kgn_msg_t       *msg = &tx->tx_msg;
527         int              i;
528
529         /* To help save on MDDs for short messages, we'll vmap a kiov to allow
530          * gni_smsg_send to send that as the payload */
531
532         LASSERT(tx->tx_buftype == GNILND_BUF_NONE);
533
534         if (nob == 0) {
535                 tx->tx_buffer = NULL;
536         } else {
537
538                 if (niov && niov > (nob >> PAGE_SHIFT))
539                         niov = DIV_ROUND_UP(nob + offset + kiov->bv_offset,
540                                             PAGE_SIZE);
541
542                 LASSERTF(niov > 0 && niov < GNILND_MAX_IMMEDIATE/PAGE_SIZE,
543                         "bad niov %d msg %p kiov %p offset %d nob%d\n",
544                         niov, msg, kiov, offset, nob);
545
546                 while (offset >= kiov->bv_len) {
547                         offset -= kiov->bv_len;
548                         niov--;
549                         kiov++;
550                         LASSERT(niov > 0);
551                 }
552                 for (i = 0; i < niov; i++) {
553                         /* We can't have a bv_offset on anything but the first
554                          * entry, otherwise we'll have a hole at the end of the
555                          * mapping as we only map whole pages.
556                          * Also, if we have a bv_len < PAGE_SIZE but we need to
557                          * map more than bv_len, we will also have a whole at
558                          * the end of that page which isn't allowed
559                          */
560                         if ((kiov[i].bv_offset != 0 && i > 0) ||
561                             (kiov[i].bv_offset + kiov[i].bv_len != PAGE_SIZE &&
562                              i < niov - 1)) {
563                                 CNETERR("Can't make payload contiguous in I/O VM:page %d, offset %u, nob %u, bv_offset %u bv_len %u\n",
564                                        i, offset, nob, kiov->bv_offset,
565                                         kiov->bv_len);
566                                 RETURN(-EINVAL);
567                         }
568                         tx->tx_imm_pages[i] = kiov[i].bv_page;
569                 }
570
571                 /* hijack tx_phys for the later unmap */
572                 if (niov == 1) {
573                         /* tx->phyx being equal to NULL is the signal for unmap to discern between kmap and vmap */
574                         tx->tx_phys = NULL;
575                         tx->tx_buffer = (void *)kmap(tx->tx_imm_pages[0]) +
576                                 kiov[0].bv_offset + offset;
577                         atomic_inc(&kgnilnd_data.kgn_nkmap_short);
578                         GNIDBG_TX(D_NET, tx, "kmapped page for %d bytes for kiov 0x%p, buffer 0x%p",
579                                 nob, kiov, tx->tx_buffer);
580                 } else {
581                         tx->tx_phys = vmap(tx->tx_imm_pages, niov, VM_MAP, PAGE_KERNEL);
582                         if (tx->tx_phys == NULL) {
583                                 CNETERR("Couldn't vmap %d frags on %d bytes\n", niov, nob);
584                                 RETURN(-ENOMEM);
585
586                         }
587                         atomic_inc(&kgnilnd_data.kgn_nvmap_short);
588                         /* make sure we take into account the kiov offset as the
589                          * start of the buffer
590                          */
591                         tx->tx_buffer = (void *)tx->tx_phys + kiov[0].bv_offset
592                                 + offset;
593                         GNIDBG_TX(D_NET, tx,
594                                   "mapped %d pages for %d bytes from kiov 0x%p to 0x%p, buffer 0x%p",
595                                   niov, nob, kiov, tx->tx_phys, tx->tx_buffer);
596                 }
597                 tx->tx_buftype = GNILND_BUF_IMMEDIATE_KIOV;
598                 tx->tx_nob = nob;
599
600         }
601
602         /* checksum payload early - it shouldn't be changing after lnd_send */
603         if (*kgnilnd_tunables.kgn_checksum >= 2) {
604                 msg->gnm_payload_cksum = kgnilnd_cksum(tx->tx_buffer, nob);
605                 if (CFS_FAIL_CHECK(CFS_FAIL_GNI_SMSG_CKSUM2)) {
606                         msg->gnm_payload_cksum += 0xe00e;
607                 }
608                 if (*kgnilnd_tunables.kgn_checksum_dump > 1) {
609                         kgnilnd_dump_blob(D_BUFFS, "payload checksum",
610                                           tx->tx_buffer, nob);
611                 }
612         } else {
613                 msg->gnm_payload_cksum = 0;
614         }
615
616         return 0;
617 }
618
619 int
620 kgnilnd_setup_phys_buffer(kgn_tx_t *tx, int nkiov, struct bio_vec *kiov,
621                           unsigned int offset, unsigned int nob)
622 {
623         gni_mem_segment_t *phys;
624         int             rc = 0;
625         unsigned int    fraglen;
626
627         GNIDBG_TX(D_NET, tx, "niov %d kiov 0x%p offset %u nob %u", nkiov, kiov, offset, nob);
628
629         LASSERT(nob > 0);
630         LASSERT(nkiov > 0);
631         LASSERT(tx->tx_buftype == GNILND_BUF_NONE);
632
633         /* only allocate this if we are going to use it */
634         tx->tx_phys = kmem_cache_alloc(kgnilnd_data.kgn_tx_phys_cache,
635                                               GFP_ATOMIC);
636         if (tx->tx_phys == NULL) {
637                 CERROR("failed to allocate tx_phys\n");
638                 rc = -ENOMEM;
639                 GOTO(error, rc);
640         }
641
642         CDEBUG(D_MALLOC, "slab-alloced 'tx->tx_phys': %lu at %p.\n",
643                LNET_MAX_IOV * sizeof(gni_mem_segment_t), tx->tx_phys);
644
645         /* if loops changes, please change kgnilnd_cksum_kiov
646          *   and kgnilnd_setup_immediate_buffer */
647
648         while (offset >= kiov->bv_len) {
649                 offset -= kiov->bv_len;
650                 nkiov--;
651                 kiov++;
652                 LASSERT(nkiov > 0);
653         }
654
655         /* at this point, kiov points to the first page that we'll actually map
656          * now that we've seeked into the koiv for offset and dropped any
657          * leading pages that fall entirely within the offset */
658         tx->tx_buftype = GNILND_BUF_PHYS_UNMAPPED;
659         tx->tx_nob = nob;
660
661         /* bv_offset is start of 'valid' buffer, so index offset past that */
662         tx->tx_buffer = (void *)((unsigned long)(kiov->bv_offset + offset));
663         phys = tx->tx_phys;
664
665         CDEBUG(D_NET, "tx 0x%p buffer 0x%p map start kiov 0x%p+%u niov %d offset %u\n",
666                tx, tx->tx_buffer, kiov, kiov->bv_offset, nkiov, offset);
667
668         do {
669                 fraglen = min(kiov->bv_len - offset, nob);
670
671                 /* We can't have a bv_offset on anything but the first entry,
672                  * otherwise we'll have a hole at the end of the mapping as we
673                  * only map whole pages.  Only the first page is allowed to
674                  * have an offset - we'll add that into tx->tx_buffer and that
675                  * will get used when we map in the segments (see
676                  * kgnilnd_map_buffer).  Also, if we have a bv_len < PAGE_SIZE
677                  * but we need to map more than bv_len, we will also have a
678                  * whole at the end of that page which isn't allowed
679                  */
680                 if ((phys != tx->tx_phys) &&
681                     ((kiov->bv_offset != 0) ||
682                      ((kiov->bv_len < PAGE_SIZE) && (nob > kiov->bv_len)))) {
683                         CERROR("Can't make payload contiguous in I/O VM:page %d, offset %u, nob %u, bv_offset %u bv_len %u\n",
684                                (int)(phys - tx->tx_phys),
685                                offset, nob, kiov->bv_offset, kiov->bv_len);
686                         rc = -EINVAL;
687                         GOTO(error, rc);
688                 }
689
690                 if ((phys - tx->tx_phys) == LNET_MAX_IOV) {
691                         CERROR ("payload too big (%d)\n", (int)(phys - tx->tx_phys));
692                         rc = -EMSGSIZE;
693                         GOTO(error, rc);
694                 }
695
696                 if (CFS_FAIL_CHECK(CFS_FAIL_GNI_PHYS_SETUP)) {
697                         rc = -EINVAL;
698                         GOTO(error, rc);
699                 }
700
701                 CDEBUG(D_BUFFS,
702                        "page 0x%p bv_offset %u bv_len %u nob %u nkiov %u offset %u\n",
703                        kiov->bv_page, kiov->bv_offset, kiov->bv_len, nob, nkiov,
704                        offset);
705
706                 phys->address = page_to_phys(kiov->bv_page);
707                 phys++;
708                 kiov++;
709                 nkiov--;
710                 nob -= fraglen;
711                 offset = 0;
712
713                 /* iov must not run out before end of data */
714                 LASSERTF(nob == 0 || nkiov > 0, "nob %u nkiov %u\n", nob, nkiov);
715
716         } while (nob > 0);
717
718         tx->tx_phys_npages = phys - tx->tx_phys;
719
720         return 0;
721
722 error:
723         if (tx->tx_phys != NULL) {
724                 kmem_cache_free(kgnilnd_data.kgn_tx_phys_cache, tx->tx_phys);
725                 CDEBUG(D_MALLOC, "slab-freed 'tx_phys': %lu at %p.\n",
726                        sizeof(*tx->tx_phys), tx->tx_phys);
727                 tx->tx_phys = NULL;
728         }
729         return rc;
730 }
731
732 static inline int
733 kgnilnd_setup_rdma_buffer(kgn_tx_t *tx, unsigned int niov,
734                           struct bio_vec *kiov,
735                           unsigned int offset, unsigned int nob)
736 {
737         return kgnilnd_setup_phys_buffer(tx, niov, kiov, offset, nob);
738 }
739
740 /* kgnilnd_parse_lnet_rdma()
741  * lntmsg - message passed in from lnet.
742  * niov, kiov, offset - see lnd_t in lib-types.h for descriptions.
743  * nob - actual number of bytes to in this message.
744  * put_len - It is possible for PUTs to have a different length than the
745  *           length stored in lntmsg->msg_len since LNET can adjust this
746  *           length based on it's buffer size and offset.
747  *           lnet_try_match_md() sets the mlength that we use to do the RDMA
748  *           transfer.
749  */
750 static void
751 kgnilnd_parse_lnet_rdma(struct lnet_msg *lntmsg, unsigned int *niov,
752                         unsigned int *offset, unsigned int *nob,
753                         struct bio_vec **kiov, int put_len)
754 {
755         /* GETs are weird, see kgnilnd_send */
756         if (lntmsg->msg_type == LNET_MSG_GET) {
757                 if ((lntmsg->msg_md->md_options & LNET_MD_KIOV) == 0) {
758                         *kiov = NULL;
759                 } else {
760                         *kiov = lntmsg->msg_md->md_kiov;
761                 }
762                 *niov = lntmsg->msg_md->md_niov;
763                 *nob = lntmsg->msg_md->md_length;
764                 *offset = 0;
765         } else {
766                 *kiov = lntmsg->msg_kiov;
767                 *niov = lntmsg->msg_niov;
768                 *nob = put_len;
769                 *offset = lntmsg->msg_offset;
770         }
771 }
772
773 static inline void
774 kgnilnd_compute_rdma_cksum(kgn_tx_t *tx, int put_len)
775 {
776         unsigned int niov, offset, nob;
777         struct bio_vec *kiov;
778         struct lnet_msg *lntmsg = tx->tx_lntmsg[0];
779         int dump_cksum = (*kgnilnd_tunables.kgn_checksum_dump > 1);
780
781         GNITX_ASSERTF(tx, ((tx->tx_msg.gnm_type == GNILND_MSG_PUT_DONE) ||
782                            (tx->tx_msg.gnm_type == GNILND_MSG_GET_DONE) ||
783                            (tx->tx_msg.gnm_type == GNILND_MSG_PUT_DONE_REV) ||
784                            (tx->tx_msg.gnm_type == GNILND_MSG_GET_DONE_REV) ||
785                            (tx->tx_msg.gnm_type == GNILND_MSG_GET_ACK_REV) ||
786                            (tx->tx_msg.gnm_type == GNILND_MSG_PUT_REQ_REV)),
787                       "bad type %s", kgnilnd_msgtype2str(tx->tx_msg.gnm_type));
788
789         if ((tx->tx_msg.gnm_type == GNILND_MSG_PUT_DONE_REV) ||
790             (tx->tx_msg.gnm_type == GNILND_MSG_GET_DONE_REV)) {
791                 tx->tx_msg.gnm_payload_cksum = 0;
792                 return;
793         }
794         if (*kgnilnd_tunables.kgn_checksum < 3) {
795                 tx->tx_msg.gnm_payload_cksum = 0;
796                 return;
797         }
798
799         GNITX_ASSERTF(tx, lntmsg, "no LNet message!", NULL);
800
801         kgnilnd_parse_lnet_rdma(lntmsg, &niov, &offset, &nob, &kiov,
802                                 put_len);
803
804         if (kiov != NULL) {
805                 tx->tx_msg.gnm_payload_cksum = kgnilnd_cksum_kiov(niov, kiov, offset, nob, dump_cksum);
806         } else {
807                 tx->tx_msg.gnm_payload_cksum = kgnilnd_cksum(tx->tx_buffer, nob);
808                 if (dump_cksum) {
809                         kgnilnd_dump_blob(D_BUFFS, "peer RDMA payload", tx->tx_buffer, nob);
810                 }
811         }
812
813         if (CFS_FAIL_CHECK(CFS_FAIL_GNI_SMSG_CKSUM3)) {
814                 tx->tx_msg.gnm_payload_cksum += 0xd00d;
815         }
816 }
817
818 /* kgnilnd_verify_rdma_cksum()
819  * tx - PUT_DONE/GET_DONE matched tx.
820  * rx_cksum - received checksum to compare against.
821  * put_len - see kgnilnd_parse_lnet_rdma comments.
822  */
823 static inline int
824 kgnilnd_verify_rdma_cksum(kgn_tx_t *tx, __u16 rx_cksum, int put_len)
825 {
826         int              rc = 0;
827         __u16            cksum;
828         unsigned int     niov, offset, nob;
829         struct bio_vec  *kiov;
830         struct lnet_msg *lntmsg = tx->tx_lntmsg[0];
831         int dump_on_err = *kgnilnd_tunables.kgn_checksum_dump;
832
833         /* we can only match certain requests */
834         GNITX_ASSERTF(tx, ((tx->tx_msg.gnm_type == GNILND_MSG_GET_REQ) ||
835                            (tx->tx_msg.gnm_type == GNILND_MSG_PUT_ACK) ||
836                            (tx->tx_msg.gnm_type == GNILND_MSG_PUT_REQ_REV) ||
837                            (tx->tx_msg.gnm_type == GNILND_MSG_GET_ACK_REV) ||
838                            (tx->tx_msg.gnm_type == GNILND_MSG_GET_DONE_REV) ||
839                            (tx->tx_msg.gnm_type == GNILND_MSG_PUT_DONE_REV)),
840                       "bad type %s", kgnilnd_msgtype2str(tx->tx_msg.gnm_type));
841
842         if ((tx->tx_msg.gnm_type == GNILND_MSG_PUT_REQ_REV) ||
843             (tx->tx_msg.gnm_type == GNILND_MSG_GET_ACK_REV)) {
844                 return 0;
845         }
846
847         if (rx_cksum == 0)  {
848                 if (*kgnilnd_tunables.kgn_checksum >= 3) {
849                         GNIDBG_MSG(D_WARNING, &tx->tx_msg,
850                                    "no RDMA payload checksum when enabled");
851                 }
852                 return 0;
853         }
854
855         GNITX_ASSERTF(tx, lntmsg, "no LNet message!", NULL);
856
857         kgnilnd_parse_lnet_rdma(lntmsg, &niov, &offset, &nob, &kiov, put_len);
858
859         if (kiov != NULL) {
860                 cksum = kgnilnd_cksum_kiov(niov, kiov, offset, nob, 0);
861         } else {
862                 cksum = kgnilnd_cksum(tx->tx_buffer, nob);
863         }
864
865         if (cksum != rx_cksum) {
866                 GNIDBG_MSG(D_NETERROR, &tx->tx_msg,
867                            "Bad RDMA payload checksum (%x expected %x); "
868                            "kiov 0x%p niov %d nob %u offset %u",
869                             cksum, rx_cksum, kiov, niov, nob, offset);
870                 switch (dump_on_err) {
871                 case 2:
872                         if (kiov != NULL) {
873                                 kgnilnd_cksum_kiov(niov, kiov, offset, nob, 1);
874                         } else {
875                                 kgnilnd_dump_blob(D_BUFFS, "RDMA payload",
876                                                   tx->tx_buffer, nob);
877                         }
878                         /* fallthrough */
879                 case 1:
880                         libcfs_debug_dumplog();
881                         break;
882                 default:
883                         break;
884                 }
885                 rc = -ENOKEY;
886                 /* kgnilnd_check_fma_rx will close conn, kill tx with error */
887         }
888         return rc;
889 }
890
891 void
892 kgnilnd_mem_add_map_list(kgn_device_t *dev, kgn_tx_t *tx)
893 {
894         int     bytes;
895
896         GNITX_ASSERTF(tx, list_empty(&tx->tx_map_list),
897                 "already mapped!", NULL);
898
899         spin_lock(&dev->gnd_map_lock);
900         switch (tx->tx_buftype) {
901         default:
902                 GNIDBG_TX(D_EMERG, tx,
903                         "SOFTWARE BUG: invalid mapping %d", tx->tx_buftype);
904                 spin_unlock(&dev->gnd_map_lock);
905                 LBUG();
906                 break;
907
908         case GNILND_BUF_PHYS_MAPPED:
909                 bytes = tx->tx_phys_npages * PAGE_SIZE;
910                 dev->gnd_map_nphys++;
911                 dev->gnd_map_physnop += tx->tx_phys_npages;
912                 break;
913         }
914
915         if (tx->tx_msg.gnm_type == GNILND_MSG_PUT_ACK ||
916             tx->tx_msg.gnm_type == GNILND_MSG_GET_REQ) {
917                 atomic64_add(bytes, &dev->gnd_rdmaq_bytes_out);
918                 GNIDBG_TX(D_NETTRACE, tx, "rdma ++ %d to %lld",
919                           bytes, atomic64_read(&dev->gnd_rdmaq_bytes_out));
920         }
921
922         atomic_inc(&dev->gnd_n_mdd);
923         atomic64_add(bytes, &dev->gnd_nbytes_map);
924
925         /* clear retrans to prevent any SMSG goofiness as that code uses the same counter */
926         tx->tx_retrans = 0;
927
928         /* we only get here in the valid cases */
929         list_add_tail(&tx->tx_map_list, &dev->gnd_map_list);
930         dev->gnd_map_version++;
931         spin_unlock(&dev->gnd_map_lock);
932 }
933
934 void
935 kgnilnd_mem_del_map_list(kgn_device_t *dev, kgn_tx_t *tx)
936 {
937         int     bytes;
938
939         GNITX_ASSERTF(tx, !list_empty(&tx->tx_map_list),
940                 "not mapped!", NULL);
941         spin_lock(&dev->gnd_map_lock);
942
943         switch (tx->tx_buftype) {
944         default:
945                 GNIDBG_TX(D_EMERG, tx,
946                         "SOFTWARE BUG: invalid mapping %d", tx->tx_buftype);
947                 spin_unlock(&dev->gnd_map_lock);
948                 LBUG();
949                 break;
950
951         case GNILND_BUF_PHYS_UNMAPPED:
952                 bytes = tx->tx_phys_npages * PAGE_SIZE;
953                 dev->gnd_map_nphys--;
954                 dev->gnd_map_physnop -= tx->tx_phys_npages;
955                 break;
956         }
957
958         if (tx->tx_msg.gnm_type == GNILND_MSG_PUT_ACK ||
959             tx->tx_msg.gnm_type == GNILND_MSG_GET_REQ) {
960                 atomic64_sub(bytes, &dev->gnd_rdmaq_bytes_out);
961                 LASSERTF(atomic64_read(&dev->gnd_rdmaq_bytes_out) >= 0,
962                          "bytes_out negative! %lld\n",
963                          (s64)atomic64_read(&dev->gnd_rdmaq_bytes_out));
964                 GNIDBG_TX(D_NETTRACE, tx, "rdma -- %d to %lld",
965                           bytes, (s64)atomic64_read(&dev->gnd_rdmaq_bytes_out));
966         }
967
968         atomic_dec(&dev->gnd_n_mdd);
969         atomic64_sub(bytes, &dev->gnd_nbytes_map);
970
971         /* we only get here in the valid cases */
972         list_del_init(&tx->tx_map_list);
973         dev->gnd_map_version++;
974         spin_unlock(&dev->gnd_map_lock);
975 }
976
977 int
978 kgnilnd_map_buffer(kgn_tx_t *tx)
979 {
980         kgn_conn_t       *conn = tx->tx_conn;
981         kgn_device_t     *dev = conn->gnc_device;
982         __u32             flags = GNI_MEM_READWRITE;
983         gni_return_t      rrc;
984
985         /* The kgnilnd_mem_register(_segments) Gemini Driver functions can
986          * be called concurrently as there are internal locks that protect
987          * any data structures or HW resources. We just need to ensure
988          * that our concurrency doesn't result in the kgn_device_t
989          * getting nuked while we are in here */
990
991         LASSERTF(conn != NULL, "tx %p with NULL conn, someone forgot"
992                 " to set tx_conn before calling %s\n", tx, __FUNCTION__);
993
994         if (unlikely(CFS_FAIL_CHECK(CFS_FAIL_GNI_MAP_TX)))
995                 RETURN(-ENOMEM);
996
997         if (*kgnilnd_tunables.kgn_bte_relaxed_ordering) {
998                 flags |= GNI_MEM_RELAXED_PI_ORDERING;
999         }
1000
1001         switch (tx->tx_buftype) {
1002         default:
1003                 LBUG();
1004
1005         case GNILND_BUF_NONE:
1006         case GNILND_BUF_IMMEDIATE:
1007         case GNILND_BUF_IMMEDIATE_KIOV:
1008         case GNILND_BUF_PHYS_MAPPED:
1009                 return 0;
1010
1011         case GNILND_BUF_PHYS_UNMAPPED:
1012                 GNITX_ASSERTF(tx, tx->tx_phys != NULL, "physical buffer not there!", NULL);
1013                 rrc = kgnilnd_mem_register_segments(dev->gnd_handle,
1014                         tx->tx_phys, tx->tx_phys_npages, NULL,
1015                         GNI_MEM_PHYS_SEGMENTS | flags,
1016                         &tx->tx_map_key);
1017                 /* could race with other uses of the map counts, but this is ok
1018                  * - this needs to turn into a non-fatal error soon to allow
1019                  *  GART resource, etc starvation handling */
1020                 if (rrc != GNI_RC_SUCCESS) {
1021                         GNIDBG_TX(D_NET, tx,
1022                                   "Can't map %d pages: dev %d phys %u pp %u",
1023                                 tx->tx_phys_npages, dev->gnd_id,
1024                                 dev->gnd_map_nphys, dev->gnd_map_physnop);
1025                         RETURN(rrc == GNI_RC_ERROR_RESOURCE ? -ENOMEM : -EINVAL);
1026                 }
1027
1028                 tx->tx_buftype = GNILND_BUF_PHYS_MAPPED;
1029                 kgnilnd_mem_add_map_list(dev, tx);
1030                 return 0;
1031         }
1032 }
1033
1034 void
1035 kgnilnd_add_purgatory_tx(kgn_tx_t *tx)
1036 {
1037         kgn_conn_t              *conn = tx->tx_conn;
1038         kgn_mdd_purgatory_t     *gmp;
1039
1040         LIBCFS_ALLOC(gmp, sizeof(*gmp));
1041         LASSERTF(gmp != NULL, "couldn't allocate MDD purgatory member;"
1042                 " asserting to avoid data corruption\n");
1043         if (tx->tx_buffer_copy)
1044                 gmp->gmp_map_key = tx->tx_buffer_copy_map_key;
1045         else
1046                 gmp->gmp_map_key = tx->tx_map_key;
1047
1048         atomic_inc(&conn->gnc_device->gnd_n_mdd_held);
1049
1050         /* ensure that we don't have a blank purgatory - indicating the
1051          * conn is not already on purgatory lists - we'd never recover these
1052          * MDD if that were the case */
1053         GNITX_ASSERTF(tx, conn->gnc_in_purgatory,
1054                 "conn 0x%p->%s with NULL purgatory",
1055                 conn, libcfs_nid2str(conn->gnc_peer->gnp_nid));
1056
1057         /* link 'er up! - only place we really need to lock for
1058          * concurrent access */
1059         spin_lock(&conn->gnc_list_lock);
1060         list_add_tail(&gmp->gmp_list, &conn->gnc_mdd_list);
1061         spin_unlock(&conn->gnc_list_lock);
1062 }
1063
1064 void
1065 kgnilnd_unmap_buffer(kgn_tx_t *tx, int error)
1066 {
1067         kgn_device_t     *dev;
1068         gni_return_t      rrc;
1069         int               hold_timeout = 0;
1070
1071         /* code below relies on +1 relationship ... */
1072         BUILD_BUG_ON(GNILND_BUF_PHYS_MAPPED !=
1073                      (GNILND_BUF_PHYS_UNMAPPED + 1));
1074
1075         switch (tx->tx_buftype) {
1076         default:
1077                 LBUG();
1078
1079         case GNILND_BUF_NONE:
1080         case GNILND_BUF_IMMEDIATE:
1081         case GNILND_BUF_PHYS_UNMAPPED:
1082                 break;
1083         case GNILND_BUF_IMMEDIATE_KIOV:
1084                 if (tx->tx_phys != NULL) {
1085                         vunmap(tx->tx_phys);
1086                 } else if (tx->tx_phys == NULL && tx->tx_buffer != NULL) {
1087                         kunmap(tx->tx_imm_pages[0]);
1088                 }
1089                 /* clear to prevent kgnilnd_free_tx from thinking
1090                  * this is a RDMA descriptor */
1091                 tx->tx_phys = NULL;
1092                 break;
1093
1094         case GNILND_BUF_PHYS_MAPPED:
1095                 LASSERT(tx->tx_conn != NULL);
1096
1097                 dev = tx->tx_conn->gnc_device;
1098
1099                 /* only want to hold if we are closing conn without
1100                  * verified peer notification  - the theory is that
1101                  * a TX error can be communicated in all other cases */
1102                 if (tx->tx_conn->gnc_state != GNILND_CONN_ESTABLISHED &&
1103                     error != -GNILND_NOPURG &&
1104                     kgnilnd_check_purgatory_conn(tx->tx_conn)) {
1105                         kgnilnd_add_purgatory_tx(tx);
1106
1107                         /* The timeout we give to kgni is a deadman stop only.
1108                          *  we are setting high to ensure we don't have the kgni timer
1109                          *  fire before ours fires _and_ is handled */
1110                         hold_timeout = GNILND_TIMEOUT2DEADMAN;
1111
1112                         GNIDBG_TX(D_NET, tx,
1113                                  "dev %p delaying MDD release for %dms key %#llx.%#llx",
1114                                  tx->tx_conn->gnc_device, hold_timeout,
1115                                  tx->tx_map_key.qword1, tx->tx_map_key.qword2);
1116                 }
1117                 if (tx->tx_buffer_copy != NULL) {
1118                         rrc = kgnilnd_mem_deregister(dev->gnd_handle, &tx->tx_buffer_copy_map_key, hold_timeout);
1119                         LASSERTF(rrc == GNI_RC_SUCCESS, "rrc %d\n", rrc);
1120                         rrc = kgnilnd_mem_deregister(dev->gnd_handle, &tx->tx_map_key, 0);
1121                         LASSERTF(rrc == GNI_RC_SUCCESS, "rrc %d\n", rrc);
1122                 } else {
1123                         rrc = kgnilnd_mem_deregister(dev->gnd_handle, &tx->tx_map_key, hold_timeout);
1124                         LASSERTF(rrc == GNI_RC_SUCCESS, "rrc %d\n", rrc);
1125                 }
1126
1127                 tx->tx_buftype--;
1128                 kgnilnd_mem_del_map_list(dev, tx);
1129                 break;
1130         }
1131 }
1132
1133 void
1134 kgnilnd_tx_done(kgn_tx_t *tx, int completion)
1135 {
1136         struct lnet_msg      *lntmsg0, *lntmsg1;
1137         int             status0, status1;
1138         struct lnet_ni       *ni = NULL;
1139         kgn_conn_t      *conn = tx->tx_conn;
1140
1141         LASSERT(!in_interrupt());
1142
1143         lntmsg0 = tx->tx_lntmsg[0]; tx->tx_lntmsg[0] = NULL;
1144         lntmsg1 = tx->tx_lntmsg[1]; tx->tx_lntmsg[1] = NULL;
1145
1146         if (completion &&
1147             !(tx->tx_state & GNILND_TX_QUIET_ERROR) &&
1148             !kgnilnd_conn_clean_errno(completion)) {
1149                 GNIDBG_TOMSG(D_NETERROR, &tx->tx_msg,
1150                        "error %d on tx 0x%p->%s id %u/%d state %s age %ds",
1151                        completion, tx, conn ?
1152                        libcfs_nid2str(conn->gnc_peer->gnp_nid) : "<?>",
1153                        tx->tx_id.txe_smsg_id, tx->tx_id.txe_idx,
1154                        kgnilnd_tx_state2str(tx->tx_list_state),
1155                        cfs_duration_sec((unsigned long)jiffies - tx->tx_qtime));
1156         }
1157
1158         /* The error codes determine if we hold onto the MDD */
1159         kgnilnd_unmap_buffer(tx, completion);
1160
1161         /* we have to deliver a reply on lntmsg[1] for the GET, so make sure
1162          * we play nice with the error codes to avoid delivering a failed
1163          * REQUEST and then a REPLY event as well */
1164
1165         /* return -EIO to lnet - it is the magic value for failed sends */
1166         if (tx->tx_msg.gnm_type == GNILND_MSG_GET_REQ) {
1167                 status0 = 0;
1168                 status1 = completion;
1169         } else {
1170                 status0 = status1 = completion;
1171         }
1172
1173         tx->tx_buftype = GNILND_BUF_NONE;
1174         tx->tx_msg.gnm_type = GNILND_MSG_NONE;
1175
1176         /* lnet_finalize doesn't do anything with the *ni, so ok for us to
1177          * set NULL when we are a tx without a conn */
1178         if (conn != NULL) {
1179                 ni = conn->gnc_peer->gnp_net->gnn_ni;
1180
1181                 spin_lock(&conn->gnc_tx_lock);
1182
1183                 LASSERTF(test_and_clear_bit(tx->tx_id.txe_idx,
1184                         (volatile unsigned long *)&conn->gnc_tx_bits),
1185                         "conn %p tx %p bit %d already cleared\n",
1186                         conn, tx, tx->tx_id.txe_idx);
1187
1188                 LASSERTF(conn->gnc_tx_ref_table[tx->tx_id.txe_idx] != NULL,
1189                          "msg_id %d already NULL\n", tx->tx_id.txe_idx);
1190
1191                 conn->gnc_tx_ref_table[tx->tx_id.txe_idx] = NULL;
1192                 spin_unlock(&conn->gnc_tx_lock);
1193         }
1194
1195         kgnilnd_free_tx(tx);
1196
1197         /* finalize AFTER freeing lnet msgs */
1198
1199         /* warning - we should hold no locks here - calling lnet_finalize
1200          * could free up lnet credits, resulting in a call chain back into
1201          * the LND via kgnilnd_send and friends */
1202
1203         lnet_finalize(lntmsg0, status0);
1204
1205         if (lntmsg1 != NULL) {
1206                 lnet_finalize(lntmsg1, status1);
1207         }
1208 }
1209
1210 void
1211 kgnilnd_txlist_done(struct list_head *txlist, int error)
1212 {
1213         kgn_tx_t        *tx, *txn;
1214         int              err_printed = 0;
1215
1216         if (list_empty(txlist))
1217                 return;
1218
1219         list_for_each_entry_safe(tx, txn, txlist, tx_list) {
1220                 /* only print the first error */
1221                 if (err_printed)
1222                         tx->tx_state |= GNILND_TX_QUIET_ERROR;
1223                 list_del_init(&tx->tx_list);
1224                 kgnilnd_tx_done(tx, error);
1225                 err_printed++;
1226         }
1227 }
1228 int
1229 kgnilnd_set_tx_id(kgn_tx_t *tx, kgn_conn_t *conn)
1230 {
1231         int     id;
1232
1233         spin_lock(&conn->gnc_tx_lock);
1234
1235         /* ID zero is NOT ALLOWED!!! */
1236
1237 search_again:
1238         id = find_next_zero_bit((unsigned long *)&conn->gnc_tx_bits,
1239                                  GNILND_MAX_MSG_ID, conn->gnc_next_tx);
1240         if (id == GNILND_MAX_MSG_ID) {
1241                 if (conn->gnc_next_tx != 1) {
1242                         /* we only searched from next_tx to end and didn't find
1243                          * one, so search again from start */
1244                         conn->gnc_next_tx = 1;
1245                         goto search_again;
1246                 }
1247                 /* couldn't find one! */
1248                 spin_unlock(&conn->gnc_tx_lock);
1249                 return -E2BIG;
1250         }
1251
1252         /* bump next_tx to prevent immediate reuse */
1253         conn->gnc_next_tx = id + 1;
1254
1255         set_bit(id, (volatile unsigned long *)&conn->gnc_tx_bits);
1256         LASSERTF(conn->gnc_tx_ref_table[id] == NULL,
1257                  "tx 0x%p already at id %d\n",
1258                  conn->gnc_tx_ref_table[id], id);
1259
1260         /* delay these until we have a valid ID - prevents bad clear of the bit
1261          * in kgnilnd_tx_done */
1262         tx->tx_conn = conn;
1263         tx->tx_id.txe_cqid = conn->gnc_cqid;
1264
1265         tx->tx_id.txe_idx = id;
1266         conn->gnc_tx_ref_table[id] = tx;
1267
1268         /* Using jiffies to help differentiate against TX reuse - with
1269          * the usual minimum of a 250HZ clock, we wrap jiffies on the same TX
1270          * if we are sending to the same node faster than 256000/sec.
1271          * To help guard against this, we OR in the tx_seq - that is 32 bits */
1272
1273         tx->tx_id.txe_chips = (__u32)(jiffies | atomic_read(&conn->gnc_tx_seq));
1274
1275         GNIDBG_TX(D_NET, tx, "set cookie/id/bits", NULL);
1276
1277         spin_unlock(&conn->gnc_tx_lock);
1278         return 0;
1279 }
1280
1281 static inline void
1282 kgnilnd_tx_log_retrans(kgn_conn_t *conn, kgn_tx_t *tx)
1283 {
1284         int             log_retrans;
1285
1286         log_retrans = ((tx->tx_retrans < 25) || ((tx->tx_retrans % 25) == 0));
1287
1288         /* we don't care about TX timeout - it could be that the network is slower
1289          * or throttled. We'll keep retranmitting - so if the network is so slow
1290          * that we fill up our mailbox, we'll keep trying to resend that msg
1291          * until we exceed the max_retrans _or_ gnc_last_rx expires, indicating
1292          * that he hasn't send us any traffic in return */
1293         
1294         /* some reasonable throttling of the debug message */
1295         if (log_retrans) {
1296                 unsigned long now = jiffies;
1297                 /* XXX Nic: Mystical TX debug here... */
1298                 /* We expect retransmissions so only log when D_NET is enabled */
1299                 GNIDBG_SMSG_CREDS(D_NET, conn);
1300                 GNIDBG_TOMSG(D_NET, &tx->tx_msg,
1301                         "NOT_DONE on conn 0x%p->%s id %x retrans %d wait %dus"
1302                         " last_msg %uus/%uus last_cq %uus/%uus",
1303                         conn, libcfs_nid2str(conn->gnc_peer->gnp_nid),
1304                         tx->tx_id, tx->tx_retrans,
1305                         jiffies_to_usecs(now - tx->tx_cred_wait),
1306                         jiffies_to_usecs(now - conn->gnc_last_tx),
1307                         jiffies_to_usecs(now - conn->gnc_last_rx),
1308                         jiffies_to_usecs(now - conn->gnc_last_tx_cq),
1309                         jiffies_to_usecs(now - conn->gnc_last_rx_cq));
1310         }
1311 }
1312
1313 /* caller must be holding gnd_cq_mutex and not unlock it afterwards, as we need to drop it
1314  * to avoid bad ordering with state_lock */
1315
1316 static inline int
1317 kgnilnd_sendmsg_nolock(kgn_tx_t *tx, void *immediate, unsigned int immediatenob,
1318                 spinlock_t *state_lock, kgn_tx_list_state_t state)
1319 {
1320         kgn_conn_t      *conn = tx->tx_conn;
1321         kgn_msg_t       *msg = &tx->tx_msg;
1322         gni_return_t     rrc;
1323         unsigned long    newest_last_rx, timeout;
1324         unsigned long    now;
1325
1326         LASSERTF((msg->gnm_type == GNILND_MSG_IMMEDIATE) ?
1327                 immediatenob <= *kgnilnd_tunables.kgn_max_immediate :
1328                 immediatenob == 0,
1329                 "msg 0x%p type %d wrong payload size %d\n",
1330                 msg, msg->gnm_type, immediatenob);
1331
1332         /* make sure we catch all the cases where we'd send on a dirty old mbox
1333          * but allow case for sending CLOSE. Since this check is within the CQ
1334          * mutex barrier and the close message is only sent through
1335          * kgnilnd_send_conn_close the last message out the door will be the
1336          * close message.
1337          */
1338         if (atomic_read(&conn->gnc_peer->gnp_dirty_eps) != 0 && msg->gnm_type != GNILND_MSG_CLOSE) {
1339                 kgnilnd_conn_mutex_unlock(&conn->gnc_smsg_mutex);
1340                 kgnilnd_gl_mutex_unlock(&conn->gnc_device->gnd_cq_mutex);
1341                 /* Return -ETIME, we are closing the connection already so we dont want to
1342                  * have this tx hit the wire. The tx will be killed by the calling function.
1343                  * Once the EP is marked dirty the close message will be the last
1344                  * thing to hit the wire */
1345                 return -ETIME;
1346         }
1347
1348         now = jiffies;
1349         timeout = cfs_time_seconds(conn->gnc_timeout);
1350
1351         newest_last_rx = GNILND_LASTRX(conn);
1352
1353         if (CFS_FAIL_CHECK(CFS_FAIL_GNI_SEND_TIMEOUT)) {
1354                 now = now + (GNILND_TIMEOUTRX(timeout) * 2);
1355         }
1356
1357         if (time_after_eq(now, newest_last_rx + GNILND_TIMEOUTRX(timeout))) {
1358                 GNIDBG_CONN(D_NETERROR|D_CONSOLE, conn,
1359                             "Cant send to %s after timeout lapse of %lu; TO %lu\n",
1360                 libcfs_nid2str(conn->gnc_peer->gnp_nid),
1361                 cfs_duration_sec(now - newest_last_rx),
1362                 cfs_duration_sec(GNILND_TIMEOUTRX(timeout)));
1363                 kgnilnd_conn_mutex_unlock(&conn->gnc_smsg_mutex);
1364                 kgnilnd_gl_mutex_unlock(&conn->gnc_device->gnd_cq_mutex);
1365                 return -ETIME;
1366         }
1367
1368         GNITX_ASSERTF(tx, (conn != NULL) && (tx->tx_id.txe_idx != 0), "tx id unset!", NULL);
1369         /* msg->gnm_srcnid is set when the message is initialized by whatever function is
1370          * creating the message this allows the message to contain the correct LNET NID/NET needed
1371          * instead of the one that the peer/conn uses for sending the data.
1372          */
1373         msg->gnm_connstamp = conn->gnc_my_connstamp;
1374         msg->gnm_payload_len = immediatenob;
1375         msg->gnm_seq = atomic_read(&conn->gnc_tx_seq);
1376
1377         /* always init here - kgn_checksum is a /sys module tunable
1378          * and can be flipped at any point, even between msg init and sending */
1379         msg->gnm_cksum = 0;
1380         if (*kgnilnd_tunables.kgn_checksum) {
1381                 /* We must set here and not in kgnilnd_init_msg,
1382                  * we could resend this msg many times
1383                  * (NOT_DONE from gni_smsg_send below) and wouldn't pass
1384                  * through init_msg again */
1385                 msg->gnm_cksum = kgnilnd_cksum(msg, sizeof(kgn_msg_t));
1386                 if (CFS_FAIL_CHECK(CFS_FAIL_GNI_SMSG_CKSUM1)) {
1387                         msg->gnm_cksum += 0xf00f;
1388                 }
1389         }
1390
1391         GNIDBG_TOMSG(D_NET, msg, "tx 0x%p conn 0x%p->%s sending SMSG sz %u id %x/%d [%p for %u]",
1392                tx, conn, libcfs_nid2str(conn->gnc_peer->gnp_nid),
1393                sizeof(kgn_msg_t), tx->tx_id.txe_smsg_id,
1394                tx->tx_id.txe_idx, immediate, immediatenob);
1395
1396         if (unlikely(tx->tx_state & GNILND_TX_FAIL_SMSG)) {
1397                 rrc = cfs_fail_val ? cfs_fail_val : GNI_RC_NOT_DONE;
1398         } else {
1399                 rrc = kgnilnd_smsg_send(conn->gnc_ephandle,
1400                                         msg, sizeof(*msg), immediate,
1401                                         immediatenob,
1402                                         tx->tx_id.txe_smsg_id);
1403         }
1404
1405         switch (rrc) {
1406         case GNI_RC_SUCCESS:
1407                 atomic_inc(&conn->gnc_tx_seq);
1408                 conn->gnc_last_tx = jiffies;
1409                 /* no locking here as LIVE isn't a list */
1410                 kgnilnd_tx_add_state_locked(tx, NULL, conn, GNILND_TX_LIVE_FMAQ, 1);
1411
1412                 /* this needs to be checked under lock as it might be freed from a completion
1413                  * event.
1414                  */
1415                 if (msg->gnm_type == GNILND_MSG_NOOP) {
1416                         set_mb(conn->gnc_last_noop_sent, jiffies);
1417                 }
1418
1419                 /* serialize with seeing CQ events for completion on this, as well as
1420                  * tx_seq */
1421                 kgnilnd_conn_mutex_unlock(&conn->gnc_smsg_mutex);
1422                 kgnilnd_gl_mutex_unlock(&conn->gnc_device->gnd_cq_mutex);
1423
1424                 atomic_inc(&conn->gnc_device->gnd_short_ntx);
1425                 atomic64_add(immediatenob, &conn->gnc_device->gnd_short_txbytes);
1426                 kgnilnd_peer_alive(conn->gnc_peer);
1427                 GNIDBG_SMSG_CREDS(D_NET, conn);
1428                 return 0;
1429
1430         case GNI_RC_NOT_DONE:
1431                 /* Jshimek: We can get GNI_RC_NOT_DONE for 3 reasons currently
1432                  * 1: out of mbox credits
1433                  * 2: out of mbox payload credits
1434                  * 3: On Aries out of dla credits
1435                  */
1436                 kgnilnd_conn_mutex_unlock(&conn->gnc_smsg_mutex);
1437                 kgnilnd_gl_mutex_unlock(&conn->gnc_device->gnd_cq_mutex);
1438                 /* We'll handle this error inline - makes the calling logic much more
1439                  * clean */
1440
1441                 /* If no lock, caller doesn't want us to retry */
1442                 if (state_lock == NULL) {
1443                         return -EAGAIN;
1444                 }
1445
1446                 /* I need kgni credits to send this.  Replace tx at the head of the
1447                  * fmaq and I'll get rescheduled when credits appear. Reset the tx_state
1448                  * and bump retrans counts since we are requeueing the tx.
1449                  */
1450                 tx->tx_state = 0;
1451                 tx->tx_retrans++;
1452                 conn->gnc_tx_retrans++;
1453
1454                 kgnilnd_tx_log_retrans(conn, tx);
1455                 /* add to head of list for the state and retries */
1456                 spin_lock(state_lock);
1457                 kgnilnd_tx_add_state_locked(tx, conn->gnc_peer, conn, state, 0);
1458                 spin_unlock(state_lock);
1459
1460                 /* We only reschedule for a certain number of retries, then
1461                  * we will wait for the CQ events indicating a release of SMSG
1462                  * credits */
1463                 if (tx->tx_retrans < *kgnilnd_tunables.kgn_max_retransmits) {
1464                         kgnilnd_schedule_conn(conn);
1465                         return 0;
1466                 } else {
1467                         /* CQ event coming in signifies either TX completed or
1468                          * RX receive. Either of these *could* free up credits
1469                          * in the SMSG mbox and we should try sending again */
1470                         GNIDBG_TX(D_NET, tx, "waiting for CQID %u event to resend",
1471                                  tx->tx_conn->gnc_cqid);
1472                         kgnilnd_schedule_delay_conn(conn);
1473                         /* use +ve return code to let upper layers know they
1474                          * should stop looping on sends */
1475                         return EAGAIN;
1476                 }
1477         default:
1478                 /* handle bad retcode gracefully */
1479                 kgnilnd_conn_mutex_unlock(&conn->gnc_smsg_mutex);
1480                 kgnilnd_gl_mutex_unlock(&conn->gnc_device->gnd_cq_mutex);
1481                 return -EIO;
1482         }
1483 }
1484
1485 /* kgnilnd_sendmsg has hard wait on gnd_cq_mutex */
1486 static inline int
1487 kgnilnd_sendmsg(kgn_tx_t *tx, void *immediate, unsigned int immediatenob,
1488                 spinlock_t *state_lock, kgn_tx_list_state_t state)
1489 {
1490         kgn_device_t    *dev = tx->tx_conn->gnc_device;
1491         unsigned long    timestamp;
1492         int              rc;
1493
1494         timestamp = jiffies;
1495         kgnilnd_gl_mutex_lock(&dev->gnd_cq_mutex);
1496         kgnilnd_conn_mutex_lock(&tx->tx_conn->gnc_smsg_mutex);
1497         /* delay in jiffies - we are really concerned only with things that
1498          * result in a schedule() or really holding this off for long times .
1499          * NB - mutex_lock could spin for 2 jiffies before going to sleep to wait */
1500         dev->gnd_mutex_delay += (long) jiffies - timestamp;
1501
1502         rc = kgnilnd_sendmsg_nolock(tx, immediate, immediatenob, state_lock, state);
1503
1504         RETURN(rc);
1505 }
1506
1507
1508 /* returns -EAGAIN for lock miss, anything else < 0 is hard error, >=0 for success */
1509 static inline int
1510 kgnilnd_sendmsg_trylock(kgn_tx_t *tx, void *immediate, unsigned int immediatenob,
1511                 spinlock_t *state_lock, kgn_tx_list_state_t state)
1512 {
1513         kgn_conn_t      *conn = tx->tx_conn;
1514         kgn_device_t    *dev = conn->gnc_device;
1515         unsigned long    timestamp;
1516         int              rc;
1517
1518         timestamp = jiffies;
1519
1520         /* technically we are doing bad things with the read_lock on the peer_conn
1521          * table, but we shouldn't be sleeping inside here - and we don't sleep/block
1522          * for the mutex. I bet lockdep is gonna flag this one though... */
1523
1524         /* there are a few cases where we don't want the immediate send - like
1525          * when we are in the scheduler thread and it'd harm the latency of
1526          * getting messages up to LNet */
1527
1528         /* rmb for gnd_ready */
1529         smp_rmb();
1530         if (conn->gnc_device->gnd_ready == GNILND_DEV_LOOP) {
1531                 rc = 0;
1532                 atomic_inc(&conn->gnc_device->gnd_fast_block);
1533         } else if (unlikely(kgnilnd_data.kgn_quiesce_trigger)) {
1534                /* dont hit HW during quiesce */
1535                 rc = 0;
1536         } else if (unlikely(atomic_read(&conn->gnc_peer->gnp_dirty_eps))) {
1537                /* dont hit HW if stale EPs and conns left to close */
1538                 rc = 0;
1539         } else {
1540                 atomic_inc(&conn->gnc_device->gnd_fast_try);
1541                 rc = kgnilnd_trylock(&conn->gnc_device->gnd_cq_mutex,
1542                                      &conn->gnc_smsg_mutex);
1543         }
1544         if (!rc) {
1545                 rc = -EAGAIN;
1546         } else {
1547                 /* we got the mutex and weren't blocked */
1548
1549                 /* delay in jiffies - we are really concerned only with things that
1550                  * result in a schedule() or really holding this off for long times .
1551                  * NB - mutex_lock could spin for 2 jiffies before going to sleep to wait */
1552                 dev->gnd_mutex_delay += (long) jiffies - timestamp;
1553
1554                 atomic_inc(&conn->gnc_device->gnd_fast_ok);
1555                 tx->tx_qtime = jiffies;
1556                 tx->tx_state = GNILND_TX_WAITING_COMPLETION;
1557                 rc = kgnilnd_sendmsg_nolock(tx, tx->tx_buffer, tx->tx_nob, &conn->gnc_list_lock, GNILND_TX_FMAQ);
1558                 /* _nolock unlocks the mutex for us */
1559         }
1560
1561         RETURN(rc);
1562 }
1563
1564 /* lets us know if we can push this RDMA through now */
1565 static int
1566 kgnilnd_auth_rdma_bytes(kgn_device_t *dev, kgn_tx_t *tx)
1567 {
1568         long    bytes_left;
1569
1570         bytes_left = atomic64_sub_return(tx->tx_nob, &dev->gnd_rdmaq_bytes_ok);
1571
1572         if (bytes_left < 0) {
1573                 atomic64_add(tx->tx_nob, &dev->gnd_rdmaq_bytes_ok);
1574                 atomic_inc(&dev->gnd_rdmaq_nstalls);
1575                 smp_wmb();
1576
1577                 CDEBUG(D_NET, "no bytes to send, turning on timer for %lu\n",
1578                        dev->gnd_rdmaq_deadline);
1579                 mod_timer(&dev->gnd_rdmaq_timer, dev->gnd_rdmaq_deadline);
1580                 /* we never del this timer - at worst it schedules us.. */
1581                 return -EAGAIN;
1582         } else {
1583                 return 0;
1584         }
1585 }
1586
1587 /* this adds a TX to the queue pending throttling authorization before
1588  * we allow our remote peer to launch a PUT at us */
1589 void
1590 kgnilnd_queue_rdma(kgn_conn_t *conn, kgn_tx_t *tx)
1591 {
1592         int     rc;
1593
1594         /* we cannot go into send_mapped_tx from here as we are holding locks
1595          * and mem registration might end up allocating memory in kgni.
1596          * That said, we'll push this as far as we can into the queue process */
1597         rc = kgnilnd_auth_rdma_bytes(conn->gnc_device, tx);
1598
1599         if (rc < 0) {
1600                 spin_lock(&conn->gnc_device->gnd_rdmaq_lock);
1601                 kgnilnd_tx_add_state_locked(tx, NULL, conn, GNILND_TX_RDMAQ, 0);
1602                 /* lets us know how delayed RDMA is */
1603                 tx->tx_qtime = jiffies;
1604                 spin_unlock(&conn->gnc_device->gnd_rdmaq_lock);
1605         } else {
1606                 /* we have RDMA authorized, now it just needs a MDD and to hit the wire */
1607                 spin_lock(&tx->tx_conn->gnc_device->gnd_lock);
1608                 kgnilnd_tx_add_state_locked(tx, NULL, tx->tx_conn, GNILND_TX_MAPQ, 0);
1609                 /* lets us know how delayed mapping is */
1610                 tx->tx_qtime = jiffies;
1611                 spin_unlock(&tx->tx_conn->gnc_device->gnd_lock);
1612         }
1613
1614         /* make sure we wake up sched to run this */
1615         kgnilnd_schedule_device(tx->tx_conn->gnc_device);
1616 }
1617
1618 /* push TX through state machine */
1619 void
1620 kgnilnd_queue_tx(kgn_conn_t *conn, kgn_tx_t *tx)
1621 {
1622         int            rc = 0;
1623         int            add_tail = 1;
1624
1625         /* set the tx_id here, we delay it until we have an actual conn
1626          * to fiddle with
1627          * in some cases, the tx_id is already set to provide for things
1628          * like RDMA completion cookies, etc */
1629         if (tx->tx_id.txe_idx == 0) {
1630                 rc = kgnilnd_set_tx_id(tx, conn);
1631                 if (rc != 0) {
1632                         kgnilnd_tx_done(tx, rc);
1633                         return;
1634                 }
1635         }
1636
1637         CDEBUG(D_NET, "%s to conn %p for %s\n", kgnilnd_msgtype2str(tx->tx_msg.gnm_type),
1638                 conn, libcfs_nid2str(conn->gnc_peer->gnp_nid));
1639
1640         /* Only let NOOPs to be sent while fail loc is set, otherwise kill the tx.
1641          */
1642         if (CFS_FAIL_CHECK(CFS_FAIL_GNI_ONLY_NOOP) && (tx->tx_msg.gnm_type != GNILND_MSG_NOOP)) {
1643                 kgnilnd_tx_done(tx, rc);
1644                 return;
1645         }
1646
1647         switch (tx->tx_msg.gnm_type) {
1648         case GNILND_MSG_PUT_ACK:
1649         case GNILND_MSG_GET_REQ:
1650         case GNILND_MSG_PUT_REQ_REV:
1651         case GNILND_MSG_GET_ACK_REV:
1652                 /* hijacking time! If this messages will authorize our peer to
1653                  * send his dirty little bytes in an RDMA, we need to get permission */
1654                 kgnilnd_queue_rdma(conn, tx);
1655                 break;
1656         case GNILND_MSG_IMMEDIATE:
1657                 /* try to send right now, can help reduce latency */
1658                 rc = kgnilnd_sendmsg_trylock(tx, tx->tx_buffer, tx->tx_nob, &conn->gnc_list_lock, GNILND_TX_FMAQ);
1659
1660                 if (rc >= 0) {
1661                         /* it was sent, break out of switch to avoid default case of queueing */
1662                         break;
1663                 }
1664                 /* needs to queue to try again, so... */
1665                 /* fall through... */
1666         case GNILND_MSG_NOOP:
1667                 /* Just make sure this goes out first for this conn */
1668                 add_tail = 0;
1669                 /* fall through... */
1670         default:
1671                 spin_lock(&conn->gnc_list_lock);
1672                 kgnilnd_tx_add_state_locked(tx, conn->gnc_peer, conn, GNILND_TX_FMAQ, add_tail);
1673                 tx->tx_qtime = jiffies;
1674                 spin_unlock(&conn->gnc_list_lock);
1675                 kgnilnd_schedule_conn(conn);
1676         }
1677 }
1678
1679 void
1680 kgnilnd_launch_tx(kgn_tx_t *tx, kgn_net_t *net, struct lnet_process_id *target)
1681 {
1682         kgn_peer_t      *peer;
1683         kgn_peer_t      *new_peer = NULL;
1684         kgn_conn_t      *conn = NULL;
1685         int              rc;
1686         int              node_state;
1687
1688         ENTRY;
1689
1690         /* If I get here, I've committed to send, so I complete the tx with
1691          * failure on any problems */
1692
1693         GNITX_ASSERTF(tx, tx->tx_conn == NULL,
1694                       "tx already has connection %p", tx->tx_conn);
1695
1696         /* do all of the peer & conn searching in one swoop - this avoids
1697          * nastiness when dropping locks and needing to maintain a sane state
1698          * in the face of stack reset or something else nuking peers & conns */
1699
1700         /* I expect to find him, so only take a read lock */
1701         read_lock(&kgnilnd_data.kgn_peer_conn_lock);
1702
1703         peer = kgnilnd_find_peer_locked(target->nid);
1704         if (peer != NULL) {
1705                 conn = kgnilnd_find_conn_locked(peer);
1706                 /* this could be NULL during quiesce */
1707                 if (conn != NULL)  {
1708                         /* Connection exists; queue message on it */
1709                         kgnilnd_queue_tx(conn, tx);
1710                         read_unlock(&kgnilnd_data.kgn_peer_conn_lock);
1711                         RETURN_EXIT;
1712                 }
1713
1714                 /* don't create a connection if the peer is marked down */
1715                 if (peer->gnp_state != GNILND_PEER_UP) {
1716                         read_unlock(&kgnilnd_data.kgn_peer_conn_lock);
1717                         rc = -ENETRESET;
1718                         GOTO(no_peer, rc);
1719                 }
1720         }
1721
1722         /* creating peer or conn; I'll need a write lock... */
1723         read_unlock(&kgnilnd_data.kgn_peer_conn_lock);
1724
1725         CFS_RACE(CFS_FAIL_GNI_FIND_TARGET);
1726
1727         node_state = kgnilnd_get_node_state(LNET_NIDADDR(target->nid));
1728
1729         /* NB - this will not block during normal operations -
1730          * the only writer of this is in the startup/shutdown path. */
1731         rc = down_read_trylock(&kgnilnd_data.kgn_net_rw_sem);
1732         if (!rc) {
1733                 rc = -ESHUTDOWN;
1734                 GOTO(no_peer, rc);
1735         }
1736
1737         /* ignore previous peer entirely - we cycled the lock, so we
1738          * will create new peer and at worst drop it if peer is still
1739          * in the tables */
1740         rc = kgnilnd_create_peer_safe(&new_peer, target->nid, net, node_state);
1741         if (rc != 0) {
1742                 up_read(&kgnilnd_data.kgn_net_rw_sem);
1743                 GOTO(no_peer, rc);
1744         }
1745
1746         write_lock(&kgnilnd_data.kgn_peer_conn_lock);
1747         up_read(&kgnilnd_data.kgn_net_rw_sem);
1748
1749         /* search for peer again now that we have the lock
1750          * if we don't find it, add our new one to the list */
1751         kgnilnd_add_peer_locked(target->nid, new_peer, &peer);
1752
1753         /* don't create a connection if the peer is not up */
1754         if (peer->gnp_state != GNILND_PEER_UP) {
1755                 write_unlock(&kgnilnd_data.kgn_peer_conn_lock);
1756                 rc = -ENETRESET;
1757                 GOTO(no_peer, rc);
1758         }
1759
1760         conn = kgnilnd_find_or_create_conn_locked(peer);
1761
1762         if (CFS_FAIL_CHECK(CFS_FAIL_GNI_DGRAM_DROP_TX)) {
1763                 write_unlock(&kgnilnd_data.kgn_peer_conn_lock);
1764                 GOTO(no_peer, rc);
1765         }
1766
1767         if (conn != NULL) {
1768                 /* oh hey, found a conn now... magical */
1769                 kgnilnd_queue_tx(conn, tx);
1770         } else {
1771                 /* no conn, must be trying to connect - so we queue for now */
1772                 tx->tx_qtime = jiffies;
1773                 kgnilnd_tx_add_state_locked(tx, peer, NULL, GNILND_TX_PEERQ, 1);
1774         }
1775         write_unlock(&kgnilnd_data.kgn_peer_conn_lock);
1776         RETURN_EXIT;
1777 no_peer:
1778         kgnilnd_tx_done(tx, rc);
1779         RETURN_EXIT;
1780 }
1781
1782 int
1783 kgnilnd_rdma(kgn_tx_t *tx, int type,
1784             kgn_rdma_desc_t *sink, unsigned int nob, __u64 cookie)
1785 {
1786         kgn_conn_t   *conn = tx->tx_conn;
1787         unsigned long timestamp;
1788         gni_post_type_t post_type;
1789         gni_return_t  rrc;
1790         int rc = 0;
1791         unsigned int desc_nob = nob;
1792         void *desc_buffer = tx->tx_buffer;
1793         gni_mem_handle_t desc_map_key = tx->tx_map_key;
1794         LASSERTF(kgnilnd_tx_mapped(tx),
1795                 "unmapped tx %p\n", tx);
1796         LASSERTF(conn != NULL,
1797                 "NULL conn on tx %p, naughty, naughty\n", tx);
1798         LASSERTF(nob <= sink->gnrd_nob,
1799                 "nob %u > sink->gnrd_nob %d (%p)\n",
1800                 nob, sink->gnrd_nob, sink);
1801         LASSERTF(nob <= tx->tx_nob,
1802                 "nob %d > tx(%p)->tx_nob %d\n",
1803                 nob, tx, tx->tx_nob);
1804
1805         switch (type) {
1806         case GNILND_MSG_GET_DONE:
1807         case GNILND_MSG_PUT_DONE:
1808                 post_type = GNI_POST_RDMA_PUT;
1809                 break;
1810         case GNILND_MSG_GET_DONE_REV:
1811         case GNILND_MSG_PUT_DONE_REV:
1812                 post_type = GNI_POST_RDMA_GET;
1813                 break;
1814         default:
1815                 CERROR("invalid msg type %s (%d)\n",
1816                         kgnilnd_msgtype2str(type), type);
1817                 LBUG();
1818         }
1819         if (post_type == GNI_POST_RDMA_GET) {
1820                 /* Check for remote buffer / local buffer / length alignment. All must be 4 byte
1821                  * aligned. If the local buffer is not aligned correctly using the copy buffer
1822                  * will fix that issue. If length is misaligned copy buffer will also fix the issue, we end
1823                  * up transferring extra bytes into the buffer but only copy the correct nob into the original
1824                  * buffer.  Remote offset correction is done through a combination of adjusting the offset,
1825                  * making sure the length and addr are aligned and copying the data into the correct location
1826                  * once the transfer has completed.
1827                  */
1828                 if ((((__u64)((unsigned long)tx->tx_buffer)) & 3) ||
1829                       (sink->gnrd_addr & 3) ||
1830                       (nob & 3)) {
1831
1832                         tx->tx_offset = ((__u64)((unsigned long)sink->gnrd_addr)) & 3;
1833                         if (tx->tx_offset)
1834                                 atomic_inc(&kgnilnd_data.kgn_rev_offset);
1835
1836                         if ((nob + tx->tx_offset) & 3) {
1837                                 desc_nob = ((nob + tx->tx_offset) + (4 - ((nob + tx->tx_offset) & 3)));
1838                                 atomic_inc(&kgnilnd_data.kgn_rev_length);
1839                         } else {
1840                                 desc_nob = (nob + tx->tx_offset);
1841                         }
1842
1843                         if (tx->tx_buffer_copy == NULL) {
1844                                 /* Allocate the largest copy buffer we will need, this will prevent us from overwriting data
1845                                  * and require at most we allocate a few extra bytes. */
1846                                 tx->tx_buffer_copy = kgnilnd_vzalloc(desc_nob);
1847
1848                                 if (!tx->tx_buffer_copy) {
1849                                         /* allocation of buffer failed nak the rdma */
1850                                         kgnilnd_nak_rdma(tx->tx_conn, tx->tx_msg.gnm_type, -EFAULT, cookie, tx->tx_msg.gnm_srcnid);
1851                                         kgnilnd_tx_done(tx, -EFAULT);
1852                                         return 0;
1853                                 }
1854                                 atomic_inc(&kgnilnd_data.kgn_rev_copy_buff);
1855                                 rc = kgnilnd_mem_register(conn->gnc_device->gnd_handle, (__u64)tx->tx_buffer_copy, desc_nob, NULL, GNI_MEM_READWRITE, &tx->tx_buffer_copy_map_key);
1856                                 if (rc != GNI_RC_SUCCESS) {
1857                                         /* Registration Failed nak rdma and kill the tx. */
1858                                         kgnilnd_vfree(tx->tx_buffer_copy,
1859                                                       desc_nob);
1860                                         tx->tx_buffer_copy = NULL;
1861                                         kgnilnd_nak_rdma(tx->tx_conn, tx->tx_msg.gnm_type, -EFAULT, cookie, tx->tx_msg.gnm_srcnid);
1862                                         kgnilnd_tx_done(tx, -EFAULT);
1863                                         return 0;
1864                                 }
1865                         }
1866                         desc_map_key = tx->tx_buffer_copy_map_key;
1867                         desc_buffer = tx->tx_buffer_copy;
1868                 }
1869         }
1870
1871         memset(&tx->tx_rdma_desc, 0, sizeof(tx->tx_rdma_desc));
1872         tx->tx_rdma_desc.post_id = tx->tx_id.txe_cookie;
1873         tx->tx_rdma_desc.type = post_type;
1874         tx->tx_rdma_desc.cq_mode = GNI_CQMODE_GLOBAL_EVENT;
1875         tx->tx_rdma_desc.local_addr = (__u64)((unsigned long)desc_buffer);
1876         tx->tx_rdma_desc.local_mem_hndl = desc_map_key;
1877         tx->tx_rdma_desc.remote_addr = sink->gnrd_addr - tx->tx_offset;
1878         tx->tx_rdma_desc.remote_mem_hndl = sink->gnrd_key;
1879         tx->tx_rdma_desc.length = desc_nob;
1880         tx->tx_nob_rdma = nob;
1881         if (post_type == GNI_POST_RDMA_PUT && *kgnilnd_tunables.kgn_bte_put_dlvr_mode)
1882                 tx->tx_rdma_desc.dlvr_mode = *kgnilnd_tunables.kgn_bte_put_dlvr_mode;
1883         if (post_type == GNI_POST_RDMA_GET && *kgnilnd_tunables.kgn_bte_get_dlvr_mode)
1884                 tx->tx_rdma_desc.dlvr_mode = *kgnilnd_tunables.kgn_bte_get_dlvr_mode;
1885         /* prep final completion message */
1886         kgnilnd_init_msg(&tx->tx_msg, type, tx->tx_msg.gnm_srcnid);
1887         tx->tx_msg.gnm_u.completion.gncm_cookie = cookie;
1888         /* send actual size RDMA'd in retval */
1889         tx->tx_msg.gnm_u.completion.gncm_retval = nob;
1890
1891         kgnilnd_compute_rdma_cksum(tx, nob);
1892
1893         if (nob == 0) {
1894                 kgnilnd_queue_tx(conn, tx);
1895                 return 0;
1896         }
1897
1898         /* Don't lie (CLOSE == RDMA idle) */
1899         LASSERTF(!conn->gnc_close_sent, "tx %p on conn %p after close sent %d\n",
1900                  tx, conn, conn->gnc_close_sent);
1901
1902         GNIDBG_TX(D_NET, tx, "Post RDMA type 0x%02x conn %p dlvr_mode "
1903                 "0x%x cookie:%#llx",
1904                 type, conn, tx->tx_rdma_desc.dlvr_mode, cookie);
1905
1906         /* set CQ dedicated for RDMA */
1907         tx->tx_rdma_desc.src_cq_hndl = conn->gnc_device->gnd_snd_rdma_cqh;
1908
1909         timestamp = jiffies;
1910         kgnilnd_conn_mutex_lock(&conn->gnc_rdma_mutex);
1911         kgnilnd_gl_mutex_lock(&conn->gnc_device->gnd_cq_mutex);
1912         /* delay in jiffies - we are really concerned only with things that
1913          * result in a schedule() or really holding this off for long times .
1914          * NB - mutex_lock could spin for 2 jiffies before going to sleep to wait */
1915         conn->gnc_device->gnd_mutex_delay += (long) jiffies - timestamp;
1916
1917         rrc = kgnilnd_post_rdma(conn->gnc_ephandle, &tx->tx_rdma_desc);
1918
1919         if (rrc == GNI_RC_ERROR_RESOURCE) {
1920                 kgnilnd_conn_mutex_unlock(&conn->gnc_rdma_mutex);
1921                 kgnilnd_gl_mutex_unlock(&conn->gnc_device->gnd_cq_mutex);
1922                 kgnilnd_unmap_buffer(tx, 0);
1923
1924                 if (tx->tx_buffer_copy != NULL) {
1925                         kgnilnd_vfree(tx->tx_buffer_copy, desc_nob);
1926                         tx->tx_buffer_copy = NULL;
1927                 }
1928
1929                 spin_lock(&tx->tx_conn->gnc_device->gnd_lock);
1930                 kgnilnd_tx_add_state_locked(tx, NULL, tx->tx_conn,
1931                                             GNILND_TX_MAPQ, 0);
1932                 spin_unlock(&tx->tx_conn->gnc_device->gnd_lock);
1933                 kgnilnd_schedule_device(tx->tx_conn->gnc_device);
1934                 return -EAGAIN;
1935         }
1936
1937         spin_lock(&conn->gnc_list_lock);
1938         kgnilnd_tx_add_state_locked(tx, conn->gnc_peer, conn, GNILND_TX_LIVE_RDMAQ, 1);
1939         tx->tx_qtime = jiffies;
1940         spin_unlock(&conn->gnc_list_lock);
1941         kgnilnd_gl_mutex_unlock(&conn->gnc_device->gnd_cq_mutex);
1942         kgnilnd_conn_mutex_unlock(&conn->gnc_rdma_mutex);
1943
1944         /* XXX Nic: is this a place we should handle more errors for
1945          * robustness sake */
1946         LASSERT(rrc == GNI_RC_SUCCESS);
1947         return 0;
1948 }
1949
1950 kgn_rx_t *
1951 kgnilnd_alloc_rx(void)
1952 {
1953         kgn_rx_t        *rx;
1954
1955         rx = kmem_cache_alloc(kgnilnd_data.kgn_rx_cache, GFP_ATOMIC);
1956         if (rx == NULL) {
1957                 CERROR("failed to allocate rx\n");
1958                 return NULL;
1959         }
1960         CDEBUG(D_MALLOC, "slab-alloced 'rx': %lu at %p.\n",
1961                sizeof(*rx), rx);
1962
1963         /* no memset to zero, we'll always fill all members */
1964         return rx;
1965 }
1966
1967 /* release is to just free connection resources
1968  * we use this for the eager path after copying */
1969 void
1970 kgnilnd_release_msg(kgn_conn_t *conn)
1971 {
1972         gni_return_t    rrc;
1973         unsigned long   timestamp;
1974
1975         CDEBUG(D_NET, "consuming %p\n", conn);
1976
1977         timestamp = jiffies;
1978         kgnilnd_gl_mutex_lock(&conn->gnc_device->gnd_cq_mutex);
1979         /* delay in jiffies - we are really concerned only with things that
1980          * result in a schedule() or really holding this off for long times .
1981          * NB - mutex_lock could spin for 2 jiffies before going to sleep to wait */
1982         conn->gnc_device->gnd_mutex_delay += (long) jiffies - timestamp;
1983
1984         rrc = kgnilnd_smsg_release(conn->gnc_ephandle);
1985         kgnilnd_gl_mutex_unlock(&conn->gnc_device->gnd_cq_mutex);
1986
1987         LASSERTF(rrc == GNI_RC_SUCCESS, "bad rrc %d\n", rrc);
1988         GNIDBG_SMSG_CREDS(D_NET, conn);
1989
1990         kgnilnd_schedule_conn(conn);
1991 }
1992
1993 void
1994 kgnilnd_consume_rx(kgn_rx_t *rx)
1995 {
1996         kgn_conn_t      *conn = rx->grx_conn;
1997         kgn_msg_t       *rxmsg = rx->grx_msg;
1998
1999         /* if we are eager, free the cache alloc'd msg */
2000         if (unlikely(rx->grx_eager)) {
2001                 LIBCFS_FREE(rxmsg, sizeof(*rxmsg) + *kgnilnd_tunables.kgn_max_immediate);
2002                 atomic_dec(&kgnilnd_data.kgn_neager_allocs);
2003
2004                 /* release ref from eager_recv */
2005                 kgnilnd_conn_decref(conn);
2006         } else {
2007                 GNIDBG_MSG(D_NET, rxmsg, "rx %p processed", rx);
2008                 kgnilnd_release_msg(conn);
2009         }
2010
2011         kmem_cache_free(kgnilnd_data.kgn_rx_cache, rx);
2012         CDEBUG(D_MALLOC, "slab-freed 'rx': %lu at %p.\n",
2013                sizeof(*rx), rx);
2014 }
2015
2016 int
2017 kgnilnd_send(struct lnet_ni *ni, void *private, struct lnet_msg *lntmsg)
2018 {
2019         struct lnet_hdr  *hdr = &lntmsg->msg_hdr;
2020         int               type = lntmsg->msg_type;
2021         struct lnet_process_id target = lntmsg->msg_target;
2022         int               target_is_router = lntmsg->msg_target_is_router;
2023         int               routing = lntmsg->msg_routing;
2024         unsigned int      niov = lntmsg->msg_niov;
2025         struct bio_vec   *kiov = lntmsg->msg_kiov;
2026         unsigned int      offset = lntmsg->msg_offset;
2027         unsigned int      nob = lntmsg->msg_len;
2028         unsigned int      msg_vmflush = lntmsg->msg_vmflush;
2029         kgn_net_t        *net = ni->ni_data;
2030         kgn_tx_t         *tx;
2031         int               rc = 0;
2032         /* '1' for consistency with code that checks !mpflag to restore */
2033         unsigned int mpflag = 1;
2034         int               reverse_rdma_flag = *kgnilnd_tunables.kgn_reverse_rdma;
2035
2036         /* NB 'private' is different depending on what we're sending.... */
2037         LASSERT(!in_interrupt());
2038
2039         CDEBUG(D_NET, "sending msg type %d with %d bytes in %d frags to %s\n",
2040                type, nob, niov, libcfs_id2str(target));
2041
2042         LASSERTF(nob == 0 || niov > 0,
2043                 "lntmsg %p nob %d niov %d\n", lntmsg, nob, niov);
2044         LASSERTF(niov <= LNET_MAX_IOV,
2045                 "lntmsg %p niov %d\n", lntmsg, niov);
2046
2047         if (msg_vmflush)
2048                 mpflag = memalloc_noreclaim_save();
2049
2050         switch (type) {
2051         default:
2052                 CERROR("lntmsg %p with unexpected type %d\n",
2053                         lntmsg, type);
2054                 LBUG();
2055
2056         case LNET_MSG_ACK:
2057                 LASSERTF(nob == 0, "lntmsg %p nob %d\n",
2058                         lntmsg, nob);
2059                 break;
2060
2061         case LNET_MSG_GET:
2062                 LASSERT(niov == 0);
2063                 LASSERT(nob == 0);
2064
2065                 if (routing || target_is_router)
2066                         break;                  /* send IMMEDIATE */
2067
2068                 /* it is safe to do direct GET with out mapping buffer for RDMA as we
2069                  * check the eventual sink buffer here - if small enough, remote
2070                  * end is perfectly capable of returning data in short message -
2071                  * The magic is that we call lnet_parse in kgnilnd_recv with rdma_req=0
2072                  * for IMMEDIATE messages which will have it send a real reply instead
2073                  * of doing kgnilnd_recv to have the RDMA continued */
2074                 if (lntmsg->msg_md->md_length <= *kgnilnd_tunables.kgn_max_immediate)
2075                        break;
2076
2077                 if ((reverse_rdma_flag & GNILND_REVERSE_GET) == 0)
2078                         tx = kgnilnd_new_tx_msg(GNILND_MSG_GET_REQ, ni->ni_nid);
2079                 else
2080                         tx = kgnilnd_new_tx_msg(GNILND_MSG_GET_REQ_REV, ni->ni_nid);
2081
2082                 if (tx == NULL) {
2083                         rc = -ENOMEM;
2084                         goto out;
2085                 }
2086                 rc = kgnilnd_setup_rdma_buffer(tx, lntmsg->msg_md->md_niov,
2087                                                lntmsg->msg_md->md_kiov,
2088                                                0, lntmsg->msg_md->md_length);
2089                 if (rc != 0) {
2090                         CERROR("unable to setup buffer: %d\n", rc);
2091                         kgnilnd_tx_done(tx, rc);
2092                         rc = -EIO;
2093                         goto out;
2094                 }
2095
2096                 tx->tx_lntmsg[1] = lnet_create_reply_msg(ni, lntmsg);
2097                 if (tx->tx_lntmsg[1] == NULL) {
2098                         CERROR("Can't create reply for GET to %s\n",
2099                                libcfs_nid2str(target.nid));
2100                         kgnilnd_tx_done(tx, rc);
2101                         rc = -EIO;
2102                         goto out;
2103                 }
2104
2105                 tx->tx_lntmsg[0] = lntmsg;
2106                 if ((reverse_rdma_flag & GNILND_REVERSE_GET) == 0)
2107                         tx->tx_msg.gnm_u.get.gngm_hdr = *hdr;
2108                 else
2109                         tx->tx_msg.gnm_u.putreq.gnprm_hdr = *hdr;
2110
2111                 /* rest of tx_msg is setup just before it is sent */
2112                 kgnilnd_launch_tx(tx, net, &target);
2113                 goto out;
2114         case LNET_MSG_REPLY:
2115         case LNET_MSG_PUT:
2116                 /* to save on MDDs, we'll handle short kiov by vmap'ing
2117                  * and sending via SMSG */
2118                 if (nob <= *kgnilnd_tunables.kgn_max_immediate)
2119                        break;
2120
2121                 if ((reverse_rdma_flag & GNILND_REVERSE_PUT) == 0)
2122                         tx = kgnilnd_new_tx_msg(GNILND_MSG_PUT_REQ, ni->ni_nid);
2123                 else
2124                         tx = kgnilnd_new_tx_msg(GNILND_MSG_PUT_REQ_REV, ni->ni_nid);
2125
2126                 if (tx == NULL) {
2127                         rc = -ENOMEM;
2128                         goto out;
2129                 }
2130
2131                 rc = kgnilnd_setup_rdma_buffer(tx, niov,
2132                                                kiov, offset, nob);
2133                 if (rc != 0) {
2134                         kgnilnd_tx_done(tx, rc);
2135                         rc = -EIO;
2136                         goto out;
2137                 }
2138
2139                 tx->tx_lntmsg[0] = lntmsg;
2140                 if ((reverse_rdma_flag & GNILND_REVERSE_PUT) == 0)
2141                         tx->tx_msg.gnm_u.putreq.gnprm_hdr = *hdr;
2142                 else
2143                         tx->tx_msg.gnm_u.get.gngm_hdr = *hdr;
2144
2145                 /* rest of tx_msg is setup just before it is sent */
2146                 kgnilnd_launch_tx(tx, net, &target);
2147                 goto out;
2148         }
2149
2150         /* send IMMEDIATE */
2151
2152         LASSERTF(nob <= *kgnilnd_tunables.kgn_max_immediate,
2153                 "lntmsg 0x%p too large %d\n", lntmsg, nob);
2154
2155         tx = kgnilnd_new_tx_msg(GNILND_MSG_IMMEDIATE, ni->ni_nid);
2156         if (tx == NULL) {
2157                 rc = -ENOMEM;
2158                 goto out;
2159         }
2160
2161         rc = kgnilnd_setup_immediate_buffer(tx, niov, kiov, offset, nob);
2162         if (rc != 0) {
2163                 kgnilnd_tx_done(tx, rc);
2164                 goto out;
2165         }
2166
2167         tx->tx_msg.gnm_u.immediate.gnim_hdr = *hdr;
2168         tx->tx_lntmsg[0] = lntmsg;
2169         kgnilnd_launch_tx(tx, net, &target);
2170
2171 out:
2172         /* use stored value as we could have already finalized lntmsg here from a failed launch */
2173         if (msg_vmflush)
2174                 memalloc_noreclaim_restore(mpflag);
2175         return rc;
2176 }
2177
2178 void
2179 kgnilnd_setup_rdma(struct lnet_ni *ni, kgn_rx_t *rx, struct lnet_msg *lntmsg, int mlen)
2180 {
2181         kgn_conn_t    *conn = rx->grx_conn;
2182         kgn_msg_t     *rxmsg = rx->grx_msg;
2183         unsigned int   niov = lntmsg->msg_niov;
2184         struct bio_vec *kiov = lntmsg->msg_kiov;
2185         unsigned int   offset = lntmsg->msg_offset;
2186         unsigned int   nob = lntmsg->msg_len;
2187         int            done_type;
2188         kgn_tx_t      *tx;
2189         int            rc = 0;
2190
2191         switch (rxmsg->gnm_type) {
2192         case GNILND_MSG_PUT_REQ_REV:
2193                 done_type = GNILND_MSG_PUT_DONE_REV;
2194                 nob = mlen;
2195                 break;
2196         case GNILND_MSG_GET_REQ:
2197                 done_type = GNILND_MSG_GET_DONE;
2198                 break;
2199         default:
2200                 CERROR("invalid msg type %s (%d)\n",
2201                         kgnilnd_msgtype2str(rxmsg->gnm_type),
2202                         rxmsg->gnm_type);
2203                 LBUG();
2204         }
2205
2206         tx = kgnilnd_new_tx_msg(done_type, ni->ni_nid);
2207         if (tx == NULL)
2208                 goto failed_0;
2209
2210         rc = kgnilnd_set_tx_id(tx, conn);
2211         if (rc != 0)
2212                 goto failed_1;
2213
2214         rc = kgnilnd_setup_rdma_buffer(tx, niov, kiov, offset, nob);
2215         if (rc != 0)
2216                 goto failed_1;
2217
2218         tx->tx_lntmsg[0] = lntmsg;
2219         tx->tx_getinfo = rxmsg->gnm_u.get;
2220
2221         /* we only queue from kgnilnd_recv - we might get called from other contexts
2222          * and we don't want to block the mutex in those cases */
2223
2224         spin_lock(&tx->tx_conn->gnc_device->gnd_lock);
2225         kgnilnd_tx_add_state_locked(tx, NULL, tx->tx_conn, GNILND_TX_MAPQ, 1);
2226         spin_unlock(&tx->tx_conn->gnc_device->gnd_lock);
2227         kgnilnd_schedule_device(tx->tx_conn->gnc_device);
2228
2229         return;
2230
2231  failed_1:
2232         kgnilnd_tx_done(tx, rc);
2233         kgnilnd_nak_rdma(conn, done_type, rc, rxmsg->gnm_u.get.gngm_cookie, ni->ni_nid);
2234  failed_0:
2235         lnet_finalize(lntmsg, rc);
2236 }
2237
2238 int
2239 kgnilnd_eager_recv(struct lnet_ni *ni, void *private, struct lnet_msg *lntmsg,
2240                    void **new_private)
2241 {
2242         kgn_rx_t        *rx = private;
2243         kgn_conn_t      *conn = rx->grx_conn;
2244         kgn_msg_t       *rxmsg = rx->grx_msg;
2245         kgn_msg_t       *eagermsg = NULL;
2246         kgn_peer_t      *peer = NULL;
2247         kgn_conn_t      *found_conn = NULL;
2248
2249         GNIDBG_MSG(D_NET, rxmsg, "eager recv for conn %p, rxmsg %p, lntmsg %p",
2250                 conn, rxmsg, lntmsg);
2251
2252         if (rxmsg->gnm_payload_len > *kgnilnd_tunables.kgn_max_immediate) {
2253                 GNIDBG_MSG(D_ERROR, rxmsg, "payload too large %d",
2254                         rxmsg->gnm_payload_len);
2255                 return -EPROTO;
2256         }
2257         /* Grab a read lock so the connection doesnt disappear on us
2258          * while we look it up
2259          */
2260         read_lock(&kgnilnd_data.kgn_peer_conn_lock);
2261
2262         peer = kgnilnd_find_peer_locked(rxmsg->gnm_srcnid);
2263         if (peer != NULL)
2264                 found_conn = kgnilnd_find_conn_locked(peer);
2265
2266
2267         /* Verify the connection found is the same one that the message
2268          * is supposed to be using, if it is not output an error message
2269          * and return.
2270          */
2271         if (!peer || !found_conn
2272             || found_conn->gnc_peer_connstamp != rxmsg->gnm_connstamp) {
2273                 read_unlock(&kgnilnd_data.kgn_peer_conn_lock);
2274                 CERROR("Couldnt find matching peer %p or conn %p / %p\n",
2275                         peer, conn, found_conn);
2276                 if (found_conn) {
2277                         CERROR("Unexpected connstamp %#llx(%#llx expected)"
2278                                 " from %s", rxmsg->gnm_connstamp,
2279                                 found_conn->gnc_peer_connstamp,
2280                                 libcfs_nid2str(peer->gnp_nid));
2281                 }
2282                 return -ENOTCONN;
2283         }
2284
2285         /* add conn ref to ensure it doesn't go away until all eager
2286          * messages processed */
2287         kgnilnd_conn_addref(conn);
2288
2289         /* Now that we have verified the connection is valid and added a
2290          * reference we can remove the read_lock on the peer_conn_lock */
2291         read_unlock(&kgnilnd_data.kgn_peer_conn_lock);
2292
2293         /* we have no credits or buffers for this message, so copy it
2294          * somewhere for a later kgnilnd_recv */
2295         if (atomic_read(&kgnilnd_data.kgn_neager_allocs) >=
2296                         *kgnilnd_tunables.kgn_eager_credits) {
2297                 CERROR("Out of eager credits to %s\n",
2298                         libcfs_nid2str(conn->gnc_peer->gnp_nid));
2299                 return -ENOMEM;
2300         }
2301
2302         atomic_inc(&kgnilnd_data.kgn_neager_allocs);
2303
2304         LIBCFS_ALLOC(eagermsg, sizeof(*eagermsg) + *kgnilnd_tunables.kgn_max_immediate);
2305         if (eagermsg == NULL) {
2306                 kgnilnd_conn_decref(conn);
2307                 CERROR("couldn't allocate eager rx message for conn %p to %s\n",
2308                         conn, libcfs_nid2str(conn->gnc_peer->gnp_nid));
2309                 return -ENOMEM;
2310         }
2311
2312         /* copy msg and payload */
2313         memcpy(eagermsg, rxmsg, sizeof(*rxmsg) + rxmsg->gnm_payload_len);
2314         rx->grx_msg = eagermsg;
2315         rx->grx_eager = 1;
2316
2317         /* stash this for lnet_finalize on cancel-on-conn-close */
2318         rx->grx_lntmsg = lntmsg;
2319
2320         /* keep the same rx_t, it just has a new grx_msg now */
2321         *new_private = private;
2322
2323         /* release SMSG buffer */
2324         kgnilnd_release_msg(conn);
2325
2326         return 0;
2327 }
2328
2329 int
2330 kgnilnd_recv(struct lnet_ni *ni, void *private, struct lnet_msg *lntmsg,
2331              int delayed, unsigned int niov,
2332              struct bio_vec *kiov,
2333              unsigned int offset, unsigned int mlen, unsigned int rlen)
2334 {
2335         kgn_rx_t    *rx = private;
2336         kgn_conn_t  *conn = rx->grx_conn;
2337         kgn_msg_t   *rxmsg = rx->grx_msg;
2338         kgn_tx_t    *tx;
2339         int          rc = 0;
2340         __u32        pload_cksum;
2341         ENTRY;
2342
2343         LASSERT(!in_interrupt());
2344         LASSERTF(mlen <= rlen, "%d <= %d\n", mlen, rlen);
2345
2346         GNIDBG_MSG(D_NET, rxmsg, "conn %p, rxmsg %p, lntmsg %p"
2347                 " niov=%d kiov=%p offset=%d mlen=%d rlen=%d",
2348                 conn, rxmsg, lntmsg,
2349                 niov, kiov, offset, mlen, rlen);
2350
2351         /* we need to lock here as recv can be called from any context */
2352         read_lock(&kgnilnd_data.kgn_peer_conn_lock);
2353         if (rx->grx_eager && conn->gnc_state != GNILND_CONN_ESTABLISHED) {
2354                 read_unlock(&kgnilnd_data.kgn_peer_conn_lock);
2355
2356                 /* someone closed the conn after we copied this out, nuke it */
2357                 kgnilnd_consume_rx(rx);
2358                 lnet_finalize(lntmsg, conn->gnc_error);
2359                 RETURN(0);
2360         }
2361         read_unlock(&kgnilnd_data.kgn_peer_conn_lock);
2362
2363         switch (rxmsg->gnm_type) {
2364         default:
2365                 GNIDBG_MSG(D_NETERROR, rxmsg, "conn %p, rx %p, rxmsg %p, lntmsg %p"
2366                 " niov=%d kiov=%p offset=%d mlen=%d rlen=%d",
2367                 conn, rx, rxmsg, lntmsg, niov, kiov, offset, mlen, rlen);
2368                 LBUG();
2369
2370         case GNILND_MSG_IMMEDIATE:
2371                 if (mlen > rxmsg->gnm_payload_len) {
2372                         GNIDBG_MSG(D_ERROR, rxmsg,
2373                                 "Immediate message from %s too big: %d > %d",
2374                                 libcfs_nid2str(conn->gnc_peer->gnp_nid), mlen,
2375                                 rxmsg->gnm_payload_len);
2376                         rc = -EINVAL;
2377                         kgnilnd_consume_rx(rx);
2378                         RETURN(rc);
2379                 }
2380
2381                 /* rxmsg[1] is a pointer to the payload, sitting in the buffer
2382                  * right after the kgn_msg_t header - so just 'cute' way of saying
2383                  * rxmsg + sizeof(kgn_msg_t) */
2384
2385                 /* check payload checksum if sent */
2386
2387                 if (*kgnilnd_tunables.kgn_checksum >= 2 &&
2388                         !rxmsg->gnm_payload_cksum &&
2389                         rxmsg->gnm_payload_len != 0)
2390                         GNIDBG_MSG(D_WARNING, rxmsg, "no msg payload checksum when enabled");
2391
2392                 if (rxmsg->gnm_payload_cksum != 0) {
2393                         /* gnm_payload_len set in kgnilnd_sendmsg from tx->tx_nob,
2394                          * which is what is used to calculate the cksum on the TX side */
2395                         pload_cksum = kgnilnd_cksum(&rxmsg[1], rxmsg->gnm_payload_len);
2396
2397                         if (rxmsg->gnm_payload_cksum != pload_cksum) {
2398                                 GNIDBG_MSG(D_NETERROR, rxmsg,
2399                                            "Bad payload checksum (%x expected %x)",
2400                                             pload_cksum, rxmsg->gnm_payload_cksum);
2401                                 switch (*kgnilnd_tunables.kgn_checksum_dump) {
2402                                 case 2:
2403                                         kgnilnd_dump_blob(D_BUFFS, "bad payload checksum",
2404                                                           &rxmsg[1], rxmsg->gnm_payload_len);
2405                                         /* fallthrough */
2406                                 case 1:
2407                                         libcfs_debug_dumplog();
2408                                         break;
2409                                 default:
2410                                         break;
2411                                 }
2412                                 rc = -ENOKEY;
2413                                 /* checksum problems are fatal, kill the conn */
2414                                 kgnilnd_consume_rx(rx);
2415                                 kgnilnd_close_conn(conn, rc);
2416                                 RETURN(rc);
2417                         }
2418                 }
2419
2420                 lnet_copy_flat2kiov(
2421                         niov, kiov, offset,
2422                         *kgnilnd_tunables.kgn_max_immediate,
2423                         &rxmsg[1], 0, mlen);
2424
2425                 kgnilnd_consume_rx(rx);
2426                 lnet_finalize(lntmsg, 0);
2427                 RETURN(0);
2428
2429         case GNILND_MSG_PUT_REQ:
2430                 /* LNET wants to truncate or drop transaction, sending NAK */
2431                 if (mlen == 0) {
2432                         kgnilnd_consume_rx(rx);
2433                         lnet_finalize(lntmsg, 0);
2434
2435                         /* only error if lntmsg == NULL, otherwise we are just
2436                          * short circuiting the rdma process of 0 bytes */
2437                         kgnilnd_nak_rdma(conn, rxmsg->gnm_type,
2438                                         lntmsg == NULL ? -ENOENT : 0,
2439                                         rxmsg->gnm_u.get.gngm_cookie,
2440                                         ni->ni_nid);
2441                         RETURN(0);
2442                 }
2443                 /* sending ACK with sink buff. info */
2444                 tx = kgnilnd_new_tx_msg(GNILND_MSG_PUT_ACK, ni->ni_nid);
2445                 if (tx == NULL) {
2446                         kgnilnd_consume_rx(rx);
2447                         RETURN(-ENOMEM);
2448                 }
2449
2450                 rc = kgnilnd_set_tx_id(tx, conn);
2451                 if (rc != 0) {
2452                         GOTO(nak_put_req, rc);
2453                 }
2454
2455                 rc = kgnilnd_setup_rdma_buffer(tx, niov,
2456                                                kiov, offset, mlen);
2457                 if (rc != 0) {
2458                         GOTO(nak_put_req, rc);
2459                 }
2460
2461                 tx->tx_msg.gnm_u.putack.gnpam_src_cookie =
2462                         rxmsg->gnm_u.putreq.gnprm_cookie;
2463                 tx->tx_msg.gnm_u.putack.gnpam_dst_cookie = tx->tx_id.txe_cookie;
2464                 tx->tx_msg.gnm_u.putack.gnpam_desc.gnrd_addr =
2465                         (__u64)((unsigned long)tx->tx_buffer);
2466                 tx->tx_msg.gnm_u.putack.gnpam_desc.gnrd_nob = mlen;
2467
2468                 tx->tx_lntmsg[0] = lntmsg; /* finalize this on RDMA_DONE */
2469                 tx->tx_qtime = jiffies;
2470                 /* we only queue from kgnilnd_recv - we might get called from other contexts
2471                  * and we don't want to block the mutex in those cases */
2472
2473                 spin_lock(&tx->tx_conn->gnc_device->gnd_lock);
2474                 kgnilnd_tx_add_state_locked(tx, NULL, tx->tx_conn, GNILND_TX_MAPQ, 1);
2475                 spin_unlock(&tx->tx_conn->gnc_device->gnd_lock);
2476                 kgnilnd_schedule_device(tx->tx_conn->gnc_device);
2477
2478                 kgnilnd_consume_rx(rx);
2479                 RETURN(0);
2480
2481 nak_put_req:
2482                 /* make sure we send an error back when the PUT fails */
2483                 kgnilnd_nak_rdma(conn, rxmsg->gnm_type, rc, rxmsg->gnm_u.get.gngm_cookie, ni->ni_nid);
2484                 kgnilnd_tx_done(tx, rc);
2485                 kgnilnd_consume_rx(rx);
2486
2487                 /* return magic LNet network error */
2488                 RETURN(-EIO);
2489         case GNILND_MSG_GET_REQ_REV:
2490                 /* LNET wants to truncate or drop transaction, sending NAK */
2491                 if (mlen == 0) {
2492                         kgnilnd_consume_rx(rx);
2493                         lnet_finalize(lntmsg, 0);
2494
2495                         /* only error if lntmsg == NULL, otherwise we are just
2496                          * short circuiting the rdma process of 0 bytes */
2497                         kgnilnd_nak_rdma(conn, rxmsg->gnm_type,
2498                                         lntmsg == NULL ? -ENOENT : 0,
2499                                         rxmsg->gnm_u.get.gngm_cookie,
2500                                         ni->ni_nid);
2501                         RETURN(0);
2502                 }
2503                 /* lntmsg can be null when parsing a LNET_GET */
2504                 if (lntmsg != NULL) {
2505                         /* sending ACK with sink buff. info */
2506                         tx = kgnilnd_new_tx_msg(GNILND_MSG_GET_ACK_REV, ni->ni_nid);
2507                         if (tx == NULL) {
2508                                 kgnilnd_consume_rx(rx);
2509                                 RETURN(-ENOMEM);
2510                         }
2511
2512                         rc = kgnilnd_set_tx_id(tx, conn);
2513                         if (rc != 0)
2514                                 GOTO(nak_get_req_rev, rc);
2515
2516                         rc = kgnilnd_setup_rdma_buffer(tx, niov,
2517                                                        kiov, offset, mlen);
2518                         if (rc != 0)
2519                                 GOTO(nak_get_req_rev, rc);
2520
2521                         tx->tx_msg.gnm_u.putack.gnpam_src_cookie =
2522                                 rxmsg->gnm_u.putreq.gnprm_cookie;
2523                         tx->tx_msg.gnm_u.putack.gnpam_dst_cookie = tx->tx_id.txe_cookie;
2524                         tx->tx_msg.gnm_u.putack.gnpam_desc.gnrd_addr =
2525                                 (__u64)((unsigned long)tx->tx_buffer);
2526                         tx->tx_msg.gnm_u.putack.gnpam_desc.gnrd_nob = mlen;
2527
2528                         tx->tx_lntmsg[0] = lntmsg; /* finalize this on RDMA_DONE */
2529
2530                         /* we only queue from kgnilnd_recv - we might get called from other contexts
2531                          * and we don't want to block the mutex in those cases */
2532
2533                         spin_lock(&tx->tx_conn->gnc_device->gnd_lock);
2534                         kgnilnd_tx_add_state_locked(tx, NULL, tx->tx_conn, GNILND_TX_MAPQ, 1);
2535                         spin_unlock(&tx->tx_conn->gnc_device->gnd_lock);
2536                         kgnilnd_schedule_device(tx->tx_conn->gnc_device);
2537                 } else {
2538                         /* No match */
2539                         kgnilnd_nak_rdma(conn, rxmsg->gnm_type,
2540                                         -ENOENT,
2541                                         rxmsg->gnm_u.get.gngm_cookie,
2542                                         ni->ni_nid);
2543                 }
2544
2545                 kgnilnd_consume_rx(rx);
2546                 RETURN(0);
2547
2548 nak_get_req_rev:
2549                 /* make sure we send an error back when the GET fails */
2550                 kgnilnd_nak_rdma(conn, rxmsg->gnm_type, rc, rxmsg->gnm_u.get.gngm_cookie, ni->ni_nid);
2551                 kgnilnd_tx_done(tx, rc);
2552                 kgnilnd_consume_rx(rx);
2553
2554                 /* return magic LNet network error */
2555                 RETURN(-EIO);
2556
2557
2558         case GNILND_MSG_PUT_REQ_REV:
2559                 /* LNET wants to truncate or drop transaction, sending NAK */
2560                 if (mlen == 0) {
2561                         kgnilnd_consume_rx(rx);
2562                         lnet_finalize(lntmsg, 0);
2563
2564                         /* only error if lntmsg == NULL, otherwise we are just
2565                          * short circuiting the rdma process of 0 bytes */
2566                         kgnilnd_nak_rdma(conn, rxmsg->gnm_type,
2567                                         lntmsg == NULL ? -ENOENT : 0,
2568                                         rxmsg->gnm_u.get.gngm_cookie,
2569                                         ni->ni_nid);
2570                         RETURN(0);
2571                 }
2572
2573                 if (lntmsg != NULL) {
2574                         /* Matched! */
2575                         kgnilnd_setup_rdma(ni, rx, lntmsg, mlen);
2576                 } else {
2577                         /* No match */
2578                         kgnilnd_nak_rdma(conn, rxmsg->gnm_type,
2579                                         -ENOENT,
2580                                         rxmsg->gnm_u.get.gngm_cookie,
2581                                         ni->ni_nid);
2582                 }
2583                 kgnilnd_consume_rx(rx);
2584                 RETURN(0);
2585         case GNILND_MSG_GET_REQ:
2586                 if (lntmsg != NULL) {
2587                         /* Matched! */
2588                         kgnilnd_setup_rdma(ni, rx, lntmsg, mlen);
2589                 } else {
2590                         /* No match */
2591                         kgnilnd_nak_rdma(conn, rxmsg->gnm_type,
2592                                         -ENOENT,
2593                                         rxmsg->gnm_u.get.gngm_cookie,
2594                                         ni->ni_nid);
2595                 }
2596                 kgnilnd_consume_rx(rx);
2597                 RETURN(0);
2598         }
2599         RETURN(0);
2600 }
2601
2602 /* needs write_lock on kgn_peer_conn_lock held */
2603 int
2604 kgnilnd_check_conn_timeouts_locked(kgn_conn_t *conn)
2605 {
2606         unsigned long      timeout, keepalive;
2607         unsigned long      now = jiffies;
2608         unsigned long      newest_last_rx;
2609         kgn_tx_t          *tx;
2610
2611         /* given that we found this conn hanging off a peer, it better damned
2612          * well be connected */
2613         LASSERTF(conn->gnc_state == GNILND_CONN_ESTABLISHED,
2614                  "conn 0x%p->%s with bad state%s\n", conn,
2615                  conn->gnc_peer ? libcfs_nid2str(conn->gnc_peer->gnp_nid)
2616                                : "<?>",
2617                  kgnilnd_conn_state2str(conn));
2618
2619         CDEBUG(D_NET, "checking conn %p->%s timeout %d keepalive %d "
2620                       "rx_diff %lu tx_diff %lu\n",
2621                 conn, libcfs_nid2str(conn->gnc_peer->gnp_nid),
2622                 conn->gnc_timeout, GNILND_TO2KA(conn->gnc_timeout),
2623                 cfs_duration_sec(now - conn->gnc_last_rx_cq),
2624                 cfs_duration_sec(now - conn->gnc_last_tx));
2625
2626         timeout = cfs_time_seconds(conn->gnc_timeout);
2627         keepalive = cfs_time_seconds(GNILND_TO2KA(conn->gnc_timeout));
2628
2629         /* just in case our lack of RX msg processing is gumming up the works - give the
2630          * remove an extra chance */
2631
2632         newest_last_rx = GNILND_LASTRX(conn);
2633
2634         if (time_after_eq(now, newest_last_rx + timeout)) {
2635                 uint32_t level = D_CONSOLE|D_NETERROR;
2636
2637                 if (conn->gnc_peer->gnp_state == GNILND_PEER_DOWN) {
2638                         level = D_NET;
2639                 }
2640                         GNIDBG_CONN(level, conn,
2641                         "No gnilnd traffic received from %s for %lu "
2642                         "seconds, terminating connection. Is node down? ",
2643                         libcfs_nid2str(conn->gnc_peer->gnp_nid),
2644                         cfs_duration_sec(now - newest_last_rx));
2645                 return -ETIMEDOUT;
2646         }
2647
2648         /* we don't timeout on last_tx stalls - we are going to trust the
2649          * underlying network to let us know when sends are failing.
2650          * At worst, the peer will timeout our RX stamp and drop the connection
2651          * at that point. We'll then see his CLOSE or at worst his RX
2652          * stamp stop and drop the connection on our end */
2653
2654         if (time_after_eq(now, conn->gnc_last_tx + keepalive)) {
2655                 CDEBUG(D_NET, "sending NOOP -> %s (%p idle %lu(%lu)) "
2656                        "last %lu/%lu/%lu %lus/%lus/%lus\n",
2657                        libcfs_nid2str(conn->gnc_peer->gnp_nid), conn,
2658                        cfs_duration_sec(jiffies - conn->gnc_last_tx),
2659                        keepalive,
2660                        conn->gnc_last_noop_want, conn->gnc_last_noop_sent,
2661                        conn->gnc_last_noop_cq,
2662                        cfs_duration_sec(jiffies - conn->gnc_last_noop_want),
2663                        cfs_duration_sec(jiffies - conn->gnc_last_noop_sent),
2664                        cfs_duration_sec(jiffies - conn->gnc_last_noop_cq));
2665                 set_mb(conn->gnc_last_noop_want, jiffies);
2666                 atomic_inc(&conn->gnc_reaper_noop);
2667                 if (CFS_FAIL_CHECK(CFS_FAIL_GNI_NOOP_SEND))
2668                         return 0;
2669
2670                 tx = kgnilnd_new_tx_msg(GNILND_MSG_NOOP, conn->gnc_peer->gnp_net->gnn_ni->ni_nid);
2671                 if (tx == NULL)
2672                         return 0;
2673                 kgnilnd_queue_tx(conn, tx);
2674         }
2675
2676         return 0;
2677 }
2678
2679 /* needs write_lock on kgn_peer_conn_lock held */
2680 void
2681 kgnilnd_check_peer_timeouts_locked(kgn_peer_t *peer, struct list_head *todie,
2682                                     struct list_head *souls)
2683 {
2684         unsigned long           timeout;
2685         kgn_conn_t             *conn, *connN = NULL;
2686         kgn_tx_t               *tx, *txN;
2687         int                     rc = 0;
2688         int                     count = 0;
2689         int                     reconnect;
2690         int                     to_reconn;
2691         short                   releaseconn = 0;
2692         unsigned long           first_rx = 0;
2693         int                     purgatory_conn_cnt = 0;
2694
2695         CDEBUG(D_NET, "checking peer 0x%p->%s for timeouts; interval %lus\n",
2696                 peer, libcfs_nid2str(peer->gnp_nid),
2697                 peer->gnp_reconnect_interval);
2698
2699         timeout = cfs_time_seconds(max(*kgnilnd_tunables.kgn_timeout,
2700                                        GNILND_MIN_TIMEOUT));
2701
2702         conn = kgnilnd_find_conn_locked(peer);
2703         if (conn) {
2704                 /* if there is a valid conn, check the queues for timeouts */
2705                 rc = kgnilnd_check_conn_timeouts_locked(conn);
2706                 if (rc) {
2707                         if (CFS_FAIL_CHECK(CFS_FAIL_GNI_RX_CLOSE_CLOSING)) {
2708                                 /* simulate a RX CLOSE after the timeout but before
2709                                  * the scheduler thread gets it */
2710                                 conn->gnc_close_recvd = GNILND_CLOSE_INJECT1;
2711                                 conn->gnc_peer_error = -ETIMEDOUT;
2712                         }
2713
2714                         if (*kgnilnd_tunables.kgn_to_reconn_disable &&
2715                             rc == -ETIMEDOUT) {
2716                                 peer->gnp_state = GNILND_PEER_TIMED_OUT;
2717                                 CDEBUG(D_WARNING, "%s conn timed out, will "
2718                                        "reconnect upon request from peer\n",
2719                                        libcfs_nid2str(conn->gnc_peer->gnp_nid));
2720                         }
2721                         /* Once we mark closed, any of the scheduler threads could
2722                          * get it and move through before we hit the fail loc code */
2723                         kgnilnd_close_conn_locked(conn, rc);
2724                 } else {
2725                         /* first_rx is used to decide when to release a conn from purgatory.
2726                          */
2727                         first_rx = conn->gnc_first_rx;
2728                 }
2729         }
2730
2731         /* now regardless of starting new conn, find tx on peer queue that
2732          * are old and smell bad - do this first so we don't trigger
2733          * reconnect on empty queue if we timeout all */
2734         list_for_each_entry_safe(tx, txN, &peer->gnp_tx_queue, tx_list) {
2735                 if (time_after_eq(jiffies, tx->tx_qtime + timeout)) {
2736                         if (count == 0) {
2737                                 LCONSOLE_INFO("could not send to %s due to connection"
2738                                        " setup failure after %lu seconds\n",
2739                                        libcfs_nid2str(peer->gnp_nid),
2740                                        cfs_duration_sec(jiffies - tx->tx_qtime));
2741                         }
2742                         kgnilnd_tx_del_state_locked(tx, peer, NULL,
2743                                                    GNILND_TX_ALLOCD);
2744                         list_add_tail(&tx->tx_list, todie);
2745                         count++;
2746                 }
2747         }
2748
2749         if (count || peer->gnp_connecting == GNILND_PEER_KILL) {
2750                 CDEBUG(D_NET, "canceling %d tx for peer 0x%p->%s\n",
2751                         count, peer, libcfs_nid2str(peer->gnp_nid));
2752                 /* if we nuked all the TX, stop peer connection attempt (if there is one..) */
2753                 if (list_empty(&peer->gnp_tx_queue) ||
2754                         peer->gnp_connecting == GNILND_PEER_KILL) {
2755                         /* we pass down todie to use a common function - but we know there are
2756                          * no TX to add */
2757                         kgnilnd_cancel_peer_connect_locked(peer, todie);
2758                 }
2759         }
2760
2761         /* Don't reconnect if we are still trying to clear out old conns.
2762          * This prevents us sending traffic on the new mbox before ensuring we are done
2763          * with the old one */
2764         reconnect = (peer->gnp_state == GNILND_PEER_UP) &&
2765                     (atomic_read(&peer->gnp_dirty_eps) == 0);
2766
2767         /* fast reconnect after a timeout */
2768         to_reconn = !conn &&
2769                     (peer->gnp_last_errno == -ETIMEDOUT) &&
2770                     *kgnilnd_tunables.kgn_fast_reconn;
2771
2772         /* if we are not connected and there are tx on the gnp_tx_queue waiting
2773          * to be sent, we'll check the reconnect interval and fire up a new
2774          * connection request */
2775
2776         if (reconnect &&
2777             (peer->gnp_connecting == GNILND_PEER_IDLE) &&
2778             (time_after_eq(jiffies, peer->gnp_reconnect_time)) &&
2779             (!list_empty(&peer->gnp_tx_queue) || to_reconn)) {
2780
2781                 CDEBUG(D_NET, "starting connect to %s\n",
2782                         libcfs_nid2str(peer->gnp_nid));
2783                 LASSERTF(peer->gnp_connecting == GNILND_PEER_IDLE,
2784                          "Peer was idle and we have a write_lock, state issue %d\n",
2785                          peer->gnp_connecting);
2786
2787                 peer->gnp_connecting = GNILND_PEER_CONNECT;
2788                 kgnilnd_peer_addref(peer); /* extra ref for connd */
2789
2790                 spin_lock(&peer->gnp_net->gnn_dev->gnd_connd_lock);
2791                 list_add_tail(&peer->gnp_connd_list,
2792                               &peer->gnp_net->gnn_dev->gnd_connd_peers);
2793                 spin_unlock(&peer->gnp_net->gnn_dev->gnd_connd_lock);
2794
2795                 kgnilnd_schedule_dgram(peer->gnp_net->gnn_dev);
2796         }
2797
2798         /* fail_loc to allow us to delay release of purgatory */
2799         if (CFS_FAIL_CHECK(CFS_FAIL_GNI_PURG_REL_DELAY))
2800                 return;
2801
2802         /* This check allows us to verify that the new conn is actually being used. This allows us to
2803          * pull the old conns out of purgatory if they have actually seen traffic.
2804          * We only release a conn from purgatory during stack reset, admin command, or when a peer reconnects
2805          */
2806         if (first_rx &&
2807                 time_after(jiffies, first_rx + cfs_time_seconds(*kgnilnd_tunables.kgn_hardware_timeout))) {
2808                 CDEBUG(D_INFO, "We can release peer %s conn's from purgatory %lu\n",
2809                         libcfs_nid2str(peer->gnp_nid), first_rx + cfs_time_seconds(*kgnilnd_tunables.kgn_hardware_timeout));
2810                 releaseconn = 1;
2811         }
2812
2813         list_for_each_entry_safe (conn, connN, &peer->gnp_conns, gnc_list) {
2814         /* check for purgatory timeouts */
2815                 if (conn->gnc_in_purgatory) {
2816                         /* We cannot detach this conn from purgatory if it has not been closed so we reschedule it
2817                          * that way the next time we check it we can detach it from purgatory
2818                          */
2819
2820                         if (conn->gnc_state != GNILND_CONN_DONE) {
2821                                 /* Skip over conns that are currently not DONE. If they arent already scheduled
2822                                  * for completion something in the state machine is broken.
2823                                  */
2824                                 continue;
2825                         }
2826
2827                         /* We only detach a conn that is in purgatory if we have received a close message,
2828                          * we have a new valid connection that has successfully received data, or an admin
2829                          * command tells us we need to detach.
2830                          */
2831
2832                         if (conn->gnc_close_recvd || releaseconn || conn->gnc_needs_detach) {
2833                                 unsigned long   waiting;
2834
2835                                 waiting = (long) jiffies - conn->gnc_last_rx_cq;
2836
2837                                 /* C.E: The remote peer is expected to close the
2838                                  * connection (see kgnilnd_check_conn_timeouts)
2839                                  * via the reaper thread and nuke out the MDD and
2840                                  * FMA resources after conn->gnc_timeout has expired
2841                                  * without an FMA RX */
2842                                 CDEBUG(D_NET, "Reconnected to %s in %lds or admin forced detach, dropping "
2843                                         " held resources\n",
2844                                         libcfs_nid2str(conn->gnc_peer->gnp_nid),
2845                                         cfs_duration_sec(waiting));
2846
2847                                 kgnilnd_detach_purgatory_locked(conn, souls);
2848                         } else {
2849                                 purgatory_conn_cnt++;
2850                         }
2851                 }
2852         }
2853
2854         /* If we have too many connections in purgatory we could run out of
2855          * resources. Limit the number of connections to a tunable number,
2856          * clean up to the minimum all in one fell swoop... there are
2857          * situations where dvs will retry tx's and we can eat up several
2858          * hundread connection requests at once.
2859          */
2860         if (purgatory_conn_cnt > *kgnilnd_tunables.kgn_max_purgatory) {
2861                 list_for_each_entry_safe(conn, connN, &peer->gnp_conns,
2862                                          gnc_list) {
2863                         if (conn->gnc_in_purgatory &&
2864                             conn->gnc_state == GNILND_CONN_DONE) {
2865                                 CDEBUG(D_NET, "Dropping Held resource due to"
2866                                               " resource limits being hit\n");
2867                                 kgnilnd_detach_purgatory_locked(conn, souls);
2868
2869                                 if (purgatory_conn_cnt-- <
2870                                     *kgnilnd_tunables.kgn_max_purgatory)
2871                                         break;
2872                         }
2873                 }
2874         }
2875 }
2876
2877 void
2878 kgnilnd_reaper_check(int idx)
2879 {
2880         struct list_head  *peers = &kgnilnd_data.kgn_peers[idx];
2881         struct list_head  *ctmp, *ctmpN;
2882         LIST_HEAD(geriatrics);
2883         LIST_HEAD(souls);
2884
2885         write_lock(&kgnilnd_data.kgn_peer_conn_lock);
2886
2887         list_for_each_safe(ctmp, ctmpN, peers) {
2888                 kgn_peer_t        *peer = NULL;
2889
2890                 /* don't timeout stuff if the network is mucked or shutting down */
2891                 if (kgnilnd_check_hw_quiesce()) {
2892                         break;
2893                 }
2894                 peer = list_entry(ctmp, kgn_peer_t, gnp_list);
2895
2896                 kgnilnd_check_peer_timeouts_locked(peer, &geriatrics, &souls);
2897         }
2898
2899         write_unlock(&kgnilnd_data.kgn_peer_conn_lock);
2900
2901         kgnilnd_txlist_done(&geriatrics, -EHOSTUNREACH);
2902         kgnilnd_release_purgatory_list(&souls);
2903 }
2904
2905 void
2906 kgnilnd_update_reaper_timeout(long timeout)
2907 {
2908         LASSERT(timeout > 0);
2909
2910         spin_lock(&kgnilnd_data.kgn_reaper_lock);
2911
2912         if (timeout < kgnilnd_data.kgn_new_min_timeout)
2913                 kgnilnd_data.kgn_new_min_timeout = timeout;
2914
2915         spin_unlock(&kgnilnd_data.kgn_reaper_lock);
2916 }
2917
2918 static void
2919 kgnilnd_reaper_poke_with_stick(cfs_timer_cb_arg_t arg)
2920 {
2921         wake_up(&kgnilnd_data.kgn_reaper_waitq);
2922 }
2923
2924 int
2925 kgnilnd_reaper(void *arg)
2926 {
2927         long               timeout;
2928         int                i;
2929         int                hash_index = 0;
2930         unsigned long      next_check_time = jiffies;
2931         long               current_min_timeout = MAX_SCHEDULE_TIMEOUT;
2932         struct timer_list  timer;
2933         DEFINE_WAIT(wait);
2934
2935         /* all gnilnd threads need to run fairly urgently */
2936         set_user_nice(current, *kgnilnd_tunables.kgn_nice);
2937         spin_lock(&kgnilnd_data.kgn_reaper_lock);
2938
2939         while (!kgnilnd_data.kgn_shutdown) {
2940                 /* I wake up every 'p' seconds to check for timeouts on some
2941                  * more peers.  I try to check every connection 'n' times
2942                  * within the global minimum of all keepalive and timeout
2943                  * intervals, to ensure I attend to every connection within
2944                  * (n+1)/n times its timeout intervals. */
2945                 const int     p = GNILND_REAPER_THREAD_WAKE;
2946                 const int     n = GNILND_REAPER_NCHECKS;
2947                 int           chunk;
2948                 /* to quiesce or to not quiesce, that is the question */
2949                 if (unlikely(kgnilnd_data.kgn_quiesce_trigger)) {
2950                         spin_unlock(&kgnilnd_data.kgn_reaper_lock);
2951                         KGNILND_SPIN_QUIESCE;
2952                         spin_lock(&kgnilnd_data.kgn_reaper_lock);
2953                 }
2954
2955                 /* careful with the jiffy wrap... */
2956                 timeout = (long)(next_check_time - jiffies);
2957
2958                 if (timeout > 0) {
2959                         prepare_to_wait(&kgnilnd_data.kgn_reaper_waitq, &wait,
2960                                         TASK_INTERRUPTIBLE);
2961                         spin_unlock(&kgnilnd_data.kgn_reaper_lock);
2962                         cfs_timer_setup(&timer, kgnilnd_reaper_poke_with_stick,
2963                                         next_check_time, 0);
2964                         mod_timer(&timer, (long) jiffies + timeout);
2965
2966                         /* check flag variables before committing */
2967                         if (!kgnilnd_data.kgn_shutdown &&
2968                             !kgnilnd_data.kgn_quiesce_trigger) {
2969                                 CDEBUG(D_INFO, "schedule timeout %ld (%lu sec)\n",
2970                                        timeout, cfs_duration_sec(timeout));
2971                                 schedule();
2972                                 CDEBUG(D_INFO, "awake after schedule\n");
2973                         }
2974
2975                         del_singleshot_timer_sync(&timer);
2976                         spin_lock(&kgnilnd_data.kgn_reaper_lock);
2977                         finish_wait(&kgnilnd_data.kgn_reaper_waitq, &wait);
2978                         continue;
2979                 }
2980
2981                 /* new_min_timeout is set from the conn timeouts and keepalive
2982                  * this should end up with a min timeout of
2983                  * GNILND_TIMEOUT2KEEPALIVE(t) or roughly LND_TIMEOUT/2 */
2984                 if (kgnilnd_data.kgn_new_min_timeout < current_min_timeout) {
2985                         current_min_timeout = kgnilnd_data.kgn_new_min_timeout;
2986                         CDEBUG(D_NET, "Set new min timeout %ld\n",
2987                                current_min_timeout);
2988                 }
2989
2990                 spin_unlock(&kgnilnd_data.kgn_reaper_lock);
2991
2992                 /* Compute how many table entries to check now so I get round
2993                  * the whole table fast enough given that I do this at fixed
2994                  * intervals of 'p' seconds) */
2995                 chunk = *kgnilnd_tunables.kgn_peer_hash_size;
2996                 if (kgnilnd_data.kgn_new_min_timeout > n * p)
2997                         chunk = (chunk * n * p) /
2998                                 kgnilnd_data.kgn_new_min_timeout;
2999                 if (chunk == 0)
3000                         chunk = 1;
3001                 for (i = 0; i < chunk; i++) {
3002                         kgnilnd_reaper_check(hash_index);
3003                         hash_index = (hash_index + 1) %
3004                                 *kgnilnd_tunables.kgn_peer_hash_size;
3005                 }
3006                 next_check_time = (long) jiffies + cfs_time_seconds(p);
3007                 CDEBUG(D_INFO, "next check at %lu or in %d sec\n", next_check_time, p);
3008
3009                 spin_lock(&kgnilnd_data.kgn_reaper_lock);
3010         }
3011
3012         spin_unlock(&kgnilnd_data.kgn_reaper_lock);
3013
3014         kgnilnd_thread_fini();
3015         return 0;
3016 }
3017
3018 int
3019 kgnilnd_recv_bte_get(kgn_tx_t *tx) {
3020         unsigned niov, offset, nob;
3021         struct bio_vec *kiov;
3022         struct lnet_msg *lntmsg = tx->tx_lntmsg[0];
3023         kgnilnd_parse_lnet_rdma(lntmsg, &niov, &offset, &nob, &kiov, tx->tx_nob_rdma);
3024
3025         if (kiov != NULL) {
3026                 lnet_copy_flat2kiov(
3027                         niov, kiov, offset,
3028                         nob,
3029                         tx->tx_buffer_copy + tx->tx_offset, 0, nob);
3030         } else {
3031                 memcpy(tx->tx_buffer, tx->tx_buffer_copy + tx->tx_offset, nob);
3032         }
3033         return 0;
3034 }
3035
3036
3037 int
3038 kgnilnd_check_rdma_cq(kgn_device_t *dev)
3039 {
3040