1 /* 2 * Copyright (c) 2016 Mellanox Technologies Ltd. All rights reserved. 3 * Copyright (c) 2015 System Fabric Works, Inc. All rights reserved. 4 * 5 * This software is available to you under a choice of one of two 6 * licenses. You may choose to be licensed under the terms of the GNU 7 * General Public License (GPL) Version 2, available from the file 8 * COPYING in the main directory of this source tree, or the 9 * OpenIB.org BSD license below: 10 * 11 * Redistribution and use in source and binary forms, with or 12 * without modification, are permitted provided that the following 13 * conditions are met: 14 * 15 * - Redistributions of source code must retain the above 16 * copyright notice, this list of conditions and the following 17 * disclaimer. 18 * 19 * - Redistributions in binary form must reproduce the above 20 * copyright notice, this list of conditions and the following 21 * disclaimer in the documentation and/or other materials 22 * provided with the distribution. 23 * 24 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, 25 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF 26 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND 27 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS 28 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN 29 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN 30 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE 31 * SOFTWARE. 32 */ 33 34 #include <linux/skbuff.h> 35 36 #include "rxe.h" 37 #include "rxe_loc.h" 38 #include "rxe_queue.h" 39 40 enum resp_states { 41 RESPST_NONE, 42 RESPST_GET_REQ, 43 RESPST_CHK_PSN, 44 RESPST_CHK_OP_SEQ, 45 RESPST_CHK_OP_VALID, 46 RESPST_CHK_RESOURCE, 47 RESPST_CHK_LENGTH, 48 RESPST_CHK_RKEY, 49 RESPST_EXECUTE, 50 RESPST_READ_REPLY, 51 RESPST_COMPLETE, 52 RESPST_ACKNOWLEDGE, 53 RESPST_CLEANUP, 54 RESPST_DUPLICATE_REQUEST, 55 RESPST_ERR_MALFORMED_WQE, 56 RESPST_ERR_UNSUPPORTED_OPCODE, 57 RESPST_ERR_MISALIGNED_ATOMIC, 58 RESPST_ERR_PSN_OUT_OF_SEQ, 59 RESPST_ERR_MISSING_OPCODE_FIRST, 60 RESPST_ERR_MISSING_OPCODE_LAST_C, 61 RESPST_ERR_MISSING_OPCODE_LAST_D1E, 62 RESPST_ERR_TOO_MANY_RDMA_ATM_REQ, 63 RESPST_ERR_RNR, 64 RESPST_ERR_RKEY_VIOLATION, 65 RESPST_ERR_LENGTH, 66 RESPST_ERR_CQ_OVERFLOW, 67 RESPST_ERROR, 68 RESPST_RESET, 69 RESPST_DONE, 70 RESPST_EXIT, 71 }; 72 73 static char *resp_state_name[] = { 74 [RESPST_NONE] = "NONE", 75 [RESPST_GET_REQ] = "GET_REQ", 76 [RESPST_CHK_PSN] = "CHK_PSN", 77 [RESPST_CHK_OP_SEQ] = "CHK_OP_SEQ", 78 [RESPST_CHK_OP_VALID] = "CHK_OP_VALID", 79 [RESPST_CHK_RESOURCE] = "CHK_RESOURCE", 80 [RESPST_CHK_LENGTH] = "CHK_LENGTH", 81 [RESPST_CHK_RKEY] = "CHK_RKEY", 82 [RESPST_EXECUTE] = "EXECUTE", 83 [RESPST_READ_REPLY] = "READ_REPLY", 84 [RESPST_COMPLETE] = "COMPLETE", 85 [RESPST_ACKNOWLEDGE] = "ACKNOWLEDGE", 86 [RESPST_CLEANUP] = "CLEANUP", 87 [RESPST_DUPLICATE_REQUEST] = "DUPLICATE_REQUEST", 88 [RESPST_ERR_MALFORMED_WQE] = "ERR_MALFORMED_WQE", 89 [RESPST_ERR_UNSUPPORTED_OPCODE] = "ERR_UNSUPPORTED_OPCODE", 90 [RESPST_ERR_MISALIGNED_ATOMIC] = "ERR_MISALIGNED_ATOMIC", 91 [RESPST_ERR_PSN_OUT_OF_SEQ] = "ERR_PSN_OUT_OF_SEQ", 92 [RESPST_ERR_MISSING_OPCODE_FIRST] = "ERR_MISSING_OPCODE_FIRST", 93 [RESPST_ERR_MISSING_OPCODE_LAST_C] = "ERR_MISSING_OPCODE_LAST_C", 94 [RESPST_ERR_MISSING_OPCODE_LAST_D1E] = "ERR_MISSING_OPCODE_LAST_D1E", 95 [RESPST_ERR_TOO_MANY_RDMA_ATM_REQ] = "ERR_TOO_MANY_RDMA_ATM_REQ", 96 [RESPST_ERR_RNR] = "ERR_RNR", 97 [RESPST_ERR_RKEY_VIOLATION] = "ERR_RKEY_VIOLATION", 98 [RESPST_ERR_LENGTH] = "ERR_LENGTH", 99 [RESPST_ERR_CQ_OVERFLOW] = "ERR_CQ_OVERFLOW", 100 [RESPST_ERROR] = "ERROR", 101 [RESPST_RESET] = "RESET", 102 [RESPST_DONE] = "DONE", 103 [RESPST_EXIT] = "EXIT", 104 }; 105 106 /* rxe_recv calls here to add a request packet to the input queue */ 107 void rxe_resp_queue_pkt(struct rxe_dev *rxe, struct rxe_qp *qp, 108 struct sk_buff *skb) 109 { 110 int must_sched; 111 struct rxe_pkt_info *pkt = SKB_TO_PKT(skb); 112 113 skb_queue_tail(&qp->req_pkts, skb); 114 115 must_sched = (pkt->opcode == IB_OPCODE_RC_RDMA_READ_REQUEST) || 116 (skb_queue_len(&qp->req_pkts) > 1); 117 118 rxe_run_task(&qp->resp.task, must_sched); 119 } 120 121 static inline enum resp_states get_req(struct rxe_qp *qp, 122 struct rxe_pkt_info **pkt_p) 123 { 124 struct sk_buff *skb; 125 126 if (qp->resp.state == QP_STATE_ERROR) { 127 skb = skb_dequeue(&qp->req_pkts); 128 if (skb) { 129 /* drain request packet queue */ 130 rxe_drop_ref(qp); 131 kfree_skb(skb); 132 return RESPST_GET_REQ; 133 } 134 135 /* go drain recv wr queue */ 136 return RESPST_CHK_RESOURCE; 137 } 138 139 skb = skb_peek(&qp->req_pkts); 140 if (!skb) 141 return RESPST_EXIT; 142 143 *pkt_p = SKB_TO_PKT(skb); 144 145 return (qp->resp.res) ? RESPST_READ_REPLY : RESPST_CHK_PSN; 146 } 147 148 static enum resp_states check_psn(struct rxe_qp *qp, 149 struct rxe_pkt_info *pkt) 150 { 151 int diff = psn_compare(pkt->psn, qp->resp.psn); 152 struct rxe_dev *rxe = to_rdev(qp->ibqp.device); 153 154 switch (qp_type(qp)) { 155 case IB_QPT_RC: 156 if (diff > 0) { 157 if (qp->resp.sent_psn_nak) 158 return RESPST_CLEANUP; 159 160 qp->resp.sent_psn_nak = 1; 161 rxe_counter_inc(rxe, RXE_CNT_OUT_OF_SEQ_REQ); 162 return RESPST_ERR_PSN_OUT_OF_SEQ; 163 164 } else if (diff < 0) { 165 rxe_counter_inc(rxe, RXE_CNT_DUP_REQ); 166 return RESPST_DUPLICATE_REQUEST; 167 } 168 169 if (qp->resp.sent_psn_nak) 170 qp->resp.sent_psn_nak = 0; 171 172 break; 173 174 case IB_QPT_UC: 175 if (qp->resp.drop_msg || diff != 0) { 176 if (pkt->mask & RXE_START_MASK) { 177 qp->resp.drop_msg = 0; 178 return RESPST_CHK_OP_SEQ; 179 } 180 181 qp->resp.drop_msg = 1; 182 return RESPST_CLEANUP; 183 } 184 break; 185 default: 186 break; 187 } 188 189 return RESPST_CHK_OP_SEQ; 190 } 191 192 static enum resp_states check_op_seq(struct rxe_qp *qp, 193 struct rxe_pkt_info *pkt) 194 { 195 switch (qp_type(qp)) { 196 case IB_QPT_RC: 197 switch (qp->resp.opcode) { 198 case IB_OPCODE_RC_SEND_FIRST: 199 case IB_OPCODE_RC_SEND_MIDDLE: 200 switch (pkt->opcode) { 201 case IB_OPCODE_RC_SEND_MIDDLE: 202 case IB_OPCODE_RC_SEND_LAST: 203 case IB_OPCODE_RC_SEND_LAST_WITH_IMMEDIATE: 204 case IB_OPCODE_RC_SEND_LAST_WITH_INVALIDATE: 205 return RESPST_CHK_OP_VALID; 206 default: 207 return RESPST_ERR_MISSING_OPCODE_LAST_C; 208 } 209 210 case IB_OPCODE_RC_RDMA_WRITE_FIRST: 211 case IB_OPCODE_RC_RDMA_WRITE_MIDDLE: 212 switch (pkt->opcode) { 213 case IB_OPCODE_RC_RDMA_WRITE_MIDDLE: 214 case IB_OPCODE_RC_RDMA_WRITE_LAST: 215 case IB_OPCODE_RC_RDMA_WRITE_LAST_WITH_IMMEDIATE: 216 return RESPST_CHK_OP_VALID; 217 default: 218 return RESPST_ERR_MISSING_OPCODE_LAST_C; 219 } 220 221 default: 222 switch (pkt->opcode) { 223 case IB_OPCODE_RC_SEND_MIDDLE: 224 case IB_OPCODE_RC_SEND_LAST: 225 case IB_OPCODE_RC_SEND_LAST_WITH_IMMEDIATE: 226 case IB_OPCODE_RC_SEND_LAST_WITH_INVALIDATE: 227 case IB_OPCODE_RC_RDMA_WRITE_MIDDLE: 228 case IB_OPCODE_RC_RDMA_WRITE_LAST: 229 case IB_OPCODE_RC_RDMA_WRITE_LAST_WITH_IMMEDIATE: 230 return RESPST_ERR_MISSING_OPCODE_FIRST; 231 default: 232 return RESPST_CHK_OP_VALID; 233 } 234 } 235 break; 236 237 case IB_QPT_UC: 238 switch (qp->resp.opcode) { 239 case IB_OPCODE_UC_SEND_FIRST: 240 case IB_OPCODE_UC_SEND_MIDDLE: 241 switch (pkt->opcode) { 242 case IB_OPCODE_UC_SEND_MIDDLE: 243 case IB_OPCODE_UC_SEND_LAST: 244 case IB_OPCODE_UC_SEND_LAST_WITH_IMMEDIATE: 245 return RESPST_CHK_OP_VALID; 246 default: 247 return RESPST_ERR_MISSING_OPCODE_LAST_D1E; 248 } 249 250 case IB_OPCODE_UC_RDMA_WRITE_FIRST: 251 case IB_OPCODE_UC_RDMA_WRITE_MIDDLE: 252 switch (pkt->opcode) { 253 case IB_OPCODE_UC_RDMA_WRITE_MIDDLE: 254 case IB_OPCODE_UC_RDMA_WRITE_LAST: 255 case IB_OPCODE_UC_RDMA_WRITE_LAST_WITH_IMMEDIATE: 256 return RESPST_CHK_OP_VALID; 257 default: 258 return RESPST_ERR_MISSING_OPCODE_LAST_D1E; 259 } 260 261 default: 262 switch (pkt->opcode) { 263 case IB_OPCODE_UC_SEND_MIDDLE: 264 case IB_OPCODE_UC_SEND_LAST: 265 case IB_OPCODE_UC_SEND_LAST_WITH_IMMEDIATE: 266 case IB_OPCODE_UC_RDMA_WRITE_MIDDLE: 267 case IB_OPCODE_UC_RDMA_WRITE_LAST: 268 case IB_OPCODE_UC_RDMA_WRITE_LAST_WITH_IMMEDIATE: 269 qp->resp.drop_msg = 1; 270 return RESPST_CLEANUP; 271 default: 272 return RESPST_CHK_OP_VALID; 273 } 274 } 275 break; 276 277 default: 278 return RESPST_CHK_OP_VALID; 279 } 280 } 281 282 static enum resp_states check_op_valid(struct rxe_qp *qp, 283 struct rxe_pkt_info *pkt) 284 { 285 switch (qp_type(qp)) { 286 case IB_QPT_RC: 287 if (((pkt->mask & RXE_READ_MASK) && 288 !(qp->attr.qp_access_flags & IB_ACCESS_REMOTE_READ)) || 289 ((pkt->mask & RXE_WRITE_MASK) && 290 !(qp->attr.qp_access_flags & IB_ACCESS_REMOTE_WRITE)) || 291 ((pkt->mask & RXE_ATOMIC_MASK) && 292 !(qp->attr.qp_access_flags & IB_ACCESS_REMOTE_ATOMIC))) { 293 return RESPST_ERR_UNSUPPORTED_OPCODE; 294 } 295 296 break; 297 298 case IB_QPT_UC: 299 if ((pkt->mask & RXE_WRITE_MASK) && 300 !(qp->attr.qp_access_flags & IB_ACCESS_REMOTE_WRITE)) { 301 qp->resp.drop_msg = 1; 302 return RESPST_CLEANUP; 303 } 304 305 break; 306 307 case IB_QPT_UD: 308 case IB_QPT_SMI: 309 case IB_QPT_GSI: 310 break; 311 312 default: 313 WARN_ON_ONCE(1); 314 break; 315 } 316 317 return RESPST_CHK_RESOURCE; 318 } 319 320 static enum resp_states get_srq_wqe(struct rxe_qp *qp) 321 { 322 struct rxe_srq *srq = qp->srq; 323 struct rxe_queue *q = srq->rq.queue; 324 struct rxe_recv_wqe *wqe; 325 struct ib_event ev; 326 327 if (srq->error) 328 return RESPST_ERR_RNR; 329 330 spin_lock_bh(&srq->rq.consumer_lock); 331 332 wqe = queue_head(q); 333 if (!wqe) { 334 spin_unlock_bh(&srq->rq.consumer_lock); 335 return RESPST_ERR_RNR; 336 } 337 338 /* note kernel and user space recv wqes have same size */ 339 memcpy(&qp->resp.srq_wqe, wqe, sizeof(qp->resp.srq_wqe)); 340 341 qp->resp.wqe = &qp->resp.srq_wqe.wqe; 342 advance_consumer(q); 343 344 if (srq->limit && srq->ibsrq.event_handler && 345 (queue_count(q) < srq->limit)) { 346 srq->limit = 0; 347 goto event; 348 } 349 350 spin_unlock_bh(&srq->rq.consumer_lock); 351 return RESPST_CHK_LENGTH; 352 353 event: 354 spin_unlock_bh(&srq->rq.consumer_lock); 355 ev.device = qp->ibqp.device; 356 ev.element.srq = qp->ibqp.srq; 357 ev.event = IB_EVENT_SRQ_LIMIT_REACHED; 358 srq->ibsrq.event_handler(&ev, srq->ibsrq.srq_context); 359 return RESPST_CHK_LENGTH; 360 } 361 362 static enum resp_states check_resource(struct rxe_qp *qp, 363 struct rxe_pkt_info *pkt) 364 { 365 struct rxe_srq *srq = qp->srq; 366 367 if (qp->resp.state == QP_STATE_ERROR) { 368 if (qp->resp.wqe) { 369 qp->resp.status = IB_WC_WR_FLUSH_ERR; 370 return RESPST_COMPLETE; 371 } else if (!srq) { 372 qp->resp.wqe = queue_head(qp->rq.queue); 373 if (qp->resp.wqe) { 374 qp->resp.status = IB_WC_WR_FLUSH_ERR; 375 return RESPST_COMPLETE; 376 } else { 377 return RESPST_EXIT; 378 } 379 } else { 380 return RESPST_EXIT; 381 } 382 } 383 384 if (pkt->mask & RXE_READ_OR_ATOMIC) { 385 /* it is the requesters job to not send 386 * too many read/atomic ops, we just 387 * recycle the responder resource queue 388 */ 389 if (likely(qp->attr.max_dest_rd_atomic > 0)) 390 return RESPST_CHK_LENGTH; 391 else 392 return RESPST_ERR_TOO_MANY_RDMA_ATM_REQ; 393 } 394 395 if (pkt->mask & RXE_RWR_MASK) { 396 if (srq) 397 return get_srq_wqe(qp); 398 399 qp->resp.wqe = queue_head(qp->rq.queue); 400 return (qp->resp.wqe) ? RESPST_CHK_LENGTH : RESPST_ERR_RNR; 401 } 402 403 return RESPST_CHK_LENGTH; 404 } 405 406 static enum resp_states check_length(struct rxe_qp *qp, 407 struct rxe_pkt_info *pkt) 408 { 409 switch (qp_type(qp)) { 410 case IB_QPT_RC: 411 return RESPST_CHK_RKEY; 412 413 case IB_QPT_UC: 414 return RESPST_CHK_RKEY; 415 416 default: 417 return RESPST_CHK_RKEY; 418 } 419 } 420 421 static enum resp_states check_rkey(struct rxe_qp *qp, 422 struct rxe_pkt_info *pkt) 423 { 424 struct rxe_mem *mem = NULL; 425 u64 va; 426 u32 rkey; 427 u32 resid; 428 u32 pktlen; 429 int mtu = qp->mtu; 430 enum resp_states state; 431 int access; 432 433 if (pkt->mask & (RXE_READ_MASK | RXE_WRITE_MASK)) { 434 if (pkt->mask & RXE_RETH_MASK) { 435 qp->resp.va = reth_va(pkt); 436 qp->resp.rkey = reth_rkey(pkt); 437 qp->resp.resid = reth_len(pkt); 438 } 439 access = (pkt->mask & RXE_READ_MASK) ? IB_ACCESS_REMOTE_READ 440 : IB_ACCESS_REMOTE_WRITE; 441 } else if (pkt->mask & RXE_ATOMIC_MASK) { 442 qp->resp.va = atmeth_va(pkt); 443 qp->resp.rkey = atmeth_rkey(pkt); 444 qp->resp.resid = sizeof(u64); 445 access = IB_ACCESS_REMOTE_ATOMIC; 446 } else { 447 return RESPST_EXECUTE; 448 } 449 450 /* A zero-byte op is not required to set an addr or rkey. */ 451 if ((pkt->mask & (RXE_READ_MASK | RXE_WRITE_OR_SEND)) && 452 (pkt->mask & RXE_RETH_MASK) && 453 reth_len(pkt) == 0) { 454 return RESPST_EXECUTE; 455 } 456 457 va = qp->resp.va; 458 rkey = qp->resp.rkey; 459 resid = qp->resp.resid; 460 pktlen = payload_size(pkt); 461 462 mem = lookup_mem(qp->pd, access, rkey, lookup_remote); 463 if (!mem) { 464 state = RESPST_ERR_RKEY_VIOLATION; 465 goto err; 466 } 467 468 if (unlikely(mem->state == RXE_MEM_STATE_FREE)) { 469 state = RESPST_ERR_RKEY_VIOLATION; 470 goto err; 471 } 472 473 if (mem_check_range(mem, va, resid)) { 474 state = RESPST_ERR_RKEY_VIOLATION; 475 goto err; 476 } 477 478 if (pkt->mask & RXE_WRITE_MASK) { 479 if (resid > mtu) { 480 if (pktlen != mtu || bth_pad(pkt)) { 481 state = RESPST_ERR_LENGTH; 482 goto err; 483 } 484 } else { 485 if (pktlen != resid) { 486 state = RESPST_ERR_LENGTH; 487 goto err; 488 } 489 if ((bth_pad(pkt) != (0x3 & (-resid)))) { 490 /* This case may not be exactly that 491 * but nothing else fits. 492 */ 493 state = RESPST_ERR_LENGTH; 494 goto err; 495 } 496 } 497 } 498 499 WARN_ON_ONCE(qp->resp.mr); 500 501 qp->resp.mr = mem; 502 return RESPST_EXECUTE; 503 504 err: 505 if (mem) 506 rxe_drop_ref(mem); 507 return state; 508 } 509 510 static enum resp_states send_data_in(struct rxe_qp *qp, void *data_addr, 511 int data_len) 512 { 513 int err; 514 515 err = copy_data(qp->pd, IB_ACCESS_LOCAL_WRITE, &qp->resp.wqe->dma, 516 data_addr, data_len, to_mem_obj, NULL); 517 if (unlikely(err)) 518 return (err == -ENOSPC) ? RESPST_ERR_LENGTH 519 : RESPST_ERR_MALFORMED_WQE; 520 521 return RESPST_NONE; 522 } 523 524 static enum resp_states write_data_in(struct rxe_qp *qp, 525 struct rxe_pkt_info *pkt) 526 { 527 enum resp_states rc = RESPST_NONE; 528 int err; 529 int data_len = payload_size(pkt); 530 531 err = rxe_mem_copy(qp->resp.mr, qp->resp.va, payload_addr(pkt), 532 data_len, to_mem_obj, NULL); 533 if (err) { 534 rc = RESPST_ERR_RKEY_VIOLATION; 535 goto out; 536 } 537 538 qp->resp.va += data_len; 539 qp->resp.resid -= data_len; 540 541 out: 542 return rc; 543 } 544 545 /* Guarantee atomicity of atomic operations at the machine level. */ 546 static DEFINE_SPINLOCK(atomic_ops_lock); 547 548 static enum resp_states process_atomic(struct rxe_qp *qp, 549 struct rxe_pkt_info *pkt) 550 { 551 u64 iova = atmeth_va(pkt); 552 u64 *vaddr; 553 enum resp_states ret; 554 struct rxe_mem *mr = qp->resp.mr; 555 556 if (mr->state != RXE_MEM_STATE_VALID) { 557 ret = RESPST_ERR_RKEY_VIOLATION; 558 goto out; 559 } 560 561 vaddr = iova_to_vaddr(mr, iova, sizeof(u64)); 562 563 /* check vaddr is 8 bytes aligned. */ 564 if (!vaddr || (uintptr_t)vaddr & 7) { 565 ret = RESPST_ERR_MISALIGNED_ATOMIC; 566 goto out; 567 } 568 569 spin_lock_bh(&atomic_ops_lock); 570 571 qp->resp.atomic_orig = *vaddr; 572 573 if (pkt->opcode == IB_OPCODE_RC_COMPARE_SWAP || 574 pkt->opcode == IB_OPCODE_RD_COMPARE_SWAP) { 575 if (*vaddr == atmeth_comp(pkt)) 576 *vaddr = atmeth_swap_add(pkt); 577 } else { 578 *vaddr += atmeth_swap_add(pkt); 579 } 580 581 spin_unlock_bh(&atomic_ops_lock); 582 583 ret = RESPST_NONE; 584 out: 585 return ret; 586 } 587 588 static struct sk_buff *prepare_ack_packet(struct rxe_qp *qp, 589 struct rxe_pkt_info *pkt, 590 struct rxe_pkt_info *ack, 591 int opcode, 592 int payload, 593 u32 psn, 594 u8 syndrome, 595 u32 *crcp) 596 { 597 struct rxe_dev *rxe = to_rdev(qp->ibqp.device); 598 struct sk_buff *skb; 599 u32 crc = 0; 600 u32 *p; 601 int paylen; 602 int pad; 603 int err; 604 605 /* 606 * allocate packet 607 */ 608 pad = (-payload) & 0x3; 609 paylen = rxe_opcode[opcode].length + payload + pad + RXE_ICRC_SIZE; 610 611 skb = rxe_init_packet(rxe, &qp->pri_av, paylen, ack); 612 if (!skb) 613 return NULL; 614 615 ack->qp = qp; 616 ack->opcode = opcode; 617 ack->mask = rxe_opcode[opcode].mask; 618 ack->offset = pkt->offset; 619 ack->paylen = paylen; 620 621 /* fill in bth using the request packet headers */ 622 memcpy(ack->hdr, pkt->hdr, pkt->offset + RXE_BTH_BYTES); 623 624 bth_set_opcode(ack, opcode); 625 bth_set_qpn(ack, qp->attr.dest_qp_num); 626 bth_set_pad(ack, pad); 627 bth_set_se(ack, 0); 628 bth_set_psn(ack, psn); 629 bth_set_ack(ack, 0); 630 ack->psn = psn; 631 632 if (ack->mask & RXE_AETH_MASK) { 633 aeth_set_syn(ack, syndrome); 634 aeth_set_msn(ack, qp->resp.msn); 635 } 636 637 if (ack->mask & RXE_ATMACK_MASK) 638 atmack_set_orig(ack, qp->resp.atomic_orig); 639 640 err = rxe_prepare(ack, skb, &crc); 641 if (err) { 642 kfree_skb(skb); 643 return NULL; 644 } 645 646 if (crcp) { 647 /* CRC computation will be continued by the caller */ 648 *crcp = crc; 649 } else { 650 p = payload_addr(ack) + payload + bth_pad(ack); 651 *p = ~crc; 652 } 653 654 return skb; 655 } 656 657 /* RDMA read response. If res is not NULL, then we have a current RDMA request 658 * being processed or replayed. 659 */ 660 static enum resp_states read_reply(struct rxe_qp *qp, 661 struct rxe_pkt_info *req_pkt) 662 { 663 struct rxe_dev *rxe = to_rdev(qp->ibqp.device); 664 struct rxe_pkt_info ack_pkt; 665 struct sk_buff *skb; 666 int mtu = qp->mtu; 667 enum resp_states state; 668 int payload; 669 int opcode; 670 int err; 671 struct resp_res *res = qp->resp.res; 672 u32 icrc; 673 u32 *p; 674 675 if (!res) { 676 /* This is the first time we process that request. Get a 677 * resource 678 */ 679 res = &qp->resp.resources[qp->resp.res_head]; 680 681 free_rd_atomic_resource(qp, res); 682 rxe_advance_resp_resource(qp); 683 684 res->type = RXE_READ_MASK; 685 res->replay = 0; 686 687 res->read.va = qp->resp.va; 688 res->read.va_org = qp->resp.va; 689 690 res->first_psn = req_pkt->psn; 691 692 if (reth_len(req_pkt)) { 693 res->last_psn = (req_pkt->psn + 694 (reth_len(req_pkt) + mtu - 1) / 695 mtu - 1) & BTH_PSN_MASK; 696 } else { 697 res->last_psn = res->first_psn; 698 } 699 res->cur_psn = req_pkt->psn; 700 701 res->read.resid = qp->resp.resid; 702 res->read.length = qp->resp.resid; 703 res->read.rkey = qp->resp.rkey; 704 705 /* note res inherits the reference to mr from qp */ 706 res->read.mr = qp->resp.mr; 707 qp->resp.mr = NULL; 708 709 qp->resp.res = res; 710 res->state = rdatm_res_state_new; 711 } 712 713 if (res->state == rdatm_res_state_new) { 714 if (res->read.resid <= mtu) 715 opcode = IB_OPCODE_RC_RDMA_READ_RESPONSE_ONLY; 716 else 717 opcode = IB_OPCODE_RC_RDMA_READ_RESPONSE_FIRST; 718 } else { 719 if (res->read.resid > mtu) 720 opcode = IB_OPCODE_RC_RDMA_READ_RESPONSE_MIDDLE; 721 else 722 opcode = IB_OPCODE_RC_RDMA_READ_RESPONSE_LAST; 723 } 724 725 res->state = rdatm_res_state_next; 726 727 payload = min_t(int, res->read.resid, mtu); 728 729 skb = prepare_ack_packet(qp, req_pkt, &ack_pkt, opcode, payload, 730 res->cur_psn, AETH_ACK_UNLIMITED, &icrc); 731 if (!skb) 732 return RESPST_ERR_RNR; 733 734 err = rxe_mem_copy(res->read.mr, res->read.va, payload_addr(&ack_pkt), 735 payload, from_mem_obj, &icrc); 736 if (err) 737 pr_err("Failed copying memory\n"); 738 739 p = payload_addr(&ack_pkt) + payload + bth_pad(&ack_pkt); 740 *p = ~icrc; 741 742 err = rxe_xmit_packet(rxe, qp, &ack_pkt, skb); 743 if (err) { 744 pr_err("Failed sending RDMA reply.\n"); 745 return RESPST_ERR_RNR; 746 } 747 748 res->read.va += payload; 749 res->read.resid -= payload; 750 res->cur_psn = (res->cur_psn + 1) & BTH_PSN_MASK; 751 752 if (res->read.resid > 0) { 753 state = RESPST_DONE; 754 } else { 755 qp->resp.res = NULL; 756 if (!res->replay) 757 qp->resp.opcode = -1; 758 if (psn_compare(res->cur_psn, qp->resp.psn) >= 0) 759 qp->resp.psn = res->cur_psn; 760 state = RESPST_CLEANUP; 761 } 762 763 return state; 764 } 765 766 static void build_rdma_network_hdr(union rdma_network_hdr *hdr, 767 struct rxe_pkt_info *pkt) 768 { 769 struct sk_buff *skb = PKT_TO_SKB(pkt); 770 771 memset(hdr, 0, sizeof(*hdr)); 772 if (skb->protocol == htons(ETH_P_IP)) 773 memcpy(&hdr->roce4grh, ip_hdr(skb), sizeof(hdr->roce4grh)); 774 else if (skb->protocol == htons(ETH_P_IPV6)) 775 memcpy(&hdr->ibgrh, ipv6_hdr(skb), sizeof(hdr->ibgrh)); 776 } 777 778 /* Executes a new request. A retried request never reach that function (send 779 * and writes are discarded, and reads and atomics are retried elsewhere. 780 */ 781 static enum resp_states execute(struct rxe_qp *qp, struct rxe_pkt_info *pkt) 782 { 783 enum resp_states err; 784 785 if (pkt->mask & RXE_SEND_MASK) { 786 if (qp_type(qp) == IB_QPT_UD || 787 qp_type(qp) == IB_QPT_SMI || 788 qp_type(qp) == IB_QPT_GSI) { 789 union rdma_network_hdr hdr; 790 791 build_rdma_network_hdr(&hdr, pkt); 792 793 err = send_data_in(qp, &hdr, sizeof(hdr)); 794 if (err) 795 return err; 796 } 797 err = send_data_in(qp, payload_addr(pkt), payload_size(pkt)); 798 if (err) 799 return err; 800 } else if (pkt->mask & RXE_WRITE_MASK) { 801 err = write_data_in(qp, pkt); 802 if (err) 803 return err; 804 } else if (pkt->mask & RXE_READ_MASK) { 805 /* For RDMA Read we can increment the msn now. See C9-148. */ 806 qp->resp.msn++; 807 return RESPST_READ_REPLY; 808 } else if (pkt->mask & RXE_ATOMIC_MASK) { 809 err = process_atomic(qp, pkt); 810 if (err) 811 return err; 812 } else { 813 /* Unreachable */ 814 WARN_ON_ONCE(1); 815 } 816 817 /* next expected psn, read handles this separately */ 818 qp->resp.psn = (pkt->psn + 1) & BTH_PSN_MASK; 819 qp->resp.ack_psn = qp->resp.psn; 820 821 qp->resp.opcode = pkt->opcode; 822 qp->resp.status = IB_WC_SUCCESS; 823 824 if (pkt->mask & RXE_COMP_MASK) { 825 /* We successfully processed this new request. */ 826 qp->resp.msn++; 827 return RESPST_COMPLETE; 828 } else if (qp_type(qp) == IB_QPT_RC) 829 return RESPST_ACKNOWLEDGE; 830 else 831 return RESPST_CLEANUP; 832 } 833 834 static enum resp_states do_complete(struct rxe_qp *qp, 835 struct rxe_pkt_info *pkt) 836 { 837 struct rxe_cqe cqe; 838 struct ib_wc *wc = &cqe.ibwc; 839 struct ib_uverbs_wc *uwc = &cqe.uibwc; 840 struct rxe_recv_wqe *wqe = qp->resp.wqe; 841 842 if (unlikely(!wqe)) 843 return RESPST_CLEANUP; 844 845 memset(&cqe, 0, sizeof(cqe)); 846 847 wc->wr_id = wqe->wr_id; 848 wc->status = qp->resp.status; 849 wc->qp = &qp->ibqp; 850 851 /* fields after status are not required for errors */ 852 if (wc->status == IB_WC_SUCCESS) { 853 wc->opcode = (pkt->mask & RXE_IMMDT_MASK && 854 pkt->mask & RXE_WRITE_MASK) ? 855 IB_WC_RECV_RDMA_WITH_IMM : IB_WC_RECV; 856 wc->vendor_err = 0; 857 wc->byte_len = wqe->dma.length - wqe->dma.resid; 858 859 /* fields after byte_len are different between kernel and user 860 * space 861 */ 862 if (qp->rcq->is_user) { 863 uwc->wc_flags = IB_WC_GRH; 864 865 if (pkt->mask & RXE_IMMDT_MASK) { 866 uwc->wc_flags |= IB_WC_WITH_IMM; 867 uwc->ex.imm_data = immdt_imm(pkt); 868 } 869 870 if (pkt->mask & RXE_IETH_MASK) { 871 uwc->wc_flags |= IB_WC_WITH_INVALIDATE; 872 uwc->ex.invalidate_rkey = ieth_rkey(pkt); 873 } 874 875 uwc->qp_num = qp->ibqp.qp_num; 876 877 if (pkt->mask & RXE_DETH_MASK) 878 uwc->src_qp = deth_sqp(pkt); 879 880 uwc->port_num = qp->attr.port_num; 881 } else { 882 struct sk_buff *skb = PKT_TO_SKB(pkt); 883 884 wc->wc_flags = IB_WC_GRH | IB_WC_WITH_NETWORK_HDR_TYPE; 885 if (skb->protocol == htons(ETH_P_IP)) 886 wc->network_hdr_type = RDMA_NETWORK_IPV4; 887 else 888 wc->network_hdr_type = RDMA_NETWORK_IPV6; 889 890 if (is_vlan_dev(skb->dev)) { 891 wc->wc_flags |= IB_WC_WITH_VLAN; 892 wc->vlan_id = vlan_dev_vlan_id(skb->dev); 893 } 894 895 if (pkt->mask & RXE_IMMDT_MASK) { 896 wc->wc_flags |= IB_WC_WITH_IMM; 897 wc->ex.imm_data = immdt_imm(pkt); 898 } 899 900 if (pkt->mask & RXE_IETH_MASK) { 901 struct rxe_dev *rxe = to_rdev(qp->ibqp.device); 902 struct rxe_mem *rmr; 903 904 wc->wc_flags |= IB_WC_WITH_INVALIDATE; 905 wc->ex.invalidate_rkey = ieth_rkey(pkt); 906 907 rmr = rxe_pool_get_index(&rxe->mr_pool, 908 wc->ex.invalidate_rkey >> 8); 909 if (unlikely(!rmr)) { 910 pr_err("Bad rkey %#x invalidation\n", 911 wc->ex.invalidate_rkey); 912 return RESPST_ERROR; 913 } 914 rmr->state = RXE_MEM_STATE_FREE; 915 rxe_drop_ref(rmr); 916 } 917 918 wc->qp = &qp->ibqp; 919 920 if (pkt->mask & RXE_DETH_MASK) 921 wc->src_qp = deth_sqp(pkt); 922 923 wc->port_num = qp->attr.port_num; 924 } 925 } 926 927 /* have copy for srq and reference for !srq */ 928 if (!qp->srq) 929 advance_consumer(qp->rq.queue); 930 931 qp->resp.wqe = NULL; 932 933 if (rxe_cq_post(qp->rcq, &cqe, pkt ? bth_se(pkt) : 1)) 934 return RESPST_ERR_CQ_OVERFLOW; 935 936 if (qp->resp.state == QP_STATE_ERROR) 937 return RESPST_CHK_RESOURCE; 938 939 if (!pkt) 940 return RESPST_DONE; 941 else if (qp_type(qp) == IB_QPT_RC) 942 return RESPST_ACKNOWLEDGE; 943 else 944 return RESPST_CLEANUP; 945 } 946 947 static int send_ack(struct rxe_qp *qp, struct rxe_pkt_info *pkt, 948 u8 syndrome, u32 psn) 949 { 950 int err = 0; 951 struct rxe_pkt_info ack_pkt; 952 struct sk_buff *skb; 953 struct rxe_dev *rxe = to_rdev(qp->ibqp.device); 954 955 skb = prepare_ack_packet(qp, pkt, &ack_pkt, IB_OPCODE_RC_ACKNOWLEDGE, 956 0, psn, syndrome, NULL); 957 if (!skb) { 958 err = -ENOMEM; 959 goto err1; 960 } 961 962 err = rxe_xmit_packet(rxe, qp, &ack_pkt, skb); 963 if (err) 964 pr_err_ratelimited("Failed sending ack\n"); 965 966 err1: 967 return err; 968 } 969 970 static int send_atomic_ack(struct rxe_qp *qp, struct rxe_pkt_info *pkt, 971 u8 syndrome) 972 { 973 int rc = 0; 974 struct rxe_pkt_info ack_pkt; 975 struct sk_buff *skb; 976 struct rxe_dev *rxe = to_rdev(qp->ibqp.device); 977 struct resp_res *res; 978 979 skb = prepare_ack_packet(qp, pkt, &ack_pkt, 980 IB_OPCODE_RC_ATOMIC_ACKNOWLEDGE, 0, pkt->psn, 981 syndrome, NULL); 982 if (!skb) { 983 rc = -ENOMEM; 984 goto out; 985 } 986 987 rxe_add_ref(qp); 988 989 res = &qp->resp.resources[qp->resp.res_head]; 990 free_rd_atomic_resource(qp, res); 991 rxe_advance_resp_resource(qp); 992 993 memcpy(SKB_TO_PKT(skb), &ack_pkt, sizeof(ack_pkt)); 994 memset((unsigned char *)SKB_TO_PKT(skb) + sizeof(ack_pkt), 0, 995 sizeof(skb->cb) - sizeof(ack_pkt)); 996 997 skb_get(skb); 998 res->type = RXE_ATOMIC_MASK; 999 res->atomic.skb = skb; 1000 res->first_psn = ack_pkt.psn; 1001 res->last_psn = ack_pkt.psn; 1002 res->cur_psn = ack_pkt.psn; 1003 1004 rc = rxe_xmit_packet(rxe, qp, &ack_pkt, skb); 1005 if (rc) { 1006 pr_err_ratelimited("Failed sending ack\n"); 1007 rxe_drop_ref(qp); 1008 } 1009 out: 1010 return rc; 1011 } 1012 1013 static enum resp_states acknowledge(struct rxe_qp *qp, 1014 struct rxe_pkt_info *pkt) 1015 { 1016 if (qp_type(qp) != IB_QPT_RC) 1017 return RESPST_CLEANUP; 1018 1019 if (qp->resp.aeth_syndrome != AETH_ACK_UNLIMITED) 1020 send_ack(qp, pkt, qp->resp.aeth_syndrome, pkt->psn); 1021 else if (pkt->mask & RXE_ATOMIC_MASK) 1022 send_atomic_ack(qp, pkt, AETH_ACK_UNLIMITED); 1023 else if (bth_ack(pkt)) 1024 send_ack(qp, pkt, AETH_ACK_UNLIMITED, pkt->psn); 1025 1026 return RESPST_CLEANUP; 1027 } 1028 1029 static enum resp_states cleanup(struct rxe_qp *qp, 1030 struct rxe_pkt_info *pkt) 1031 { 1032 struct sk_buff *skb; 1033 1034 if (pkt) { 1035 skb = skb_dequeue(&qp->req_pkts); 1036 rxe_drop_ref(qp); 1037 kfree_skb(skb); 1038 } 1039 1040 if (qp->resp.mr) { 1041 rxe_drop_ref(qp->resp.mr); 1042 qp->resp.mr = NULL; 1043 } 1044 1045 return RESPST_DONE; 1046 } 1047 1048 static struct resp_res *find_resource(struct rxe_qp *qp, u32 psn) 1049 { 1050 int i; 1051 1052 for (i = 0; i < qp->attr.max_dest_rd_atomic; i++) { 1053 struct resp_res *res = &qp->resp.resources[i]; 1054 1055 if (res->type == 0) 1056 continue; 1057 1058 if (psn_compare(psn, res->first_psn) >= 0 && 1059 psn_compare(psn, res->last_psn) <= 0) { 1060 return res; 1061 } 1062 } 1063 1064 return NULL; 1065 } 1066 1067 static enum resp_states duplicate_request(struct rxe_qp *qp, 1068 struct rxe_pkt_info *pkt) 1069 { 1070 enum resp_states rc; 1071 u32 prev_psn = (qp->resp.ack_psn - 1) & BTH_PSN_MASK; 1072 1073 if (pkt->mask & RXE_SEND_MASK || 1074 pkt->mask & RXE_WRITE_MASK) { 1075 /* SEND. Ack again and cleanup. C9-105. */ 1076 if (bth_ack(pkt)) 1077 send_ack(qp, pkt, AETH_ACK_UNLIMITED, prev_psn); 1078 rc = RESPST_CLEANUP; 1079 goto out; 1080 } else if (pkt->mask & RXE_READ_MASK) { 1081 struct resp_res *res; 1082 1083 res = find_resource(qp, pkt->psn); 1084 if (!res) { 1085 /* Resource not found. Class D error. Drop the 1086 * request. 1087 */ 1088 rc = RESPST_CLEANUP; 1089 goto out; 1090 } else { 1091 /* Ensure this new request is the same as the previous 1092 * one or a subset of it. 1093 */ 1094 u64 iova = reth_va(pkt); 1095 u32 resid = reth_len(pkt); 1096 1097 if (iova < res->read.va_org || 1098 resid > res->read.length || 1099 (iova + resid) > (res->read.va_org + 1100 res->read.length)) { 1101 rc = RESPST_CLEANUP; 1102 goto out; 1103 } 1104 1105 if (reth_rkey(pkt) != res->read.rkey) { 1106 rc = RESPST_CLEANUP; 1107 goto out; 1108 } 1109 1110 res->cur_psn = pkt->psn; 1111 res->state = (pkt->psn == res->first_psn) ? 1112 rdatm_res_state_new : 1113 rdatm_res_state_replay; 1114 res->replay = 1; 1115 1116 /* Reset the resource, except length. */ 1117 res->read.va_org = iova; 1118 res->read.va = iova; 1119 res->read.resid = resid; 1120 1121 /* Replay the RDMA read reply. */ 1122 qp->resp.res = res; 1123 rc = RESPST_READ_REPLY; 1124 goto out; 1125 } 1126 } else { 1127 struct resp_res *res; 1128 1129 /* Find the operation in our list of responder resources. */ 1130 res = find_resource(qp, pkt->psn); 1131 if (res) { 1132 skb_get(res->atomic.skb); 1133 /* Resend the result. */ 1134 rc = rxe_xmit_packet(to_rdev(qp->ibqp.device), qp, 1135 pkt, res->atomic.skb); 1136 if (rc) { 1137 pr_err("Failed resending result. This flow is not handled - skb ignored\n"); 1138 rc = RESPST_CLEANUP; 1139 goto out; 1140 } 1141 } 1142 1143 /* Resource not found. Class D error. Drop the request. */ 1144 rc = RESPST_CLEANUP; 1145 goto out; 1146 } 1147 out: 1148 return rc; 1149 } 1150 1151 /* Process a class A or C. Both are treated the same in this implementation. */ 1152 static void do_class_ac_error(struct rxe_qp *qp, u8 syndrome, 1153 enum ib_wc_status status) 1154 { 1155 qp->resp.aeth_syndrome = syndrome; 1156 qp->resp.status = status; 1157 1158 /* indicate that we should go through the ERROR state */ 1159 qp->resp.goto_error = 1; 1160 } 1161 1162 static enum resp_states do_class_d1e_error(struct rxe_qp *qp) 1163 { 1164 /* UC */ 1165 if (qp->srq) { 1166 /* Class E */ 1167 qp->resp.drop_msg = 1; 1168 if (qp->resp.wqe) { 1169 qp->resp.status = IB_WC_REM_INV_REQ_ERR; 1170 return RESPST_COMPLETE; 1171 } else { 1172 return RESPST_CLEANUP; 1173 } 1174 } else { 1175 /* Class D1. This packet may be the start of a 1176 * new message and could be valid. The previous 1177 * message is invalid and ignored. reset the 1178 * recv wr to its original state 1179 */ 1180 if (qp->resp.wqe) { 1181 qp->resp.wqe->dma.resid = qp->resp.wqe->dma.length; 1182 qp->resp.wqe->dma.cur_sge = 0; 1183 qp->resp.wqe->dma.sge_offset = 0; 1184 qp->resp.opcode = -1; 1185 } 1186 1187 if (qp->resp.mr) { 1188 rxe_drop_ref(qp->resp.mr); 1189 qp->resp.mr = NULL; 1190 } 1191 1192 return RESPST_CLEANUP; 1193 } 1194 } 1195 1196 static void rxe_drain_req_pkts(struct rxe_qp *qp, bool notify) 1197 { 1198 struct sk_buff *skb; 1199 1200 while ((skb = skb_dequeue(&qp->req_pkts))) { 1201 rxe_drop_ref(qp); 1202 kfree_skb(skb); 1203 } 1204 1205 if (notify) 1206 return; 1207 1208 while (!qp->srq && qp->rq.queue && queue_head(qp->rq.queue)) 1209 advance_consumer(qp->rq.queue); 1210 } 1211 1212 int rxe_responder(void *arg) 1213 { 1214 struct rxe_qp *qp = (struct rxe_qp *)arg; 1215 struct rxe_dev *rxe = to_rdev(qp->ibqp.device); 1216 enum resp_states state; 1217 struct rxe_pkt_info *pkt = NULL; 1218 int ret = 0; 1219 1220 rxe_add_ref(qp); 1221 1222 qp->resp.aeth_syndrome = AETH_ACK_UNLIMITED; 1223 1224 if (!qp->valid) { 1225 ret = -EINVAL; 1226 goto done; 1227 } 1228 1229 switch (qp->resp.state) { 1230 case QP_STATE_RESET: 1231 state = RESPST_RESET; 1232 break; 1233 1234 default: 1235 state = RESPST_GET_REQ; 1236 break; 1237 } 1238 1239 while (1) { 1240 pr_debug("qp#%d state = %s\n", qp_num(qp), 1241 resp_state_name[state]); 1242 switch (state) { 1243 case RESPST_GET_REQ: 1244 state = get_req(qp, &pkt); 1245 break; 1246 case RESPST_CHK_PSN: 1247 state = check_psn(qp, pkt); 1248 break; 1249 case RESPST_CHK_OP_SEQ: 1250 state = check_op_seq(qp, pkt); 1251 break; 1252 case RESPST_CHK_OP_VALID: 1253 state = check_op_valid(qp, pkt); 1254 break; 1255 case RESPST_CHK_RESOURCE: 1256 state = check_resource(qp, pkt); 1257 break; 1258 case RESPST_CHK_LENGTH: 1259 state = check_length(qp, pkt); 1260 break; 1261 case RESPST_CHK_RKEY: 1262 state = check_rkey(qp, pkt); 1263 break; 1264 case RESPST_EXECUTE: 1265 state = execute(qp, pkt); 1266 break; 1267 case RESPST_COMPLETE: 1268 state = do_complete(qp, pkt); 1269 break; 1270 case RESPST_READ_REPLY: 1271 state = read_reply(qp, pkt); 1272 break; 1273 case RESPST_ACKNOWLEDGE: 1274 state = acknowledge(qp, pkt); 1275 break; 1276 case RESPST_CLEANUP: 1277 state = cleanup(qp, pkt); 1278 break; 1279 case RESPST_DUPLICATE_REQUEST: 1280 state = duplicate_request(qp, pkt); 1281 break; 1282 case RESPST_ERR_PSN_OUT_OF_SEQ: 1283 /* RC only - Class B. Drop packet. */ 1284 send_ack(qp, pkt, AETH_NAK_PSN_SEQ_ERROR, qp->resp.psn); 1285 state = RESPST_CLEANUP; 1286 break; 1287 1288 case RESPST_ERR_TOO_MANY_RDMA_ATM_REQ: 1289 case RESPST_ERR_MISSING_OPCODE_FIRST: 1290 case RESPST_ERR_MISSING_OPCODE_LAST_C: 1291 case RESPST_ERR_UNSUPPORTED_OPCODE: 1292 case RESPST_ERR_MISALIGNED_ATOMIC: 1293 /* RC Only - Class C. */ 1294 do_class_ac_error(qp, AETH_NAK_INVALID_REQ, 1295 IB_WC_REM_INV_REQ_ERR); 1296 state = RESPST_COMPLETE; 1297 break; 1298 1299 case RESPST_ERR_MISSING_OPCODE_LAST_D1E: 1300 state = do_class_d1e_error(qp); 1301 break; 1302 case RESPST_ERR_RNR: 1303 if (qp_type(qp) == IB_QPT_RC) { 1304 rxe_counter_inc(rxe, RXE_CNT_SND_RNR); 1305 /* RC - class B */ 1306 send_ack(qp, pkt, AETH_RNR_NAK | 1307 (~AETH_TYPE_MASK & 1308 qp->attr.min_rnr_timer), 1309 pkt->psn); 1310 } else { 1311 /* UD/UC - class D */ 1312 qp->resp.drop_msg = 1; 1313 } 1314 state = RESPST_CLEANUP; 1315 break; 1316 1317 case RESPST_ERR_RKEY_VIOLATION: 1318 if (qp_type(qp) == IB_QPT_RC) { 1319 /* Class C */ 1320 do_class_ac_error(qp, AETH_NAK_REM_ACC_ERR, 1321 IB_WC_REM_ACCESS_ERR); 1322 state = RESPST_COMPLETE; 1323 } else { 1324 qp->resp.drop_msg = 1; 1325 if (qp->srq) { 1326 /* UC/SRQ Class D */ 1327 qp->resp.status = IB_WC_REM_ACCESS_ERR; 1328 state = RESPST_COMPLETE; 1329 } else { 1330 /* UC/non-SRQ Class E. */ 1331 state = RESPST_CLEANUP; 1332 } 1333 } 1334 break; 1335 1336 case RESPST_ERR_LENGTH: 1337 if (qp_type(qp) == IB_QPT_RC) { 1338 /* Class C */ 1339 do_class_ac_error(qp, AETH_NAK_INVALID_REQ, 1340 IB_WC_REM_INV_REQ_ERR); 1341 state = RESPST_COMPLETE; 1342 } else if (qp->srq) { 1343 /* UC/UD - class E */ 1344 qp->resp.status = IB_WC_REM_INV_REQ_ERR; 1345 state = RESPST_COMPLETE; 1346 } else { 1347 /* UC/UD - class D */ 1348 qp->resp.drop_msg = 1; 1349 state = RESPST_CLEANUP; 1350 } 1351 break; 1352 1353 case RESPST_ERR_MALFORMED_WQE: 1354 /* All, Class A. */ 1355 do_class_ac_error(qp, AETH_NAK_REM_OP_ERR, 1356 IB_WC_LOC_QP_OP_ERR); 1357 state = RESPST_COMPLETE; 1358 break; 1359 1360 case RESPST_ERR_CQ_OVERFLOW: 1361 /* All - Class G */ 1362 state = RESPST_ERROR; 1363 break; 1364 1365 case RESPST_DONE: 1366 if (qp->resp.goto_error) { 1367 state = RESPST_ERROR; 1368 break; 1369 } 1370 1371 goto done; 1372 1373 case RESPST_EXIT: 1374 if (qp->resp.goto_error) { 1375 state = RESPST_ERROR; 1376 break; 1377 } 1378 1379 goto exit; 1380 1381 case RESPST_RESET: 1382 rxe_drain_req_pkts(qp, false); 1383 qp->resp.wqe = NULL; 1384 goto exit; 1385 1386 case RESPST_ERROR: 1387 qp->resp.goto_error = 0; 1388 pr_warn("qp#%d moved to error state\n", qp_num(qp)); 1389 rxe_qp_error(qp); 1390 goto exit; 1391 1392 default: 1393 WARN_ON_ONCE(1); 1394 } 1395 } 1396 1397 exit: 1398 ret = -EAGAIN; 1399 done: 1400 rxe_drop_ref(qp); 1401 return ret; 1402 } 1403