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