Whamcloud - gitweb
4cff9eda91bb90686e2ab946f7c3906e7aebab7a
[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 #include "gnilnd.h"
31
32 /* this is useful when needed to debug wire corruption. */
33 static void
34 kgnilnd_dump_blob(int level, char *prefix, void *buf, int len) {
35         __u64 *ptr;
36
37         ptr = (__u64 *) buf;
38
39         while (len > 0) {
40                 if (len >= 32) {
41                         CDEBUG(level,
42                                "%s 0x%p: 0x%16.16llx 0x%16.16llx 0x%16.16llx 0x%16.16llx\n",
43                                prefix, ptr, *(ptr), *(ptr + 1), *(ptr + 2), *(ptr + 3));
44                         ptr += 4;
45                         len -= 32;
46                 } else if (len >= 16) {
47                         CDEBUG(level,
48                                "%s 0x%p: 0x%16.16llx 0x%16.16llx\n",
49                                prefix, ptr, *(ptr), *(ptr + 1));
50                         ptr += 2;
51                         len -= 16;
52                 } else {
53                         CDEBUG(level, "%s 0x%p: 0x%16.16llx\n",
54                                prefix, ptr, *(ptr));
55                         ptr++;
56                         len -= 8;
57                 }
58         }
59 }
60
61 static void
62 kgnilnd_dump_msg(int mask, kgn_msg_t *msg)
63 {
64         CDEBUG(mask, "0x%8.8x 0x%4.4x 0x%4.4x 0x%16.16llx"
65                 " 0x%16.16llx 0x%8.8x 0x%4.4x 0x%4.4x 0x%8.8x\n",
66                 msg->gnm_magic, msg->gnm_version,
67                 msg->gnm_type, msg->gnm_srcnid,
68                 msg->gnm_connstamp, msg->gnm_seq,
69                 msg->gnm_cksum, msg->gnm_payload_cksum,
70                 msg->gnm_payload_len);
71 }
72
73 void
74 kgnilnd_schedule_device(kgn_device_t *dev)
75 {
76         short         already_live = 0;
77
78         /* we'll only want to wake if the scheduler thread
79          * has come around and set ready to zero */
80         already_live = cmpxchg(&dev->gnd_ready, GNILND_DEV_IDLE, GNILND_DEV_IRQ);
81
82         if (!already_live) {
83                 wake_up_all(&dev->gnd_waitq);
84         }
85 }
86
87 void kgnilnd_schedule_device_timer(unsigned long arg)
88 {
89         kgn_device_t *dev = (kgn_device_t *) arg;
90
91         kgnilnd_schedule_device(dev);
92 }
93
94 void
95 kgnilnd_device_callback(__u32 devid, __u64 arg)
96 {
97         kgn_device_t *dev;
98         int           index = (int) arg;
99
100         if (index >= kgnilnd_data.kgn_ndevs) {
101                 /* use _EMERG instead of an LBUG to prevent LBUG'ing in
102                  * interrupt context. */
103                 LCONSOLE_EMERG("callback for unknown device %d->%d\n",
104                                 devid, index);
105                 return;
106         }
107
108         dev = &kgnilnd_data.kgn_devices[index];
109         /* just basic sanity */
110         if (dev->gnd_id == devid) {
111                 kgnilnd_schedule_device(dev);
112         } else {
113                 LCONSOLE_EMERG("callback for bad device %d devid %d\n",
114                                 dev->gnd_id, devid);
115         }
116 }
117
118 /* sched_intent values:
119  * < 0 : do not reschedule under any circumstances
120  * == 0: reschedule if someone marked him WANTS_SCHED
121  * > 0 : force a reschedule */
122 /* Return code 0 means it did not schedule the conn, 1
123  * means it successfully scheduled the conn.
124  */
125
126 int
127 kgnilnd_schedule_process_conn(kgn_conn_t *conn, int sched_intent)
128 {
129         int     conn_sched;
130
131         /* move back to IDLE but save previous state.
132          * if we see WANTS_SCHED, we'll call kgnilnd_schedule_conn and
133          * let the xchg there handle any racing callers to get it
134          * onto gnd_ready_conns */
135
136         conn_sched = xchg(&conn->gnc_scheduled, GNILND_CONN_IDLE);
137         LASSERTF(conn_sched == GNILND_CONN_WANTS_SCHED ||
138                  conn_sched == GNILND_CONN_PROCESS,
139                  "conn %p after process in bad state: %d\n",
140                  conn, conn_sched);
141
142         if (sched_intent >= 0) {
143                 if ((sched_intent > 0 || (conn_sched == GNILND_CONN_WANTS_SCHED))) {
144                         return kgnilnd_schedule_conn_refheld(conn, 1);
145                 }
146         }
147         return 0;
148 }
149
150 /* Return of 0 for conn not scheduled, 1 returned if conn was scheduled or marked
151  * as scheduled */
152
153 int
154 _kgnilnd_schedule_conn(kgn_conn_t *conn, const char *caller, int line, int refheld, int lock_held)
155 {
156         kgn_device_t        *dev = conn->gnc_device;
157         int                  sched;
158         int                  rc;
159
160         sched = xchg(&conn->gnc_scheduled, GNILND_CONN_WANTS_SCHED);
161         /* we only care about the last person who marked want_sched since they
162          * are most likely the culprit
163          */
164         memcpy(conn->gnc_sched_caller, caller, sizeof(conn->gnc_sched_caller));
165         conn->gnc_sched_line = line;
166         /* if we are IDLE, add to list - only one guy sees IDLE and "wins"
167          * the chance to put it onto gnd_ready_conns.
168          * otherwise, leave marked as WANTS_SCHED and the thread that "owns"
169          *  the conn in process_conns will take care of moving it back to
170          *  SCHED when it is done processing */
171
172         if (sched == GNILND_CONN_IDLE) {
173                 /* if the conn is already scheduled, we've already requested
174                  * the scheduler thread wakeup */
175                 if (!refheld) {
176                         /* Add a reference to the conn if we are not holding a reference
177                          * already from the exisiting scheduler. We now use the same
178                          * reference if we need to reschedule a conn while in a scheduler
179                          * thread.
180                          */
181                         kgnilnd_conn_addref(conn);
182                 }
183                 LASSERTF(list_empty(&conn->gnc_schedlist), "conn %p already sched state %d\n",
184                          conn, sched);
185
186                 CDEBUG(D_INFO, "scheduling conn 0x%p caller %s:%d\n", conn, caller, line);
187                 if (!lock_held)
188                         spin_lock(&dev->gnd_lock);
189                 list_add_tail(&conn->gnc_schedlist, &dev->gnd_ready_conns);
190                 if (!lock_held)
191                         spin_unlock(&dev->gnd_lock);
192                 set_mb(conn->gnc_last_sched_ask, jiffies);
193                 rc = 1;
194         } else {
195                 CDEBUG(D_INFO, "not scheduling conn 0x%p: %d caller %s:%d\n", conn, sched, caller, line);
196                 rc = 0;
197         }
198
199         /* make sure thread(s) going to process conns - but let it make
200          * separate decision from conn schedule */
201         if (!lock_held)
202                 kgnilnd_schedule_device(dev);
203         return rc;
204 }
205
206 int
207 _kgnilnd_schedule_delay_conn(kgn_conn_t *conn)
208 {
209         kgn_device_t    *dev = conn->gnc_device;
210         int rc = 0;
211         spin_lock(&dev->gnd_lock);
212         if (list_empty(&conn->gnc_delaylist)) {
213                 list_add_tail(&conn->gnc_delaylist, &dev->gnd_delay_conns);
214                 rc = 1;
215         }
216         spin_unlock(&dev->gnd_lock);
217
218         kgnilnd_schedule_device(dev);
219         return rc;
220 }
221
222 void
223 kgnilnd_schedule_dgram(kgn_device_t *dev)
224 {
225         int                  wake;
226
227         wake = xchg(&dev->gnd_dgram_ready, GNILND_DGRAM_SCHED);
228         if (wake != GNILND_DGRAM_SCHED)  {
229                 wake_up(&dev->gnd_dgram_waitq);
230         } else {
231                 CDEBUG(D_NETTRACE, "not waking: %d\n", wake);
232         }
233 }
234
235 void
236 kgnilnd_free_tx(kgn_tx_t *tx)
237 {
238         /* taken from kgnilnd_tx_add_state_locked */
239
240         LASSERTF((tx->tx_list_p == NULL &&
241                   tx->tx_list_state == GNILND_TX_ALLOCD) &&
242                 list_empty(&tx->tx_list),
243                 "tx %p with bad state %s (list_p %p) tx_list %s\n",
244                 tx, kgnilnd_tx_state2str(tx->tx_list_state), tx->tx_list_p,
245                 list_empty(&tx->tx_list) ? "empty" : "not empty");
246
247         atomic_dec(&kgnilnd_data.kgn_ntx);
248
249         /* we only allocate this if we need to */
250         if (tx->tx_phys != NULL) {
251                 kmem_cache_free(kgnilnd_data.kgn_tx_phys_cache, tx->tx_phys);
252                 CDEBUG(D_MALLOC, "slab-freed 'tx_phys': %lu at %p.\n",
253                        LNET_MAX_IOV * sizeof(gni_mem_segment_t), tx->tx_phys);
254         }
255
256         /* Only free the buffer if we used it */
257         if (tx->tx_buffer_copy != NULL) {
258                 kgnilnd_vfree(tx->tx_buffer_copy, tx->tx_rdma_desc.length);
259                 tx->tx_buffer_copy = NULL;
260                 CDEBUG(D_MALLOC, "vfreed buffer2\n");
261         }
262 #if 0
263         KGNILND_POISON(tx, 0x5a, sizeof(kgn_tx_t));
264 #endif
265         CDEBUG(D_MALLOC, "slab-freed 'tx': %lu at %p.\n", sizeof(*tx), tx);
266         kmem_cache_free(kgnilnd_data.kgn_tx_cache, tx);
267 }
268
269 kgn_tx_t *
270 kgnilnd_alloc_tx (void)
271 {
272         kgn_tx_t        *tx = NULL;
273
274         if (CFS_FAIL_CHECK(CFS_FAIL_GNI_ALLOC_TX))
275                 return tx;
276
277         tx = kmem_cache_alloc(kgnilnd_data.kgn_tx_cache, GFP_ATOMIC);
278         if (tx == NULL) {
279                 CERROR("failed to allocate tx\n");
280                 return NULL;
281         }
282         CDEBUG(D_MALLOC, "slab-alloced 'tx': %lu at %p.\n",
283                sizeof(*tx), tx);
284
285         /* need this memset, cache alloc'd memory is not cleared */
286         memset(tx, 0, sizeof(*tx));
287
288         /* setup everything here to minimize time under the lock */
289         tx->tx_buftype = GNILND_BUF_NONE;
290         tx->tx_msg.gnm_type = GNILND_MSG_NONE;
291         INIT_LIST_HEAD(&tx->tx_list);
292         INIT_LIST_HEAD(&tx->tx_map_list);
293         tx->tx_list_state = GNILND_TX_ALLOCD;
294
295         atomic_inc(&kgnilnd_data.kgn_ntx);
296
297         return tx;
298 }
299
300 /* csum_fold needs to be run on the return value before shipping over the wire */
301 #define _kgnilnd_cksum(seed, ptr, nob)  csum_partial(ptr, nob, seed)
302
303 /* we don't use offset as every one is passing a buffer reference that already
304  * includes the offset into the base address -
305  *  see kgnilnd_setup_virt_buffer and kgnilnd_setup_immediate_buffer */
306 static inline __u16
307 kgnilnd_cksum(void *ptr, size_t nob)
308 {
309         __u16   sum;
310
311         sum = csum_fold(_kgnilnd_cksum(0, ptr, nob));
312
313         /* don't use magic 'no checksum' value */
314         if (sum == 0)
315                 sum = 1;
316
317         CDEBUG(D_INFO, "cksum 0x%x for ptr 0x%p sz %zu\n",
318                sum, ptr, nob);
319
320         return sum;
321 }
322
323 __u16
324 kgnilnd_cksum_kiov(unsigned int nkiov, lnet_kiov_t *kiov,
325                     unsigned int offset, unsigned int nob, int dump_blob)
326 {
327         __wsum             cksum = 0;
328         __wsum             tmpck;
329         __u16              retsum;
330         void              *addr;
331         unsigned int       fraglen;
332         int                i, odd;
333
334         LASSERT(nkiov > 0);
335         LASSERT(nob > 0);
336
337         CDEBUG(D_BUFFS, "calc cksum for kiov 0x%p nkiov %u offset %u nob %u, dump %d\n",
338                kiov, nkiov, offset, nob, dump_blob);
339
340         /* if loops changes, please change kgnilnd_setup_phys_buffer */
341
342         while (offset >= kiov->kiov_len) {
343                 offset -= kiov->kiov_len;
344                 nkiov--;
345                 kiov++;
346                 LASSERT(nkiov > 0);
347         }
348
349         /* ignore nob here, if nob < (kiov_len - offset), kiov == 1 */
350         odd = (unsigned long) (kiov[0].kiov_len - offset) & 1;
351
352         if ((odd || *kgnilnd_tunables.kgn_vmap_cksum) && nkiov > 1) {
353                 struct page **pages = kgnilnd_data.kgn_cksum_map_pages[get_cpu()];
354
355                 LASSERTF(pages != NULL, "NULL pages for cpu %d map_pages 0x%p\n",
356                          get_cpu(), kgnilnd_data.kgn_cksum_map_pages);
357
358                 CDEBUG(D_BUFFS, "odd %d len %u offset %u nob %u\n",
359                        odd, kiov[0].kiov_len, offset, nob);
360
361                 for (i = 0; i < nkiov; i++) {
362                         pages[i] = kiov[i].kiov_page;
363                 }
364
365                 addr = vmap(pages, nkiov, VM_MAP, PAGE_KERNEL);
366                 if (addr == NULL) {
367                         CNETERR("Couldn't vmap %d frags on %d bytes to avoid odd length fragment in cksum\n",
368                                 nkiov, nob);
369                         /* return zero to avoid killing tx - we'll just get warning on console
370                          * when remote end sees zero checksum */
371                         RETURN(0);
372                 }
373                 atomic_inc(&kgnilnd_data.kgn_nvmap_cksum);
374
375                 tmpck = _kgnilnd_cksum(0, (void *) addr + kiov[0].kiov_offset + offset, nob);
376                 cksum = tmpck;
377
378                 if (dump_blob) {
379                         kgnilnd_dump_blob(D_BUFFS, "flat kiov RDMA payload",
380                                           (void *)addr + kiov[0].kiov_offset + offset, nob);
381                 }
382                 CDEBUG(D_BUFFS, "cksum 0x%x (+0x%x) for addr 0x%p+%u len %u offset %u\n",
383                        cksum, tmpck, addr, kiov[0].kiov_offset, nob, offset);
384                 vunmap(addr);
385         } else {
386                 do {
387                         fraglen = min(kiov->kiov_len - offset, nob);
388
389                         /* make dang sure we don't send a bogus checksum if somehow we get
390                          * an odd length fragment on anything but the last entry in a kiov  -
391                          * we know from kgnilnd_setup_rdma_buffer that we can't have non
392                          * PAGE_SIZE pages in the middle, so if nob < PAGE_SIZE, it is the last one */
393                         LASSERTF(!(fraglen&1) || (nob < PAGE_SIZE),
394                                  "odd fraglen %u on nkiov %d, nob %u kiov_len %u offset %u kiov 0x%p\n",
395                                  fraglen, nkiov, nob, kiov->kiov_len, offset, kiov);
396
397                         addr = (void *)kmap(kiov->kiov_page) + kiov->kiov_offset + offset;
398                         tmpck = _kgnilnd_cksum(cksum, addr, fraglen);
399
400                         CDEBUG(D_BUFFS,
401                                "cksum 0x%x (+0x%x) for page 0x%p+%u (0x%p) len %u offset %u\n",
402                                cksum, tmpck, kiov->kiov_page, kiov->kiov_offset, addr,
403                                fraglen, offset);
404
405                         cksum = tmpck;
406
407                         if (dump_blob)
408                                 kgnilnd_dump_blob(D_BUFFS, "kiov cksum", addr, fraglen);
409
410                         kunmap(kiov->kiov_page);
411
412                         kiov++;
413                         nkiov--;
414                         nob -= fraglen;
415                         offset = 0;
416
417                         /* iov must not run out before end of data */
418                         LASSERTF(nob == 0 || nkiov > 0, "nob %u nkiov %u\n", nob, nkiov);
419
420                 } while (nob > 0);
421         }
422
423         retsum = csum_fold(cksum);
424
425         /* don't use magic 'no checksum' value */
426         if (retsum == 0)
427                 retsum = 1;
428
429         CDEBUG(D_BUFFS, "retsum 0x%x from cksum 0x%x\n", retsum, cksum);
430
431         return retsum;
432 }
433
434 void
435 kgnilnd_init_msg(kgn_msg_t *msg, int type, lnet_nid_t source)
436 {
437         msg->gnm_magic = GNILND_MSG_MAGIC;
438         msg->gnm_version = GNILND_MSG_VERSION;
439         msg->gnm_type = type;
440         msg->gnm_payload_len = 0;
441         msg->gnm_srcnid = source;
442         /* gnm_connstamp gets set when FMA is sent */
443         /* gnm_srcnid is set on creation via function argument
444          * The right interface/net and nid is passed in when the message
445          * is created.
446          */
447 }
448
449 kgn_tx_t *
450 kgnilnd_new_tx_msg(int type, lnet_nid_t source)
451 {
452         kgn_tx_t *tx = kgnilnd_alloc_tx();
453
454         if (tx != NULL) {
455                 kgnilnd_init_msg(&tx->tx_msg, type, source);
456         } else {
457                 CERROR("couldn't allocate new tx type %s!\n",
458                        kgnilnd_msgtype2str(type));
459         }
460
461         return tx;
462 }
463
464 static void
465 kgnilnd_nak_rdma(kgn_conn_t *conn, int rx_type, int error, __u64 cookie, lnet_nid_t source) {
466         kgn_tx_t        *tx;
467
468         int             nak_type;
469
470         switch (rx_type) {
471         case GNILND_MSG_GET_REQ:
472         case GNILND_MSG_GET_DONE:
473                 nak_type = GNILND_MSG_GET_NAK;
474                 break;
475         case GNILND_MSG_PUT_REQ:
476         case GNILND_MSG_PUT_ACK:
477         case GNILND_MSG_PUT_DONE:
478                 nak_type = GNILND_MSG_PUT_NAK;
479                 break;
480         case GNILND_MSG_PUT_REQ_REV:
481         case GNILND_MSG_PUT_DONE_REV:
482                 nak_type = GNILND_MSG_PUT_NAK_REV;
483                 break;
484         case GNILND_MSG_GET_REQ_REV:
485         case GNILND_MSG_GET_ACK_REV:
486         case GNILND_MSG_GET_DONE_REV:
487                 nak_type = GNILND_MSG_GET_NAK_REV;
488                 break;
489         default:
490                 CERROR("invalid msg type %s (%d)\n",
491                         kgnilnd_msgtype2str(rx_type), rx_type);
492                 LBUG();
493         }
494         /* only allow NAK on error and truncate to zero */
495         LASSERTF(error <= 0, "error %d conn 0x%p, cookie %llu\n",
496                  error, conn, cookie);
497
498         tx = kgnilnd_new_tx_msg(nak_type, source);
499         if (tx == NULL) {
500                 CNETERR("can't get TX to NAK RDMA to %s\n",
501                         libcfs_nid2str(conn->gnc_peer->gnp_nid));
502                 return;
503         }
504
505         tx->tx_msg.gnm_u.completion.gncm_retval = error;
506         tx->tx_msg.gnm_u.completion.gncm_cookie = cookie;
507         kgnilnd_queue_tx(conn, tx);
508 }
509
510 int
511 kgnilnd_setup_immediate_buffer(kgn_tx_t *tx, unsigned int niov,
512                                struct kvec *iov, lnet_kiov_t *kiov,
513                                unsigned int offset, unsigned int nob)
514 {
515         kgn_msg_t       *msg = &tx->tx_msg;
516         int              i;
517
518         /* To help save on MDDs for short messages, we'll vmap a kiov to allow
519          * gni_smsg_send to send that as the payload */
520
521         LASSERT(tx->tx_buftype == GNILND_BUF_NONE);
522
523         if (nob == 0) {
524                 tx->tx_buffer = NULL;
525         } else if (kiov != NULL) {
526
527                 if ((niov > 0) && unlikely(niov > (nob/PAGE_SIZE))) {
528                         niov = ((nob + offset + kiov->kiov_offset + PAGE_SIZE - 1) /
529                                 PAGE_SIZE);
530                 }
531
532                 LASSERTF(niov > 0 && niov < GNILND_MAX_IMMEDIATE/PAGE_SIZE,
533                         "bad niov %d msg %p kiov %p iov %p offset %d nob%d\n",
534                         niov, msg, kiov, iov, offset, nob);
535
536                 while (offset >= kiov->kiov_len) {
537                         offset -= kiov->kiov_len;
538                         niov--;
539                         kiov++;
540                         LASSERT(niov > 0);
541                 }
542                 for (i = 0; i < niov; i++) {
543                         /* We can't have a kiov_offset on anything but the first entry,
544                          * otherwise we'll have a hole at the end of the mapping as we only map
545                          * whole pages.
546                          * Also, if we have a kiov_len < PAGE_SIZE but we need to map more
547                          * than kiov_len, we will also have a whole at the end of that page
548                          * which isn't allowed */
549                         if ((kiov[i].kiov_offset != 0 && i > 0) ||
550                             (kiov[i].kiov_offset + kiov[i].kiov_len != PAGE_SIZE && i < niov - 1)) {
551                                 CNETERR("Can't make payload contiguous in I/O VM:"
552                                        "page %d, offset %u, nob %u, kiov_offset %u kiov_len %u \n",
553                                        i, offset, nob, kiov->kiov_offset, kiov->kiov_len);
554                                 RETURN(-EINVAL);
555                         }
556                         tx->tx_imm_pages[i] = kiov[i].kiov_page;
557                 }
558
559                 /* hijack tx_phys for the later unmap */
560                 if (niov == 1) {
561                         /* tx->phyx being equal to NULL is the signal for unmap to discern between kmap and vmap */
562                         tx->tx_phys = NULL;
563                         tx->tx_buffer = (void *)kmap(tx->tx_imm_pages[0]) + kiov[0].kiov_offset + offset;
564                         atomic_inc(&kgnilnd_data.kgn_nkmap_short);
565                         GNIDBG_TX(D_NET, tx, "kmapped page for %d bytes for kiov 0x%p, buffer 0x%p",
566                                 nob, kiov, tx->tx_buffer);
567                 } else {
568                         tx->tx_phys = vmap(tx->tx_imm_pages, niov, VM_MAP, PAGE_KERNEL);
569                         if (tx->tx_phys == NULL) {
570                                 CNETERR("Couldn't vmap %d frags on %d bytes\n", niov, nob);
571                                 RETURN(-ENOMEM);
572
573                         }
574                         atomic_inc(&kgnilnd_data.kgn_nvmap_short);
575                         /* make sure we take into account the kiov offset as the start of the buffer */
576                         tx->tx_buffer = (void *)tx->tx_phys + kiov[0].kiov_offset + offset;
577                         GNIDBG_TX(D_NET, tx, "mapped %d pages for %d bytes from kiov 0x%p to 0x%p, buffer 0x%p",
578                                 niov, nob, kiov, tx->tx_phys, tx->tx_buffer);
579                 }
580                 tx->tx_buftype = GNILND_BUF_IMMEDIATE_KIOV;
581                 tx->tx_nob = nob;
582
583         } else {
584                 /* For now this is almost identical to kgnilnd_setup_virt_buffer, but we
585                  * could "flatten" the payload into a single contiguous buffer ready
586                  * for sending direct over an FMA if we ever needed to. */
587
588                 LASSERT(niov > 0);
589
590                 while (offset >= iov->iov_len) {
591                         offset -= iov->iov_len;
592                         niov--;
593                         iov++;
594                         LASSERT(niov > 0);
595                 }
596
597                 if (nob > iov->iov_len - offset) {
598                         CERROR("Can't handle multiple vaddr fragments\n");
599                         return -EMSGSIZE;
600                 }
601
602                 tx->tx_buffer = (void *)(((unsigned long)iov->iov_base) + offset);
603
604                 tx->tx_buftype = GNILND_BUF_IMMEDIATE;
605                 tx->tx_nob = nob;
606         }
607
608         /* checksum payload early - it shouldn't be changing after lnd_send */
609         if (*kgnilnd_tunables.kgn_checksum >= 2) {
610                 msg->gnm_payload_cksum = kgnilnd_cksum(tx->tx_buffer, nob);
611                 if (CFS_FAIL_CHECK(CFS_FAIL_GNI_SMSG_CKSUM2)) {
612                         msg->gnm_payload_cksum += 0xe00e;
613                 }
614                 if (*kgnilnd_tunables.kgn_checksum_dump > 1) {
615                         kgnilnd_dump_blob(D_BUFFS, "payload checksum",
616                                           tx->tx_buffer, nob);
617                 }
618         } else {
619                 msg->gnm_payload_cksum = 0;
620         }
621
622         return 0;
623 }
624
625 int
626 kgnilnd_setup_virt_buffer(kgn_tx_t *tx,
627                           unsigned int niov, struct kvec *iov,
628                           unsigned int offset, unsigned int nob)
629
630 {
631         LASSERT(nob > 0);
632         LASSERT(niov > 0);
633         LASSERT(tx->tx_buftype == GNILND_BUF_NONE);
634
635         while (offset >= iov->iov_len) {
636                 offset -= iov->iov_len;
637                 niov--;
638                 iov++;
639                 LASSERT(niov > 0);
640         }
641
642         if (nob > iov->iov_len - offset) {
643                 CERROR("Can't handle multiple vaddr fragments\n");
644                 return -EMSGSIZE;
645         }
646
647         tx->tx_buftype = GNILND_BUF_VIRT_UNMAPPED;
648         tx->tx_nob = nob;
649         tx->tx_buffer = (void *)(((unsigned long)iov->iov_base) + offset);
650         return 0;
651 }
652
653 int
654 kgnilnd_setup_phys_buffer(kgn_tx_t *tx, int nkiov, lnet_kiov_t *kiov,
655                           unsigned int offset, unsigned int nob)
656 {
657         gni_mem_segment_t *phys;
658         int             rc = 0;
659         unsigned int    fraglen;
660
661         GNIDBG_TX(D_NET, tx, "niov %d kiov 0x%p offset %u nob %u", nkiov, kiov, offset, nob);
662
663         LASSERT(nob > 0);
664         LASSERT(nkiov > 0);
665         LASSERT(tx->tx_buftype == GNILND_BUF_NONE);
666
667         /* only allocate this if we are going to use it */
668         tx->tx_phys = kmem_cache_alloc(kgnilnd_data.kgn_tx_phys_cache,
669                                               GFP_ATOMIC);
670         if (tx->tx_phys == NULL) {
671                 CERROR("failed to allocate tx_phys\n");
672                 rc = -ENOMEM;
673                 GOTO(error, rc);
674         }
675
676         CDEBUG(D_MALLOC, "slab-alloced 'tx->tx_phys': %lu at %p.\n",
677                LNET_MAX_IOV * sizeof(gni_mem_segment_t), tx->tx_phys);
678
679         /* if loops changes, please change kgnilnd_cksum_kiov
680          *   and kgnilnd_setup_immediate_buffer */
681
682         while (offset >= kiov->kiov_len) {
683                 offset -= kiov->kiov_len;
684                 nkiov--;
685                 kiov++;
686                 LASSERT(nkiov > 0);
687         }
688
689         /* at this point, kiov points to the first page that we'll actually map
690          * now that we've seeked into the koiv for offset and dropped any
691          * leading pages that fall entirely within the offset */
692         tx->tx_buftype = GNILND_BUF_PHYS_UNMAPPED;
693         tx->tx_nob = nob;
694
695         /* kiov_offset is start of 'valid' buffer, so index offset past that */
696         tx->tx_buffer = (void *)((unsigned long)(kiov->kiov_offset + offset));
697         phys = tx->tx_phys;
698
699         CDEBUG(D_NET, "tx 0x%p buffer 0x%p map start kiov 0x%p+%u niov %d offset %u\n",
700                tx, tx->tx_buffer, kiov, kiov->kiov_offset, nkiov, offset);
701
702         do {
703                 fraglen = min(kiov->kiov_len - offset, nob);
704
705                 /* We can't have a kiov_offset on anything but the first entry,
706                  * otherwise we'll have a hole at the end of the mapping as we only map
707                  * whole pages. Only the first page is allowed to have an offset -
708                  * we'll add that into tx->tx_buffer and that will get used when we
709                  * map in the segments (see kgnilnd_map_buffer).
710                  * Also, if we have a kiov_len < PAGE_SIZE but we need to map more
711                  * than kiov_len, we will also have a whole at the end of that page
712                  * which isn't allowed */
713                 if ((phys != tx->tx_phys) &&
714                     ((kiov->kiov_offset != 0) ||
715                      ((kiov->kiov_len < PAGE_SIZE) && (nob > kiov->kiov_len)))) {
716                         CERROR("Can't make payload contiguous in I/O VM:"
717                                "page %d, offset %u, nob %u, kiov_offset %u kiov_len %u \n",
718                                (int)(phys - tx->tx_phys),
719                                offset, nob, kiov->kiov_offset, kiov->kiov_len);
720                         rc = -EINVAL;
721                         GOTO(error, rc);
722                 }
723
724                 if ((phys - tx->tx_phys) == LNET_MAX_IOV) {
725                         CERROR ("payload too big (%d)\n", (int)(phys - tx->tx_phys));
726                         rc = -EMSGSIZE;
727                         GOTO(error, rc);
728                 }
729
730                 if (CFS_FAIL_CHECK(CFS_FAIL_GNI_PHYS_SETUP)) {
731                         rc = -EINVAL;
732                         GOTO(error, rc);
733                 }
734
735                 CDEBUG(D_BUFFS, "page 0x%p kiov_offset %u kiov_len %u nob %u "
736                                "nkiov %u offset %u\n",
737                       kiov->kiov_page, kiov->kiov_offset, kiov->kiov_len, nob, nkiov, offset);
738
739                 phys->address = page_to_phys(kiov->kiov_page);
740                 phys++;
741                 kiov++;
742                 nkiov--;
743                 nob -= fraglen;
744                 offset = 0;
745
746                 /* iov must not run out before end of data */
747                 LASSERTF(nob == 0 || nkiov > 0, "nob %u nkiov %u\n", nob, nkiov);
748
749         } while (nob > 0);
750
751         tx->tx_phys_npages = phys - tx->tx_phys;
752
753         return 0;
754
755 error:
756         if (tx->tx_phys != NULL) {
757                 kmem_cache_free(kgnilnd_data.kgn_tx_phys_cache, tx->tx_phys);
758                 CDEBUG(D_MALLOC, "slab-freed 'tx_phys': %lu at %p.\n",
759                        sizeof(*tx->tx_phys), tx->tx_phys);
760                 tx->tx_phys = NULL;
761         }
762         return rc;
763 }
764
765 static inline int
766 kgnilnd_setup_rdma_buffer(kgn_tx_t *tx, unsigned int niov,
767                           struct kvec *iov, lnet_kiov_t *kiov,
768                           unsigned int offset, unsigned int nob)
769 {
770         int     rc;
771
772         LASSERTF((iov == NULL) != (kiov == NULL), "iov 0x%p, kiov 0x%p, tx 0x%p,"
773                                                 " offset %d, nob %d, niov %d\n"
774                                                 , iov, kiov, tx, offset, nob, niov);
775
776         if (kiov != NULL) {
777                 rc = kgnilnd_setup_phys_buffer(tx, niov, kiov, offset, nob);
778         } else {
779                 rc = kgnilnd_setup_virt_buffer(tx, niov, iov, offset, nob);
780         }
781         return rc;
782 }
783
784 /* kgnilnd_parse_lnet_rdma()
785  * lntmsg - message passed in from lnet.
786  * niov, kiov, offset - see lnd_t in lib-types.h for descriptions.
787  * nob - actual number of bytes to in this message.
788  * put_len - It is possible for PUTs to have a different length than the
789  *           length stored in lntmsg->msg_len since LNET can adjust this
790  *           length based on it's buffer size and offset.
791  *           lnet_try_match_md() sets the mlength that we use to do the RDMA
792  *           transfer.
793  */
794 static void
795 kgnilnd_parse_lnet_rdma(struct lnet_msg *lntmsg, unsigned int *niov,
796                         unsigned int *offset, unsigned int *nob,
797                         lnet_kiov_t **kiov, int put_len)
798 {
799         /* GETs are weird, see kgnilnd_send */
800         if (lntmsg->msg_type == LNET_MSG_GET) {
801                 if ((lntmsg->msg_md->md_options & LNET_MD_KIOV) == 0) {
802                         *kiov = NULL;
803                 } else {
804                         *kiov = lntmsg->msg_md->md_iov.kiov;
805                 }
806                 *niov = lntmsg->msg_md->md_niov;
807                 *nob = lntmsg->msg_md->md_length;
808                 *offset = 0;
809         } else {
810                 *kiov = lntmsg->msg_kiov;
811                 *niov = lntmsg->msg_niov;
812                 *nob = put_len;
813                 *offset = lntmsg->msg_offset;
814         }
815 }
816
817 static inline void
818 kgnilnd_compute_rdma_cksum(kgn_tx_t *tx, int put_len)
819 {
820         unsigned int     niov, offset, nob;
821         lnet_kiov_t     *kiov;
822         struct lnet_msg      *lntmsg = tx->tx_lntmsg[0];
823         int              dump_cksum = (*kgnilnd_tunables.kgn_checksum_dump > 1);
824
825         GNITX_ASSERTF(tx, ((tx->tx_msg.gnm_type == GNILND_MSG_PUT_DONE) ||
826                            (tx->tx_msg.gnm_type == GNILND_MSG_GET_DONE) ||
827                            (tx->tx_msg.gnm_type == GNILND_MSG_PUT_DONE_REV) ||
828                            (tx->tx_msg.gnm_type == GNILND_MSG_GET_DONE_REV) ||
829                            (tx->tx_msg.gnm_type == GNILND_MSG_GET_ACK_REV) ||
830                            (tx->tx_msg.gnm_type == GNILND_MSG_PUT_REQ_REV)),
831                       "bad type %s", kgnilnd_msgtype2str(tx->tx_msg.gnm_type));
832
833         if ((tx->tx_msg.gnm_type == GNILND_MSG_PUT_DONE_REV) ||
834             (tx->tx_msg.gnm_type == GNILND_MSG_GET_DONE_REV)) {
835                 tx->tx_msg.gnm_payload_cksum = 0;
836                 return;
837         }
838         if (*kgnilnd_tunables.kgn_checksum < 3) {
839                 tx->tx_msg.gnm_payload_cksum = 0;
840                 return;
841         }
842
843         GNITX_ASSERTF(tx, lntmsg, "no LNet message!", NULL);
844
845         kgnilnd_parse_lnet_rdma(lntmsg, &niov, &offset, &nob, &kiov,
846                                 put_len);
847
848         if (kiov != NULL) {
849                 tx->tx_msg.gnm_payload_cksum = kgnilnd_cksum_kiov(niov, kiov, offset, nob, dump_cksum);
850         } else {
851                 tx->tx_msg.gnm_payload_cksum = kgnilnd_cksum(tx->tx_buffer, nob);
852                 if (dump_cksum) {
853                         kgnilnd_dump_blob(D_BUFFS, "peer RDMA payload", tx->tx_buffer, nob);
854                 }
855         }
856
857         if (CFS_FAIL_CHECK(CFS_FAIL_GNI_SMSG_CKSUM3)) {
858                 tx->tx_msg.gnm_payload_cksum += 0xd00d;
859         }
860 }
861
862 /* kgnilnd_verify_rdma_cksum()
863  * tx - PUT_DONE/GET_DONE matched tx.
864  * rx_cksum - received checksum to compare against.
865  * put_len - see kgnilnd_parse_lnet_rdma comments.
866  */
867 static inline int
868 kgnilnd_verify_rdma_cksum(kgn_tx_t *tx, __u16 rx_cksum, int put_len)
869 {
870         int              rc = 0;
871         __u16            cksum;
872         unsigned int     niov, offset, nob;
873         lnet_kiov_t     *kiov;
874         struct lnet_msg      *lntmsg = tx->tx_lntmsg[0];
875         int dump_on_err = *kgnilnd_tunables.kgn_checksum_dump;
876
877         /* we can only match certain requests */
878         GNITX_ASSERTF(tx, ((tx->tx_msg.gnm_type == GNILND_MSG_GET_REQ) ||
879                            (tx->tx_msg.gnm_type == GNILND_MSG_PUT_ACK) ||
880                            (tx->tx_msg.gnm_type == GNILND_MSG_PUT_REQ_REV) ||
881                            (tx->tx_msg.gnm_type == GNILND_MSG_GET_ACK_REV) ||
882                            (tx->tx_msg.gnm_type == GNILND_MSG_GET_DONE_REV) ||
883                            (tx->tx_msg.gnm_type == GNILND_MSG_PUT_DONE_REV)),
884                       "bad type %s", kgnilnd_msgtype2str(tx->tx_msg.gnm_type));
885
886         if ((tx->tx_msg.gnm_type == GNILND_MSG_PUT_REQ_REV) ||
887             (tx->tx_msg.gnm_type == GNILND_MSG_GET_ACK_REV)) {
888                 return 0;
889         }
890
891         if (rx_cksum == 0)  {
892                 if (*kgnilnd_tunables.kgn_checksum >= 3) {
893                         GNIDBG_MSG(D_WARNING, &tx->tx_msg,
894                                    "no RDMA payload checksum when enabled");
895                 }
896                 return 0;
897         }
898
899         GNITX_ASSERTF(tx, lntmsg, "no LNet message!", NULL);
900
901         kgnilnd_parse_lnet_rdma(lntmsg, &niov, &offset, &nob, &kiov, put_len);
902
903         if (kiov != NULL) {
904                 cksum = kgnilnd_cksum_kiov(niov, kiov, offset, nob, 0);
905         } else {
906                 cksum = kgnilnd_cksum(tx->tx_buffer, nob);
907         }
908
909         if (cksum != rx_cksum) {
910                 GNIDBG_MSG(D_NETERROR, &tx->tx_msg,
911                            "Bad RDMA payload checksum (%x expected %x); "
912                            "kiov 0x%p niov %d nob %u offset %u",
913                             cksum, rx_cksum, kiov, niov, nob, offset);
914                 switch (dump_on_err) {
915                 case 2:
916                         if (kiov != NULL) {
917                                 kgnilnd_cksum_kiov(niov, kiov, offset, nob, 1);
918                         } else {
919                                 kgnilnd_dump_blob(D_BUFFS, "RDMA payload",
920                                                   tx->tx_buffer, nob);
921                         }
922                         /* fall through to dump log */
923                 case 1:
924                         libcfs_debug_dumplog();
925                         break;
926                 default:
927                         break;
928                 }
929                 rc = -ENOKEY;
930                 /* kgnilnd_check_fma_rx will close conn, kill tx with error */
931         }
932         return rc;
933 }
934
935 void
936 kgnilnd_mem_add_map_list(kgn_device_t *dev, kgn_tx_t *tx)
937 {
938         int     bytes;
939
940         GNITX_ASSERTF(tx, list_empty(&tx->tx_map_list),
941                 "already mapped!", NULL);
942
943         spin_lock(&dev->gnd_map_lock);
944         switch (tx->tx_buftype) {
945         default:
946                 GNIDBG_TX(D_EMERG, tx,
947                         "SOFTWARE BUG: invalid mapping %d", tx->tx_buftype);
948                 spin_unlock(&dev->gnd_map_lock);
949                 LBUG();
950                 break;
951
952         case GNILND_BUF_PHYS_MAPPED:
953                 bytes = tx->tx_phys_npages * PAGE_SIZE;
954                 dev->gnd_map_nphys++;
955                 dev->gnd_map_physnop += tx->tx_phys_npages;
956                 break;
957
958         case GNILND_BUF_VIRT_MAPPED:
959                 bytes = tx->tx_nob;
960                 dev->gnd_map_nvirt++;
961                 dev->gnd_map_virtnob += tx->tx_nob;
962                 break;
963         }
964
965         if (tx->tx_msg.gnm_type == GNILND_MSG_PUT_ACK ||
966             tx->tx_msg.gnm_type == GNILND_MSG_GET_REQ) {
967                 atomic64_add(bytes, &dev->gnd_rdmaq_bytes_out);
968                 GNIDBG_TX(D_NETTRACE, tx, "rdma ++ %d to %lld",
969                           bytes, atomic64_read(&dev->gnd_rdmaq_bytes_out));
970         }
971
972         atomic_inc(&dev->gnd_n_mdd);
973         atomic64_add(bytes, &dev->gnd_nbytes_map);
974
975         /* clear retrans to prevent any SMSG goofiness as that code uses the same counter */
976         tx->tx_retrans = 0;
977
978         /* we only get here in the valid cases */
979         list_add_tail(&tx->tx_map_list, &dev->gnd_map_list);
980         dev->gnd_map_version++;
981         spin_unlock(&dev->gnd_map_lock);
982 }
983
984 void
985 kgnilnd_mem_del_map_list(kgn_device_t *dev, kgn_tx_t *tx)
986 {
987         int     bytes;
988
989         GNITX_ASSERTF(tx, !list_empty(&tx->tx_map_list),
990                 "not mapped!", NULL);
991         spin_lock(&dev->gnd_map_lock);
992
993         switch (tx->tx_buftype) {
994         default:
995                 GNIDBG_TX(D_EMERG, tx,
996                         "SOFTWARE BUG: invalid mapping %d", tx->tx_buftype);
997                 spin_unlock(&dev->gnd_map_lock);
998                 LBUG();
999                 break;
1000
1001         case GNILND_BUF_PHYS_UNMAPPED:
1002                 bytes = tx->tx_phys_npages * PAGE_SIZE;
1003                 dev->gnd_map_nphys--;
1004                 dev->gnd_map_physnop -= tx->tx_phys_npages;
1005                 break;
1006
1007         case GNILND_BUF_VIRT_UNMAPPED:
1008                 bytes = tx->tx_nob;
1009                 dev->gnd_map_nvirt--;
1010                 dev->gnd_map_virtnob -= tx->tx_nob;
1011                 break;
1012         }
1013
1014         if (tx->tx_msg.gnm_type == GNILND_MSG_PUT_ACK ||
1015             tx->tx_msg.gnm_type == GNILND_MSG_GET_REQ) {
1016                 atomic64_sub(bytes, &dev->gnd_rdmaq_bytes_out);
1017                 LASSERTF(atomic64_read(&dev->gnd_rdmaq_bytes_out) >= 0,
1018                          "bytes_out negative! %ld\n", atomic64_read(&dev->gnd_rdmaq_bytes_out));
1019                 GNIDBG_TX(D_NETTRACE, tx, "rdma -- %d to %lld",
1020                           bytes, atomic64_read(&dev->gnd_rdmaq_bytes_out));
1021         }
1022
1023         atomic_dec(&dev->gnd_n_mdd);
1024         atomic64_sub(bytes, &dev->gnd_nbytes_map);
1025
1026         /* we only get here in the valid cases */
1027         list_del_init(&tx->tx_map_list);
1028         dev->gnd_map_version++;
1029         spin_unlock(&dev->gnd_map_lock);
1030 }
1031
1032 int
1033 kgnilnd_map_buffer(kgn_tx_t *tx)
1034 {
1035         kgn_conn_t       *conn = tx->tx_conn;
1036         kgn_device_t     *dev = conn->gnc_device;
1037         __u32             flags = GNI_MEM_READWRITE;
1038         gni_return_t      rrc;
1039
1040         /* The kgnilnd_mem_register(_segments) Gemini Driver functions can
1041          * be called concurrently as there are internal locks that protect
1042          * any data structures or HW resources. We just need to ensure
1043          * that our concurrency doesn't result in the kgn_device_t
1044          * getting nuked while we are in here */
1045
1046         LASSERTF(conn != NULL, "tx %p with NULL conn, someone forgot"
1047                 " to set tx_conn before calling %s\n", tx, __FUNCTION__);
1048
1049         if (unlikely(CFS_FAIL_CHECK(CFS_FAIL_GNI_MAP_TX)))
1050                 RETURN(-ENOMEM);
1051
1052         if (*kgnilnd_tunables.kgn_bte_relaxed_ordering) {
1053                 flags |= GNI_MEM_RELAXED_PI_ORDERING;
1054         }
1055
1056         switch (tx->tx_buftype) {
1057         default:
1058                 LBUG();
1059
1060         case GNILND_BUF_NONE:
1061         case GNILND_BUF_IMMEDIATE:
1062         case GNILND_BUF_IMMEDIATE_KIOV:
1063         case GNILND_BUF_PHYS_MAPPED:
1064         case GNILND_BUF_VIRT_MAPPED:
1065                 return 0;
1066
1067         case GNILND_BUF_PHYS_UNMAPPED:
1068                 GNITX_ASSERTF(tx, tx->tx_phys != NULL, "physical buffer not there!", NULL);
1069                 rrc = kgnilnd_mem_register_segments(dev->gnd_handle,
1070                         tx->tx_phys, tx->tx_phys_npages, NULL,
1071                         GNI_MEM_PHYS_SEGMENTS | flags,
1072                         &tx->tx_map_key);
1073                 /* could race with other uses of the map counts, but this is ok
1074                  * - this needs to turn into a non-fatal error soon to allow
1075                  *  GART resource, etc starvation handling */
1076                 if (rrc != GNI_RC_SUCCESS) {
1077                         GNIDBG_TX(D_NET, tx, "Can't map %d pages: dev %d "
1078                                 "phys %u pp %u, virt %u nob %llu",
1079                                 tx->tx_phys_npages, dev->gnd_id,
1080                                 dev->gnd_map_nphys, dev->gnd_map_physnop,
1081                                 dev->gnd_map_nvirt, dev->gnd_map_virtnob);
1082                         RETURN(rrc == GNI_RC_ERROR_RESOURCE ? -ENOMEM : -EINVAL);
1083                 }
1084
1085                 tx->tx_buftype = GNILND_BUF_PHYS_MAPPED;
1086                 kgnilnd_mem_add_map_list(dev, tx);
1087                 return 0;
1088
1089         case GNILND_BUF_VIRT_UNMAPPED:
1090                 rrc = kgnilnd_mem_register(dev->gnd_handle,
1091                         (__u64)tx->tx_buffer, tx->tx_nob,
1092                         NULL, flags, &tx->tx_map_key);
1093                 if (rrc != GNI_RC_SUCCESS) {
1094                         GNIDBG_TX(D_NET, tx, "Can't map %u bytes: dev %d "
1095                                 "phys %u pp %u, virt %u nob %llu",
1096                                 tx->tx_nob, dev->gnd_id,
1097                                 dev->gnd_map_nphys, dev->gnd_map_physnop,
1098                                 dev->gnd_map_nvirt, dev->gnd_map_virtnob);
1099                         RETURN(rrc == GNI_RC_ERROR_RESOURCE ? -ENOMEM : -EINVAL);
1100                 }
1101
1102                 tx->tx_buftype = GNILND_BUF_VIRT_MAPPED;
1103                 kgnilnd_mem_add_map_list(dev, tx);
1104                 if (tx->tx_msg.gnm_type == GNILND_MSG_PUT_ACK ||
1105                     tx->tx_msg.gnm_type == GNILND_MSG_GET_REQ) {
1106                         atomic64_add(tx->tx_nob, &dev->gnd_rdmaq_bytes_out);
1107                         GNIDBG_TX(D_NETTRACE, tx, "rdma ++ %d to %ld\n",
1108                                tx->tx_nob, atomic64_read(&dev->gnd_rdmaq_bytes_out));
1109                 }
1110
1111                 return 0;
1112         }
1113 }
1114
1115 void
1116 kgnilnd_add_purgatory_tx(kgn_tx_t *tx)
1117 {
1118         kgn_conn_t              *conn = tx->tx_conn;
1119         kgn_mdd_purgatory_t     *gmp;
1120
1121         LIBCFS_ALLOC(gmp, sizeof(*gmp));
1122         LASSERTF(gmp != NULL, "couldn't allocate MDD purgatory member;"
1123                 " asserting to avoid data corruption\n");
1124         if (tx->tx_buffer_copy)
1125                 gmp->gmp_map_key = tx->tx_buffer_copy_map_key;
1126         else
1127                 gmp->gmp_map_key = tx->tx_map_key;
1128
1129         atomic_inc(&conn->gnc_device->gnd_n_mdd_held);
1130
1131         /* ensure that we don't have a blank purgatory - indicating the
1132          * conn is not already on purgatory lists - we'd never recover these
1133          * MDD if that were the case */
1134         GNITX_ASSERTF(tx, conn->gnc_in_purgatory,
1135                 "conn 0x%p->%s with NULL purgatory",
1136                 conn, libcfs_nid2str(conn->gnc_peer->gnp_nid));
1137
1138         /* link 'er up! - only place we really need to lock for
1139          * concurrent access */
1140         spin_lock(&conn->gnc_list_lock);
1141         list_add_tail(&gmp->gmp_list, &conn->gnc_mdd_list);
1142         spin_unlock(&conn->gnc_list_lock);
1143 }
1144
1145 void
1146 kgnilnd_unmap_buffer(kgn_tx_t *tx, int error)
1147 {
1148         kgn_device_t     *dev;
1149         gni_return_t      rrc;
1150         int               hold_timeout = 0;
1151
1152         /* code below relies on +1 relationship ... */
1153         BUILD_BUG_ON(GNILND_BUF_PHYS_MAPPED !=
1154                      (GNILND_BUF_PHYS_UNMAPPED + 1));
1155         BUILD_BUG_ON(GNILND_BUF_VIRT_MAPPED !=
1156                      (GNILND_BUF_VIRT_UNMAPPED + 1));
1157
1158         switch (tx->tx_buftype) {
1159         default:
1160                 LBUG();
1161
1162         case GNILND_BUF_NONE:
1163         case GNILND_BUF_IMMEDIATE:
1164         case GNILND_BUF_PHYS_UNMAPPED:
1165         case GNILND_BUF_VIRT_UNMAPPED:
1166                 break;
1167         case GNILND_BUF_IMMEDIATE_KIOV:
1168                 if (tx->tx_phys != NULL) {
1169                         vunmap(tx->tx_phys);
1170                 } else if (tx->tx_phys == NULL && tx->tx_buffer != NULL) {
1171                         kunmap(tx->tx_imm_pages[0]);
1172                 }
1173                 /* clear to prevent kgnilnd_free_tx from thinking
1174                  * this is a RDMA descriptor */
1175                 tx->tx_phys = NULL;
1176                 break;
1177
1178         case GNILND_BUF_PHYS_MAPPED:
1179         case GNILND_BUF_VIRT_MAPPED:
1180                 LASSERT(tx->tx_conn != NULL);
1181
1182                 dev = tx->tx_conn->gnc_device;
1183
1184                 /* only want to hold if we are closing conn without
1185                  * verified peer notification  - the theory is that
1186                  * a TX error can be communicated in all other cases */
1187                 if (tx->tx_conn->gnc_state != GNILND_CONN_ESTABLISHED &&
1188                     error != -GNILND_NOPURG &&
1189                     kgnilnd_check_purgatory_conn(tx->tx_conn)) {
1190                         kgnilnd_add_purgatory_tx(tx);
1191
1192                         /* The timeout we give to kgni is a deadman stop only.
1193                          *  we are setting high to ensure we don't have the kgni timer
1194                          *  fire before ours fires _and_ is handled */
1195                         hold_timeout = GNILND_TIMEOUT2DEADMAN;
1196
1197                         GNIDBG_TX(D_NET, tx,
1198                                  "dev %p delaying MDD release for %dms key %#llx.%#llx",
1199                                  tx->tx_conn->gnc_device, hold_timeout,
1200                                  tx->tx_map_key.qword1, tx->tx_map_key.qword2);
1201                 }
1202                 if (tx->tx_buffer_copy != NULL) {
1203                         rrc = kgnilnd_mem_deregister(dev->gnd_handle, &tx->tx_buffer_copy_map_key, hold_timeout);
1204                         LASSERTF(rrc == GNI_RC_SUCCESS, "rrc %d\n", rrc);
1205                         rrc = kgnilnd_mem_deregister(dev->gnd_handle, &tx->tx_map_key, 0);
1206                         LASSERTF(rrc == GNI_RC_SUCCESS, "rrc %d\n", rrc);
1207                 } else {
1208                         rrc = kgnilnd_mem_deregister(dev->gnd_handle, &tx->tx_map_key, hold_timeout);
1209                         LASSERTF(rrc == GNI_RC_SUCCESS, "rrc %d\n", rrc);
1210                 }
1211
1212                 tx->tx_buftype--;
1213                 kgnilnd_mem_del_map_list(dev, tx);
1214                 break;
1215         }
1216 }
1217
1218 void
1219 kgnilnd_tx_done(kgn_tx_t *tx, int completion)
1220 {
1221         struct lnet_msg      *lntmsg0, *lntmsg1;
1222         int             status0, status1;
1223         struct lnet_ni       *ni = NULL;
1224         kgn_conn_t      *conn = tx->tx_conn;
1225
1226         LASSERT(!in_interrupt());
1227
1228         lntmsg0 = tx->tx_lntmsg[0]; tx->tx_lntmsg[0] = NULL;
1229         lntmsg1 = tx->tx_lntmsg[1]; tx->tx_lntmsg[1] = NULL;
1230
1231         if (completion &&
1232             !(tx->tx_state & GNILND_TX_QUIET_ERROR) &&
1233             !kgnilnd_conn_clean_errno(completion)) {
1234                 GNIDBG_TOMSG(D_NETERROR, &tx->tx_msg,
1235                        "error %d on tx 0x%p->%s id %u/%d state %s age %ds",
1236                        completion, tx, conn ?
1237                        libcfs_nid2str(conn->gnc_peer->gnp_nid) : "<?>",
1238                        tx->tx_id.txe_smsg_id, tx->tx_id.txe_idx,
1239                        kgnilnd_tx_state2str(tx->tx_list_state),
1240                        cfs_duration_sec((unsigned long)jiffies - tx->tx_qtime));
1241         }
1242
1243         /* The error codes determine if we hold onto the MDD */
1244         kgnilnd_unmap_buffer(tx, completion);
1245
1246         /* we have to deliver a reply on lntmsg[1] for the GET, so make sure
1247          * we play nice with the error codes to avoid delivering a failed
1248          * REQUEST and then a REPLY event as well */
1249
1250         /* return -EIO to lnet - it is the magic value for failed sends */
1251         if (tx->tx_msg.gnm_type == GNILND_MSG_GET_REQ) {
1252                 status0 = 0;
1253                 status1 = completion;
1254         } else {
1255                 status0 = status1 = completion;
1256         }
1257
1258         tx->tx_buftype = GNILND_BUF_NONE;
1259         tx->tx_msg.gnm_type = GNILND_MSG_NONE;
1260
1261         /* lnet_finalize doesn't do anything with the *ni, so ok for us to
1262          * set NULL when we are a tx without a conn */
1263         if (conn != NULL) {
1264                 ni = conn->gnc_peer->gnp_net->gnn_ni;
1265
1266                 spin_lock(&conn->gnc_tx_lock);
1267
1268                 LASSERTF(test_and_clear_bit(tx->tx_id.txe_idx,
1269                         (volatile unsigned long *)&conn->gnc_tx_bits),
1270                         "conn %p tx %p bit %d already cleared\n",
1271                         conn, tx, tx->tx_id.txe_idx);
1272
1273                 LASSERTF(conn->gnc_tx_ref_table[tx->tx_id.txe_idx] != NULL,
1274                          "msg_id %d already NULL\n", tx->tx_id.txe_idx);
1275
1276                 conn->gnc_tx_ref_table[tx->tx_id.txe_idx] = NULL;
1277                 spin_unlock(&conn->gnc_tx_lock);
1278         }
1279
1280         kgnilnd_free_tx(tx);
1281
1282         /* finalize AFTER freeing lnet msgs */
1283
1284         /* warning - we should hold no locks here - calling lnet_finalize
1285          * could free up lnet credits, resulting in a call chain back into
1286          * the LND via kgnilnd_send and friends */
1287
1288         lnet_finalize(lntmsg0, status0);
1289
1290         if (lntmsg1 != NULL) {
1291                 lnet_finalize(lntmsg1, status1);
1292         }
1293 }
1294
1295 void
1296 kgnilnd_txlist_done(struct list_head *txlist, int error)
1297 {
1298         kgn_tx_t        *tx, *txn;
1299         int              err_printed = 0;
1300
1301         if (list_empty(txlist))
1302                 return;
1303
1304         list_for_each_entry_safe(tx, txn, txlist, tx_list) {
1305                 /* only print the first error */
1306                 if (err_printed)
1307                         tx->tx_state |= GNILND_TX_QUIET_ERROR;
1308                 list_del_init(&tx->tx_list);
1309                 kgnilnd_tx_done(tx, error);
1310                 err_printed++;
1311         }
1312 }
1313 int
1314 kgnilnd_set_tx_id(kgn_tx_t *tx, kgn_conn_t *conn)
1315 {
1316         int     id;
1317
1318         spin_lock(&conn->gnc_tx_lock);
1319
1320         /* ID zero is NOT ALLOWED!!! */
1321
1322 search_again:
1323         id = find_next_zero_bit((unsigned long *)&conn->gnc_tx_bits,
1324                                  GNILND_MAX_MSG_ID, conn->gnc_next_tx);
1325         if (id == GNILND_MAX_MSG_ID) {
1326                 if (conn->gnc_next_tx != 1) {
1327                         /* we only searched from next_tx to end and didn't find
1328                          * one, so search again from start */
1329                         conn->gnc_next_tx = 1;
1330                         goto search_again;
1331                 }
1332                 /* couldn't find one! */
1333                 spin_unlock(&conn->gnc_tx_lock);
1334                 return -E2BIG;
1335         }
1336
1337         /* bump next_tx to prevent immediate reuse */
1338         conn->gnc_next_tx = id + 1;
1339
1340         set_bit(id, (volatile unsigned long *)&conn->gnc_tx_bits);
1341         LASSERTF(conn->gnc_tx_ref_table[id] == NULL,
1342                  "tx 0x%p already at id %d\n",
1343                  conn->gnc_tx_ref_table[id], id);
1344
1345         /* delay these until we have a valid ID - prevents bad clear of the bit
1346          * in kgnilnd_tx_done */
1347         tx->tx_conn = conn;
1348         tx->tx_id.txe_cqid = conn->gnc_cqid;
1349
1350         tx->tx_id.txe_idx = id;
1351         conn->gnc_tx_ref_table[id] = tx;
1352
1353         /* Using jiffies to help differentiate against TX reuse - with
1354          * the usual minimum of a 250HZ clock, we wrap jiffies on the same TX
1355          * if we are sending to the same node faster than 256000/sec.
1356          * To help guard against this, we OR in the tx_seq - that is 32 bits */
1357
1358         tx->tx_id.txe_chips = (__u32)(jiffies | atomic_read(&conn->gnc_tx_seq));
1359
1360         GNIDBG_TX(D_NET, tx, "set cookie/id/bits", NULL);
1361
1362         spin_unlock(&conn->gnc_tx_lock);
1363         return 0;
1364 }
1365
1366 static inline void
1367 kgnilnd_tx_log_retrans(kgn_conn_t *conn, kgn_tx_t *tx)
1368 {
1369         int             log_retrans;
1370
1371         log_retrans = ((tx->tx_retrans < 25) || ((tx->tx_retrans % 25) == 0));
1372
1373         /* we don't care about TX timeout - it could be that the network is slower
1374          * or throttled. We'll keep retranmitting - so if the network is so slow
1375          * that we fill up our mailbox, we'll keep trying to resend that msg
1376          * until we exceed the max_retrans _or_ gnc_last_rx expires, indicating
1377          * that he hasn't send us any traffic in return */
1378         
1379         /* some reasonable throttling of the debug message */
1380         if (log_retrans) {
1381                 unsigned long now = jiffies;
1382                 /* XXX Nic: Mystical TX debug here... */
1383                 /* We expect retransmissions so only log when D_NET is enabled */
1384                 GNIDBG_SMSG_CREDS(D_NET, conn);
1385                 GNIDBG_TOMSG(D_NET, &tx->tx_msg,
1386                         "NOT_DONE on conn 0x%p->%s id %x retrans %d wait %dus"
1387                         " last_msg %uus/%uus last_cq %uus/%uus",
1388                         conn, libcfs_nid2str(conn->gnc_peer->gnp_nid),
1389                         tx->tx_id, tx->tx_retrans,
1390                         jiffies_to_usecs(now - tx->tx_cred_wait),
1391                         jiffies_to_usecs(now - conn->gnc_last_tx),
1392                         jiffies_to_usecs(now - conn->gnc_last_rx),
1393                         jiffies_to_usecs(now - conn->gnc_last_tx_cq),
1394                         jiffies_to_usecs(now - conn->gnc_last_rx_cq));
1395         }
1396 }
1397
1398 /* caller must be holding gnd_cq_mutex and not unlock it afterwards, as we need to drop it
1399  * to avoid bad ordering with state_lock */
1400
1401 static inline int
1402 kgnilnd_sendmsg_nolock(kgn_tx_t *tx, void *immediate, unsigned int immediatenob,
1403                 spinlock_t *state_lock, kgn_tx_list_state_t state)
1404 {
1405         kgn_conn_t      *conn = tx->tx_conn;
1406         kgn_msg_t       *msg = &tx->tx_msg;
1407         gni_return_t     rrc;
1408         unsigned long    newest_last_rx, timeout;
1409         unsigned long    now;
1410
1411         LASSERTF((msg->gnm_type == GNILND_MSG_IMMEDIATE) ?
1412                 immediatenob <= *kgnilnd_tunables.kgn_max_immediate :
1413                 immediatenob == 0,
1414                 "msg 0x%p type %d wrong payload size %d\n",
1415                 msg, msg->gnm_type, immediatenob);
1416
1417         /* make sure we catch all the cases where we'd send on a dirty old mbox
1418          * but allow case for sending CLOSE. Since this check is within the CQ
1419          * mutex barrier and the close message is only sent through
1420          * kgnilnd_send_conn_close the last message out the door will be the
1421          * close message.
1422          */
1423         if (atomic_read(&conn->gnc_peer->gnp_dirty_eps) != 0 && msg->gnm_type != GNILND_MSG_CLOSE) {
1424                 kgnilnd_conn_mutex_unlock(&conn->gnc_smsg_mutex);
1425                 kgnilnd_gl_mutex_unlock(&conn->gnc_device->gnd_cq_mutex);
1426                 /* Return -ETIME, we are closing the connection already so we dont want to
1427                  * have this tx hit the wire. The tx will be killed by the calling function.
1428                  * Once the EP is marked dirty the close message will be the last
1429                  * thing to hit the wire */
1430                 return -ETIME;
1431         }
1432
1433         now = jiffies;
1434         timeout = cfs_time_seconds(conn->gnc_timeout);
1435
1436         newest_last_rx = GNILND_LASTRX(conn);
1437
1438         if (CFS_FAIL_CHECK(CFS_FAIL_GNI_SEND_TIMEOUT)) {
1439                 now = now + (GNILND_TIMEOUTRX(timeout) * 2);
1440         }
1441
1442         if (time_after_eq(now, newest_last_rx + GNILND_TIMEOUTRX(timeout))) {
1443                 GNIDBG_CONN(D_NETERROR|D_CONSOLE, conn,
1444                             "Cant send to %s after timeout lapse of %lu; TO %lu\n",
1445                 libcfs_nid2str(conn->gnc_peer->gnp_nid),
1446                 cfs_duration_sec(now - newest_last_rx),
1447                 cfs_duration_sec(GNILND_TIMEOUTRX(timeout)));
1448                 kgnilnd_conn_mutex_unlock(&conn->gnc_smsg_mutex);
1449                 kgnilnd_gl_mutex_unlock(&conn->gnc_device->gnd_cq_mutex);
1450                 return -ETIME;
1451         }
1452
1453         GNITX_ASSERTF(tx, (conn != NULL) && (tx->tx_id.txe_idx != 0), "tx id unset!", NULL);
1454         /* msg->gnm_srcnid is set when the message is initialized by whatever function is
1455          * creating the message this allows the message to contain the correct LNET NID/NET needed
1456          * instead of the one that the peer/conn uses for sending the data.
1457          */
1458         msg->gnm_connstamp = conn->gnc_my_connstamp;
1459         msg->gnm_payload_len = immediatenob;
1460         msg->gnm_seq = atomic_read(&conn->gnc_tx_seq);
1461
1462         /* always init here - kgn_checksum is a /sys module tunable
1463          * and can be flipped at any point, even between msg init and sending */
1464         msg->gnm_cksum = 0;
1465         if (*kgnilnd_tunables.kgn_checksum) {
1466                 /* We must set here and not in kgnilnd_init_msg,
1467                  * we could resend this msg many times
1468                  * (NOT_DONE from gni_smsg_send below) and wouldn't pass
1469                  * through init_msg again */
1470                 msg->gnm_cksum = kgnilnd_cksum(msg, sizeof(kgn_msg_t));
1471                 if (CFS_FAIL_CHECK(CFS_FAIL_GNI_SMSG_CKSUM1)) {
1472                         msg->gnm_cksum += 0xf00f;
1473                 }
1474         }
1475
1476         GNIDBG_TOMSG(D_NET, msg, "tx 0x%p conn 0x%p->%s sending SMSG sz %u id %x/%d [%p for %u]",
1477                tx, conn, libcfs_nid2str(conn->gnc_peer->gnp_nid),
1478                sizeof(kgn_msg_t), tx->tx_id.txe_smsg_id,
1479                tx->tx_id.txe_idx, immediate, immediatenob);
1480
1481         if (unlikely(tx->tx_state & GNILND_TX_FAIL_SMSG)) {
1482                 rrc = cfs_fail_val ? cfs_fail_val : GNI_RC_NOT_DONE;
1483         } else {
1484                 rrc = kgnilnd_smsg_send(conn->gnc_ephandle,
1485                                         msg, sizeof(*msg), immediate,
1486                                         immediatenob,
1487                                         tx->tx_id.txe_smsg_id);
1488         }
1489
1490         switch (rrc) {
1491         case GNI_RC_SUCCESS:
1492                 atomic_inc(&conn->gnc_tx_seq);
1493                 conn->gnc_last_tx = jiffies;
1494                 /* no locking here as LIVE isn't a list */
1495                 kgnilnd_tx_add_state_locked(tx, NULL, conn, GNILND_TX_LIVE_FMAQ, 1);
1496
1497                 /* this needs to be checked under lock as it might be freed from a completion
1498                  * event.
1499                  */
1500                 if (msg->gnm_type == GNILND_MSG_NOOP) {
1501                         set_mb(conn->gnc_last_noop_sent, jiffies);
1502                 }
1503
1504                 /* serialize with seeing CQ events for completion on this, as well as
1505                  * tx_seq */
1506                 kgnilnd_conn_mutex_unlock(&conn->gnc_smsg_mutex);
1507                 kgnilnd_gl_mutex_unlock(&conn->gnc_device->gnd_cq_mutex);
1508
1509                 atomic_inc(&conn->gnc_device->gnd_short_ntx);
1510                 atomic64_add(immediatenob, &conn->gnc_device->gnd_short_txbytes);
1511                 kgnilnd_peer_alive(conn->gnc_peer);
1512                 GNIDBG_SMSG_CREDS(D_NET, conn);
1513                 return 0;
1514
1515         case GNI_RC_NOT_DONE:
1516                 /* Jshimek: We can get GNI_RC_NOT_DONE for 3 reasons currently
1517                  * 1: out of mbox credits
1518                  * 2: out of mbox payload credits
1519                  * 3: On Aries out of dla credits
1520                  */
1521                 kgnilnd_conn_mutex_unlock(&conn->gnc_smsg_mutex);
1522                 kgnilnd_gl_mutex_unlock(&conn->gnc_device->gnd_cq_mutex);
1523                 /* We'll handle this error inline - makes the calling logic much more
1524                  * clean */
1525
1526                 /* If no lock, caller doesn't want us to retry */
1527                 if (state_lock == NULL) {
1528                         return -EAGAIN;
1529                 }
1530
1531                 /* I need kgni credits to send this.  Replace tx at the head of the
1532                  * fmaq and I'll get rescheduled when credits appear. Reset the tx_state
1533                  * and bump retrans counts since we are requeueing the tx.
1534                  */
1535                 tx->tx_state = 0;
1536                 tx->tx_retrans++;
1537                 conn->gnc_tx_retrans++;
1538
1539                 kgnilnd_tx_log_retrans(conn, tx);
1540                 /* add to head of list for the state and retries */
1541                 spin_lock(state_lock);
1542                 kgnilnd_tx_add_state_locked(tx, conn->gnc_peer, conn, state, 0);
1543                 spin_unlock(state_lock);
1544
1545                 /* We only reschedule for a certain number of retries, then
1546                  * we will wait for the CQ events indicating a release of SMSG
1547                  * credits */
1548                 if (tx->tx_retrans < *kgnilnd_tunables.kgn_max_retransmits) {
1549                         kgnilnd_schedule_conn(conn);
1550                         return 0;
1551                 } else {
1552                         /* CQ event coming in signifies either TX completed or
1553                          * RX receive. Either of these *could* free up credits
1554                          * in the SMSG mbox and we should try sending again */
1555                         GNIDBG_TX(D_NET, tx, "waiting for CQID %u event to resend",
1556                                  tx->tx_conn->gnc_cqid);
1557                         kgnilnd_schedule_delay_conn(conn);
1558                         /* use +ve return code to let upper layers know they
1559                          * should stop looping on sends */
1560                         return EAGAIN;
1561                 }
1562         default:
1563                 /* handle bad retcode gracefully */
1564                 kgnilnd_conn_mutex_unlock(&conn->gnc_smsg_mutex);
1565                 kgnilnd_gl_mutex_unlock(&conn->gnc_device->gnd_cq_mutex);
1566                 return -EIO;
1567         }
1568 }
1569
1570 /* kgnilnd_sendmsg has hard wait on gnd_cq_mutex */
1571 static inline int
1572 kgnilnd_sendmsg(kgn_tx_t *tx, void *immediate, unsigned int immediatenob,
1573                 spinlock_t *state_lock, kgn_tx_list_state_t state)
1574 {
1575         kgn_device_t    *dev = tx->tx_conn->gnc_device;
1576         unsigned long    timestamp;
1577         int              rc;
1578
1579         timestamp = jiffies;
1580         kgnilnd_gl_mutex_lock(&dev->gnd_cq_mutex);
1581         kgnilnd_conn_mutex_lock(&tx->tx_conn->gnc_smsg_mutex);
1582         /* delay in jiffies - we are really concerned only with things that
1583          * result in a schedule() or really holding this off for long times .
1584          * NB - mutex_lock could spin for 2 jiffies before going to sleep to wait */
1585         dev->gnd_mutex_delay += (long) jiffies - timestamp;
1586
1587         rc = kgnilnd_sendmsg_nolock(tx, immediate, immediatenob, state_lock, state);
1588
1589         RETURN(rc);
1590 }
1591
1592
1593 /* returns -EAGAIN for lock miss, anything else < 0 is hard error, >=0 for success */
1594 static inline int
1595 kgnilnd_sendmsg_trylock(kgn_tx_t *tx, void *immediate, unsigned int immediatenob,
1596                 spinlock_t *state_lock, kgn_tx_list_state_t state)
1597 {
1598         kgn_conn_t      *conn = tx->tx_conn;
1599         kgn_device_t    *dev = conn->gnc_device;
1600         unsigned long    timestamp;
1601         int              rc;
1602
1603         timestamp = jiffies;
1604
1605         /* technically we are doing bad things with the read_lock on the peer_conn
1606          * table, but we shouldn't be sleeping inside here - and we don't sleep/block
1607          * for the mutex. I bet lockdep is gonna flag this one though... */
1608
1609         /* there are a few cases where we don't want the immediate send - like
1610          * when we are in the scheduler thread and it'd harm the latency of
1611          * getting messages up to LNet */
1612
1613         /* rmb for gnd_ready */
1614         smp_rmb();
1615         if (conn->gnc_device->gnd_ready == GNILND_DEV_LOOP) {
1616                 rc = 0;
1617                 atomic_inc(&conn->gnc_device->gnd_fast_block);
1618         } else if (unlikely(kgnilnd_data.kgn_quiesce_trigger)) {
1619                /* dont hit HW during quiesce */
1620                 rc = 0;
1621         } else if (unlikely(atomic_read(&conn->gnc_peer->gnp_dirty_eps))) {
1622                /* dont hit HW if stale EPs and conns left to close */
1623                 rc = 0;
1624         } else {
1625                 atomic_inc(&conn->gnc_device->gnd_fast_try);
1626                 rc = kgnilnd_trylock(&conn->gnc_device->gnd_cq_mutex,
1627                                      &conn->gnc_smsg_mutex);
1628         }
1629         if (!rc) {
1630                 rc = -EAGAIN;
1631         } else {
1632                 /* we got the mutex and weren't blocked */
1633
1634                 /* delay in jiffies - we are really concerned only with things that
1635                  * result in a schedule() or really holding this off for long times .
1636                  * NB - mutex_lock could spin for 2 jiffies before going to sleep to wait */
1637                 dev->gnd_mutex_delay += (long) jiffies - timestamp;
1638
1639                 atomic_inc(&conn->gnc_device->gnd_fast_ok);
1640                 tx->tx_qtime = jiffies;
1641                 tx->tx_state = GNILND_TX_WAITING_COMPLETION;
1642                 rc = kgnilnd_sendmsg_nolock(tx, tx->tx_buffer, tx->tx_nob, &conn->gnc_list_lock, GNILND_TX_FMAQ);
1643                 /* _nolock unlocks the mutex for us */
1644         }
1645
1646         RETURN(rc);
1647 }
1648
1649 /* lets us know if we can push this RDMA through now */
1650 static int
1651 kgnilnd_auth_rdma_bytes(kgn_device_t *dev, kgn_tx_t *tx)
1652 {
1653         long    bytes_left;
1654
1655         bytes_left = atomic64_sub_return(tx->tx_nob, &dev->gnd_rdmaq_bytes_ok);
1656
1657         if (bytes_left < 0) {
1658                 atomic64_add(tx->tx_nob, &dev->gnd_rdmaq_bytes_ok);
1659                 atomic_inc(&dev->gnd_rdmaq_nstalls);
1660                 smp_wmb();
1661
1662                 CDEBUG(D_NET, "no bytes to send, turning on timer for %lu\n",
1663                        dev->gnd_rdmaq_deadline);
1664                 mod_timer(&dev->gnd_rdmaq_timer, dev->gnd_rdmaq_deadline);
1665                 /* we never del this timer - at worst it schedules us.. */
1666                 return -EAGAIN;
1667         } else {
1668                 return 0;
1669         }
1670 }
1671
1672 /* this adds a TX to the queue pending throttling authorization before
1673  * we allow our remote peer to launch a PUT at us */
1674 void
1675 kgnilnd_queue_rdma(kgn_conn_t *conn, kgn_tx_t *tx)
1676 {
1677         int     rc;
1678
1679         /* we cannot go into send_mapped_tx from here as we are holding locks
1680          * and mem registration might end up allocating memory in kgni.
1681          * That said, we'll push this as far as we can into the queue process */
1682         rc = kgnilnd_auth_rdma_bytes(conn->gnc_device, tx);
1683
1684         if (rc < 0) {
1685                 spin_lock(&conn->gnc_device->gnd_rdmaq_lock);
1686                 kgnilnd_tx_add_state_locked(tx, NULL, conn, GNILND_TX_RDMAQ, 0);
1687                 /* lets us know how delayed RDMA is */
1688                 tx->tx_qtime = jiffies;
1689                 spin_unlock(&conn->gnc_device->gnd_rdmaq_lock);
1690         } else {
1691                 /* we have RDMA authorized, now it just needs a MDD and to hit the wire */
1692                 spin_lock(&tx->tx_conn->gnc_device->gnd_lock);
1693                 kgnilnd_tx_add_state_locked(tx, NULL, tx->tx_conn, GNILND_TX_MAPQ, 0);
1694                 /* lets us know how delayed mapping is */
1695                 tx->tx_qtime = jiffies;
1696                 spin_unlock(&tx->tx_conn->gnc_device->gnd_lock);
1697         }
1698
1699         /* make sure we wake up sched to run this */
1700         kgnilnd_schedule_device(tx->tx_conn->gnc_device);
1701 }
1702
1703 /* push TX through state machine */
1704 void
1705 kgnilnd_queue_tx(kgn_conn_t *conn, kgn_tx_t *tx)
1706 {
1707         int            rc = 0;
1708         int            add_tail = 1;
1709
1710         /* set the tx_id here, we delay it until we have an actual conn
1711          * to fiddle with
1712          * in some cases, the tx_id is already set to provide for things
1713          * like RDMA completion cookies, etc */
1714         if (tx->tx_id.txe_idx == 0) {
1715                 rc = kgnilnd_set_tx_id(tx, conn);
1716                 if (rc != 0) {
1717                         kgnilnd_tx_done(tx, rc);
1718                         return;
1719                 }
1720         }
1721
1722         CDEBUG(D_NET, "%s to conn %p for %s\n", kgnilnd_msgtype2str(tx->tx_msg.gnm_type),
1723                 conn, libcfs_nid2str(conn->gnc_peer->gnp_nid));
1724
1725         /* Only let NOOPs to be sent while fail loc is set, otherwise kill the tx.
1726          */
1727         if (CFS_FAIL_CHECK(CFS_FAIL_GNI_ONLY_NOOP) && (tx->tx_msg.gnm_type != GNILND_MSG_NOOP)) {
1728                 kgnilnd_tx_done(tx, rc);
1729                 return;
1730         }
1731
1732         switch (tx->tx_msg.gnm_type) {
1733         case GNILND_MSG_PUT_ACK:
1734         case GNILND_MSG_GET_REQ:
1735         case GNILND_MSG_PUT_REQ_REV:
1736         case GNILND_MSG_GET_ACK_REV:
1737                 /* hijacking time! If this messages will authorize our peer to
1738                  * send his dirty little bytes in an RDMA, we need to get permission */
1739                 kgnilnd_queue_rdma(conn, tx);
1740                 break;
1741         case GNILND_MSG_IMMEDIATE:
1742                 /* try to send right now, can help reduce latency */
1743                 rc = kgnilnd_sendmsg_trylock(tx, tx->tx_buffer, tx->tx_nob, &conn->gnc_list_lock, GNILND_TX_FMAQ);
1744
1745                 if (rc >= 0) {
1746                         /* it was sent, break out of switch to avoid default case of queueing */
1747                         break;
1748                 }
1749                 /* needs to queue to try again, so fall through to default case */
1750         case GNILND_MSG_NOOP:
1751                 /* Just make sure this goes out first for this conn */
1752                 add_tail = 0;
1753                 /* fall through... */
1754         default:
1755                 spin_lock(&conn->gnc_list_lock);
1756                 kgnilnd_tx_add_state_locked(tx, conn->gnc_peer, conn, GNILND_TX_FMAQ, add_tail);
1757                 tx->tx_qtime = jiffies;
1758                 spin_unlock(&conn->gnc_list_lock);
1759                 kgnilnd_schedule_conn(conn);
1760         }
1761 }
1762
1763 void
1764 kgnilnd_launch_tx(kgn_tx_t *tx, kgn_net_t *net, struct lnet_process_id *target)
1765 {
1766         kgn_peer_t      *peer;
1767         kgn_peer_t      *new_peer = NULL;
1768         kgn_conn_t      *conn = NULL;
1769         int              rc;
1770         int              node_state;
1771
1772         ENTRY;
1773
1774         /* If I get here, I've committed to send, so I complete the tx with
1775          * failure on any problems */
1776
1777         GNITX_ASSERTF(tx, tx->tx_conn == NULL,
1778                       "tx already has connection %p", tx->tx_conn);
1779
1780         /* do all of the peer & conn searching in one swoop - this avoids
1781          * nastiness when dropping locks and needing to maintain a sane state
1782          * in the face of stack reset or something else nuking peers & conns */
1783
1784         /* I expect to find him, so only take a read lock */
1785         read_lock(&kgnilnd_data.kgn_peer_conn_lock);
1786
1787         peer = kgnilnd_find_peer_locked(target->nid);
1788         if (peer != NULL) {
1789                 conn = kgnilnd_find_conn_locked(peer);
1790                 /* this could be NULL during quiesce */
1791                 if (conn != NULL)  {
1792                         /* Connection exists; queue message on it */
1793                         kgnilnd_queue_tx(conn, tx);
1794                         read_unlock(&kgnilnd_data.kgn_peer_conn_lock);
1795                         RETURN_EXIT;
1796                 }
1797
1798                 /* don't create a connection if the peer is marked down */
1799                 if (peer->gnp_state != GNILND_PEER_UP) {
1800                         read_unlock(&kgnilnd_data.kgn_peer_conn_lock);
1801                         rc = -ENETRESET;
1802                         GOTO(no_peer, rc);
1803                 }
1804         }
1805
1806         /* creating peer or conn; I'll need a write lock... */
1807         read_unlock(&kgnilnd_data.kgn_peer_conn_lock);
1808
1809         CFS_RACE(CFS_FAIL_GNI_FIND_TARGET);
1810
1811         node_state = kgnilnd_get_node_state(LNET_NIDADDR(target->nid));
1812
1813         /* NB - this will not block during normal operations -
1814          * the only writer of this is in the startup/shutdown path. */
1815         rc = down_read_trylock(&kgnilnd_data.kgn_net_rw_sem);
1816         if (!rc) {
1817                 rc = -ESHUTDOWN;
1818                 GOTO(no_peer, rc);
1819         }
1820
1821         /* ignore previous peer entirely - we cycled the lock, so we
1822          * will create new peer and at worst drop it if peer is still
1823          * in the tables */
1824         rc = kgnilnd_create_peer_safe(&new_peer, target->nid, net, node_state);
1825         if (rc != 0) {
1826                 up_read(&kgnilnd_data.kgn_net_rw_sem);
1827                 GOTO(no_peer, rc);
1828         }
1829
1830         write_lock(&kgnilnd_data.kgn_peer_conn_lock);
1831         up_read(&kgnilnd_data.kgn_net_rw_sem);
1832
1833         /* search for peer again now that we have the lock
1834          * if we don't find it, add our new one to the list */
1835         kgnilnd_add_peer_locked(target->nid, new_peer, &peer);
1836
1837         /* don't create a connection if the peer is not up */
1838         if (peer->gnp_state != GNILND_PEER_UP) {
1839                 write_unlock(&kgnilnd_data.kgn_peer_conn_lock);
1840                 rc = -ENETRESET;
1841                 GOTO(no_peer, rc);
1842         }
1843
1844         conn = kgnilnd_find_or_create_conn_locked(peer);
1845
1846         if (CFS_FAIL_CHECK(CFS_FAIL_GNI_DGRAM_DROP_TX)) {
1847                 write_unlock(&kgnilnd_data.kgn_peer_conn_lock);
1848                 GOTO(no_peer, rc);
1849         }
1850
1851         if (conn != NULL) {
1852                 /* oh hey, found a conn now... magical */
1853                 kgnilnd_queue_tx(conn, tx);
1854         } else {
1855                 /* no conn, must be trying to connect - so we queue for now */
1856                 tx->tx_qtime = jiffies;
1857                 kgnilnd_tx_add_state_locked(tx, peer, NULL, GNILND_TX_PEERQ, 1);
1858         }
1859         write_unlock(&kgnilnd_data.kgn_peer_conn_lock);
1860         RETURN_EXIT;
1861 no_peer:
1862         kgnilnd_tx_done(tx, rc);
1863         RETURN_EXIT;
1864 }
1865
1866 int
1867 kgnilnd_rdma(kgn_tx_t *tx, int type,
1868             kgn_rdma_desc_t *sink, unsigned int nob, __u64 cookie)
1869 {
1870         kgn_conn_t   *conn = tx->tx_conn;
1871         unsigned long timestamp;
1872         gni_post_type_t post_type;
1873         gni_return_t  rrc;
1874         int rc = 0;
1875         unsigned int desc_nob = nob;
1876         void *desc_buffer = tx->tx_buffer;
1877         gni_mem_handle_t desc_map_key = tx->tx_map_key;
1878         LASSERTF(kgnilnd_tx_mapped(tx),
1879                 "unmapped tx %p\n", tx);
1880         LASSERTF(conn != NULL,
1881                 "NULL conn on tx %p, naughty, naughty\n", tx);
1882         LASSERTF(nob <= sink->gnrd_nob,
1883                 "nob %u > sink->gnrd_nob %d (%p)\n",
1884                 nob, sink->gnrd_nob, sink);
1885         LASSERTF(nob <= tx->tx_nob,
1886                 "nob %d > tx(%p)->tx_nob %d\n",
1887                 nob, tx, tx->tx_nob);
1888
1889         switch (type) {
1890         case GNILND_MSG_GET_DONE:
1891         case GNILND_MSG_PUT_DONE:
1892                 post_type = GNI_POST_RDMA_PUT;
1893                 break;
1894         case GNILND_MSG_GET_DONE_REV:
1895         case GNILND_MSG_PUT_DONE_REV:
1896                 post_type = GNI_POST_RDMA_GET;
1897                 break;
1898         default:
1899                 CERROR("invalid msg type %s (%d)\n",
1900                         kgnilnd_msgtype2str(type), type);
1901                 LBUG();
1902         }
1903         if (post_type == GNI_POST_RDMA_GET) {
1904                 /* Check for remote buffer / local buffer / length alignment. All must be 4 byte
1905                  * aligned. If the local buffer is not aligned correctly using the copy buffer
1906                  * will fix that issue. If length is misaligned copy buffer will also fix the issue, we end
1907                  * up transferring extra bytes into the buffer but only copy the correct nob into the original
1908                  * buffer.  Remote offset correction is done through a combination of adjusting the offset,
1909                  * making sure the length and addr are aligned and copying the data into the correct location
1910                  * once the transfer has completed.
1911                  */
1912                 if ((((__u64)((unsigned long)tx->tx_buffer)) & 3) ||
1913                       (sink->gnrd_addr & 3) ||
1914                       (nob & 3)) {
1915
1916                         tx->tx_offset = ((__u64)((unsigned long)sink->gnrd_addr)) & 3;
1917                         if (tx->tx_offset)
1918                                 atomic_inc(&kgnilnd_data.kgn_rev_offset);
1919
1920                         if ((nob + tx->tx_offset) & 3) {
1921                                 desc_nob = ((nob + tx->tx_offset) + (4 - ((nob + tx->tx_offset) & 3)));
1922                                 atomic_inc(&kgnilnd_data.kgn_rev_length);
1923                         } else {
1924                                 desc_nob = (nob + tx->tx_offset);
1925                         }
1926
1927                         if (tx->tx_buffer_copy == NULL) {
1928                                 /* Allocate the largest copy buffer we will need, this will prevent us from overwriting data
1929                                  * and require at most we allocate a few extra bytes. */
1930                                 tx->tx_buffer_copy = kgnilnd_vzalloc(desc_nob);
1931
1932                                 if (!tx->tx_buffer_copy) {
1933                                         /* allocation of buffer failed nak the rdma */
1934                                         kgnilnd_nak_rdma(tx->tx_conn, tx->tx_msg.gnm_type, -EFAULT, cookie, tx->tx_msg.gnm_srcnid);
1935                                         kgnilnd_tx_done(tx, -EFAULT);
1936                                         return 0;
1937                                 }
1938                                 atomic_inc(&kgnilnd_data.kgn_rev_copy_buff);
1939                                 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);
1940                                 if (rc != GNI_RC_SUCCESS) {
1941                                         /* Registration Failed nak rdma and kill the tx. */
1942                                         kgnilnd_vfree(tx->tx_buffer_copy,
1943                                                       desc_nob);
1944                                         tx->tx_buffer_copy = NULL;
1945                                         kgnilnd_nak_rdma(tx->tx_conn, tx->tx_msg.gnm_type, -EFAULT, cookie, tx->tx_msg.gnm_srcnid);
1946                                         kgnilnd_tx_done(tx, -EFAULT);
1947                                         return 0;
1948                                 }
1949                         }
1950                         desc_map_key = tx->tx_buffer_copy_map_key;
1951                         desc_buffer = tx->tx_buffer_copy;
1952                 }
1953         }
1954
1955         memset(&tx->tx_rdma_desc, 0, sizeof(tx->tx_rdma_desc));
1956         tx->tx_rdma_desc.post_id = tx->tx_id.txe_cookie;
1957         tx->tx_rdma_desc.type = post_type;
1958         tx->tx_rdma_desc.cq_mode = GNI_CQMODE_GLOBAL_EVENT;
1959         tx->tx_rdma_desc.local_addr = (__u64)((unsigned long)desc_buffer);
1960         tx->tx_rdma_desc.local_mem_hndl = desc_map_key;
1961         tx->tx_rdma_desc.remote_addr = sink->gnrd_addr - tx->tx_offset;
1962         tx->tx_rdma_desc.remote_mem_hndl = sink->gnrd_key;
1963         tx->tx_rdma_desc.length = desc_nob;
1964         tx->tx_nob_rdma = nob;
1965         if (post_type == GNI_POST_RDMA_PUT && *kgnilnd_tunables.kgn_bte_put_dlvr_mode)
1966                 tx->tx_rdma_desc.dlvr_mode = *kgnilnd_tunables.kgn_bte_put_dlvr_mode;
1967         if (post_type == GNI_POST_RDMA_GET && *kgnilnd_tunables.kgn_bte_get_dlvr_mode)
1968                 tx->tx_rdma_desc.dlvr_mode = *kgnilnd_tunables.kgn_bte_get_dlvr_mode;
1969         /* prep final completion message */
1970         kgnilnd_init_msg(&tx->tx_msg, type, tx->tx_msg.gnm_srcnid);
1971         tx->tx_msg.gnm_u.completion.gncm_cookie = cookie;
1972         /* send actual size RDMA'd in retval */
1973         tx->tx_msg.gnm_u.completion.gncm_retval = nob;
1974
1975         kgnilnd_compute_rdma_cksum(tx, nob);
1976
1977         if (nob == 0) {
1978                 kgnilnd_queue_tx(conn, tx);
1979                 return 0;
1980         }
1981
1982         /* Don't lie (CLOSE == RDMA idle) */
1983         LASSERTF(!conn->gnc_close_sent, "tx %p on conn %p after close sent %d\n",
1984                  tx, conn, conn->gnc_close_sent);
1985
1986         GNIDBG_TX(D_NET, tx, "Post RDMA type 0x%02x conn %p dlvr_mode "
1987                 "0x%x cookie:%#llx",
1988                 type, conn, tx->tx_rdma_desc.dlvr_mode, cookie);
1989
1990         /* set CQ dedicated for RDMA */
1991         tx->tx_rdma_desc.src_cq_hndl = conn->gnc_device->gnd_snd_rdma_cqh;
1992
1993         timestamp = jiffies;
1994         kgnilnd_conn_mutex_lock(&conn->gnc_rdma_mutex);
1995         kgnilnd_gl_mutex_lock(&conn->gnc_device->gnd_cq_mutex);
1996         /* delay in jiffies - we are really concerned only with things that
1997          * result in a schedule() or really holding this off for long times .
1998          * NB - mutex_lock could spin for 2 jiffies before going to sleep to wait */
1999         conn->gnc_device->gnd_mutex_delay += (long) jiffies - timestamp;
2000
2001         rrc = kgnilnd_post_rdma(conn->gnc_ephandle, &tx->tx_rdma_desc);
2002
2003         if (rrc == GNI_RC_ERROR_RESOURCE) {
2004                 kgnilnd_conn_mutex_unlock(&conn->gnc_rdma_mutex);
2005                 kgnilnd_gl_mutex_unlock(&conn->gnc_device->gnd_cq_mutex);
2006                 kgnilnd_unmap_buffer(tx, 0);
2007
2008                 if (tx->tx_buffer_copy != NULL) {
2009                         kgnilnd_vfree(tx->tx_buffer_copy, desc_nob);
2010                         tx->tx_buffer_copy = NULL;
2011                 }
2012
2013                 spin_lock(&tx->tx_conn->gnc_device->gnd_lock);
2014                 kgnilnd_tx_add_state_locked(tx, NULL, tx->tx_conn,
2015                                             GNILND_TX_MAPQ, 0);
2016                 spin_unlock(&tx->tx_conn->gnc_device->gnd_lock);
2017                 kgnilnd_schedule_device(tx->tx_conn->gnc_device);
2018                 return -EAGAIN;
2019         }
2020
2021         spin_lock(&conn->gnc_list_lock);
2022         kgnilnd_tx_add_state_locked(tx, conn->gnc_peer, conn, GNILND_TX_LIVE_RDMAQ, 1);
2023         tx->tx_qtime = jiffies;
2024         spin_unlock(&conn->gnc_list_lock);
2025         kgnilnd_gl_mutex_unlock(&conn->gnc_device->gnd_cq_mutex);
2026         kgnilnd_conn_mutex_unlock(&conn->gnc_rdma_mutex);
2027
2028         /* XXX Nic: is this a place we should handle more errors for
2029          * robustness sake */
2030         LASSERT(rrc == GNI_RC_SUCCESS);
2031         return 0;
2032 }
2033
2034 kgn_rx_t *
2035 kgnilnd_alloc_rx(void)
2036 {
2037         kgn_rx_t        *rx;
2038
2039         rx = kmem_cache_alloc(kgnilnd_data.kgn_rx_cache, GFP_ATOMIC);
2040         if (rx == NULL) {
2041                 CERROR("failed to allocate rx\n");
2042                 return NULL;
2043         }
2044         CDEBUG(D_MALLOC, "slab-alloced 'rx': %lu at %p.\n",
2045                sizeof(*rx), rx);
2046
2047         /* no memset to zero, we'll always fill all members */
2048         return rx;
2049 }
2050
2051 /* release is to just free connection resources
2052  * we use this for the eager path after copying */
2053 void
2054 kgnilnd_release_msg(kgn_conn_t *conn)
2055 {
2056         gni_return_t    rrc;
2057         unsigned long   timestamp;
2058
2059         CDEBUG(D_NET, "consuming %p\n", conn);
2060
2061         timestamp = jiffies;
2062         kgnilnd_gl_mutex_lock(&conn->gnc_device->gnd_cq_mutex);
2063         /* delay in jiffies - we are really concerned only with things that
2064          * result in a schedule() or really holding this off for long times .
2065          * NB - mutex_lock could spin for 2 jiffies before going to sleep to wait */
2066         conn->gnc_device->gnd_mutex_delay += (long) jiffies - timestamp;
2067
2068         rrc = kgnilnd_smsg_release(conn->gnc_ephandle);
2069         kgnilnd_gl_mutex_unlock(&conn->gnc_device->gnd_cq_mutex);
2070
2071         LASSERTF(rrc == GNI_RC_SUCCESS, "bad rrc %d\n", rrc);
2072         GNIDBG_SMSG_CREDS(D_NET, conn);
2073
2074         kgnilnd_schedule_conn(conn);
2075 }
2076
2077 void
2078 kgnilnd_consume_rx(kgn_rx_t *rx)
2079 {
2080         kgn_conn_t      *conn = rx->grx_conn;
2081         kgn_msg_t       *rxmsg = rx->grx_msg;
2082
2083         /* if we are eager, free the cache alloc'd msg */
2084         if (unlikely(rx->grx_eager)) {
2085                 LIBCFS_FREE(rxmsg, sizeof(*rxmsg) + *kgnilnd_tunables.kgn_max_immediate);
2086                 atomic_dec(&kgnilnd_data.kgn_neager_allocs);
2087
2088                 /* release ref from eager_recv */
2089                 kgnilnd_conn_decref(conn);
2090         } else {
2091                 GNIDBG_MSG(D_NET, rxmsg, "rx %p processed", rx);
2092                 kgnilnd_release_msg(conn);
2093         }
2094
2095         kmem_cache_free(kgnilnd_data.kgn_rx_cache, rx);
2096         CDEBUG(D_MALLOC, "slab-freed 'rx': %lu at %p.\n",
2097                sizeof(*rx), rx);
2098 }
2099
2100 int
2101 kgnilnd_send(struct lnet_ni *ni, void *private, struct lnet_msg *lntmsg)
2102 {
2103         struct lnet_hdr  *hdr = &lntmsg->msg_hdr;
2104         int               type = lntmsg->msg_type;
2105         struct lnet_process_id target = lntmsg->msg_target;
2106         int               target_is_router = lntmsg->msg_target_is_router;
2107         int               routing = lntmsg->msg_routing;
2108         unsigned int      niov = lntmsg->msg_niov;
2109         struct kvec      *iov = lntmsg->msg_iov;
2110         lnet_kiov_t      *kiov = lntmsg->msg_kiov;
2111         unsigned int      offset = lntmsg->msg_offset;
2112         unsigned int      nob = lntmsg->msg_len;
2113         unsigned int      msg_vmflush = lntmsg->msg_vmflush;
2114         kgn_net_t        *net = ni->ni_data;
2115         kgn_tx_t         *tx;
2116         int               rc = 0;
2117         int               mpflag = 0;
2118         int               reverse_rdma_flag = *kgnilnd_tunables.kgn_reverse_rdma;
2119
2120         /* NB 'private' is different depending on what we're sending.... */
2121         LASSERT(!in_interrupt());
2122
2123         CDEBUG(D_NET, "sending msg type %d with %d bytes in %d frags to %s\n",
2124                type, nob, niov, libcfs_id2str(target));
2125
2126         LASSERTF(nob == 0 || niov > 0,
2127                 "lntmsg %p nob %d niov %d\n", lntmsg, nob, niov);
2128         LASSERTF(niov <= LNET_MAX_IOV,
2129                 "lntmsg %p niov %d\n", lntmsg, niov);
2130
2131         /* payload is either all vaddrs or all pages */
2132         LASSERTF(!(kiov != NULL && iov != NULL),
2133                 "lntmsg %p kiov %p iov %p\n", lntmsg, kiov, iov);
2134
2135         if (msg_vmflush)
2136                 mpflag = cfs_memory_pressure_get_and_set();
2137
2138         switch (type) {
2139         default:
2140                 CERROR("lntmsg %p with unexpected type %d\n",
2141                         lntmsg, type);
2142                 LBUG();
2143
2144         case LNET_MSG_ACK:
2145                 LASSERTF(nob == 0, "lntmsg %p nob %d\n",
2146                         lntmsg, nob);
2147                 break;
2148
2149         case LNET_MSG_GET:
2150                 LASSERT(niov == 0);
2151                 LASSERT(nob == 0);
2152
2153                 if (routing || target_is_router)
2154                         break;                  /* send IMMEDIATE */
2155
2156                 /* it is safe to do direct GET with out mapping buffer for RDMA as we
2157                  * check the eventual sink buffer here - if small enough, remote
2158                  * end is perfectly capable of returning data in short message -
2159                  * The magic is that we call lnet_parse in kgnilnd_recv with rdma_req=0
2160                  * for IMMEDIATE messages which will have it send a real reply instead
2161                  * of doing kgnilnd_recv to have the RDMA continued */
2162                 if (lntmsg->msg_md->md_length <= *kgnilnd_tunables.kgn_max_immediate)
2163                        break;
2164
2165                 if ((reverse_rdma_flag & GNILND_REVERSE_GET) == 0)
2166                         tx = kgnilnd_new_tx_msg(GNILND_MSG_GET_REQ, ni->ni_nid);
2167                 else
2168                         tx = kgnilnd_new_tx_msg(GNILND_MSG_GET_REQ_REV, ni->ni_nid);
2169
2170                 if (tx == NULL) {
2171                         rc = -ENOMEM;
2172                         goto out;
2173                 }
2174                 /* slightly different options as we might actually have a GET with a
2175                  * MD_KIOV set but a non-NULL md_iov.iov */
2176                 if ((lntmsg->msg_md->md_options & LNET_MD_KIOV) == 0)
2177                         rc = kgnilnd_setup_rdma_buffer(tx, lntmsg->msg_md->md_niov,
2178                                                       lntmsg->msg_md->md_iov.iov, NULL,
2179                                                       0, lntmsg->msg_md->md_length);
2180                 else
2181                         rc = kgnilnd_setup_rdma_buffer(tx, lntmsg->msg_md->md_niov,
2182                                                       NULL, lntmsg->msg_md->md_iov.kiov,
2183                                                       0, lntmsg->msg_md->md_length);
2184                 if (rc != 0) {
2185                         CERROR("unable to setup buffer: %d\n", rc);
2186                         kgnilnd_tx_done(tx, rc);
2187                         rc = -EIO;
2188                         goto out;
2189                 }
2190
2191                 tx->tx_lntmsg[1] = lnet_create_reply_msg(ni, lntmsg);
2192                 if (tx->tx_lntmsg[1] == NULL) {
2193                         CERROR("Can't create reply for GET to %s\n",
2194                                libcfs_nid2str(target.nid));
2195                         kgnilnd_tx_done(tx, rc);
2196                         rc = -EIO;
2197                         goto out;
2198                 }
2199
2200                 tx->tx_lntmsg[0] = lntmsg;
2201                 if ((reverse_rdma_flag & GNILND_REVERSE_GET) == 0)
2202                         tx->tx_msg.gnm_u.get.gngm_hdr = *hdr;
2203                 else
2204                         tx->tx_msg.gnm_u.putreq.gnprm_hdr = *hdr;
2205
2206                 /* rest of tx_msg is setup just before it is sent */
2207                 kgnilnd_launch_tx(tx, net, &target);
2208                 goto out;
2209         case LNET_MSG_REPLY:
2210         case LNET_MSG_PUT:
2211                 /* to save on MDDs, we'll handle short kiov by vmap'ing
2212                  * and sending via SMSG */
2213                 if (nob <= *kgnilnd_tunables.kgn_max_immediate)
2214                        break;
2215
2216                 if ((reverse_rdma_flag & GNILND_REVERSE_PUT) == 0)
2217                         tx = kgnilnd_new_tx_msg(GNILND_MSG_PUT_REQ, ni->ni_nid);
2218                 else
2219                         tx = kgnilnd_new_tx_msg(GNILND_MSG_PUT_REQ_REV, ni->ni_nid);
2220
2221                 if (tx == NULL) {
2222                         rc = -ENOMEM;
2223                         goto out;
2224                 }
2225
2226                 rc = kgnilnd_setup_rdma_buffer(tx, niov, iov, kiov, offset, nob);
2227                 if (rc != 0) {
2228                         kgnilnd_tx_done(tx, rc);
2229                         rc = -EIO;
2230                         goto out;
2231                 }
2232
2233                 tx->tx_lntmsg[0] = lntmsg;
2234                 if ((reverse_rdma_flag & GNILND_REVERSE_PUT) == 0)
2235                         tx->tx_msg.gnm_u.putreq.gnprm_hdr = *hdr;
2236                 else
2237                         tx->tx_msg.gnm_u.get.gngm_hdr = *hdr;
2238
2239                 /* rest of tx_msg is setup just before it is sent */
2240                 kgnilnd_launch_tx(tx, net, &target);
2241                 goto out;
2242         }
2243
2244         /* send IMMEDIATE */
2245
2246         LASSERTF(nob <= *kgnilnd_tunables.kgn_max_immediate,
2247                 "lntmsg 0x%p too large %d\n", lntmsg, nob);
2248
2249         tx = kgnilnd_new_tx_msg(GNILND_MSG_IMMEDIATE, ni->ni_nid);
2250         if (tx == NULL) {
2251                 rc = -ENOMEM;
2252                 goto out;
2253         }
2254
2255         rc = kgnilnd_setup_immediate_buffer(tx, niov, iov, kiov, offset, nob);
2256         if (rc != 0) {
2257                 kgnilnd_tx_done(tx, rc);
2258                 goto out;
2259         }
2260
2261         tx->tx_msg.gnm_u.immediate.gnim_hdr = *hdr;
2262         tx->tx_lntmsg[0] = lntmsg;
2263         kgnilnd_launch_tx(tx, net, &target);
2264
2265 out:
2266         /* use stored value as we could have already finalized lntmsg here from a failed launch */
2267         if (msg_vmflush)
2268                 cfs_memory_pressure_restore(mpflag);
2269         return rc;
2270 }
2271
2272 void
2273 kgnilnd_setup_rdma(struct lnet_ni *ni, kgn_rx_t *rx, struct lnet_msg *lntmsg, int mlen)
2274 {
2275         kgn_conn_t    *conn = rx->grx_conn;
2276         kgn_msg_t     *rxmsg = rx->grx_msg;
2277         unsigned int   niov = lntmsg->msg_niov;
2278         struct kvec   *iov = lntmsg->msg_iov;
2279         lnet_kiov_t   *kiov = lntmsg->msg_kiov;
2280         unsigned int   offset = lntmsg->msg_offset;
2281         unsigned int   nob = lntmsg->msg_len;
2282         int            done_type;
2283         kgn_tx_t      *tx;
2284         int            rc = 0;
2285
2286         switch (rxmsg->gnm_type) {
2287         case GNILND_MSG_PUT_REQ_REV:
2288                 done_type = GNILND_MSG_PUT_DONE_REV;
2289                 nob = mlen;
2290                 break;
2291         case GNILND_MSG_GET_REQ:
2292                 done_type = GNILND_MSG_GET_DONE;
2293                 break;
2294         default:
2295                 CERROR("invalid msg type %s (%d)\n",
2296                         kgnilnd_msgtype2str(rxmsg->gnm_type),
2297                         rxmsg->gnm_type);
2298                 LBUG();
2299         }
2300
2301         tx = kgnilnd_new_tx_msg(done_type, ni->ni_nid);
2302         if (tx == NULL)
2303                 goto failed_0;
2304
2305         rc = kgnilnd_set_tx_id(tx, conn);
2306         if (rc != 0)
2307                 goto failed_1;
2308
2309         rc = kgnilnd_setup_rdma_buffer(tx, niov, iov, kiov, offset, nob);
2310         if (rc != 0)
2311                 goto failed_1;
2312
2313         tx->tx_lntmsg[0] = lntmsg;
2314         tx->tx_getinfo = rxmsg->gnm_u.get;
2315
2316         /* we only queue from kgnilnd_recv - we might get called from other contexts
2317          * and we don't want to block the mutex in those cases */
2318
2319         spin_lock(&tx->tx_conn->gnc_device->gnd_lock);
2320         kgnilnd_tx_add_state_locked(tx, NULL, tx->tx_conn, GNILND_TX_MAPQ, 1);
2321         spin_unlock(&tx->tx_conn->gnc_device->gnd_lock);
2322         kgnilnd_schedule_device(tx->tx_conn->gnc_device);
2323
2324         return;
2325
2326  failed_1:
2327         kgnilnd_tx_done(tx, rc);
2328         kgnilnd_nak_rdma(conn, done_type, rc, rxmsg->gnm_u.get.gngm_cookie, ni->ni_nid);
2329  failed_0:
2330         lnet_finalize(lntmsg, rc);
2331 }
2332
2333 int
2334 kgnilnd_eager_recv(struct lnet_ni *ni, void *private, struct lnet_msg *lntmsg,
2335                    void **new_private)
2336 {
2337         kgn_rx_t        *rx = private;
2338         kgn_conn_t      *conn = rx->grx_conn;
2339         kgn_msg_t       *rxmsg = rx->grx_msg;
2340         kgn_msg_t       *eagermsg = NULL;
2341         kgn_peer_t      *peer = NULL;
2342         kgn_conn_t      *found_conn = NULL;
2343
2344         GNIDBG_MSG(D_NET, rxmsg, "eager recv for conn %p, rxmsg %p, lntmsg %p",
2345                 conn, rxmsg, lntmsg);
2346
2347         if (rxmsg->gnm_payload_len > *kgnilnd_tunables.kgn_max_immediate) {
2348                 GNIDBG_MSG(D_ERROR, rxmsg, "payload too large %d",
2349                         rxmsg->gnm_payload_len);
2350                 return -EPROTO;
2351         }
2352         /* Grab a read lock so the connection doesnt disappear on us
2353          * while we look it up
2354          */
2355         read_lock(&kgnilnd_data.kgn_peer_conn_lock);
2356
2357         peer = kgnilnd_find_peer_locked(rxmsg->gnm_srcnid);
2358         if (peer != NULL)
2359                 found_conn = kgnilnd_find_conn_locked(peer);
2360
2361
2362         /* Verify the connection found is the same one that the message
2363          * is supposed to be using, if it is not output an error message
2364          * and return.
2365          */
2366         if (!peer || !found_conn
2367             || found_conn->gnc_peer_connstamp != rxmsg->gnm_connstamp) {
2368                 read_unlock(&kgnilnd_data.kgn_peer_conn_lock);
2369                 CERROR("Couldnt find matching peer %p or conn %p / %p\n",
2370                         peer, conn, found_conn);
2371                 if (found_conn) {
2372                         CERROR("Unexpected connstamp %#llx(%#llx expected)"
2373                                 " from %s", rxmsg->gnm_connstamp,
2374                                 found_conn->gnc_peer_connstamp,
2375                                 libcfs_nid2str(peer->gnp_nid));
2376                 }
2377                 return -ENOTCONN;
2378         }
2379
2380         /* add conn ref to ensure it doesn't go away until all eager
2381          * messages processed */
2382         kgnilnd_conn_addref(conn);
2383
2384         /* Now that we have verified the connection is valid and added a
2385          * reference we can remove the read_lock on the peer_conn_lock */
2386         read_unlock(&kgnilnd_data.kgn_peer_conn_lock);
2387
2388         /* we have no credits or buffers for this message, so copy it
2389          * somewhere for a later kgnilnd_recv */
2390         if (atomic_read(&kgnilnd_data.kgn_neager_allocs) >=
2391                         *kgnilnd_tunables.kgn_eager_credits) {
2392                 CERROR("Out of eager credits to %s\n",
2393                         libcfs_nid2str(conn->gnc_peer->gnp_nid));
2394                 return -ENOMEM;
2395         }
2396
2397         atomic_inc(&kgnilnd_data.kgn_neager_allocs);
2398
2399         LIBCFS_ALLOC(eagermsg, sizeof(*eagermsg) + *kgnilnd_tunables.kgn_max_immediate);
2400         if (eagermsg == NULL) {
2401                 kgnilnd_conn_decref(conn);
2402                 CERROR("couldn't allocate eager rx message for conn %p to %s\n",
2403                         conn, libcfs_nid2str(conn->gnc_peer->gnp_nid));
2404                 return -ENOMEM;
2405         }
2406
2407         /* copy msg and payload */
2408         memcpy(eagermsg, rxmsg, sizeof(*rxmsg) + rxmsg->gnm_payload_len);
2409         rx->grx_msg = eagermsg;
2410         rx->grx_eager = 1;
2411
2412         /* stash this for lnet_finalize on cancel-on-conn-close */
2413         rx->grx_lntmsg = lntmsg;
2414
2415         /* keep the same rx_t, it just has a new grx_msg now */
2416         *new_private = private;
2417
2418         /* release SMSG buffer */
2419         kgnilnd_release_msg(conn);
2420
2421         return 0;
2422 }
2423
2424 int
2425 kgnilnd_recv(struct lnet_ni *ni, void *private, struct lnet_msg *lntmsg,
2426              int delayed, unsigned int niov,
2427              struct kvec *iov, lnet_kiov_t *kiov,
2428              unsigned int offset, unsigned int mlen, unsigned int rlen)
2429 {
2430         kgn_rx_t    *rx = private;
2431         kgn_conn_t  *conn = rx->grx_conn;
2432         kgn_msg_t   *rxmsg = rx->grx_msg;
2433         kgn_tx_t    *tx;
2434         int          rc = 0;
2435         __u32        pload_cksum;
2436         ENTRY;
2437
2438         LASSERT(!in_interrupt());
2439         LASSERTF(mlen <= rlen, "%d <= %d\n", mlen, rlen);
2440         /* Either all pages or all vaddrs */
2441         LASSERTF(!(kiov != NULL && iov != NULL), "kiov %p iov %p\n",
2442                 kiov, iov);
2443
2444         GNIDBG_MSG(D_NET, rxmsg, "conn %p, rxmsg %p, lntmsg %p"
2445                 " niov=%d kiov=%p iov=%p offset=%d mlen=%d rlen=%d",
2446                 conn, rxmsg, lntmsg,
2447                 niov, kiov, iov, offset, mlen, rlen);
2448
2449         /* we need to lock here as recv can be called from any context */
2450         read_lock(&kgnilnd_data.kgn_peer_conn_lock);
2451         if (rx->grx_eager && conn->gnc_state != GNILND_CONN_ESTABLISHED) {
2452                 read_unlock(&kgnilnd_data.kgn_peer_conn_lock);
2453
2454                 /* someone closed the conn after we copied this out, nuke it */
2455                 kgnilnd_consume_rx(rx);
2456                 lnet_finalize(lntmsg, conn->gnc_error);
2457                 RETURN(0);
2458         }
2459         read_unlock(&kgnilnd_data.kgn_peer_conn_lock);
2460
2461         switch (rxmsg->gnm_type) {
2462         default:
2463                 GNIDBG_MSG(D_NETERROR, rxmsg, "conn %p, rx %p, rxmsg %p, lntmsg %p"
2464                 " niov=%d kiov=%p iov=%p offset=%d mlen=%d rlen=%d",
2465                 conn, rx, rxmsg, lntmsg, niov, kiov, iov, offset, mlen, rlen);
2466                 LBUG();
2467
2468         case GNILND_MSG_IMMEDIATE:
2469                 if (mlen > rxmsg->gnm_payload_len) {
2470                         GNIDBG_MSG(D_ERROR, rxmsg,
2471                                 "Immediate message from %s too big: %d > %d",
2472                                 libcfs_nid2str(conn->gnc_peer->gnp_nid), mlen,
2473                                 rxmsg->gnm_payload_len);
2474                         rc = -EINVAL;
2475                         kgnilnd_consume_rx(rx);
2476                         RETURN(rc);
2477                 }
2478
2479                 /* rxmsg[1] is a pointer to the payload, sitting in the buffer
2480                  * right after the kgn_msg_t header - so just 'cute' way of saying
2481                  * rxmsg + sizeof(kgn_msg_t) */
2482
2483                 /* check payload checksum if sent */
2484
2485                 if (*kgnilnd_tunables.kgn_checksum >= 2 &&
2486                         !rxmsg->gnm_payload_cksum &&
2487                         rxmsg->gnm_payload_len != 0)
2488                         GNIDBG_MSG(D_WARNING, rxmsg, "no msg payload checksum when enabled");
2489
2490                 if (rxmsg->gnm_payload_cksum != 0) {
2491                         /* gnm_payload_len set in kgnilnd_sendmsg from tx->tx_nob,
2492                          * which is what is used to calculate the cksum on the TX side */
2493                         pload_cksum = kgnilnd_cksum(&rxmsg[1], rxmsg->gnm_payload_len);
2494
2495                         if (rxmsg->gnm_payload_cksum != pload_cksum) {
2496                                 GNIDBG_MSG(D_NETERROR, rxmsg,
2497                                            "Bad payload checksum (%x expected %x)",
2498                                             pload_cksum, rxmsg->gnm_payload_cksum);
2499                                 switch (*kgnilnd_tunables.kgn_checksum_dump) {
2500                                 case 2:
2501                                         kgnilnd_dump_blob(D_BUFFS, "bad payload checksum",
2502                                                           &rxmsg[1], rxmsg->gnm_payload_len);
2503                                         /* fall through to dump */
2504                                 case 1:
2505                                         libcfs_debug_dumplog();
2506                                         break;
2507                                 default:
2508                                         break;
2509                                 }
2510                                 rc = -ENOKEY;
2511                                 /* checksum problems are fatal, kill the conn */
2512                                 kgnilnd_consume_rx(rx);
2513                                 kgnilnd_close_conn(conn, rc);
2514                                 RETURN(rc);
2515                         }
2516                 }
2517
2518                 if (kiov != NULL)
2519                         lnet_copy_flat2kiov(
2520                                 niov, kiov, offset,
2521                                 *kgnilnd_tunables.kgn_max_immediate,
2522                                 &rxmsg[1], 0, mlen);
2523                 else
2524                         lnet_copy_flat2iov(
2525                                 niov, iov, offset,
2526                                 *kgnilnd_tunables.kgn_max_immediate,
2527                                 &rxmsg[1], 0, mlen);
2528
2529                 kgnilnd_consume_rx(rx);
2530                 lnet_finalize(lntmsg, 0);
2531                 RETURN(0);
2532
2533         case GNILND_MSG_PUT_REQ:
2534                 /* LNET wants to truncate or drop transaction, sending NAK */
2535                 if (mlen == 0) {
2536                         kgnilnd_consume_rx(rx);
2537                         lnet_finalize(lntmsg, 0);
2538
2539                         /* only error if lntmsg == NULL, otherwise we are just
2540                          * short circuiting the rdma process of 0 bytes */
2541                         kgnilnd_nak_rdma(conn, rxmsg->gnm_type,
2542                                         lntmsg == NULL ? -ENOENT : 0,
2543                                         rxmsg->gnm_u.get.gngm_cookie,
2544                                         ni->ni_nid);
2545                         RETURN(0);
2546                 }
2547                 /* sending ACK with sink buff. info */
2548                 tx = kgnilnd_new_tx_msg(GNILND_MSG_PUT_ACK, ni->ni_nid);
2549                 if (tx == NULL) {
2550                         kgnilnd_consume_rx(rx);
2551                         RETURN(-ENOMEM);
2552                 }
2553
2554                 rc = kgnilnd_set_tx_id(tx, conn);
2555                 if (rc != 0) {
2556                         GOTO(nak_put_req, rc);
2557                 }
2558
2559                 rc = kgnilnd_setup_rdma_buffer(tx, niov, iov, kiov, offset, mlen);
2560                 if (rc != 0) {
2561                         GOTO(nak_put_req, rc);
2562                 }
2563
2564                 tx->tx_msg.gnm_u.putack.gnpam_src_cookie =
2565                         rxmsg->gnm_u.putreq.gnprm_cookie;
2566                 tx->tx_msg.gnm_u.putack.gnpam_dst_cookie = tx->tx_id.txe_cookie;
2567                 tx->tx_msg.gnm_u.putack.gnpam_desc.gnrd_addr =
2568                         (__u64)((unsigned long)tx->tx_buffer);
2569                 tx->tx_msg.gnm_u.putack.gnpam_desc.gnrd_nob = mlen;
2570
2571                 tx->tx_lntmsg[0] = lntmsg; /* finalize this on RDMA_DONE */
2572                 tx->tx_qtime = jiffies;
2573                 /* we only queue from kgnilnd_recv - we might get called from other contexts
2574                  * and we don't want to block the mutex in those cases */
2575
2576                 spin_lock(&tx->tx_conn->gnc_device->gnd_lock);
2577                 kgnilnd_tx_add_state_locked(tx, NULL, tx->tx_conn, GNILND_TX_MAPQ, 1);
2578                 spin_unlock(&tx->tx_conn->gnc_device->gnd_lock);
2579                 kgnilnd_schedule_device(tx->tx_conn->gnc_device);
2580
2581                 kgnilnd_consume_rx(rx);
2582                 RETURN(0);
2583
2584 nak_put_req:
2585                 /* make sure we send an error back when the PUT fails */
2586                 kgnilnd_nak_rdma(conn, rxmsg->gnm_type, rc, rxmsg->gnm_u.get.gngm_cookie, ni->ni_nid);
2587                 kgnilnd_tx_done(tx, rc);
2588                 kgnilnd_consume_rx(rx);
2589
2590                 /* return magic LNet network error */
2591                 RETURN(-EIO);
2592         case GNILND_MSG_GET_REQ_REV:
2593                 /* LNET wants to truncate or drop transaction, sending NAK */
2594                 if (mlen == 0) {
2595                         kgnilnd_consume_rx(rx);
2596                         lnet_finalize(lntmsg, 0);
2597
2598                         /* only error if lntmsg == NULL, otherwise we are just
2599                          * short circuiting the rdma process of 0 bytes */
2600                         kgnilnd_nak_rdma(conn, rxmsg->gnm_type,
2601                                         lntmsg == NULL ? -ENOENT : 0,
2602                                         rxmsg->gnm_u.get.gngm_cookie,
2603                                         ni->ni_nid);
2604                         RETURN(0);
2605                 }
2606                 /* lntmsg can be null when parsing a LNET_GET */
2607                 if (lntmsg != NULL) {
2608                         /* sending ACK with sink buff. info */
2609                         tx = kgnilnd_new_tx_msg(GNILND_MSG_GET_ACK_REV, ni->ni_nid);
2610                         if (tx == NULL) {
2611                                 kgnilnd_consume_rx(rx);
2612                                 RETURN(-ENOMEM);
2613                         }
2614
2615                         rc = kgnilnd_set_tx_id(tx, conn);
2616                         if (rc != 0)
2617                                 GOTO(nak_get_req_rev, rc);
2618
2619
2620                         rc = kgnilnd_setup_rdma_buffer(tx, niov, iov, kiov, offset, mlen);
2621                         if (rc != 0)
2622                                 GOTO(nak_get_req_rev, rc);
2623
2624
2625                         tx->tx_msg.gnm_u.putack.gnpam_src_cookie =
2626                                 rxmsg->gnm_u.putreq.gnprm_cookie;
2627                         tx->tx_msg.gnm_u.putack.gnpam_dst_cookie = tx->tx_id.txe_cookie;
2628                         tx->tx_msg.gnm_u.putack.gnpam_desc.gnrd_addr =
2629                                 (__u64)((unsigned long)tx->tx_buffer);
2630                         tx->tx_msg.gnm_u.putack.gnpam_desc.gnrd_nob = mlen;
2631
2632                         tx->tx_lntmsg[0] = lntmsg; /* finalize this on RDMA_DONE */
2633
2634                         /* we only queue from kgnilnd_recv - we might get called from other contexts
2635                          * and we don't want to block the mutex in those cases */
2636
2637                         spin_lock(&tx->tx_conn->gnc_device->gnd_lock);
2638                         kgnilnd_tx_add_state_locked(tx, NULL, tx->tx_conn, GNILND_TX_MAPQ, 1);
2639                         spin_unlock(&tx->tx_conn->gnc_device->gnd_lock);
2640                         kgnilnd_schedule_device(tx->tx_conn->gnc_device);
2641                 } else {
2642                         /* No match */
2643                         kgnilnd_nak_rdma(conn, rxmsg->gnm_type,
2644                                         -ENOENT,
2645                                         rxmsg->gnm_u.get.gngm_cookie,
2646                                         ni->ni_nid);
2647                 }
2648
2649                 kgnilnd_consume_rx(rx);
2650                 RETURN(0);
2651
2652 nak_get_req_rev:
2653                 /* make sure we send an error back when the GET fails */
2654                 kgnilnd_nak_rdma(conn, rxmsg->gnm_type, rc, rxmsg->gnm_u.get.gngm_cookie, ni->ni_nid);
2655                 kgnilnd_tx_done(tx, rc);
2656                 kgnilnd_consume_rx(rx);
2657
2658                 /* return magic LNet network error */
2659                 RETURN(-EIO);
2660
2661
2662         case GNILND_MSG_PUT_REQ_REV:
2663                 /* LNET wants to truncate or drop transaction, sending NAK */
2664                 if (mlen == 0) {
2665                         kgnilnd_consume_rx(rx);
2666                         lnet_finalize(lntmsg, 0);
2667
2668                         /* only error if lntmsg == NULL, otherwise we are just
2669                          * short circuiting the rdma process of 0 bytes */
2670                         kgnilnd_nak_rdma(conn, rxmsg->gnm_type,
2671                                         lntmsg == NULL ? -ENOENT : 0,
2672                                         rxmsg->gnm_u.get.gngm_cookie,
2673                                         ni->ni_nid);
2674                         RETURN(0);
2675                 }
2676
2677                 if (lntmsg != NULL) {
2678                         /* Matched! */
2679                         kgnilnd_setup_rdma(ni, rx, lntmsg, mlen);
2680                 } else {
2681                         /* No match */
2682                         kgnilnd_nak_rdma(conn, rxmsg->gnm_type,
2683                                         -ENOENT,
2684                                         rxmsg->gnm_u.get.gngm_cookie,
2685                                         ni->ni_nid);
2686                 }
2687                 kgnilnd_consume_rx(rx);
2688                 RETURN(0);
2689         case GNILND_MSG_GET_REQ:
2690                 if (lntmsg != NULL) {
2691                         /* Matched! */
2692                         kgnilnd_setup_rdma(ni, rx, lntmsg, mlen);
2693                 } else {
2694                         /* No match */
2695                         kgnilnd_nak_rdma(conn, rxmsg->gnm_type,
2696                                         -ENOENT,
2697                                         rxmsg->gnm_u.get.gngm_cookie,
2698                                         ni->ni_nid);
2699                 }
2700                 kgnilnd_consume_rx(rx);
2701                 RETURN(0);
2702         }
2703         RETURN(0);
2704 }
2705
2706 /* needs write_lock on kgn_peer_conn_lock held */
2707 int
2708 kgnilnd_check_conn_timeouts_locked(kgn_conn_t *conn)
2709 {
2710         unsigned long      timeout, keepalive;
2711         unsigned long      now = jiffies;
2712         unsigned long      newest_last_rx;
2713         kgn_tx_t          *tx;
2714
2715         /* given that we found this conn hanging off a peer, it better damned
2716          * well be connected */
2717         LASSERTF(conn->gnc_state == GNILND_CONN_ESTABLISHED,
2718                  "conn 0x%p->%s with bad state%s\n", conn,
2719                  conn->gnc_peer ? libcfs_nid2str(conn->gnc_peer->gnp_nid)
2720                                : "<?>",
2721                  kgnilnd_conn_state2str(conn));
2722
2723         CDEBUG(D_NET, "checking conn %p->%s timeout %d keepalive %d "
2724                       "rx_diff %lu tx_diff %lu\n",
2725                 conn, libcfs_nid2str(conn->gnc_peer->gnp_nid),
2726                 conn->gnc_timeout, GNILND_TO2KA(conn->gnc_timeout),
2727                 cfs_duration_sec(now - conn->gnc_last_rx_cq),
2728                 cfs_duration_sec(now - conn->gnc_last_tx));
2729
2730         timeout = cfs_time_seconds(conn->gnc_timeout);
2731         keepalive = cfs_time_seconds(GNILND_TO2KA(conn->gnc_timeout));
2732
2733         /* just in case our lack of RX msg processing is gumming up the works - give the
2734          * remove an extra chance */
2735
2736         newest_last_rx = GNILND_LASTRX(conn);
2737
2738         if (time_after_eq(now, newest_last_rx + timeout)) {
2739                 uint32_t level = D_CONSOLE|D_NETERROR;
2740
2741                 if (conn->gnc_peer->gnp_state == GNILND_PEER_DOWN) {
2742                         level = D_NET;
2743                 }
2744                         GNIDBG_CONN(level, conn,
2745                         "No gnilnd traffic received from %s for %lu "
2746                         "seconds, terminating connection. Is node down? ",
2747                         libcfs_nid2str(conn->gnc_peer->gnp_nid),
2748                         cfs_duration_sec(now - newest_last_rx));
2749                 return -ETIMEDOUT;
2750         }
2751
2752         /* we don't timeout on last_tx stalls - we are going to trust the
2753          * underlying network to let us know when sends are failing.
2754          * At worst, the peer will timeout our RX stamp and drop the connection
2755          * at that point. We'll then see his CLOSE or at worst his RX
2756          * stamp stop and drop the connection on our end */
2757
2758         if (time_after_eq(now, conn->gnc_last_tx + keepalive)) {
2759                 CDEBUG(D_NET, "sending NOOP -> %s (%p idle %lu(%lu)) "
2760                        "last %lu/%lu/%lu %lus/%lus/%lus\n",
2761                        libcfs_nid2str(conn->gnc_peer->gnp_nid), conn,
2762                        cfs_duration_sec(jiffies - conn->gnc_last_tx),
2763                        keepalive,
2764                        conn->gnc_last_noop_want, conn->gnc_last_noop_sent,
2765                        conn->gnc_last_noop_cq,
2766                        cfs_duration_sec(jiffies - conn->gnc_last_noop_want),
2767                        cfs_duration_sec(jiffies - conn->gnc_last_noop_sent),
2768                        cfs_duration_sec(jiffies - conn->gnc_last_noop_cq));
2769                 set_mb(conn->gnc_last_noop_want, jiffies);
2770                 atomic_inc(&conn->gnc_reaper_noop);
2771                 if (CFS_FAIL_CHECK(CFS_FAIL_GNI_NOOP_SEND))
2772                         return 0;
2773
2774                 tx = kgnilnd_new_tx_msg(GNILND_MSG_NOOP, conn->gnc_peer->gnp_net->gnn_ni->ni_nid);
2775                 if (tx == NULL)
2776                         return 0;
2777                 kgnilnd_queue_tx(conn, tx);
2778         }
2779
2780         return 0;
2781 }
2782
2783 /* needs write_lock on kgn_peer_conn_lock held */
2784 void
2785 kgnilnd_check_peer_timeouts_locked(kgn_peer_t *peer, struct list_head *todie,
2786                                     struct list_head *souls)
2787 {
2788         unsigned long           timeout;
2789         kgn_conn_t             *conn, *connN = NULL;
2790         kgn_tx_t               *tx, *txN;
2791         int                     rc = 0;
2792         int                     count = 0;
2793         int                     reconnect;
2794         int                     to_reconn;
2795         short                   releaseconn = 0;
2796         unsigned long           first_rx = 0;
2797         int                     purgatory_conn_cnt = 0;
2798
2799         CDEBUG(D_NET, "checking peer 0x%p->%s for timeouts; interval %lus\n",
2800                 peer, libcfs_nid2str(peer->gnp_nid),
2801                 peer->gnp_reconnect_interval);
2802
2803         timeout = cfs_time_seconds(max(*kgnilnd_tunables.kgn_timeout,
2804                                        GNILND_MIN_TIMEOUT));
2805
2806         conn = kgnilnd_find_conn_locked(peer);
2807         if (conn) {
2808                 /* if there is a valid conn, check the queues for timeouts */
2809                 rc = kgnilnd_check_conn_timeouts_locked(conn);
2810                 if (rc) {
2811                         if (CFS_FAIL_CHECK(CFS_FAIL_GNI_RX_CLOSE_CLOSING)) {
2812                                 /* simulate a RX CLOSE after the timeout but before
2813                                  * the scheduler thread gets it */
2814                                 conn->gnc_close_recvd = GNILND_CLOSE_INJECT1;
2815                                 conn->gnc_peer_error = -ETIMEDOUT;
2816                         }
2817
2818                         if (*kgnilnd_tunables.kgn_to_reconn_disable &&
2819                             rc == -ETIMEDOUT) {
2820                                 peer->gnp_state = GNILND_PEER_TIMED_OUT;
2821                                 CDEBUG(D_WARNING, "%s conn timed out, will "
2822                                        "reconnect upon request from peer\n",
2823                                        libcfs_nid2str(conn->gnc_peer->gnp_nid));
2824                         }
2825                         /* Once we mark closed, any of the scheduler threads could
2826                          * get it and move through before we hit the fail loc code */
2827                         kgnilnd_close_conn_locked(conn, rc);
2828                 } else {
2829                         /* first_rx is used to decide when to release a conn from purgatory.
2830                          */
2831                         first_rx = conn->gnc_first_rx;
2832                 }
2833         }
2834
2835         /* now regardless of starting new conn, find tx on peer queue that
2836          * are old and smell bad - do this first so we don't trigger
2837          * reconnect on empty queue if we timeout all */
2838         list_for_each_entry_safe(tx, txN, &peer->gnp_tx_queue, tx_list) {
2839                 if (time_after_eq(jiffies, tx->tx_qtime + timeout)) {
2840                         if (count == 0) {
2841                                 LCONSOLE_INFO("could not send to %s due to connection"
2842                                        " setup failure after %lu seconds\n",
2843                                        libcfs_nid2str(peer->gnp_nid),
2844                                        cfs_duration_sec(jiffies - tx->tx_qtime));
2845                         }
2846                         kgnilnd_tx_del_state_locked(tx, peer, NULL,
2847                                                    GNILND_TX_ALLOCD);
2848                         list_add_tail(&tx->tx_list, todie);
2849                         count++;
2850                 }
2851         }
2852
2853         if (count || peer->gnp_connecting == GNILND_PEER_KILL) {
2854                 CDEBUG(D_NET, "canceling %d tx for peer 0x%p->%s\n",
2855                         count, peer, libcfs_nid2str(peer->gnp_nid));
2856                 /* if we nuked all the TX, stop peer connection attempt (if there is one..) */
2857                 if (list_empty(&peer->gnp_tx_queue) ||
2858                         peer->gnp_connecting == GNILND_PEER_KILL) {
2859                         /* we pass down todie to use a common function - but we know there are
2860                          * no TX to add */
2861                         kgnilnd_cancel_peer_connect_locked(peer, todie);
2862                 }
2863         }
2864
2865         /* Don't reconnect if we are still trying to clear out old conns.
2866          * This prevents us sending traffic on the new mbox before ensuring we are done
2867          * with the old one */
2868         reconnect = (peer->gnp_state == GNILND_PEER_UP) &&
2869                     (atomic_read(&peer->gnp_dirty_eps) == 0);
2870
2871         /* fast reconnect after a timeout */
2872         to_reconn = !conn &&
2873                     (peer->gnp_last_errno == -ETIMEDOUT) &&
2874                     *kgnilnd_tunables.kgn_fast_reconn;
2875
2876         /* if we are not connected and there are tx on the gnp_tx_queue waiting
2877          * to be sent, we'll check the reconnect interval and fire up a new
2878          * connection request */
2879
2880         if (reconnect &&
2881             (peer->gnp_connecting == GNILND_PEER_IDLE) &&
2882             (time_after_eq(jiffies, peer->gnp_reconnect_time)) &&
2883             (!list_empty(&peer->gnp_tx_queue) || to_reconn)) {
2884
2885                 CDEBUG(D_NET, "starting connect to %s\n",
2886                         libcfs_nid2str(peer->gnp_nid));
2887                 LASSERTF(peer->gnp_connecting == GNILND_PEER_IDLE,
2888                          "Peer was idle and we have a write_lock, state issue %d\n",
2889                          peer->gnp_connecting);
2890
2891                 peer->gnp_connecting = GNILND_PEER_CONNECT;
2892                 kgnilnd_peer_addref(peer); /* extra ref for connd */
2893
2894                 spin_lock(&peer->gnp_net->gnn_dev->gnd_connd_lock);
2895                 list_add_tail(&peer->gnp_connd_list,
2896                               &peer->gnp_net->gnn_dev->gnd_connd_peers);
2897                 spin_unlock(&peer->gnp_net->gnn_dev->gnd_connd_lock);
2898
2899                 kgnilnd_schedule_dgram(peer->gnp_net->gnn_dev);
2900         }
2901
2902         /* fail_loc to allow us to delay release of purgatory */
2903         if (CFS_FAIL_CHECK(CFS_FAIL_GNI_PURG_REL_DELAY))
2904                 return;
2905
2906         /* This check allows us to verify that the new conn is actually being used. This allows us to
2907          * pull the old conns out of purgatory if they have actually seen traffic.
2908          * We only release a conn from purgatory during stack reset, admin command, or when a peer reconnects
2909          */
2910         if (first_rx &&
2911                 time_after(jiffies, first_rx + cfs_time_seconds(*kgnilnd_tunables.kgn_hardware_timeout))) {
2912                 CDEBUG(D_INFO, "We can release peer %s conn's from purgatory %lu\n",
2913                         libcfs_nid2str(peer->gnp_nid), first_rx + cfs_time_seconds(*kgnilnd_tunables.kgn_hardware_timeout));
2914                 releaseconn = 1;
2915         }
2916
2917         list_for_each_entry_safe (conn, connN, &peer->gnp_conns, gnc_list) {
2918         /* check for purgatory timeouts */
2919                 if (conn->gnc_in_purgatory) {
2920                         /* We cannot detach this conn from purgatory if it has not been closed so we reschedule it
2921                          * that way the next time we check it we can detach it from purgatory
2922                          */
2923
2924                         if (conn->gnc_state != GNILND_CONN_DONE) {
2925                                 /* Skip over conns that are currently not DONE. If they arent already scheduled
2926                                  * for completion something in the state machine is broken.
2927                                  */
2928                                 continue;
2929                         }
2930
2931                         /* We only detach a conn that is in purgatory if we have received a close message,
2932                          * we have a new valid connection that has successfully received data, or an admin
2933                          * command tells us we need to detach.
2934                          */
2935
2936                         if (conn->gnc_close_recvd || releaseconn || conn->gnc_needs_detach) {
2937                                 unsigned long   waiting;
2938
2939                                 waiting = (long) jiffies - conn->gnc_last_rx_cq;
2940
2941                                 /* C.E: The remote peer is expected to close the
2942                                  * connection (see kgnilnd_check_conn_timeouts)
2943                                  * via the reaper thread and nuke out the MDD and
2944                                  * FMA resources after conn->gnc_timeout has expired
2945                                  * without an FMA RX */
2946                                 CDEBUG(D_NET, "Reconnected to %s in %lds or admin forced detach, dropping "
2947                                         " held resources\n",
2948                                         libcfs_nid2str(conn->gnc_peer->gnp_nid),
2949                                         cfs_duration_sec(waiting));
2950
2951                                 kgnilnd_detach_purgatory_locked(conn, souls);
2952                         } else {
2953                                 purgatory_conn_cnt++;
2954                         }
2955                 }
2956         }
2957
2958         /* If we have too many connections in purgatory we could run out of
2959          * resources. Limit the number of connections to a tunable number,
2960          * clean up to the minimum all in one fell swoop... there are
2961          * situations where dvs will retry tx's and we can eat up several
2962          * hundread connection requests at once.
2963          */
2964         if (purgatory_conn_cnt > *kgnilnd_tunables.kgn_max_purgatory) {
2965                 list_for_each_entry_safe(conn, connN, &peer->gnp_conns,
2966                                          gnc_list) {
2967                         if (conn->gnc_in_purgatory &&
2968                             conn->gnc_state == GNILND_CONN_DONE) {
2969                                 CDEBUG(D_NET, "Dropping Held resource due to"
2970                                               " resource limits being hit\n");
2971                                 kgnilnd_detach_purgatory_locked(conn, souls);
2972
2973                                 if (purgatory_conn_cnt-- <
2974                                     *kgnilnd_tunables.kgn_max_purgatory)
2975                                         break;
2976                         }
2977                 }
2978         }
2979 }
2980
2981 void
2982 kgnilnd_reaper_check(int idx)
2983 {
2984         struct list_head  *peers = &kgnilnd_data.kgn_peers[idx];
2985         struct list_head  *ctmp, *ctmpN;
2986         LIST_HEAD(geriatrics);
2987         LIST_HEAD(souls);
2988
2989         write_lock(&kgnilnd_data.kgn_peer_conn_lock);
2990
2991         list_for_each_safe(ctmp, ctmpN, peers) {
2992                 kgn_peer_t        *peer = NULL;
2993
2994                 /* don't timeout stuff if the network is mucked or shutting down */
2995                 if (kgnilnd_check_hw_quiesce()) {
2996                         break;
2997                 }
2998                 peer = list_entry(ctmp, kgn_peer_t, gnp_list);
2999
3000                 kgnilnd_check_peer_timeouts_locked(peer, &geriatrics, &souls);
3001         }
3002
3003         write_unlock(&kgnilnd_data.kgn_peer_conn_lock);
3004
3005         kgnilnd_txlist_done(&geriatrics, -EHOSTUNREACH);
3006         kgnilnd_release_purgatory_list(&souls);
3007 }
3008
3009 void
3010 kgnilnd_update_reaper_timeout(long timeout)
3011 {
3012         LASSERT(timeout > 0);
3013
3014         spin_lock(&kgnilnd_data.kgn_reaper_lock);
3015
3016         if (timeout < kgnilnd_data.kgn_new_min_timeout)
3017                 kgnilnd_data.kgn_new_min_timeout = timeout;
3018
3019         spin_unlock(&kgnilnd_data.kgn_reaper_lock);
3020 }
3021
3022 static void
3023 kgnilnd_reaper_poke_with_stick(unsigned long arg)
3024 {
3025         wake_up(&kgnilnd_data.kgn_reaper_waitq);
3026 }
3027
3028 int
3029 kgnilnd_reaper(void *arg)
3030 {
3031         long               timeout;
3032         int                i;
3033         int                hash_index = 0;
3034         unsigned long      next_check_time = jiffies;
3035         long               current_min_timeout = MAX_SCHEDULE_TIMEOUT;
3036         struct timer_list  timer;
3037         DEFINE_WAIT(wait);
3038
3039         cfs_block_allsigs();
3040
3041         /* all gnilnd threads need to run fairly urgently */
3042         set_user_nice(current, *kgnilnd_tunables.kgn_nice);
3043         spin_lock(&kgnilnd_data.kgn_reaper_lock);
3044
3045         while (!kgnilnd_data.kgn_shutdown) {
3046                 /* I wake up every 'p' seconds to check for timeouts on some
3047                  * more peers.  I try to check every connection 'n' times
3048                  * within the global minimum of all keepalive and timeout
3049                  * intervals, to ensure I attend to every connection within
3050                  * (n+1)/n times its timeout intervals. */
3051                 const int     p = GNILND_REAPER_THREAD_WAKE;
3052                 const int     n = GNILND_REAPER_NCHECKS;
3053                 int           chunk;
3054                 /* to quiesce or to not quiesce, that is the question */
3055                 if (unlikely(kgnilnd_data.kgn_quiesce_trigger)) {
3056                         spin_unlock(&kgnilnd_data.kgn_reaper_lock);
3057                         KGNILND_SPIN_QUIESCE;
3058                         spin_lock(&kgnilnd_data.kgn_reaper_lock);
3059                 }
3060
3061                 /* careful with the jiffy wrap... */
3062                 timeout = (long)(next_check_time - jiffies);
3063
3064                 if (timeout > 0) {
3065                         prepare_to_wait(&kgnilnd_data.kgn_reaper_waitq, &wait,
3066                                         TASK_INTERRUPTIBLE);
3067                         spin_unlock(&kgnilnd_data.kgn_reaper_lock);
3068                         setup_timer(&timer, kgnilnd_reaper_poke_with_stick,
3069                                     next_check_time);
3070                         mod_timer(&timer, (long) jiffies + timeout);
3071
3072                         /* check flag variables before committing */
3073                         if (!kgnilnd_data.kgn_shutdown &&
3074                             !kgnilnd_data.kgn_quiesce_trigger) {
3075                                 CDEBUG(D_INFO, "schedule timeout %ld (%lu sec)\n",
3076                                        timeout, cfs_duration_sec(timeout));
3077                                 schedule();
3078                                 CDEBUG(D_INFO, "awake after schedule\n");
3079                         }
3080
3081                         del_singleshot_timer_sync(&timer);
3082                         spin_lock(&kgnilnd_data.kgn_reaper_lock);
3083                         finish_wait(&kgnilnd_data.kgn_reaper_waitq, &wait);
3084                         continue;
3085                 }
3086
3087                 /* new_min_timeout is set from the conn timeouts and keepalive
3088                  * this should end up with a min timeout of
3089                  * GNILND_TIMEOUT2KEEPALIVE(t) or roughly LND_TIMEOUT/2 */
3090                 if (kgnilnd_data.kgn_new_min_timeout < current_min_timeout) {
3091                         current_min_timeout = kgnilnd_data.kgn_new_min_timeout;
3092                         CDEBUG(D_NET, "Set new min timeout %ld\n",
3093                                current_min_timeout);
3094                 }
3095
3096                 spin_unlock(&kgnilnd_data.kgn_reaper_lock);
3097
3098                 /* Compute how many table entries to check now so I get round
3099                  * the whole table fast enough given that I do this at fixed
3100                  * intervals of 'p' seconds) */
3101                 chunk = *kgnilnd_tunables.kgn_peer_hash_size;
3102                 if (kgnilnd_data.kgn_new_min_timeout > n * p)
3103                         chunk = (chunk * n * p) /
3104                                 kgnilnd_data.kgn_new_min_timeout;
3105                 if (chunk == 0)
3106                         chunk = 1;
3107                 for (i = 0; i < chunk; i++) {
3108                         kgnilnd_reaper_check(hash_index);
3109                         hash_index = (hash_index + 1) %
3110                                 *kgnilnd_tunables.kgn_peer_hash_size;
3111                 }
3112                 next_check_time = (long) jiffies + cfs_time_seconds(p);
3113                 CDEBUG(D_INFO, "next check at %lu or in %d sec\n", next_check_time, p);
3114
3115                 spin_lock(&kgnilnd_data.kgn_reaper_lock);
3116         }
3117
3118         spin_unlock(&kgnilnd_data.kgn_reaper_lock);
3119
3120         kgnilnd_thread_fini();
3121         return 0;
3122 }
3123
3124 int
3125 kgnilnd_recv_bte_get(kgn_tx_t *tx) {
3126         unsigned niov, offset, nob;
3127         lnet_kiov_t     *kiov;
3128         struct lnet_msg *lntmsg = tx->tx_lntmsg[0];
3129         kgnilnd_parse_lnet_rdma(lntmsg, &niov, &offset, &nob, &kiov, tx->tx_nob_rdma);
3130
3131         if (kiov != NULL) {
3132                 lnet_copy_flat2kiov(
3133                         niov, kiov, offset,
3134                         nob,
3135                         tx->tx_buffer_copy + tx->tx_offset, 0, nob);
3136         } else {
3137                 memcpy(tx->tx_buffer, tx->tx_buffer_copy + tx->tx_offset, nob);
3138         }
3139         return 0;
3140 }
3141
3142
3143 int
3144 kgnilnd_check_rdma_cq(kgn_device_t *dev)
3145 {
3146         gni_return_t           rrc;
3147         gni_post_descriptor_t *desc;
3148         __u64                  event_data;
3149         kgn_tx_ev_id_t         ev_id;
3150         char                   err_str[256];
3151         int                    should_retry, rc;
3152         long                   num_processed = 0;
3153         kgn_conn_t            *conn = NULL;
3154         kgn_tx_t              *tx = NULL;
3155         kgn_rdma_desc_t       *rdesc;
3156         unsigned int           rnob;
3157         __u64                  rcookie;
3158
3159         for (;;) {
3160                 /* make sure we don't keep looping if we need to reset */
3161                 if (unlikely(kgnilnd_data.kgn_quiesce_trigger)) {
3162                         return num_processed;
3163                 }
3164                 rc = kgnilnd_mutex_trylock(&dev->gnd_cq_mutex);
3165                 if (!rc) {
3166                         /* we didn't get the mutex, so return that there is still work
3167                          * to be done */
3168                         return 1;
3169                 }
3170                 if (CFS_FAIL_CHECK(CFS_FAIL_GNI_DELAY_RDMA)) {
3171                         /* a bit gross - but we need a good way to test for
3172                          * delayed RDMA completions and the easiest way to do
3173                          * that is to delay the RDMA CQ events */
3174                         rrc = GNI_RC_NOT_DONE;
3175                 } else {
3176                         rrc = kgnilnd_cq_get_event(dev->gnd_snd_rdma_cqh, &event_data);
3177                 }
3178
3179                 if (rrc == GNI_RC_NOT_DONE) {
3180                         kgnilnd_gl_mutex_unlock(&dev->gnd_cq_mutex);
3181                         CDEBUG(D_INFO, "SEND RDMA CQ %d empty processed %ld\n",
3182                                dev->gnd_id, num_processed);
3183                         return num_processed;
3184                 }
3185                 dev->gnd_sched_alive = jiffies;
3186                 num_processed++;
3187
3188                 LASSERTF(!GNI_CQ_OVERRUN(event_data),
3189                         "this is bad, somehow our credits didn't protect us"
3190                         " from CQ overrun\n");
3191                 LASSERTF(GNI_CQ_GET_TYPE(event_data) == GNI_CQ_EVENT_TYPE_POST,
3192                         "rrc %d, GNI_CQ_GET_TYPE(%#llx) = %#llx\n", rrc,
3193                         event_data, GNI_CQ_GET_TYPE(event_data));
3194
3195                 rrc = kgnilnd_get_completed(dev->gnd_snd_rdma_cqh, event_data,
3196                                             &desc);
3197                 kgnilnd_gl_mutex_unlock(&dev->gnd_cq_mutex);
3198
3199                 /* XXX Nic: Need better error handling here... */
3200                 LASSERTF((rrc == GNI_RC_SUCCESS) ||
3201                           (rrc == GNI_RC_TRANSACTION_ERROR),
3202                          "rrc %d\n", rrc);
3203
3204                 ev_id.txe_cookie = desc->post_id;
3205
3206                 kgnilnd_validate_tx_ev_id(&ev_id, &tx, &conn);
3207
3208                 if (conn == NULL || tx == NULL) {
3209                         /* either conn or tx was already nuked and this is a "late"
3210                          * completion, so drop it */
3211                         continue;
3212                 }
3213
3214                 GNITX_ASSERTF(tx, tx->tx_msg.gnm_type == GNILND_MSG_PUT_DONE ||
3215                         tx->tx_msg.gnm_type == GNILND_MSG_GET_DONE ||
3216                         tx->tx_msg.gnm_type == GNILND_MSG_PUT_DONE_REV ||
3217                         tx->tx_msg.gnm_type == GNILND_MSG_GET_DONE_REV,
3218                         "tx %p with type %d\n", tx, tx->tx_msg.gnm_type);
3219
3220                 GNIDBG_TX(D_NET, tx, "RDMA completion for %d bytes", tx->tx_nob);
3221
3222                 if (tx->tx_msg.gnm_type == GNILND_MSG_GET_DONE_REV) {
3223                         lnet_set_reply_msg_len(NULL, tx->tx_lntmsg[1],
3224                                                tx->tx_msg.gnm_u.completion.gncm_retval);
3225                 }
3226
3227                 rc = 0;
3228                 if (tx->tx_msg.gnm_type == GNILND_MSG_GET_DONE_REV && desc->status == GNI_RC_SUCCESS) {
3229                         if (tx->tx_buffer_copy != NULL)
3230                                 kgnilnd_recv_bte_get(tx);
3231                         rc = kgnilnd_verify_rdma_cksum(tx, tx->tx_putinfo.gnpam_payload_cksum, tx->tx_nob_rdma);
3232                 }
3233
3234                 if (tx->tx_msg.gnm_type == GNILND_MSG_PUT_DONE_REV && desc->status == GNI_RC_SUCCESS) {
3235                         if (tx->tx_buffer_copy != NULL)
3236                                 kgnilnd_recv_bte_get(tx);
3237                         rc = kgnilnd_verify_rdma_cksum(tx, tx->tx_getinfo.gngm_payload_cksum, tx->tx_nob_rdma);
3238                 }
3239
3240                 /* remove from rdmaq */
3241                 kgnilnd_conn_mutex_lock(&conn->gnc_rdma_mutex);
3242                 spin_lock(&conn->gnc_list_lock);
3243                 kgnilnd_tx_del_state_locked(tx, NULL, conn, GNILND_TX_ALLOCD);
3244                 spin_unlock(&conn->gnc_list_lock);
3245                 kgnilnd_conn_mutex_unlock(&conn->gnc_rdma_mutex);
3246
3247                 if (CFS_FAIL_CHECK(CFS_FAIL_GNI_RDMA_CQ_ERROR)) {
3248                         event_data = 1LL << 48;
3249                         rc = 1;
3250                 }
3251
3252                 if (likely(desc->status == GNI_RC_SUCCESS) && rc == 0) {
3253                         atomic_inc(&dev->gnd_rdma_ntx);
3254                         atomic64_add(tx->tx_nob, &dev->gnd_rdma_txbytes);
3255                         /* transaction succeeded, add into fmaq */
3256                         kgnilnd_queue_tx(conn, tx);
3257                         kgnilnd_peer_alive(conn->gnc_peer);
3258
3259                         /* drop ref from kgnilnd_validate_tx_ev_id */
3260                         kgnilnd_admin_decref(conn->gnc_tx_in_use);
3261                         kgnilnd_conn_decref(conn);
3262
3263                         continue;
3264                 }
3265
3266                 /* fall through to the TRANSACTION_ERROR case */
3267                 tx->tx_retrans++;
3268
3269                 /* get stringified version for log messages */
3270                 kgnilnd_cq_error_str(event_data, &err_str, 256);
3271                 kgnilnd_cq_error_recoverable(event_data, &should_retry);
3272
3273                 /* make sure we are not off in the weeds with this tx */
3274                 if (tx->tx_retrans >
3275                         *kgnilnd_tunables.kgn_max_retransmits) {
3276                         GNIDBG_TX(D_NETERROR, tx,
3277                                "giving up on TX, too many retries", NULL);
3278                         should_retry = 0;
3279                 }
3280
3281                 GNIDBG_TX(D_NETERROR, tx, "RDMA %s error (%s)",
3282                         should_retry ? "transient" : "unrecoverable", err_str);
3283
3284                 if (tx->tx_msg.gnm_type == GNILND_MSG_PUT_DONE ||
3285                     tx->tx_msg.gnm_type == GNILND_MSG_GET_DONE_REV) {
3286                         rdesc    = &tx->tx_putinfo.gnpam_desc;
3287                         rnob     = tx->tx_putinfo.gnpam_desc.gnrd_nob;
3288                         rcookie  = tx->tx_putinfo.gnpam_dst_cookie;
3289                 } else {
3290                         rdesc    = &tx->tx_getinfo.gngm_desc;
3291                         rnob     = tx->tx_lntmsg[0]->msg_len;
3292                         rcookie  = tx->tx_getinfo.gngm_cookie;
3293                 }
3294
3295                 if (should_retry) {
3296                         kgnilnd_rdma(tx,
3297                                      tx->tx_msg.gnm_type,
3298                                      rdesc,
3299                                      rnob, rcookie);
3300                 } else {
3301                         kgnilnd_nak_rdma(conn,
3302                                          tx->tx_msg.gnm_type,
3303                                          -EFAULT,
3304                                          rcookie,
3305                                          tx->tx_msg.gnm_srcnid);
3306                         kgnilnd_tx_done(tx, -GNILND_NOPURG);
3307                         kgnilnd_close_conn(conn, -ECOMM);
3308                 }
3309
3310                 /* drop ref from kgnilnd_validate_tx_ev_id */
3311                 kgnilnd_admin_decref(conn->gnc_tx_in_use);
3312                 kgnilnd_conn_decref(conn);
3313         }
3314 }
3315
3316 int
3317 kgnilnd_check_fma_send_cq(kgn_device_t *dev)
3318 {
3319         gni_return_t           rrc;
3320         __u64                  event_data;
3321         kgn_tx_ev_id_t         ev_id;
3322         kgn_tx_t              *tx = NULL;
3323         kgn_conn_t            *conn = NULL;
3324         int                    queued_fma, saw_reply, rc;
3325         long                   num_processed = 0;
3326         struct list_head      *ctmp, *ctmpN;
3327
3328         for (;;) {
3329                 /* make sure we don't keep looping if we need to reset */
3330                 if (unlikely(kgnilnd_data.kgn_quiesce_trigger)) {
3331                         return num_processed;
3332                 }
3333
3334                 rc = kgnilnd_mutex_trylock(&dev->gnd_cq_mutex);
3335                 if (!rc) {
3336                         /* we didn't get the mutex, so return that there is still work
3337                          * to be done */
3338                         return 1;
3339                 }
3340
3341                 rrc = kgnilnd_cq_get_event(dev->gnd_snd_fma_cqh, &event_data);
3342                 kgnilnd_gl_mutex_unlock(&dev->gnd_cq_mutex);
3343
3344                 if (rrc == GNI_RC_NOT_DONE) {
3345                         CDEBUG(D_INFO,
3346                                "SMSG send CQ %d not ready (data %#llx) "
3347                                "processed %ld\n", dev->gnd_id, event_data,
3348                                num_processed);
3349
3350                         if (num_processed > 0) {
3351                                 spin_lock(&dev->gnd_lock);
3352                                 if (!list_empty(&dev->gnd_delay_conns)) {
3353                                         list_for_each_safe(ctmp, ctmpN, &dev->gnd_delay_conns) {
3354                                                 conn = list_entry(ctmp, kgn_conn_t, gnc_delaylist);
3355                                                 list_del_init(&conn->gnc_delaylist);
3356                                                 CDEBUG(D_NET, "Moving Conn %p from delay queue to ready_queue\n", conn);
3357                                                 kgnilnd_schedule_conn_nolock(conn);
3358                                         }
3359                                         spin_unlock(&dev->gnd_lock);
3360                                         kgnilnd_schedule_device(dev);
3361                                 } else {
3362                                         spin_unlock(&dev->gnd_lock);
3363                                 }
3364                         }
3365                         return num_processed;
3366                 }
3367
3368                 dev->gnd_sched_alive = jiffies;
3369                 num_processed++;
3370
3371                 LASSERTF(!GNI_CQ_OVERRUN(event_data),
3372                         "this is bad, somehow our credits didn't "
3373                         "protect us from CQ overrun\n");
3374                 LASSERTF(GNI_CQ_GET_TYPE(event_data) == GNI_CQ_EVENT_TYPE_SMSG,
3375                         "rrc %d, GNI_CQ_GET_TYPE(%#llx) = %#llx\n", rrc,
3376                         event_data, GNI_CQ_GET_TYPE(event_data));
3377
3378                 /* if SMSG couldn't handle an error, time for conn to die */
3379                 if (unlikely(rrc == GNI_RC_TRANSACTION_ERROR)) {
3380                         char            err_str[256];
3381
3382                         /* need to take the write_lock to ensure atomicity
3383                          * on the conn state if we need to close it */
3384                         write_lock(&kgnilnd_data.kgn_peer_conn_lock);
3385                         conn = kgnilnd_cqid2conn_locked(GNI_CQ_GET_INST_ID(event_data));
3386                         if (conn == NULL) {
3387                                 /* Conn was destroyed? */
3388                                 CDEBUG(D_NET,
3389                                         "SMSG CQID lookup %#llx failed\n",
3390                                         GNI_CQ_GET_INST_ID(event_data));
3391                                 write_unlock(&kgnilnd_data.kgn_peer_conn_lock);
3392                                 continue;
3393                         }
3394
3395                         kgnilnd_cq_error_str(event_data, &err_str, 256);
3396                         CNETERR("SMSG send error to %s: rc %d (%s)\n",
3397                                libcfs_nid2str(conn->gnc_peer->gnp_nid),
3398                                rrc, err_str);
3399                         kgnilnd_close_conn_locked(conn, -ECOMM);
3400
3401                         write_unlock(&kgnilnd_data.kgn_peer_conn_lock);
3402
3403                         /* no need to process rest of this tx -
3404                          * it is getting canceled */
3405                         continue;
3406                 }
3407
3408                 /* fall through to GNI_RC_SUCCESS case */
3409                 ev_id.txe_smsg_id = GNI_CQ_GET_MSG_ID(event_data);
3410
3411                 kgnilnd_validate_tx_ev_id(&ev_id, &tx, &conn);
3412                 if (conn == NULL || tx == NULL) {
3413                         /* either conn or tx was already nuked and this is a "late"
3414                          * completion, so drop it */
3415                         continue;
3416                 }
3417
3418                 tx->tx_conn->gnc_last_tx_cq = jiffies;
3419                 if (tx->tx_msg.gnm_type == GNILND_MSG_NOOP) {
3420                         set_mb(conn->gnc_last_noop_cq, jiffies);
3421                 }
3422
3423                 /* lock tx_list_state and tx_state */
3424                 kgnilnd_conn_mutex_lock(&conn->gnc_smsg_mutex);
3425                 spin_lock(&tx->tx_conn->gnc_list_lock);
3426
3427                 GNITX_ASSERTF(tx, tx->tx_list_state == GNILND_TX_LIVE_FMAQ,
3428                                 "state not GNILND_TX_LIVE_FMAQ", NULL);
3429                 GNITX_ASSERTF(tx, tx->tx_state & GNILND_TX_WAITING_COMPLETION,
3430                         "not waiting for completion", NULL);
3431
3432                 GNIDBG_TX(D_NET, tx, "SMSG complete tx_state %x rc %d",
3433                         tx->tx_state, rrc);
3434
3435                 tx->tx_state &= ~GNILND_TX_WAITING_COMPLETION;
3436
3437                 /* This will trigger other FMA sends that were
3438                  * pending this completion */
3439                 queued_fma = !list_empty(&tx->tx_conn->gnc_fmaq);
3440
3441                 /* we either did not expect reply or we already got it */
3442                 saw_reply = !(tx->tx_state & GNILND_TX_WAITING_REPLY);
3443
3444                 spin_unlock(&tx->tx_conn->gnc_list_lock);
3445                 kgnilnd_conn_mutex_unlock(&conn->gnc_smsg_mutex);
3446
3447                 if (queued_fma) {
3448                         CDEBUG(D_NET, "scheduling conn 0x%p->%s for fmaq\n",
3449                                conn,
3450                                libcfs_nid2str(conn->gnc_peer->gnp_nid));
3451                         kgnilnd_schedule_conn(conn);
3452                 }
3453
3454                 /* If saw_reply is false as soon as gnc_list_lock is dropped the tx could be nuked
3455                  * If saw_reply is true we know that the tx is safe to use as the other thread
3456                  * is already finished with it.
3457                  */
3458
3459                 if (saw_reply) {
3460                         /* no longer need to track on the live_fmaq */
3461                         kgnilnd_tx_del_state_locked(tx, NULL, tx->tx_conn, GNILND_TX_ALLOCD);
3462
3463                         if (tx->tx_state & GNILND_TX_PENDING_RDMA) {
3464                                 /* we already got reply & were waiting for
3465                                  * completion of initial send */
3466                                 /* to initiate RDMA transaction */
3467                                 GNIDBG_TX(D_NET, tx,
3468                                          "Pending RDMA 0x%p type 0x%02x",
3469                                          tx->tx_msg.gnm_type);
3470                                 tx->tx_state &= ~GNILND_TX_PENDING_RDMA;
3471                                 rc = kgnilnd_send_mapped_tx(tx, 0);
3472                                 GNITX_ASSERTF(tx, rc == 0, "RDMA send failed: %d\n", rc);
3473                         } else {
3474                                 /* we are done with this tx */
3475                                 GNIDBG_TX(D_NET, tx,
3476                                          "Done with tx type 0x%02x",
3477                                          tx->tx_msg.gnm_type);
3478                                 kgnilnd_tx_done(tx, tx->tx_rc);
3479                         }
3480                 }
3481
3482                 /* drop ref from kgnilnd_validate_tx_ev_id */
3483                 kgnilnd_admin_decref(conn->gnc_tx_in_use);
3484                 kgnilnd_conn_decref(conn);
3485
3486                 /* if we are waiting for a REPLY, we'll handle the tx then */
3487         } /* end for loop */
3488 }
3489
3490 int
3491 kgnilnd_check_fma_rcv_cq(kgn_device_t *dev)
3492 {
3493         kgn_conn_t         *conn;
3494         gni_return_t        rrc;
3495         __u64               event_data;
3496         long                num_processed = 0;
3497         struct list_head   *conns;
3498         struct list_head   *tmp;
3499         int                 rc;
3500
3501         for (;;) {
3502                 /* make sure we don't keep looping if we need to reset */
3503                 if (unlikely(kgnilnd_data.kgn_quiesce_trigger)) {
3504                         return num_processed;
3505                 }
3506
3507                 rc = kgnilnd_mutex_trylock(&dev->gnd_cq_mutex);
3508                 if (!rc) {
3509                         /* we didn't get the mutex, so return that there is still work
3510                          * to be done */
3511                         return 1;
3512                 }
3513                 rrc = kgnilnd_cq_get_event(dev->gnd_rcv_fma_cqh, &event_data);
3514                 kgnilnd_gl_mutex_unlock(&dev->gnd_cq_mutex);
3515
3516                 if (rrc == GNI_RC_NOT_DONE) {
3517                         CDEBUG(D_INFO, "SMSG RX CQ %d empty data %#llx "
3518                                 "processed %ld\n",
3519                                 dev->gnd_id, event_data, num_processed);
3520                         return num_processed;
3521                 }
3522                 dev->gnd_sched_alive = jiffies;
3523                 num_processed++;
3524
3525                 /* this is the only CQ that can really handle transient
3526                  * CQ errors */
3527                 if (CFS_FAIL_CHECK(CFS_FAIL_GNI_CQ_GET_EVENT)) {
3528                         rrc = cfs_fail_val ? cfs_fail_val
3529                                            : GNI_RC_ERROR_RESOURCE;
3530                         if (rrc == GNI_RC_ERROR_RESOURCE) {
3531                                 /* set overrun too */
3532                                 event_data |= (1UL << 63);
3533                                 LASSERTF(GNI_CQ_OVERRUN(event_data),
3534                                          "(1UL << 63) is no longer the bit to set to indicate CQ_OVERRUN\n");
3535                         }
3536                 }
3537                 /* sender should get error event too and take care
3538                 of failed transaction by re-transmitting */
3539                 if (rrc == GNI_RC_TRANSACTION_ERROR) {
3540                         CDEBUG(D_NET, "SMSG RX CQ error %#llx\n", event_data);
3541                         continue;
3542                 }
3543
3544                 if (likely(!GNI_CQ_OVERRUN(event_data))) {
3545                         read_lock(&kgnilnd_data.kgn_peer_conn_lock);
3546                         conn = kgnilnd_cqid2conn_locked(
3547                                                  GNI_CQ_GET_INST_ID(event_data));
3548                         if (conn == NULL) {
3549                                 CDEBUG(D_NET, "SMSG RX CQID lookup %llu "
3550                                         "failed, dropping event %#llx\n",
3551                                         GNI_CQ_GET_INST_ID(event_data),
3552                                         event_data);
3553                         } else {
3554                                 CDEBUG(D_NET, "SMSG RX: CQID %llu "
3555                                        "conn %p->%s\n",
3556                                         GNI_CQ_GET_INST_ID(event_data),
3557                                         conn, conn->gnc_peer ?
3558                                         libcfs_nid2str(conn->gnc_peer->gnp_nid) :
3559                                         "<?>");
3560
3561                                 conn->gnc_last_rx_cq = jiffies;
3562
3563                                 /* stash first rx so we can clear out purgatory.
3564                                  */
3565                                 if (conn->gnc_first_rx == 0) {
3566                                         conn->gnc_first_rx = jiffies;
3567                                 }
3568                                 kgnilnd_peer_alive(conn->gnc_peer);
3569                                 kgnilnd_schedule_conn(conn);
3570                         }
3571                         read_unlock(&kgnilnd_data.kgn_peer_conn_lock);
3572                         continue;
3573                 }
3574
3575                 /* FMA CQ has overflowed: check ALL conns */
3576                 CNETERR("SMSG RX CQ overflow: scheduling ALL "
3577                        "conns on device %d\n", dev->gnd_id);
3578
3579                 for (rc = 0; rc < *kgnilnd_tunables.kgn_peer_hash_size; rc++) {
3580
3581                         read_lock(&kgnilnd_data.kgn_peer_conn_lock);
3582                         conns = &kgnilnd_data.kgn_conns[rc];
3583
3584                         list_for_each(tmp, conns) {
3585                                 conn = list_entry(tmp, kgn_conn_t,
3586                                                   gnc_hashlist);
3587
3588                                 if (conn->gnc_device == dev) {
3589                                         kgnilnd_schedule_conn(conn);
3590                                         conn->gnc_last_rx_cq = jiffies;
3591                                 }
3592                         }
3593
3594                         /* don't block write lockers for too long... */
3595                         read_unlock(&kgnilnd_data.kgn_peer_conn_lock);
3596                 }
3597         }
3598 }
3599
3600 /* try_map_if_full should only be used when processing TX from list of
3601  * backlog TX waiting on mappings to free up
3602  *
3603  * Return Codes:
3604  *  try_map_if_full = 0: 0 (sent or queued), (-|+)errno failure of kgnilnd_sendmsg
3605  *  try_map_if_full = 1: 0 (sent), -ENOMEM for caller to requeue, (-|+)errno failure of kgnilnd_sendmsg */
3606
3607 int
3608 kgnilnd_send_mapped_tx(kgn_tx_t *tx, int try_map_if_full)
3609 {
3610         /* slight bit of race if multiple people calling, but at worst we'll have
3611          * order altered just a bit... which would not be determenistic anyways */
3612         int     rc = atomic_read(&tx->tx_conn->gnc_device->gnd_nq_map);
3613
3614         GNIDBG_TX(D_NET, tx, "try %d nq_map %d", try_map_if_full, rc);
3615
3616         /* We know that we have a GART reservation that should guarantee forward progress.
3617          * This means we don't need to take any extraordinary efforts if we are failing
3618          * mappings here - even if we are holding a very small number of these. */
3619
3620         if (try_map_if_full || (rc == 0)) {
3621                 rc = kgnilnd_map_buffer(tx);
3622         }
3623
3624         /* rc should be 0 if we mapped successfully here, if non-zero
3625          * we are queueing */
3626         if (rc != 0) {
3627                 /* if try_map_if_full set, they handle requeuing */
3628                 if (unlikely(try_map_if_full)) {
3629                         RETURN(rc);
3630                 } else {
3631                         spin_lock(&tx->tx_conn->gnc_device->gnd_lock);
3632                         kgnilnd_tx_add_state_locked(tx, NULL, tx->tx_conn, GNILND_TX_MAPQ, 1);
3633                         spin_unlock(&tx->tx_conn->gnc_device->gnd_lock);
3634                         /* make sure we wake up sched to run this */
3635                         kgnilnd_schedule_device(tx->tx_conn->gnc_device);
3636                         /* return 0 as this is now queued for later sending */
3637                         RETURN(0);
3638                 }
3639         }
3640
3641         switch (tx->tx_msg.gnm_type) {
3642         default:
3643                 LBUG();
3644                 break;
3645         /* GET_REQ and PUT_ACK are outbound messages sending our mapping key to
3646          * remote node where the RDMA will be started
3647          * Special case -EAGAIN logic - this should just queued as if the mapping couldn't
3648          * be satisified. The rest of the errors are "hard" errors that require
3649          * upper layers to handle themselves.
3650          * If kgnilnd_post_rdma returns a resource error, kgnilnd_rdma will put
3651          * the tx back on the TX_MAPQ. When this tx is pulled back off the MAPQ,
3652          * it's gnm_type will now be GNILND_MSG_PUT_DONE or
3653          * GNILND_MSG_GET_DONE_REV.
3654          */
3655         case GNILND_MSG_GET_REQ:
3656                 tx->tx_msg.gnm_u.get.gngm_desc.gnrd_key = tx->tx_map_key;
3657                 tx->tx_msg.gnm_u.get.gngm_cookie = tx->tx_id.txe_cookie;
3658                 tx->tx_msg.gnm_u.get.gngm_desc.gnrd_addr = (__u64)((unsigned long)tx->tx_buffer);
3659                 tx->tx_msg.gnm_u.get.gngm_desc.gnrd_nob = tx->tx_nob;
3660                 tx->tx_state = GNILND_TX_WAITING_COMPLETION | GNILND_TX_WAITING_REPLY;
3661                 if (CFS_FAIL_CHECK(CFS_FAIL_GNI_GET_REQ_AGAIN)) {
3662                         tx->tx_state |= GNILND_TX_FAIL_SMSG;
3663                 }
3664                 /* redirect to FMAQ on failure, no need to infinite loop here in MAPQ */
3665                 rc = kgnilnd_sendmsg(tx, NULL, 0, &tx->tx_conn->gnc_list_lock, GNILND_TX_FMAQ);
3666                 break;
3667         case GNILND_MSG_PUT_ACK:
3668                 tx->tx_msg.gnm_u.putack.gnpam_desc.gnrd_key = tx->tx_map_key;
3669                 tx->tx_state = GNILND_TX_WAITING_COMPLETION | GNILND_TX_WAITING_REPLY;
3670                 if (CFS_FAIL_CHECK(CFS_FAIL_GNI_PUT_ACK_AGAIN)) {
3671                         tx->tx_state |= GNILND_TX_FAIL_SMSG;
3672                 }
3673                 /* redirect to FMAQ on failure, no need to infinite loop here in MAPQ */
3674                 rc = kgnilnd_sendmsg(tx, NULL, 0, &tx->tx_conn->gnc_list_lock, GNILND_TX_FMAQ);
3675                 break;
3676
3677         /* PUT_REQ and GET_DONE are where we do the actual RDMA */
3678         case GNILND_MSG_PUT_DONE:
3679         case GNILND_MSG_PUT_REQ:
3680                 rc = kgnilnd_rdma(tx, GNILND_MSG_PUT_DONE,
3681                              &tx->tx_putinfo.gnpam_desc,
3682                              tx->tx_putinfo.gnpam_desc.gnrd_nob,
3683                              tx->tx_putinfo.gnpam_dst_cookie);
3684                 RETURN(try_map_if_full ? rc : 0);
3685                 break;
3686         case GNILND_MSG_GET_DONE:
3687                 rc = kgnilnd_rdma(tx, GNILND_MSG_GET_DONE,
3688                              &tx->tx_getinfo.gngm_desc,
3689                              tx->tx_lntmsg[0]->msg_len,
3690                              tx->tx_getinfo.gngm_cookie);
3691                 RETURN(try_map_if_full ? rc : 0);
3692                 break;
3693         case GNILND_MSG_PUT_REQ_REV:
3694                 tx->tx_msg.gnm_u.get.gngm_desc.gnrd_key = tx->tx_map_key;
3695                 tx->tx_msg.gnm_u.get.gngm_cookie = tx->tx_id.txe_cookie;
3696                 tx->tx_msg.gnm_u.get.gngm_desc.gnrd_addr = (__u64)((unsigned long)tx->tx_buffer);
3697                 tx->tx_msg.gnm_u.get.gngm_desc.gnrd_nob = tx->tx_nob;
3698                 tx->tx_state = GNILND_TX_WAITING_COMPLETION | GNILND_TX_WAITING_REPLY;
3699                 kgnilnd_compute_rdma_cksum(tx, tx->tx_nob);
3700                 tx->tx_msg.gnm_u.get.gngm_payload_cksum = tx->tx_msg.gnm_payload_cksum;
3701
3702                 rc = kgnilnd_sendmsg(tx, NULL, 0, &tx->tx_conn->gnc_list_lock, GNILND_TX_FMAQ);
3703                 break;
3704         case GNILND_MSG_PUT_DONE_REV:
3705                 rc = kgnilnd_rdma(tx, GNILND_MSG_PUT_DONE_REV,
3706                              &tx->tx_getinfo.gngm_desc,
3707                              tx->tx_nob,
3708                              tx->tx_getinfo.gngm_cookie);
3709                 RETURN(try_map_if_full ? rc : 0);
3710                 break;
3711         case GNILND_MSG_GET_ACK_REV:
3712                 tx->tx_msg.gnm_u.putack.gnpam_desc.gnrd_key = tx->tx_map_key;
3713                 tx->tx_state = GNILND_TX_WAITING_COMPLETION | GNILND_TX_WAITING_REPLY;
3714                 /* LNET_GETS are a special case for parse */
3715                 kgnilnd_compute_rdma_cksum(tx, tx->tx_msg.gnm_u.putack.gnpam_desc.gnrd_nob);
3716                 tx->tx_msg.gnm_u.putack.gnpam_payload_cksum = tx->tx_msg.gnm_payload_cksum;
3717
3718                 if (CFS_FAIL_CHECK(CFS_FAIL_GNI_PUT_ACK_AGAIN))
3719                         tx->tx_state |= GNILND_TX_FAIL_SMSG;
3720
3721                 /* redirect to FMAQ on failure, no need to infinite loop here in MAPQ */
3722                 rc = kgnilnd_sendmsg(tx, NULL, 0, &tx->tx_conn->gnc_list_lock, GNILND_TX_FMAQ);
3723                 break;
3724         case GNILND_MSG_GET_DONE_REV:
3725         case GNILND_MSG_GET_REQ_REV:
3726                 rc = kgnilnd_rdma(tx, GNILND_MSG_GET_DONE_REV,
3727                                 &tx->tx_putinfo.gnpam_desc,
3728                                 tx->tx_putinfo.gnpam_desc.gnrd_nob,
3729                                 tx->tx_putinfo.gnpam_dst_cookie);
3730                 RETURN(try_map_if_full ? rc : 0);
3731                 break;
3732         }
3733
3734         RETURN(rc);
3735 }
3736
3737 void
3738 kgnilnd_process_fmaq(kgn_conn_t *conn)
3739 {
3740         int           more_to_do = 0;
3741         kgn_tx_t     *tx = NULL;
3742         void         *buffer = NULL;
3743         unsigned int  nob = 0;
3744         int           rc;
3745
3746         /* NB 1. kgnilnd_sendmsg() may fail if I'm out of credits right now.
3747          *       However I will be rescheduled by an FMA completion event
3748          *       when I eventually get some.
3749          * NB 2. Sampling gnc_state here races with setting it elsewhere.
3750          *       But it doesn't matter if I try to send a "real" message just
3751          *       as I start closing because I'll get scheduled to send the
3752          *       close anyway. */
3753
3754         /* Short circuit if the ep_handle is null we cant send anyway. */
3755         if (conn->gnc_ephandle == NULL)
3756                 return;
3757
3758         LASSERTF(!conn->gnc_close_sent, "Conn %p close was sent\n", conn);
3759
3760         spin_lock(&conn->gnc_list_lock);
3761
3762         if (list_empty(&conn->gnc_fmaq)) {
3763                 int     keepalive = GNILND_TO2KA(conn->gnc_timeout);
3764
3765                 spin_unlock(&conn->gnc_list_lock);
3766
3767                 if (time_after_eq(jiffies, conn->gnc_last_tx + cfs_time_seconds(keepalive))) {
3768                         CDEBUG(D_NET, "sending NOOP -> %s (%p idle %lu(%d)) "
3769                                "last %lu/%lu/%lu %lus/%lus/%lus\n",
3770                                libcfs_nid2str(conn->gnc_peer->gnp_nid), conn,
3771                                cfs_duration_sec(jiffies - conn->gnc_last_tx),
3772                                keepalive,
3773                                conn->gnc_last_noop_want, conn->gnc_last_noop_sent,
3774                                conn->gnc_last_noop_cq,
3775                                cfs_duration_sec(jiffies - conn->gnc_last_noop_want),
3776                                cfs_duration_sec(jiffies - conn->gnc_last_noop_sent),
3777                                cfs_duration_sec(jiffies - conn->gnc_last_noop_cq));
3778                         atomic_inc(&conn->gnc_sched_noop);
3779                         set_mb(conn->gnc_last_noop_want, jiffies);
3780
3781                         if (CFS_FAIL_CHECK(CFS_FAIL_GNI_NOOP_SEND))
3782                                 return;
3783
3784                         tx = kgnilnd_new_tx_msg(GNILND_MSG_NOOP, conn->gnc_peer->gnp_net->gnn_ni->ni_nid);
3785                         if (tx != NULL) {
3786                                 int     rc;
3787
3788                                 rc = kgnilnd_set_tx_id(tx, conn);
3789                                 if (rc != 0) {
3790                                         kgnilnd_tx_done(tx, rc);
3791                                         return;
3792                                 }
3793                         }
3794                 }
3795         } else {
3796                 tx = list_first_entry(&conn->gnc_fmaq, kgn_tx_t, tx_list);
3797                 /* move from fmaq to allocd, kgnilnd_sendmsg will move to live_fmaq */
3798                 kgnilnd_tx_del_state_locked(tx, NULL, conn, GNILND_TX_ALLOCD);
3799                 more_to_do = !list_empty(&conn->gnc_fmaq);
3800                 spin_unlock(&conn->gnc_list_lock);
3801         }
3802
3803         /* if there is no real TX or no NOOP to send, bail */
3804         if (tx == NULL) {
3805                 return;
3806         }
3807
3808         if (!tx->tx_retrans)
3809                 tx->tx_cred_wait = jiffies;
3810
3811         GNITX_ASSERTF(tx, tx->tx_id.txe_smsg_id != 0,
3812                       "tx with zero id", NULL);
3813
3814         CDEBUG(D_NET, "sending regular msg: %p, type %s(0x%02x), cookie %#llx\n",
3815                tx, kgnilnd_msgtype2str(tx->tx_msg.gnm_type),
3816                tx->tx_msg.gnm_type, tx->tx_id.txe_cookie);
3817
3818         rc = 0;
3819
3820         switch (tx->tx_msg.gnm_type) {
3821         default:
3822                 LBUG();
3823
3824         case GNILND_MSG_NOOP:
3825         case GNILND_MSG_CLOSE:
3826         case GNILND_MSG_IMMEDIATE:
3827                 tx->tx_state = GNILND_TX_WAITING_COMPLETION;
3828                 buffer = tx->tx_buffer;
3829                 nob = tx->tx_nob;
3830                 break;
3831
3832         case GNILND_MSG_GET_DONE:
3833         case GNILND_MSG_PUT_DONE:
3834         case GNILND_MSG_PUT_DONE_REV:
3835         case GNILND_MSG_GET_DONE_REV:
3836         case GNILND_MSG_PUT_NAK:
3837         case GNILND_MSG_GET_NAK:
3838         case GNILND_MSG_GET_NAK_REV:
3839         case GNILND_MSG_PUT_NAK_REV:
3840                 tx->tx_state = GNILND_TX_WAITING_COMPLETION;
3841                 break;
3842
3843         case GNILND_MSG_PUT_REQ:
3844         case GNILND_MSG_GET_REQ_REV:
3845                 tx->tx_msg.gnm_u.putreq.gnprm_cookie = tx->tx_id.txe_cookie;
3846
3847         case GNILND_MSG_PUT_ACK:
3848         case GNILND_MSG_PUT_REQ_REV:
3849         case GNILND_MSG_GET_ACK_REV:
3850         case GNILND_MSG_GET_REQ:
3851                 /* This is really only to handle the retransmit of SMSG once these
3852                  * two messages are setup in send_mapped_tx */
3853                 tx->tx_state = GNILND_TX_WAITING_COMPLETION | GNILND_TX_WAITING_REPLY;
3854                 break;
3855         }
3856
3857         if (likely(rc == 0)) {
3858                 rc = kgnilnd_sendmsg(tx, buffer, nob, &conn->gnc_list_lock, GNILND_TX_FMAQ);
3859         }
3860
3861         if (rc > 0) {
3862                 /* don't explicitly reschedule here - we are short credits and will rely on
3863                  * kgnilnd_sendmsg to resched the conn if need be */
3864                 more_to_do = 0;
3865         } else if (rc < 0) {
3866                 /* bail: it wasn't sent and we didn't get EAGAIN indicating we should retrans
3867                  * almost certainly a software bug, but lets play nice with the other kids */
3868                 kgnilnd_tx_done(tx, rc);
3869                 /* just for fun, kick peer in arse - resetting conn might help to correct
3870                  * this almost certainly buggy software caused return code */
3871                 kgnilnd_close_conn(conn, rc);
3872         }
3873
3874         if (more_to_do) {
3875                 CDEBUG(D_NET, "Rescheduling %p (more to do)\n", conn);
3876                 kgnilnd_schedule_conn(conn);
3877         }
3878 }
3879
3880 int
3881 kgnilnd_process_rdmaq(kgn_device_t *dev)
3882 {
3883         int               found_work = 0;
3884         kgn_tx_t         *tx;
3885
3886         if (CFS_FAIL_CHECK(CFS_FAIL_GNI_DELAY_RDMAQ)) {
3887                 RETURN(found_work);
3888         }
3889
3890         if (time_after_eq(jiffies, dev->gnd_rdmaq_deadline)) {
3891                 unsigned long           dead_bump;
3892                 long                    new_ok;
3893
3894                 /* if we think we need to adjust, take lock to serialize and recheck */
3895                 spin_lock(&dev->gnd_rdmaq_lock);
3896                 if (time_after_eq(jiffies, dev->gnd_rdmaq_deadline)) {
3897                         del_singleshot_timer_sync(&dev->gnd_rdmaq_timer);
3898
3899                         dead_bump = cfs_time_seconds(1) / *kgnilnd_tunables.kgn_rdmaq_intervals;
3900
3901                         /* roll the bucket forward */
3902                         dev->gnd_rdmaq_deadline = jiffies + dead_bump;
3903
3904                         if (kgnilnd_data.kgn_rdmaq_override &&
3905                                 (*kgnilnd_tunables.kgn_rdmaq_intervals != 0)) {
3906                                 new_ok = kgnilnd_data.kgn_rdmaq_override / *kgnilnd_tunables.kgn_rdmaq_intervals;
3907                         }  else {
3908                                 new_ok = ~0UL >> 1;
3909                         }
3910
3911                         /* roll current outstanding forward to make sure we carry outstanding
3912                          * committment forward
3913                          * new_ok starts out as the whole interval value
3914                          *  - first subtract bytes_out from last interval, as that would push us over
3915                          *    strict limits for this interval
3916                          *  - second, set bytes_ok to new_ok to ensure it doesn't exceed the current auth
3917                          *
3918                          * there is a small race here if someone is actively processing mappings and
3919                          * adding to rdmaq_bytes_out, but it should be small as the mappings are triggered
3920                          * quite quickly after kgnilnd_auth_rdma_bytes gives us the go-ahead
3921                          * - if this gives us problems in the future, we could use a read/write lock
3922                          * to protect the resetting of these values */
3923                         new_ok -= atomic64_read(&dev->gnd_rdmaq_bytes_out);
3924                         atomic64_set(&dev->gnd_rdmaq_bytes_ok, new_ok);
3925
3926                         CDEBUG(D_NET, "resetting rdmaq bytes to %ld, deadline +%lu -> %lu, "
3927                                        "current out %ld\n",
3928                                atomic64_read(&dev->gnd_rdmaq_bytes_ok), dead_bump, dev->gnd_rdmaq_deadline,
3929                                atomic64_read(&dev->gnd_rdmaq_bytes_out));
3930                 }
3931                 spin_unlock(&dev->gnd_rdmaq_lock);
3932         }
3933
3934         spin_lock(&dev->gnd_rdmaq_lock);
3935         while (!list_empty(&dev->gnd_rdmaq)) {
3936                 int     rc;
3937
3938                 /* make sure we break out early on quiesce */
3939                 if (unlikely(kgnilnd_data.kgn_quiesce_trigger)) {
3940                         /* always break with lock held - we unlock outside loop */
3941                         break;
3942                 }
3943
3944                 tx = list_first_entry(&dev->gnd_rdmaq, kgn_tx_t, tx_list);
3945                 kgnilnd_tx_del_state_locked(tx, NULL, tx->tx_conn, GNILND_TX_ALLOCD);
3946                 found_work++;
3947
3948                 /* sample with lock held, serializing with kgnilnd_complete_closed_conn */
3949                 if (tx->tx_conn->gnc_state != GNILND_CONN_ESTABLISHED) {
3950                         /* if conn is dying, mark tx in tx_ref_table for
3951                          * kgnilnd_complete_closed_conn to finish up */
3952                         kgnilnd_tx_add_state_locked(tx, NULL, tx->tx_conn, GNILND_TX_DYING, 1);
3953
3954                         /* tx was moved to DYING, get next */
3955                         continue;
3956                 }
3957                 spin_unlock(&dev->gnd_rdmaq_lock);
3958
3959                 rc = kgnilnd_auth_rdma_bytes(dev, tx);
3960                 spin_lock(&dev->gnd_rdmaq_lock);
3961
3962                 if (rc < 0) {
3963                         /* no ticket! add back to head */
3964                         kgnilnd_tx_add_state_locked(tx, NULL, tx->tx_conn, GNILND_TX_RDMAQ, 0);
3965                         /* clear found_work so scheduler threads wait for timer */
3966                         found_work = 0;
3967                         break;
3968                 } else {
3969                         /* TX is GO for launch */
3970                         tx->tx_qtime = jiffies;
3971                         kgnilnd_send_mapped_tx(tx, 0);
3972                         found_work++;
3973                 }
3974         }
3975         spin_unlock(&dev->gnd_rdmaq_lock);
3976
3977         RETURN(found_work);
3978 }
3979
3980 static inline void
3981 kgnilnd_swab_rdma_desc(kgn_rdma_desc_t *d)
3982 {
3983         __swab64s(&d->gnrd_key.qword1);
3984         __swab64s(&d->gnrd_key.qword2);
3985         __swab64s(&d->gnrd_addr);
3986         __swab32s(&d->gnrd_nob);
3987 }
3988
3989 #define kgnilnd_match_reply_either(w, x, y, z) _kgnilnd_match_reply(w, x, y, z)
3990 #define kgnilnd_match_reply(x, y, z) _kgnilnd_match_reply(x, y, GNILND_MSG_NONE, z)
3991
3992 kgn_tx_t *
3993 _kgnilnd_match_reply(kgn_conn_t *conn, int type1, int type2, __u64 cookie)
3994 {
3995         kgn_tx_ev_id_t    ev_id;
3996         kgn_tx_t         *tx;
3997
3998         /* we use the cookie from the original TX, so we can find the match
3999          * by parsing that and using the txe_idx */
4000         ev_id.txe_cookie = cookie;
4001
4002         tx = conn->gnc_tx_ref_table[ev_id.txe_idx];
4003
4004         if (tx != NULL) {
4005                 /* check tx to make sure kgni didn't eat it */
4006                 GNITX_ASSERTF(tx, tx->tx_msg.gnm_magic == GNILND_MSG_MAGIC,
4007                               "came back from kgni with bad magic %x\n", tx->tx_msg.gnm_magic);
4008
4009                 GNITX_ASSERTF(tx, ((tx->tx_id.txe_idx == ev_id.txe_idx) &&
4010                                   (tx->tx_id.txe_cookie = cookie)),
4011                               "conn 0x%p->%s tx_ref_table hosed: wanted "
4012                               "txe_cookie %#llx txe_idx %d "
4013                               "found tx %p cookie %#llx txe_idx %d\n",
4014                               conn, libcfs_nid2str(conn->gnc_peer->gnp_nid),
4015                               cookie, ev_id.txe_idx,
4016                               tx, tx->tx_id.txe_cookie, tx->tx_id.txe_idx);
4017
4018                 LASSERTF((((tx->tx_msg.gnm_type == type1) || (tx->tx_msg.gnm_type == type2)) &&
4019                         (tx->tx_state & GNILND_TX_WAITING_REPLY)),
4020                         "Unexpected TX type (%x, %x or %x) "
4021                         "or state (%x, expected +%x) "
4022                         "matched reply from %s\n",
4023                         tx->tx_msg.gnm_type, type1, type2,
4024                         tx->tx_state, GNILND_TX_WAITING_REPLY,
4025                         libcfs_nid2str(conn->gnc_peer->gnp_nid));
4026         } else {
4027                 CWARN("Unmatched reply %02x, or %02x/%#llx from %s\n",
4028                       type1, type2, cookie, libcfs_nid2str(conn->gnc_peer->gnp_nid));
4029         }
4030         return tx;
4031 }
4032
4033 static inline void
4034 kgnilnd_complete_tx(kgn_tx_t *tx, int rc)
4035 {
4036         int             complete = 0;
4037         kgn_conn_t      *conn = tx->tx_conn;
4038         __u64 nob = tx->tx_nob;
4039         __u32 physnop = tx->tx_phys_npages;
4040         int   id = tx->tx_id.txe_smsg_id;
4041         int buftype = tx->tx_buftype;
4042         gni_mem_handle_t hndl;
4043         hndl.qword1 = tx->tx_map_key.qword1;
4044         hndl.qword2 = tx->tx_map_key.qword2;
4045
4046         spin_lock(&conn->gnc_list_lock);
4047
4048         GNITX_ASSERTF(tx, tx->tx_state & GNILND_TX_WAITING_REPLY,
4049                 "not waiting for reply", NULL);
4050
4051         tx->tx_rc = rc;
4052         tx->tx_state &= ~GNILND_TX_WAITING_REPLY;
4053
4054         if (rc == -EFAULT) {
4055                 CDEBUG(D_NETERROR, "Error %d TX data: TX %p tx_id %x nob %16llu physnop %8d buffertype %#8x MemHandle %#llx.%#llxx\n",
4056                         rc, tx, id, nob, physnop, buftype, hndl.qword1, hndl.qword2);
4057
4058                 if(*kgnilnd_tunables.kgn_efault_lbug) {
4059                         GNIDBG_TOMSG(D_NETERROR, &tx->tx_msg,
4060                         "error %d on tx 0x%p->%s id %u/%d state %s age %ds",
4061                         rc, tx, conn ?
4062                         libcfs_nid2str(conn->gnc_peer->gnp_nid) : "<?>",
4063                         tx->tx_id.txe_smsg_id, tx->tx_id.txe_idx,
4064                         kgnilnd_tx_state2str(tx->tx_list_state),
4065                         cfs_duration_sec((unsigned long) jiffies - tx->tx_qtime));
4066                         LBUG();
4067                 }
4068         }
4069
4070         if (!(tx->tx_state & GNILND_TX_WAITING_COMPLETION)) {
4071                 kgnilnd_tx_del_state_locked(tx, NULL, conn, GNILND_TX_ALLOCD);
4072                 /* sample under lock as follow on steps require gnc_list_lock
4073                  * - or call kgnilnd_tx_done which requires no locks held over
4074                  *   call to lnet_finalize */
4075                 complete = 1;
4076         }
4077         spin_unlock(&conn->gnc_list_lock);
4078
4079         if (complete) {
4080                 kgnilnd_tx_done(tx, tx->tx_rc);
4081         }
4082 }
4083
4084 static inline void
4085 kgnilnd_finalize_rx_done(kgn_tx_t *tx, kgn_msg_t *msg)
4086 {
4087         int              rc;
4088         kgn_conn_t      *conn = tx->tx_conn;
4089
4090         atomic_inc(&conn->gnc_device->gnd_rdma_nrx);
4091         atomic64_add(tx->tx_nob, &conn->gnc_device->gnd_rdma_rxbytes);
4092
4093         /* the gncm_retval is passed in for PUTs */
4094         rc = kgnilnd_verify_rdma_cksum(tx, msg->gnm_payload_cksum,
4095                                        msg->gnm_u.completion.gncm_retval);
4096
4097         kgnilnd_complete_tx(tx, rc);
4098 }
4099
4100 void
4101 kgnilnd_check_fma_rx(kgn_conn_t *conn)
4102 {
4103         __u32         seq;
4104         kgn_tx_t     *tx;
4105         kgn_rx_t     *rx;
4106         kgn_msg_t    *msg;
4107         void         *prefix;
4108         gni_return_t  rrc;
4109         kgn_peer_t   *peer = conn->gnc_peer;
4110         kgn_net_t    *net;
4111         int           rc = 0;
4112         __u16         tmp_cksum = 0, msg_cksum = 0;
4113         int           repost = 1, saw_complete;
4114         unsigned long timestamp, newest_last_rx, timeout;
4115         int           last_seq;
4116         ENTRY;
4117
4118         /* Short circuit if the ep_handle is null.
4119          * It's likely that its about to be closed as stale.
4120          */
4121         if (conn->gnc_ephandle == NULL)
4122                 RETURN_EXIT;
4123
4124         timestamp = jiffies;
4125         kgnilnd_gl_mutex_lock(&conn->gnc_device->gnd_cq_mutex);
4126         /* delay in jiffies - we are really concerned only with things that
4127          * result in a schedule() or really holding this off for long times .
4128          * NB - mutex_lock could spin for 2 jiffies before going to sleep to wait */
4129         conn->gnc_device->gnd_mutex_delay += (long) jiffies - timestamp;
4130
4131         /* Resample current time as we have no idea how long it took to get the mutex */
4132         timestamp = jiffies;
4133
4134         /* We check here when the last time we received an rx, we do this before
4135          * we call getnext in case the thread has been blocked for a while. If we
4136          * havent received an rx since our timeout value we close the connection
4137          * as we should assume the other side has closed the connection. This will
4138          * stop us from sending replies to a mailbox that is already in purgatory.
4139          */
4140
4141         timeout = cfs_time_seconds(conn->gnc_timeout);
4142         newest_last_rx = GNILND_LASTRX(conn);
4143
4144         /* Error injection to validate that timestamp checking works and closing the conn */
4145         if (CFS_FAIL_CHECK(CFS_FAIL_GNI_RECV_TIMEOUT)) {
4146                 timestamp = timestamp + (GNILND_TIMEOUTRX(timeout) * 2);
4147         }
4148
4149         if (time_after_eq(timestamp, newest_last_rx + (GNILND_TIMEOUTRX(timeout)))) {
4150                 GNIDBG_CONN(D_NETERROR|D_CONSOLE, conn, "Cant receive from %s after timeout lapse of %lu; TO %lu",
4151                 libcfs_nid2str(conn->gnc_peer->gnp_nid),
4152                 cfs_duration_sec(timestamp - newest_last_rx),
4153                 cfs_duration_sec(GNILND_TIMEOUTRX(timeout)));
4154                 kgnilnd_gl_mutex_unlock(&conn->gnc_device->gnd_cq_mutex);
4155                 rc = -ETIME;
4156                 kgnilnd_close_conn(conn, rc);
4157                 RETURN_EXIT;
4158         }
4159
4160         rrc = kgnilnd_smsg_getnext(conn->gnc_ephandle, &prefix);
4161
4162         if (rrc == GNI_RC_NOT_DONE) {
4163                 kgnilnd_gl_mutex_unlock(&conn->gnc_device->gnd_cq_mutex);
4164                 CDEBUG(D_INFO, "SMSG RX empty conn 0x%p\n", conn);
4165                 RETURN_EXIT;
4166         }
4167
4168         /* Instead of asserting when we get mailbox corruption lets attempt to
4169          * close the conn and recover. We can put the conn/mailbox into
4170          * purgatory and let purgatory deal with the problem. If we see
4171          * this NETTERROR reported on production systems in large amounts
4172          * we will need to revisit the state machine to see if we can tighten
4173          * it up further to improve data protection.
4174          */
4175
4176         if (rrc == GNI_RC_INVALID_STATE) {
4177                 kgnilnd_gl_mutex_unlock(&conn->gnc_device->gnd_cq_mutex);
4178                 GNIDBG_CONN(D_NETERROR | D_CONSOLE, conn, "Mailbox corruption "
4179                         "detected closing conn %p from peer %s\n", conn,
4180                         libcfs_nid2str(conn->gnc_peer->gnp_nid));
4181                 rc = -EIO;
4182                 kgnilnd_close_conn(conn, rc);
4183                 RETURN_EXIT;
4184         }
4185
4186         LASSERTF(rrc == GNI_RC_SUCCESS,
4187                 "bad rc %d on conn %p from peer %s\n",
4188                 rrc, conn, libcfs_nid2str(peer->gnp_nid));
4189
4190         msg = (kgn_msg_t *)prefix;
4191
4192         rx = kgnilnd_alloc_rx();
4193         if (rx == NULL) {
4194                 kgnilnd_gl_mutex_unlock(&conn->gnc_device->gnd_cq_mutex);
4195                 kgnilnd_release_msg(conn);
4196                 GNIDBG_MSG(D_NETERROR, msg, "Dropping SMSG RX from 0x%p->%s, no RX memory",
4197                            conn, libcfs_nid2str(peer->gnp_nid));
4198                 RETURN_EXIT;
4199         }
4200
4201         GNIDBG_MSG(D_INFO, msg, "SMSG RX on %p", conn);
4202
4203         timestamp = conn->gnc_last_rx;
4204         seq = last_seq = atomic_read(&conn->gnc_rx_seq);
4205         atomic_inc(&conn->gnc_rx_seq);
4206
4207         conn->gnc_last_rx = jiffies;
4208         /* stash first rx so we can clear out purgatory
4209          */
4210         if (conn->gnc_first_rx == 0)
4211                 conn->gnc_first_rx = jiffies;
4212
4213         /* needs to linger to protect gnc_rx_seq like we do with gnc_tx_seq */
4214         kgnilnd_gl_mutex_unlock(&conn->gnc_device->gnd_cq_mutex);
4215         kgnilnd_peer_alive(conn->gnc_peer);
4216
4217         rx->grx_msg = msg;
4218         rx->grx_conn = conn;
4219         rx->grx_eager = 0;
4220         rx->grx_received = current_kernel_time();
4221
4222         if (CFS_FAIL_CHECK(CFS_FAIL_GNI_NET_LOOKUP)) {
4223                 rc = -ENONET;
4224         } else {
4225                 rc = kgnilnd_find_net(msg->gnm_srcnid, &net);
4226         }
4227
4228         if (rc < 0) {
4229                 GOTO(out, rc);
4230         } else {
4231                 kgnilnd_net_decref(net);
4232         }
4233
4234         if (*kgnilnd_tunables.kgn_checksum && !msg->gnm_cksum)
4235                 GNIDBG_MSG(D_WARNING, msg, "no msg header checksum when enabled");
4236
4237         /* XXX Nic: Do we need to swab cksum */
4238         if (msg->gnm_cksum != 0) {
4239                 msg_cksum = msg->gnm_cksum;
4240                 msg->gnm_cksum = 0;
4241                 tmp_cksum = kgnilnd_cksum(msg, sizeof(kgn_msg_t));
4242
4243                 if (tmp_cksum != msg_cksum) {
4244                         GNIDBG_MSG(D_NETERROR, msg, "Bad hdr checksum (%x expected %x)",
4245                                         tmp_cksum, msg_cksum);
4246                         kgnilnd_dump_msg(D_BUFFS, msg);
4247                         rc = -ENOKEY;
4248                         GOTO(out, rc);
4249                 }
4250         }
4251         /* restore checksum for future debug messages */
4252         msg->gnm_cksum = tmp_cksum;
4253
4254         if (msg->gnm_magic != GNILND_MSG_MAGIC) {
4255                 if (__swab32(msg->gnm_magic) != GNILND_MSG_MAGIC) {
4256                         GNIDBG_MSG(D_NETERROR, msg, "Unexpected magic %08x from %s",
4257                                msg->gnm_magic, libcfs_nid2str(peer->gnp_nid));
4258                         rc = -EPROTO;
4259                         GOTO(out, rc);
4260                 }
4261
4262                 __swab32s(&msg->gnm_magic);
4263                 __swab16s(&msg->gnm_version);
4264                 __swab16s(&msg->gnm_type);
4265                 __swab64s(&msg->gnm_srcnid);
4266                 __swab64s(&msg->gnm_connstamp);
4267                 __swab32s(&msg->gnm_seq);
4268
4269                 /* NB message type checked below; NOT here... */
4270                 switch (msg->gnm_type) {
4271                 case GNILND_MSG_GET_ACK_REV:
4272                 case GNILND_MSG_PUT_ACK:
4273                         kgnilnd_swab_rdma_desc(&msg->gnm_u.putack.gnpam_desc);
4274                         break;
4275
4276                 case GNILND_MSG_PUT_REQ_REV:
4277                 case GNILND_MSG_GET_REQ:
4278                         kgnilnd_swab_rdma_desc(&msg->gnm_u.get.gngm_desc);
4279                         break;
4280
4281                 default:
4282                         break;
4283                 }
4284         }
4285
4286         if (msg->gnm_version != GNILND_MSG_VERSION) {
4287                 GNIDBG_MSG(D_NETERROR, msg, "Unexpected protocol version %d from %s",
4288                        msg->gnm_version, libcfs_nid2str(peer->gnp_nid));
4289                 rc = -EPROTO;
4290                 GOTO(out, rc);
4291         }
4292
4293         if (LNET_NIDADDR(msg->gnm_srcnid) != LNET_NIDADDR(peer->gnp_nid)) {
4294                 GNIDBG_MSG(D_NETERROR, msg, "Unexpected peer %s from %s",
4295                        libcfs_nid2str(msg->gnm_srcnid),
4296                        libcfs_nid2str(peer->gnp_nid));
4297                 rc = -EPROTO;
4298                 GOTO(out, rc);
4299         }
4300
4301         if (msg->gnm_connstamp != conn->gnc_peer_connstamp) {
4302                 GNIDBG_MSG(D_NETERROR, msg, "Unexpected connstamp %#llx(%#llx"
4303                        " expected) from %s",
4304                        msg->gnm_connstamp, conn->gnc_peer_connstamp,
4305                        libcfs_nid2str(peer->gnp_nid));
4306                 rc = -EPROTO;
4307                 GOTO(out, rc);
4308         }
4309
4310         if (msg->gnm_seq != seq) {
4311                 GNIDBG_MSG(D_NETERROR, msg, "Unexpected sequence number %d(%d expected) from %s",
4312                        msg->gnm_seq, seq, libcfs_nid2str(peer->gnp_nid));
4313                 rc = -EPROTO;
4314                 GOTO(out, rc);
4315         }
4316
4317         atomic_inc(&conn->gnc_device->gnd_short_nrx);
4318
4319         if (msg->gnm_type == GNILND_MSG_CLOSE) {
4320                 CDEBUG(D_NETTRACE, "%s sent us CLOSE msg\n",
4321                               libcfs_nid2str(conn->gnc_peer->gnp_nid));
4322                 write_lock(&kgnilnd_data.kgn_peer_conn_lock);
4323                 conn->gnc_close_recvd = GNILND_CLOSE_RX;
4324                 conn->gnc_peer_error = msg->gnm_u.completion.gncm_retval;
4325                 /* double check state with lock held */
4326                 if (conn->gnc_state == GNILND_CONN_ESTABLISHED) {
4327                         /* only error if we are not already closing */
4328                         if (conn->gnc_peer_error == -ETIMEDOUT) {
4329                                 unsigned long           now = jiffies;
4330                                 CNETERR("peer 0x%p->%s closed connection 0x%p due to timeout. "
4331                                        "Is node down? "
4332                                        "RX %d @ %lus/%lus; TX %d @ %lus/%lus; "
4333                                        "NOOP %lus/%lus/%lus; sched %lus/%lus/%lus ago\n",
4334                                        conn->gnc_peer, libcfs_nid2str(conn->gnc_peer->gnp_nid),
4335                                        conn, last_seq,
4336                                        cfs_duration_sec(now - timestamp),
4337                                        cfs_duration_sec(now - conn->gnc_last_rx_cq),
4338                                        atomic_read(&conn->gnc_tx_seq),
4339                                        cfs_duration_sec(now - conn->gnc_last_tx),
4340                                        cfs_duration_sec(now - conn->gnc_last_tx_cq),
4341                                        cfs_duration_sec(now - conn->gnc_last_noop_want),
4342                                        cfs_duration_sec(now - conn->gnc_last_noop_sent),
4343                                        cfs_duration_sec(now - conn->gnc_last_noop_cq),
4344                                        cfs_duration_sec(now - conn->gnc_last_sched_ask),
4345                                        cfs_duration_sec(now - conn->gnc_last_sched_do),
4346                                        cfs_duration_sec(now - conn->gnc_device->gnd_sched_alive));
4347                         }
4348                         kgnilnd_close_conn_locked(conn, -ECONNRESET);
4349                 }
4350                 write_unlock(&kgnilnd_data.kgn_peer_conn_lock);
4351                 GOTO(out, rc);
4352         }
4353
4354         if (conn->gnc_close_recvd) {
4355                 GNIDBG_MSG(D_NETERROR, msg, "Unexpected message %s(%d/%d) after CLOSE from %s",
4356                        kgnilnd_msgtype2str(msg->gnm_type),
4357                        msg->gnm_type, conn->gnc_close_recvd,
4358                        libcfs_nid2str(conn->gnc_peer->gnp_nid));
4359                 rc = -EPROTO;
4360                 GOTO(out, rc);
4361         }
4362
4363         if (conn->gnc_state != GNILND_CONN_ESTABLISHED) {
4364                 /* XXX Nic: log message received on bad connection state */
4365                 GOTO(out, rc);
4366         }
4367
4368         switch (msg->gnm_type) {
4369         case GNILND_MSG_NOOP:
4370                 /* Nothing to do; just a keepalive */
4371                 break;
4372
4373         case GNILND_MSG_IMMEDIATE:
4374                 /* only get SMSG payload for IMMEDIATE */
4375                 atomic64_add(msg->gnm_payload_len, &conn->gnc_device->gnd_short_rxbytes);
4376                 rc = lnet_parse(net->gnn_ni, &msg->gnm_u.immediate.gnim_hdr,
4377                                 msg->gnm_srcnid, rx, 0);
4378                 repost = rc < 0;
4379                 break;
4380         case GNILND_MSG_GET_REQ_REV:
4381         case GNILND_MSG_PUT_REQ:
4382                 rc = lnet_parse(net->gnn_ni, &msg->gnm_u.putreq.gnprm_hdr,
4383                                 msg->gnm_srcnid, rx, 1);
4384                 repost = rc < 0;
4385                 break;
4386         case GNILND_MSG_GET_NAK_REV:
4387                 tx = kgnilnd_match_reply_either(conn, GNILND_MSG_GET_REQ_REV, GNILND_MSG_GET_ACK_REV,
4388                                         msg->gnm_u.completion.gncm_cookie);
4389                 if (tx == NULL)
4390                         break;
4391
4392                 kgnilnd_complete_tx(tx, msg->gnm_u.completion.gncm_retval);
4393                 break;
4394         case GNILND_MSG_PUT_NAK:
4395                 tx = kgnilnd_match_reply_either(conn, GNILND_MSG_PUT_REQ, GNILND_MSG_PUT_ACK,
4396                                         msg->gnm_u.completion.gncm_cookie);
4397                 if (tx == NULL)
4398                         break;
4399
4400                 kgnilnd_complete_tx(tx, msg->gnm_u.completion.gncm_retval);
4401                 break;
4402         case GNILND_MSG_PUT_ACK:
4403                 tx = kgnilnd_match_reply(conn, GNILND_MSG_PUT_REQ,
4404                                         msg->gnm_u.putack.gnpam_src_cookie);
4405                 if (tx == NULL)
4406                         break;
4407
4408                 /* store putack data for later: deferred rdma or re-try */
4409                 tx->tx_putinfo = msg->gnm_u.putack;
4410
4411                 saw_complete = 0;
4412                 spin_lock(&tx->tx_conn->gnc_list_lock);
4413
4414                 GNITX_ASSERTF(tx, tx->tx_state & GNILND_TX_WAITING_REPLY,
4415                         "not waiting for reply", NULL);
4416
4417                 tx->tx_state &= ~GNILND_TX_WAITING_REPLY;
4418
4419                 if (likely(!(tx->tx_state & GNILND_TX_WAITING_COMPLETION))) {
4420                         kgnilnd_tx_del_state_locked(tx, NULL, conn, GNILND_TX_ALLOCD);
4421                         /* sample under lock as follow on steps require gnc_list_lock
4422                          * - or call kgnilnd_tx_done which requires no locks held over
4423                          *   call to lnet_finalize */
4424                         saw_complete = 1;
4425                 } else {
4426                         /* cannot launch rdma if still waiting for fma-msg completion */
4427                         CDEBUG(D_NET, "tx 0x%p type 0x%02x will need to "
4428                                        "wait for SMSG completion\n", tx, tx->tx_msg.gnm_type);
4429                         tx->tx_state |= GNILND_TX_PENDING_RDMA;
4430                 }
4431                 spin_unlock(&tx->tx_conn->gnc_list_lock);
4432
4433                 if (saw_complete) {
4434                         rc = kgnilnd_send_mapped_tx(tx, 0);
4435                         if (rc < 0)
4436                                 kgnilnd_tx_done(tx, rc);
4437                 }
4438                 break;
4439         case GNILND_MSG_GET_ACK_REV:
4440                 tx = kgnilnd_match_reply(conn, GNILND_MSG_GET_REQ_REV,
4441                                         msg->gnm_u.putack.gnpam_src_cookie);
4442                 if (tx == NULL)
4443                         break;
4444
4445                 /* store putack data for later: deferred rdma or re-try */
4446                 tx->tx_putinfo = msg->gnm_u.putack;
4447                 saw_complete = 0;
4448                 spin_lock(&tx->tx_conn->gnc_list_lock);
4449
4450                 GNITX_ASSERTF(tx, tx->tx_state & GNILND_TX_WAITING_REPLY,
4451                         "not waiting for reply", NULL);
4452
4453                 tx->tx_state &= ~GNILND_TX_WAITING_REPLY;
4454
4455                 if (likely(!(tx->tx_state & GNILND_TX_WAITING_COMPLETION))) {
4456                         kgnilnd_tx_del_state_locked(tx, NULL, conn, GNILND_TX_ALLOCD);
4457                         /* sample under lock as follow on steps require gnc_list_lock
4458                          * - or call kgnilnd_tx_done which requires no locks held over
4459                          *   call to lnet_finalize */
4460                         saw_complete = 1;
4461                 } else {
4462                         /* cannot launch rdma if still waiting for fma-msg completion */
4463                         CDEBUG(D_NET, "tx 0x%p type 0x%02x will need to "
4464                                         "wait for SMSG completion\n", tx, tx->tx_msg.gnm_type);
4465                         tx->tx_state |= GNILND_TX_PENDING_RDMA;
4466                 }
4467                 spin_unlock(&tx->tx_conn->gnc_list_lock);
4468
4469                 if (saw_complete) {
4470                         rc = kgnilnd_send_mapped_tx(tx, 0);
4471                         if (rc < 0)
4472                                 kgnilnd_tx_done(tx, rc);
4473                 }
4474                 break;
4475         case GNILND_MSG_PUT_DONE:
4476                 tx = kgnilnd_match_reply(conn, GNILND_MSG_PUT_ACK,
4477                                         msg->gnm_u.completion.gncm_cookie);
4478                 if (tx == NULL)
4479                         break;
4480
4481                 GNITX_ASSERTF(tx, tx->tx_buftype == GNILND_BUF_PHYS_MAPPED ||
4482                                tx->tx_buftype == GNILND_BUF_VIRT_MAPPED,
4483                                "bad tx buftype %d", tx->tx_buftype);
4484
4485                 kgnilnd_finalize_rx_done(tx, msg);
4486                 break;
4487         case GNILND_MSG_PUT_REQ_REV:
4488         case GNILND_MSG_GET_REQ:
4489                 rc = lnet_parse(net->gnn_ni, &msg->gnm_u.get.gngm_hdr,
4490                                 msg->gnm_srcnid, rx, 1);
4491                 repost = rc < 0;
4492                 break;
4493
4494         case GNILND_MSG_GET_NAK:
4495                 tx = kgnilnd_match_reply(conn, GNILND_MSG_GET_REQ,
4496                                         msg->gnm_u.completion.gncm_cookie);
4497                 if (tx == NULL)
4498                         break;
4499
4500                 GNITX_ASSERTF(tx, tx->tx_buftype == GNILND_BUF_PHYS_MAPPED ||
4501                                tx->tx_buftype == GNILND_BUF_VIRT_MAPPED,
4502                                "bad tx buftype %d", tx->tx_buftype);
4503
4504                 kgnilnd_complete_tx(tx, msg->gnm_u.completion.gncm_retval);
4505                 break;
4506
4507         case GNILND_MSG_GET_DONE:
4508                 tx = kgnilnd_match_reply(conn, GNILND_MSG_GET_REQ,
4509                                         msg->gnm_u.completion.gncm_cookie);
4510                 if (tx == NULL)
4511                         break;
4512
4513                 GNITX_ASSERTF(tx, tx->tx_buftype == GNILND_BUF_PHYS_MAPPED ||
4514                                tx->tx_buftype == GNILND_BUF_VIRT_MAPPED,
4515                                "bad tx buftype %d", tx->tx_buftype);
4516
4517                 lnet_set_reply_msg_len(net->gnn_ni, tx->tx_lntmsg[1],
4518                                        msg->gnm_u.completion.gncm_retval);
4519
4520                 kgnilnd_finalize_rx_done(tx, msg);
4521                 break;
4522         case GNILND_MSG_GET_DONE_REV:
4523                 tx = kgnilnd_match_reply(conn, GNILND_MSG_GET_ACK_REV,
4524                                         msg->gnm_u.completion.gncm_cookie);
4525                 if (tx == NULL)
4526                         break;
4527
4528                 GNITX_ASSERTF(tx, tx->tx_buftype == GNILND_BUF_PHYS_MAPPED ||
4529                                 tx->tx_buftype == GNILND_BUF_VIRT_MAPPED,
4530                                 "bad tx buftype %d", tx->tx_buftype);
4531
4532                 kgnilnd_finalize_rx_done(tx, msg);
4533                 break;
4534
4535         case GNILND_MSG_PUT_DONE_REV:
4536                 tx = kgnilnd_match_reply(conn, GNILND_MSG_PUT_REQ_REV,
4537                                         msg->gnm_u.completion.gncm_cookie);
4538
4539                 if (tx == NULL)
4540                         break;
4541
4542                 GNITX_ASSERTF(tx, tx->tx_buftype == GNILND_BUF_PHYS_MAPPED ||
4543                                tx->tx_buftype == GNILND_BUF_VIRT_MAPPED,
4544                                "bad tx buftype %d", tx->tx_buftype);
4545
4546                 kgnilnd_finalize_rx_done(tx, msg);
4547                 break;
4548         case GNILND_MSG_PUT_NAK_REV:
4549                 tx = kgnilnd_match_reply(conn, GNILND_MSG_PUT_REQ_REV,
4550                                         msg->gnm_u.completion.gncm_cookie);
4551
4552                 if (tx == NULL)
4553                         break;
4554
4555                 GNITX_ASSERTF(tx, tx->tx_buftype == GNILND_BUF_PHYS_MAPPED ||
4556                                tx->tx_buftype == GNILND_BUF_VIRT_MAPPED,
4557                                 "bad tx buftype %d", tx->tx_buftype);
4558
4559                 kgnilnd_complete_tx(tx, msg->gnm_u.completion.gncm_retval);
4560                 break;
4561         }
4562
4563  out:
4564         if (rc < 0)                             /* protocol/comms error */
4565                 kgnilnd_close_conn(conn, rc);
4566
4567         if (repost && rx != NULL) {
4568                 kgnilnd_consume_rx(rx);
4569         }
4570
4571         /* we got an event so assume more there and call for reschedule */
4572         if (rc >= 0)
4573                 kgnilnd_schedule_conn(conn);
4574         EXIT;
4575 }
4576
4577 /* Do the failure injections that we need to affect conn processing in the following function.
4578  * When writing tests that use this function make sure to use a fail_loc with a fail mask.
4579  * If you dont you can cause the scheduler threads to spin on the conn without it leaving
4580  * process_conns.
4581  *
4582  * intent is used to signal the calling function whether or not the conn needs to be rescheduled.
4583  */
4584
4585 static inline int
4586 kgnilnd_check_conn_fail_loc(kgn_device_t *dev, kgn_conn_t *conn, int *intent)
4587 {
4588         int     rc = 0;
4589
4590         /* short circuit out when not set */
4591         if (likely(!cfs_fail_loc)) {
4592                 RETURN(rc);
4593         }
4594
4595         /* failure injection to test for stack reset clean ups */
4596         if (CFS_FAIL_CHECK(CFS_FAIL_GNI_DROP_CLOSING)) {
4597                 /* we can't rely on busy loops being nice enough to get the
4598                  *  stack reset triggered - it'd just spin on this conn */
4599                 CFS_RACE(CFS_FAIL_GNI_DROP_CLOSING);
4600                 rc = 1;
4601                 *intent = 1;
4602                 GOTO(did_fail_loc, rc);
4603         }
4604
4605         if (conn->gnc_state == GNILND_CONN_DESTROY_EP) {
4606                 /* DESTROY_EP set in kgnilnd_conn_decref on gnc_refcount = 1 */
4607
4608                 if (CFS_FAIL_CHECK(CFS_FAIL_GNI_DROP_DESTROY_EP)) {
4609                         CFS_RACE(CFS_FAIL_GNI_DROP_DESTROY_EP);
4610                         rc = 1;
4611                         *intent = 1;
4612                         GOTO(did_fail_loc, rc);
4613                 }
4614         }
4615
4616         /* CFS_FAIL_GNI_FINISH_PURG2 is used to stop a connection from fully closing. This scheduler
4617          * will spin on the CFS_FAIL_TIMEOUT until the fail_loc is cleared at which time the connection
4618          * will be closed by kgnilnd_complete_closed_conn.
4619          */
4620         if ((conn->gnc_state == GNILND_CONN_CLOSED) && CFS_FAIL_CHECK(CFS_FAIL_GNI_FINISH_PURG2)) {
4621                 while (CFS_FAIL_TIMEOUT(CFS_FAIL_GNI_FINISH_PURG2, 1)) {};
4622                 rc = 1;
4623                 *intent = 1;
4624                 GOTO(did_fail_loc, rc);
4625         }
4626
4627         /* this one is a bit gross - we can't hold the mutex from process_conns
4628          * across a CFS_RACE here - it'd block the conn threads from doing an ep_bind
4629          * and moving onto finish_connect
4630          * so, we'll just set the rc - kgnilnd_process_conns will clear
4631          * found_work on a fail_loc, getting the scheduler thread to call schedule()
4632          * and effectively getting this thread to sleep */
4633         if ((conn->gnc_state == GNILND_CONN_CLOSED) && CFS_FAIL_CHECK(CFS_FAIL_GNI_FINISH_PURG)) {
4634                 rc = 1;
4635                 *intent = 1;
4636                 GOTO(did_fail_loc, rc);
4637         }
4638
4639 did_fail_loc:
4640         RETURN(rc);
4641 }
4642
4643 static inline void
4644 kgnilnd_send_conn_close(kgn_conn_t *conn)
4645 {
4646         kgn_tx_t        *tx;
4647
4648         /* we are closing the conn - we will try to send the CLOSE msg
4649          * but will not wait for anything else to flush */
4650
4651         /* send the close if not already done so or received one */
4652         if (!conn->gnc_close_sent && !conn->gnc_close_recvd) {
4653                 /* set close_sent regardless of the success of the
4654                  * CLOSE message. We are going to try once and then
4655                  * kick him out of the sandbox */
4656                 conn->gnc_close_sent = 1;
4657                 mb();
4658
4659                 /* EP might be null already if remote side initiated a new connection.
4660                  * kgnilnd_finish_connect destroys existing ep_handles before wiring up the new connection,
4661                  * so this check is here to make sure we dont attempt to send with a null ep_handle.
4662                  */
4663                 if (conn->gnc_ephandle != NULL) {
4664                         int rc = 0;
4665
4666                         tx = kgnilnd_new_tx_msg(GNILND_MSG_CLOSE, conn->gnc_peer->gnp_net->gnn_ni->ni_nid);
4667                         if (tx != NULL) {
4668                                 tx->tx_msg.gnm_u.completion.gncm_retval = conn->gnc_error;
4669                                 tx->tx_state = GNILND_TX_WAITING_COMPLETION;
4670                                 tx->tx_qtime = jiffies;
4671
4672                                 if (tx->tx_id.txe_idx == 0) {
4673                                         rc = kgnilnd_set_tx_id(tx, conn);
4674                                         if (rc != 0) {
4675                                                 kgnilnd_tx_done(tx, rc);
4676                                         }
4677                                 }
4678
4679                                 CDEBUG(D_NETTRACE, "sending close with errno %d\n",
4680                                                 conn->gnc_error);
4681
4682                                 if (CFS_FAIL_CHECK(CFS_FAIL_GNI_CLOSE_SEND)) {
4683                                         kgnilnd_tx_done(tx, -EAGAIN);
4684                                 } else if (!rc) {
4685                                         rc = kgnilnd_sendmsg(tx, NULL, 0, NULL, GNILND_TX_FMAQ);
4686                                         if (rc) {
4687                                                 /* It wasnt sent and we dont care. */
4688                                                 kgnilnd_tx_done(tx, rc);
4689                                         }
4690                                 }
4691
4692                         }
4693                 }
4694         }
4695
4696         /* When changing gnc_state we need to take the kgn_peer_conn_lock */
4697         write_lock(&kgnilnd_data.kgn_peer_conn_lock);
4698         conn->gnc_state = GNILND_CONN_CLOSED;
4699         write_unlock(&kgnilnd_data.kgn_peer_conn_lock);
4700         /* mark this conn as CLOSED now that we processed it
4701          * do after TX, so we can use CLOSING in asserts */
4702
4703         mb();
4704
4705         if (CFS_FAIL_CHECK(CFS_FAIL_GNI_RX_CLOSE_CLOSED)) {
4706                 /* simulate a RX CLOSE after the timeout but before
4707                  * the scheduler thread gets it */
4708                 conn->gnc_close_recvd = GNILND_CLOSE_INJECT2;
4709                 conn->gnc_peer_error = -ETIMEDOUT;
4710         }
4711         /* schedule to allow potential CLOSE and get the complete phase run */
4712         kgnilnd_schedule_conn(conn);
4713 }
4714
4715 int
4716 kgnilnd_process_mapped_tx(kgn_device_t *dev)
4717 {
4718         int             found_work = 0;
4719         int             rc = 0;
4720         kgn_tx_t        *tx;
4721         int              fast_remaps = GNILND_FAST_MAPPING_TRY;
4722         int             log_retrans, log_retrans_level;
4723         static int      last_map_version;
4724         ENTRY;
4725
4726         spin_lock(&dev->gnd_lock);
4727         if (list_empty(&dev->gnd_map_tx)) {
4728                 /* if the list is empty make sure we dont have a timer running */
4729                 del_singleshot_timer_sync(&dev->gnd_map_timer);
4730                 spin_unlock(&dev->gnd_lock);
4731                 RETURN(0);
4732         }
4733
4734         dev->gnd_sched_alive = jiffies;
4735
4736         /* we'll retry as fast as possible up to 25% of the limit, then we start
4737          * backing off until our map version changes - indicating we unmapped
4738          * something */
4739         tx = list_first_entry(&dev->gnd_map_tx, kgn_tx_t, tx_list);
4740         if (likely(dev->gnd_map_attempt == 0) ||
4741                 time_after_eq(jiffies, dev->gnd_next_map) ||
4742                 last_map_version != dev->gnd_map_version) {
4743
4744                 /* if this is our first attempt at mapping set last mapped to current
4745                  * jiffies so we can timeout our attempt correctly.
4746                  */
4747                 if (dev->gnd_map_attempt == 0)
4748                         dev->gnd_last_map = jiffies;
4749         } else {
4750                 GNIDBG_TX(D_NET, tx, "waiting for mapping event event to retry", NULL);
4751                 spin_unlock(&dev->gnd_lock);
4752                 RETURN(0);
4753         }
4754
4755         /* delete the previous timer if it exists */
4756         del_singleshot_timer_sync(&dev->gnd_map_timer);
4757         /* stash the last map version to let us know when a good one was seen */
4758         last_map_version = dev->gnd_map_version;
4759
4760         /* we need to to take the lock and continually refresh the head of the list as
4761          * kgnilnd_complete_closed_conn might be nuking stuff and we are cycling the lock
4762          * allowing them to squeeze in */
4763
4764         while (!list_empty(&dev->gnd_map_tx)) {
4765                 /* make sure we break out early on quiesce */
4766                 if (unlikely(kgnilnd_data.kgn_quiesce_trigger)) {
4767                         /* always break with lock held - we unlock outside loop */
4768                         break;
4769                 }
4770
4771                 tx = list_first_entry(&dev->gnd_map_tx, kgn_tx_t, tx_list);
4772
4773                 kgnilnd_tx_del_state_locked(tx, NULL, tx->tx_conn, GNILND_TX_ALLOCD);
4774                 found_work++;
4775
4776                 /* sample with lock held, serializing with kgnilnd_complete_closed_conn */
4777                 if (tx->tx_conn->gnc_state != GNILND_CONN_ESTABLISHED) {
4778                         /* if conn is dying, mark tx in tx_ref_table for
4779                          * kgnilnd_complete_closed_conn to finish up */
4780                         kgnilnd_tx_add_state_locked(tx, NULL, tx->tx_conn, GNILND_TX_DYING, 1);
4781                         found_work++;
4782
4783                         /* tx was moved to DYING, get next */
4784                         continue;
4785                 }
4786
4787                 spin_unlock(&dev->gnd_lock);
4788                 rc = kgnilnd_send_mapped_tx(tx, 1);
4789
4790                 /* We made it! skip error handling.. */
4791                 if (rc >= 0) {
4792                         /* OK to continue on +ve errors as it won't get seen until
4793                          * this function is called again - we operate on a copy of the original
4794                          * list and not the live list */
4795                         spin_lock(&dev->gnd_lock);
4796                         /* reset map attempts back to zero we successfully
4797                          * mapped so we can reset our timers */
4798                         dev->gnd_map_attempt = 0;
4799                         continue;
4800                 } else if (rc == -EAGAIN) {
4801                         spin_lock(&dev->gnd_lock);
4802                         mod_timer(&dev->gnd_map_timer, dev->gnd_next_map);
4803                         spin_unlock(&dev->gnd_lock);
4804                         GOTO(get_out_mapped, rc);
4805                 } else if (rc != -ENOMEM) {
4806                         /* carp, failure we can't handle */
4807                         kgnilnd_tx_done(tx, rc);
4808                         spin_lock(&dev->gnd_lock);
4809                         /* reset map attempts back to zero we dont know what happened but it
4810                          * wasnt a failed mapping
4811                          */
4812                         dev->gnd_map_attempt = 0;
4813                         continue;
4814                 }
4815
4816                 /* time to handle the retry cases..  lock so we dont have 2 threads
4817                  * mucking with gnd_map_attempt, or gnd_next_map at the same time.
4818                  */
4819                 spin_lock(&dev->gnd_lock);
4820                 dev->gnd_map_attempt++;
4821                 if (dev->gnd_map_attempt < fast_remaps) {
4822                         /* do nothing we just want it to go as fast as possible.
4823                          * just set gnd_next_map to current jiffies so it will process
4824                          * as fast as possible.
4825                          */
4826                         dev->gnd_next_map = jiffies;
4827                 } else {
4828                         /* Retry based on GNILND_MAP_RETRY_RATE */
4829                         dev->gnd_next_map = jiffies + GNILND_MAP_RETRY_RATE;
4830                 }
4831
4832                 /* only log occasionally once we've retried fast_remaps */
4833                 log_retrans = (dev->gnd_map_attempt >= fast_remaps) &&
4834                               ((dev->gnd_map_attempt % fast_remaps) == 0);
4835                 log_retrans_level = log_retrans ? D_NETERROR : D_NET;
4836
4837                 /* make sure we are not off in the weeds with this tx */
4838                 if (time_after(jiffies, dev->gnd_last_map + GNILND_MAP_TIMEOUT)) {
4839                        GNIDBG_TX(D_NETERROR, tx,
4840                                "giving up on TX, too many retries", NULL);
4841                        spin_unlock(&dev->gnd_lock);
4842                        if (tx->tx_msg.gnm_type == GNILND_MSG_PUT_REQ ||
4843                            tx->tx_msg.gnm_type == GNILND_MSG_GET_REQ_REV) {
4844                                kgnilnd_nak_rdma(tx->tx_conn, tx->tx_msg.gnm_type,
4845                                                 -ENOMEM,
4846                                                 tx->tx_putinfo.gnpam_dst_cookie,
4847                                                 tx->tx_msg.gnm_srcnid);
4848                         } else {
4849                                 kgnilnd_nak_rdma(tx->tx_conn, tx->tx_msg.gnm_type,
4850                                                 -ENOMEM,
4851                                                 tx->tx_getinfo.gngm_cookie,
4852                                                 tx->tx_msg.gnm_srcnid);
4853                         }
4854                        kgnilnd_tx_done(tx, -ENOMEM);
4855                        GOTO(get_out_mapped, rc);
4856                 } else {
4857                        GNIDBG_TX(log_retrans_level, tx,
4858                                 "transient map failure #%d %d pages/%d bytes phys %u@%u "
4859                                 "virt %u@%llu "
4860                                 "nq_map %d mdd# %d/%d GART %ld",
4861                                 dev->gnd_map_attempt, tx->tx_phys_npages, tx->tx_nob,
4862                                 dev->gnd_map_nphys, dev->gnd_map_physnop * PAGE_SIZE,
4863                                 dev->gnd_map_nvirt, dev->gnd_map_virtnob,
4864                                 atomic_read(&dev->gnd_nq_map),
4865                                 atomic_read(&dev->gnd_n_mdd), atomic_read(&dev->gnd_n_mdd_held),
4866                                 atomic64_read(&dev->gnd_nbytes_map));
4867                 }
4868
4869                 /* we need to stop processing the rest of the list, so add it back in */
4870                 /* set timer to wake device when we need to schedule this tx */
4871                 mod_timer(&dev->gnd_map_timer, dev->gnd_next_map);
4872                 kgnilnd_tx_add_state_locked(tx, NULL, tx->tx_conn, GNILND_TX_MAPQ, 0);
4873                 spin_unlock(&dev->gnd_lock);
4874                 GOTO(get_out_mapped, rc);
4875         }
4876         spin_unlock(&dev->gnd_lock);
4877 get_out_mapped:
4878         RETURN(found_work);
4879 }
4880
4881 int
4882 kgnilnd_process_conns(kgn_device_t *dev, unsigned long deadline)
4883 {
4884         int              found_work = 0;
4885         int              conn_sched;
4886         int              intent = 0;
4887         int              error_inject = 0;
4888         int              rc = 0;
4889         kgn_conn_t      *conn;
4890
4891         spin_lock(&dev->gnd_lock);
4892         while (!list_empty(&dev->gnd_ready_conns) && time_before(jiffies, deadline)) {
4893                 dev->gnd_sched_alive = jiffies;
4894                 error_inject = 0;
4895                 rc = 0;
4896
4897                 if (unlikely(kgnilnd_data.kgn_quiesce_trigger)) {
4898                         /* break with lock held */
4899                         break;
4900                 }
4901
4902                 conn = list_first_entry(&dev->gnd_ready_conns, kgn_conn_t, gnc_schedlist);
4903                 list_del_init(&conn->gnc_schedlist);
4904                 /* 
4905                  * Since we are processing conn now, we don't need to be on the delaylist any longer.
4906                  */
4907
4908                 if (!list_empty(&conn->gnc_delaylist))
4909                         list_del_init(&conn->gnc_delaylist);
4910                 spin_unlock(&dev->gnd_lock);
4911
4912                 conn_sched = xchg(&conn->gnc_scheduled, GNILND_CONN_PROCESS);
4913
4914                 LASSERTF(conn_sched != GNILND_CONN_IDLE &&
4915                          conn_sched != GNILND_CONN_PROCESS,
4916                          "conn %p on ready list but in bad state: %d\n",
4917                          conn, conn_sched);
4918
4919                 CDEBUG(D_INFO, "conn %p@%s for processing\n",
4920                         conn, kgnilnd_conn_state2str(conn));
4921
4922                 found_work++;
4923                 set_mb(conn->gnc_last_sched_do, jiffies);
4924
4925                 if (kgnilnd_check_conn_fail_loc(dev, conn, &intent)) {
4926
4927                         /* based on intent see if we should run again. */
4928                         rc = kgnilnd_schedule_process_conn(conn, intent);
4929                         error_inject = 1;
4930                         /* drop ref from gnd_ready_conns */
4931                         if (atomic_read(&conn->gnc_refcount) == 1 && rc != 1) {
4932                                 down_write(&dev->gnd_conn_sem);
4933                                 kgnilnd_conn_decref(conn);
4934                                 up_write(&dev->gnd_conn_sem);
4935                         } else if (rc != 1) {
4936                                 kgnilnd_conn_decref(conn);
4937                         }
4938                         /* clear this so that scheduler thread doesn't spin */
4939                         found_work = 0;
4940                         /* break with lock held... */
4941                         spin_lock(&dev->gnd_lock);
4942                         break;
4943                 }
4944
4945                 if (unlikely(conn->gnc_state == GNILND_CONN_CLOSED)) {
4946                         down_write(&dev->gnd_conn_sem);
4947
4948                         /* CONN_CLOSED set in procces_fmaq when CLOSE is sent */
4949                         if (unlikely(atomic_read(&conn->gnc_tx_in_use))) {
4950                                 /* If there are tx's currently in use in another
4951                                  * thread we dont want to complete the close
4952                                  * yet. Cycle this conn back through
4953                                  * the scheduler. */
4954                                 kgnilnd_schedule_conn(conn);
4955                         } else {
4956                                 kgnilnd_complete_closed_conn(conn);
4957                         }
4958                         up_write(&dev->gnd_conn_sem);
4959                 } else if (unlikely(conn->gnc_state == GNILND_CONN_DESTROY_EP)) {
4960                         /* DESTROY_EP set in kgnilnd_conn_decref on gnc_refcount = 1 */
4961                         /* serialize SMSG CQs with ep_bind and smsg_release */
4962                         down_write(&dev->gnd_conn_sem);
4963                         kgnilnd_destroy_conn_ep(conn);
4964                         up_write(&dev->gnd_conn_sem);
4965                 } else if (unlikely(conn->gnc_state == GNILND_CONN_CLOSING)) {
4966                        /* if we need to do some CLOSE sending, etc done here do it */
4967                         down_write(&dev->gnd_conn_sem);
4968                         kgnilnd_send_conn_close(conn);
4969                         kgnilnd_check_fma_rx(conn);
4970                         up_write(&dev->gnd_conn_sem);
4971                 } else if (atomic_read(&conn->gnc_peer->gnp_dirty_eps) == 0) {
4972                         /* start moving traffic if the old conns are cleared out */
4973                         down_read(&dev->gnd_conn_sem);
4974                         kgnilnd_check_fma_rx(conn);
4975                         kgnilnd_process_fmaq(conn);
4976                         up_read(&dev->gnd_conn_sem);
4977                 }
4978
4979                 rc = kgnilnd_schedule_process_conn(conn, 0);
4980
4981                 /* drop ref from gnd_ready_conns */
4982                 if (atomic_read(&conn->gnc_refcount) == 1 && rc != 1) {
4983                         down_write(&dev->gnd_conn_sem);
4984                         kgnilnd_conn_decref(conn);
4985                         up_write(&dev->gnd_conn_sem);
4986                 } else if (rc != 1) {
4987                         kgnilnd_conn_decref(conn);
4988                 }
4989
4990                 /* check list again with lock held */
4991                 spin_lock(&dev->gnd_lock);
4992         }
4993
4994         /* If we are short circuiting due to timing we want to be scheduled
4995          * as soon as possible.
4996          */
4997         if (!list_empty(&dev->gnd_ready_conns) && !error_inject)
4998                 found_work++;
4999
5000         spin_unlock(&dev->gnd_lock);
5001
5002         RETURN(found_work);
5003 }
5004
5005 int
5006 kgnilnd_scheduler(void *arg)
5007 {
5008         int               threadno = (long)arg;
5009         kgn_device_t            *dev;
5010         int                     busy_loops = 0;
5011         unsigned long     deadline = 0;
5012         DEFINE_WAIT(wait);
5013
5014         dev = &kgnilnd_data.kgn_devices[(threadno + 1) % kgnilnd_data.kgn_ndevs];
5015
5016         cfs_block_allsigs();
5017
5018         /* all gnilnd threads need to run fairly urgently */
5019         set_user_nice(current, *kgnilnd_tunables.kgn_sched_nice);
5020         deadline = jiffies + cfs_time_seconds(*kgnilnd_tunables.kgn_sched_timeout);
5021         while (!kgnilnd_data.kgn_shutdown) {
5022                 int     found_work = 0;
5023                 /* Safe: kgn_shutdown only set when quiescent */
5024
5025                 /* to quiesce or to not quiesce, that is the question */
5026
5027                 if (unlikely(kgnilnd_data.kgn_quiesce_trigger)) {
5028                         KGNILND_SPIN_QUIESCE;
5029                 }
5030
5031                 /* tracking for when thread goes AWOL */
5032                 dev->gnd_sched_alive = jiffies;
5033
5034                 CFS_FAIL_TIMEOUT(CFS_FAIL_GNI_SCHED_DEADLINE,
5035                         (*kgnilnd_tunables.kgn_sched_timeout + 1));
5036                 /* let folks know we are up and kicking
5037                  * - they can use this for latency savings, etc
5038                  * - only change if IRQ, if IDLE leave alone as that
5039                  *   schedule_device calls to put us back to IRQ */
5040                 (void)cmpxchg(&dev->gnd_ready, GNILND_DEV_IRQ, GNILND_DEV_LOOP);
5041
5042                 down_read(&dev->gnd_conn_sem);
5043                 /* always check these - they are super low cost  */
5044                 found_work += kgnilnd_check_fma_send_cq(dev);
5045                 found_work += kgnilnd_check_fma_rcv_cq(dev);
5046
5047                 /* rdma CQ doesn't care about eps */
5048                 found_work += kgnilnd_check_rdma_cq(dev);
5049
5050                 /* move some RDMA ? */
5051                 found_work += kgnilnd_process_rdmaq(dev);
5052
5053                 /* map some pending RDMA requests ? */
5054                 found_work += kgnilnd_process_mapped_tx(dev);
5055
5056                 /* the EP for a conn is not destroyed until all the references
5057                  * to it are gone, so these checks should be safe
5058                  * even if run in parallel with the CQ checking functions
5059                  * _AND_ a thread that processes the CLOSED->DONE
5060                  * transistion
5061                  * ...should.... */
5062
5063                 up_read(&dev->gnd_conn_sem);
5064
5065                 /* process all conns ready now */
5066                 found_work += kgnilnd_process_conns(dev, deadline);
5067
5068                 /* do an eager check to avoid the IRQ disabling in
5069                  * prepare_to_wait and friends */
5070
5071                 if (found_work &&
5072                    (busy_loops++ < *kgnilnd_tunables.kgn_loops) &&
5073                    time_before(jiffies, deadline)) {
5074                         found_work = 0;
5075                         if ((busy_loops % 10) == 0) {
5076                                 /* tickle heartbeat and watchdog to ensure our
5077                                  * piggishness doesn't turn into heartbeat failure */
5078                                 touch_nmi_watchdog();
5079                                 kgnilnd_hw_hb();
5080                         }
5081                         continue;
5082                 }
5083
5084                 /* if we got here, found_work was zero or busy_loops means we
5085                  * need to take a break. We'll clear gnd_ready but we'll check
5086                  * one last time if there is an IRQ that needs processing */
5087
5088                 prepare_to_wait(&dev->gnd_waitq, &wait, TASK_INTERRUPTIBLE);
5089
5090                 /* the first time this will go LOOP -> IDLE and let us do one final check
5091                  * during which we might get an IRQ, then IDLE->IDLE and schedule()
5092                  * - this might allow other threads to block us for a bit if they
5093                  *   try to get the mutex, but that is good as we'd need to wake
5094                  *   up soon to handle the CQ or other processing anyways */
5095
5096                 found_work += xchg(&dev->gnd_ready, GNILND_DEV_IDLE);
5097
5098                 if ((busy_loops >= *kgnilnd_tunables.kgn_loops) ||
5099                    time_after_eq(jiffies, deadline)) {
5100                         CDEBUG(D_INFO,
5101                                "yeilding: found_work %d busy_loops %d\n",
5102                                found_work, busy_loops);
5103                         busy_loops = 0;
5104                         /* use yield if we are bailing due to busy_loops
5105                          * - this will ensure we wake up soonish. This closes
5106                          * a race with kgnilnd_device_callback - where it'd
5107                          * not call wake_up() because gnd_ready == 1, but then
5108                          * we come down and schedule() because of busy_loops.
5109                          * We'd not be woken up until something poked our waitq
5110                          * again. yield() ensures we wake up without another
5111                          * waitq poke in that case */
5112                         atomic_inc(&dev->gnd_n_yield);
5113                         kgnilnd_data.kgn_last_condresched = jiffies;
5114                         yield();
5115                         CDEBUG(D_INFO, "awake after yeild\n");
5116                         deadline = jiffies + cfs_time_seconds(*kgnilnd_tunables.kgn_sched_timeout);
5117                 } else if (found_work == GNILND_DEV_IDLE) {
5118                         /* busy_loops is low and there is nothing to do,
5119                          * go to sleep and wait for a waitq poke */
5120                         CDEBUG(D_INFO,
5121                                "scheduling: found_work %d busy_loops %d\n",
5122                                found_work, busy_loops);
5123                         atomic_inc(&dev->gnd_n_schedule);
5124                         kgnilnd_data.kgn_last_scheduled = jiffies;
5125                         schedule();
5126                         CDEBUG(D_INFO, "awake after schedule\n");
5127                         deadline = jiffies + cfs_time_seconds(*kgnilnd_tunables.kgn_sched_timeout);
5128                 }
5129                 finish_wait(&dev->gnd_waitq, &wait);
5130         }
5131
5132         kgnilnd_thread_fini();
5133         return 0;
5134 }