| // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause |
| |
| /* Authors: Cheng Xu <chengyou@linux.alibaba.com> */ |
| /* Kai Shen <kaishen@linux.alibaba.com> */ |
| /* Copyright (c) 2020-2021, Alibaba Group */ |
| /* Authors: Bernard Metzler <bmt@zurich.ibm.com> */ |
| /* Copyright (c) 2008-2019, IBM Corporation */ |
| |
| #include "erdma_cm.h" |
| #include "erdma_verbs.h" |
| |
| void erdma_qp_llp_close(struct erdma_qp *qp) |
| { |
| struct erdma_qp_attrs qp_attrs; |
| |
| down_write(&qp->state_lock); |
| |
| switch (qp->attrs.state) { |
| case ERDMA_QP_STATE_RTS: |
| case ERDMA_QP_STATE_RTR: |
| case ERDMA_QP_STATE_IDLE: |
| case ERDMA_QP_STATE_TERMINATE: |
| qp_attrs.state = ERDMA_QP_STATE_CLOSING; |
| erdma_modify_qp_internal(qp, &qp_attrs, ERDMA_QP_ATTR_STATE); |
| break; |
| case ERDMA_QP_STATE_CLOSING: |
| qp->attrs.state = ERDMA_QP_STATE_IDLE; |
| break; |
| default: |
| break; |
| } |
| |
| if (qp->cep) { |
| erdma_cep_put(qp->cep); |
| qp->cep = NULL; |
| } |
| |
| up_write(&qp->state_lock); |
| } |
| |
| struct ib_qp *erdma_get_ibqp(struct ib_device *ibdev, int id) |
| { |
| struct erdma_qp *qp = find_qp_by_qpn(to_edev(ibdev), id); |
| |
| if (qp) |
| return &qp->ibqp; |
| |
| return NULL; |
| } |
| |
| static int erdma_modify_qp_state_to_rts(struct erdma_qp *qp, |
| struct erdma_qp_attrs *attrs, |
| enum erdma_qp_attr_mask mask) |
| { |
| int ret; |
| struct erdma_dev *dev = qp->dev; |
| struct erdma_cmdq_modify_qp_req req; |
| struct tcp_sock *tp; |
| struct erdma_cep *cep = qp->cep; |
| struct sockaddr_storage local_addr, remote_addr; |
| |
| if (!(mask & ERDMA_QP_ATTR_LLP_HANDLE)) |
| return -EINVAL; |
| |
| if (!(mask & ERDMA_QP_ATTR_MPA)) |
| return -EINVAL; |
| |
| ret = getname_local(cep->sock, &local_addr); |
| if (ret < 0) |
| return ret; |
| |
| ret = getname_peer(cep->sock, &remote_addr); |
| if (ret < 0) |
| return ret; |
| |
| qp->attrs.state = ERDMA_QP_STATE_RTS; |
| |
| tp = tcp_sk(qp->cep->sock->sk); |
| |
| erdma_cmdq_build_reqhdr(&req.hdr, CMDQ_SUBMOD_RDMA, |
| CMDQ_OPCODE_MODIFY_QP); |
| |
| req.cfg = FIELD_PREP(ERDMA_CMD_MODIFY_QP_STATE_MASK, qp->attrs.state) | |
| FIELD_PREP(ERDMA_CMD_MODIFY_QP_CC_MASK, qp->attrs.cc) | |
| FIELD_PREP(ERDMA_CMD_MODIFY_QP_QPN_MASK, QP_ID(qp)); |
| |
| req.cookie = be32_to_cpu(qp->cep->mpa.ext_data.cookie); |
| req.dip = to_sockaddr_in(remote_addr).sin_addr.s_addr; |
| req.sip = to_sockaddr_in(local_addr).sin_addr.s_addr; |
| req.dport = to_sockaddr_in(remote_addr).sin_port; |
| req.sport = to_sockaddr_in(local_addr).sin_port; |
| |
| req.send_nxt = tp->snd_nxt; |
| /* rsvd tcp seq for mpa-rsp in server. */ |
| if (qp->attrs.qp_type == ERDMA_QP_PASSIVE) |
| req.send_nxt += MPA_DEFAULT_HDR_LEN + qp->attrs.pd_len; |
| req.recv_nxt = tp->rcv_nxt; |
| |
| return erdma_post_cmd_wait(&dev->cmdq, &req, sizeof(req), NULL, NULL); |
| } |
| |
| static int erdma_modify_qp_state_to_stop(struct erdma_qp *qp, |
| struct erdma_qp_attrs *attrs, |
| enum erdma_qp_attr_mask mask) |
| { |
| struct erdma_dev *dev = qp->dev; |
| struct erdma_cmdq_modify_qp_req req; |
| |
| qp->attrs.state = attrs->state; |
| |
| erdma_cmdq_build_reqhdr(&req.hdr, CMDQ_SUBMOD_RDMA, |
| CMDQ_OPCODE_MODIFY_QP); |
| |
| req.cfg = FIELD_PREP(ERDMA_CMD_MODIFY_QP_STATE_MASK, attrs->state) | |
| FIELD_PREP(ERDMA_CMD_MODIFY_QP_QPN_MASK, QP_ID(qp)); |
| |
| return erdma_post_cmd_wait(&dev->cmdq, &req, sizeof(req), NULL, NULL); |
| } |
| |
| int erdma_modify_qp_internal(struct erdma_qp *qp, struct erdma_qp_attrs *attrs, |
| enum erdma_qp_attr_mask mask) |
| { |
| bool need_reflush = false; |
| int drop_conn, ret = 0; |
| |
| if (!mask) |
| return 0; |
| |
| if (!(mask & ERDMA_QP_ATTR_STATE)) |
| return 0; |
| |
| switch (qp->attrs.state) { |
| case ERDMA_QP_STATE_IDLE: |
| case ERDMA_QP_STATE_RTR: |
| if (attrs->state == ERDMA_QP_STATE_RTS) { |
| ret = erdma_modify_qp_state_to_rts(qp, attrs, mask); |
| } else if (attrs->state == ERDMA_QP_STATE_ERROR) { |
| qp->attrs.state = ERDMA_QP_STATE_ERROR; |
| need_reflush = true; |
| if (qp->cep) { |
| erdma_cep_put(qp->cep); |
| qp->cep = NULL; |
| } |
| ret = erdma_modify_qp_state_to_stop(qp, attrs, mask); |
| } |
| break; |
| case ERDMA_QP_STATE_RTS: |
| drop_conn = 0; |
| |
| if (attrs->state == ERDMA_QP_STATE_CLOSING || |
| attrs->state == ERDMA_QP_STATE_TERMINATE || |
| attrs->state == ERDMA_QP_STATE_ERROR) { |
| ret = erdma_modify_qp_state_to_stop(qp, attrs, mask); |
| drop_conn = 1; |
| need_reflush = true; |
| } |
| |
| if (drop_conn) |
| erdma_qp_cm_drop(qp); |
| |
| break; |
| case ERDMA_QP_STATE_TERMINATE: |
| if (attrs->state == ERDMA_QP_STATE_ERROR) |
| qp->attrs.state = ERDMA_QP_STATE_ERROR; |
| break; |
| case ERDMA_QP_STATE_CLOSING: |
| if (attrs->state == ERDMA_QP_STATE_IDLE) { |
| qp->attrs.state = ERDMA_QP_STATE_IDLE; |
| } else if (attrs->state == ERDMA_QP_STATE_ERROR) { |
| ret = erdma_modify_qp_state_to_stop(qp, attrs, mask); |
| qp->attrs.state = ERDMA_QP_STATE_ERROR; |
| } else if (attrs->state != ERDMA_QP_STATE_CLOSING) { |
| return -ECONNABORTED; |
| } |
| break; |
| default: |
| break; |
| } |
| |
| if (need_reflush && !ret && rdma_is_kernel_res(&qp->ibqp.res)) { |
| qp->flags |= ERDMA_QP_IN_FLUSHING; |
| mod_delayed_work(qp->dev->reflush_wq, &qp->reflush_dwork, |
| usecs_to_jiffies(100)); |
| } |
| |
| return ret; |
| } |
| |
| static void erdma_qp_safe_free(struct kref *ref) |
| { |
| struct erdma_qp *qp = container_of(ref, struct erdma_qp, ref); |
| |
| complete(&qp->safe_free); |
| } |
| |
| void erdma_qp_put(struct erdma_qp *qp) |
| { |
| WARN_ON(kref_read(&qp->ref) < 1); |
| kref_put(&qp->ref, erdma_qp_safe_free); |
| } |
| |
| void erdma_qp_get(struct erdma_qp *qp) |
| { |
| kref_get(&qp->ref); |
| } |
| |
| static int fill_inline_data(struct erdma_qp *qp, |
| const struct ib_send_wr *send_wr, u16 wqe_idx, |
| u32 sgl_offset, __le32 *length_field) |
| { |
| u32 remain_size, copy_size, data_off, bytes = 0; |
| char *data; |
| int i = 0; |
| |
| wqe_idx += (sgl_offset >> SQEBB_SHIFT); |
| sgl_offset &= (SQEBB_SIZE - 1); |
| data = get_queue_entry(qp->kern_qp.sq_buf, wqe_idx, qp->attrs.sq_size, |
| SQEBB_SHIFT); |
| |
| while (i < send_wr->num_sge) { |
| bytes += send_wr->sg_list[i].length; |
| if (bytes > (int)ERDMA_MAX_INLINE) |
| return -EINVAL; |
| |
| remain_size = send_wr->sg_list[i].length; |
| data_off = 0; |
| |
| while (1) { |
| copy_size = min(remain_size, SQEBB_SIZE - sgl_offset); |
| |
| memcpy(data + sgl_offset, |
| (void *)(uintptr_t)send_wr->sg_list[i].addr + |
| data_off, |
| copy_size); |
| remain_size -= copy_size; |
| data_off += copy_size; |
| sgl_offset += copy_size; |
| wqe_idx += (sgl_offset >> SQEBB_SHIFT); |
| sgl_offset &= (SQEBB_SIZE - 1); |
| |
| data = get_queue_entry(qp->kern_qp.sq_buf, wqe_idx, |
| qp->attrs.sq_size, SQEBB_SHIFT); |
| if (!remain_size) |
| break; |
| } |
| |
| i++; |
| } |
| *length_field = cpu_to_le32(bytes); |
| |
| return bytes; |
| } |
| |
| static int fill_sgl(struct erdma_qp *qp, const struct ib_send_wr *send_wr, |
| u16 wqe_idx, u32 sgl_offset, __le32 *length_field) |
| { |
| int i = 0; |
| u32 bytes = 0; |
| char *sgl; |
| |
| if (send_wr->num_sge > qp->dev->attrs.max_send_sge) |
| return -EINVAL; |
| |
| if (sgl_offset & 0xF) |
| return -EINVAL; |
| |
| while (i < send_wr->num_sge) { |
| wqe_idx += (sgl_offset >> SQEBB_SHIFT); |
| sgl_offset &= (SQEBB_SIZE - 1); |
| sgl = get_queue_entry(qp->kern_qp.sq_buf, wqe_idx, |
| qp->attrs.sq_size, SQEBB_SHIFT); |
| |
| bytes += send_wr->sg_list[i].length; |
| memcpy(sgl + sgl_offset, &send_wr->sg_list[i], |
| sizeof(struct ib_sge)); |
| |
| sgl_offset += sizeof(struct ib_sge); |
| i++; |
| } |
| |
| *length_field = cpu_to_le32(bytes); |
| return 0; |
| } |
| |
| static int erdma_push_one_sqe(struct erdma_qp *qp, u16 *pi, |
| const struct ib_send_wr *send_wr) |
| { |
| u32 wqe_size, wqebb_cnt, hw_op, flags, sgl_offset; |
| u32 idx = *pi & (qp->attrs.sq_size - 1); |
| enum ib_wr_opcode op = send_wr->opcode; |
| struct erdma_atomic_sqe *atomic_sqe; |
| struct erdma_readreq_sqe *read_sqe; |
| struct erdma_reg_mr_sqe *regmr_sge; |
| struct erdma_write_sqe *write_sqe; |
| struct erdma_send_sqe *send_sqe; |
| struct ib_rdma_wr *rdma_wr; |
| struct erdma_sge *sge; |
| __le32 *length_field; |
| struct erdma_mr *mr; |
| u64 wqe_hdr, *entry; |
| u32 attrs; |
| int ret; |
| |
| entry = get_queue_entry(qp->kern_qp.sq_buf, idx, qp->attrs.sq_size, |
| SQEBB_SHIFT); |
| |
| /* Clear the SQE header section. */ |
| *entry = 0; |
| |
| qp->kern_qp.swr_tbl[idx] = send_wr->wr_id; |
| flags = send_wr->send_flags; |
| wqe_hdr = FIELD_PREP( |
| ERDMA_SQE_HDR_CE_MASK, |
| ((flags & IB_SEND_SIGNALED) || qp->kern_qp.sig_all) ? 1 : 0); |
| wqe_hdr |= FIELD_PREP(ERDMA_SQE_HDR_SE_MASK, |
| flags & IB_SEND_SOLICITED ? 1 : 0); |
| wqe_hdr |= FIELD_PREP(ERDMA_SQE_HDR_FENCE_MASK, |
| flags & IB_SEND_FENCE ? 1 : 0); |
| wqe_hdr |= FIELD_PREP(ERDMA_SQE_HDR_INLINE_MASK, |
| flags & IB_SEND_INLINE ? 1 : 0); |
| wqe_hdr |= FIELD_PREP(ERDMA_SQE_HDR_QPN_MASK, QP_ID(qp)); |
| |
| switch (op) { |
| case IB_WR_RDMA_WRITE: |
| case IB_WR_RDMA_WRITE_WITH_IMM: |
| hw_op = ERDMA_OP_WRITE; |
| if (op == IB_WR_RDMA_WRITE_WITH_IMM) |
| hw_op = ERDMA_OP_WRITE_WITH_IMM; |
| wqe_hdr |= FIELD_PREP(ERDMA_SQE_HDR_OPCODE_MASK, hw_op); |
| rdma_wr = container_of(send_wr, struct ib_rdma_wr, wr); |
| write_sqe = (struct erdma_write_sqe *)entry; |
| |
| write_sqe->imm_data = send_wr->ex.imm_data; |
| write_sqe->sink_stag = cpu_to_le32(rdma_wr->rkey); |
| write_sqe->sink_to_h = |
| cpu_to_le32(upper_32_bits(rdma_wr->remote_addr)); |
| write_sqe->sink_to_l = |
| cpu_to_le32(lower_32_bits(rdma_wr->remote_addr)); |
| |
| length_field = &write_sqe->length; |
| wqe_size = sizeof(struct erdma_write_sqe); |
| sgl_offset = wqe_size; |
| break; |
| case IB_WR_RDMA_READ: |
| case IB_WR_RDMA_READ_WITH_INV: |
| read_sqe = (struct erdma_readreq_sqe *)entry; |
| if (unlikely(send_wr->num_sge != 1)) |
| return -EINVAL; |
| hw_op = ERDMA_OP_READ; |
| if (op == IB_WR_RDMA_READ_WITH_INV) { |
| hw_op = ERDMA_OP_READ_WITH_INV; |
| read_sqe->invalid_stag = |
| cpu_to_le32(send_wr->ex.invalidate_rkey); |
| } |
| |
| wqe_hdr |= FIELD_PREP(ERDMA_SQE_HDR_OPCODE_MASK, hw_op); |
| rdma_wr = container_of(send_wr, struct ib_rdma_wr, wr); |
| read_sqe->length = cpu_to_le32(send_wr->sg_list[0].length); |
| read_sqe->sink_stag = cpu_to_le32(send_wr->sg_list[0].lkey); |
| read_sqe->sink_to_l = |
| cpu_to_le32(lower_32_bits(send_wr->sg_list[0].addr)); |
| read_sqe->sink_to_h = |
| cpu_to_le32(upper_32_bits(send_wr->sg_list[0].addr)); |
| |
| sge = get_queue_entry(qp->kern_qp.sq_buf, idx + 1, |
| qp->attrs.sq_size, SQEBB_SHIFT); |
| sge->addr = cpu_to_le64(rdma_wr->remote_addr); |
| sge->key = cpu_to_le32(rdma_wr->rkey); |
| sge->length = cpu_to_le32(send_wr->sg_list[0].length); |
| wqe_size = sizeof(struct erdma_readreq_sqe) + |
| send_wr->num_sge * sizeof(struct ib_sge); |
| |
| goto out; |
| case IB_WR_SEND: |
| case IB_WR_SEND_WITH_IMM: |
| case IB_WR_SEND_WITH_INV: |
| send_sqe = (struct erdma_send_sqe *)entry; |
| hw_op = ERDMA_OP_SEND; |
| if (op == IB_WR_SEND_WITH_IMM) { |
| hw_op = ERDMA_OP_SEND_WITH_IMM; |
| send_sqe->imm_data = send_wr->ex.imm_data; |
| } else if (op == IB_WR_SEND_WITH_INV) { |
| hw_op = ERDMA_OP_SEND_WITH_INV; |
| send_sqe->invalid_stag = |
| cpu_to_le32(send_wr->ex.invalidate_rkey); |
| } |
| wqe_hdr |= FIELD_PREP(ERDMA_SQE_HDR_OPCODE_MASK, hw_op); |
| length_field = &send_sqe->length; |
| wqe_size = sizeof(struct erdma_send_sqe); |
| sgl_offset = wqe_size; |
| |
| break; |
| case IB_WR_REG_MR: |
| wqe_hdr |= |
| FIELD_PREP(ERDMA_SQE_HDR_OPCODE_MASK, ERDMA_OP_REG_MR); |
| regmr_sge = (struct erdma_reg_mr_sqe *)entry; |
| mr = to_emr(reg_wr(send_wr)->mr); |
| |
| mr->access = ERDMA_MR_ACC_LR | |
| to_erdma_access_flags(reg_wr(send_wr)->access); |
| regmr_sge->addr = cpu_to_le64(mr->ibmr.iova); |
| regmr_sge->length = cpu_to_le32(mr->ibmr.length); |
| regmr_sge->stag = cpu_to_le32(reg_wr(send_wr)->key); |
| attrs = FIELD_PREP(ERDMA_SQE_MR_ACCESS_MASK, mr->access) | |
| FIELD_PREP(ERDMA_SQE_MR_MTT_CNT_MASK, |
| mr->mem.mtt_nents); |
| |
| if (mr->mem.mtt_nents <= ERDMA_MAX_INLINE_MTT_ENTRIES) { |
| attrs |= FIELD_PREP(ERDMA_SQE_MR_MTT_TYPE_MASK, 0); |
| /* Copy SGLs to SQE content to accelerate */ |
| memcpy(get_queue_entry(qp->kern_qp.sq_buf, idx + 1, |
| qp->attrs.sq_size, SQEBB_SHIFT), |
| mr->mem.mtt->buf, MTT_SIZE(mr->mem.mtt_nents)); |
| wqe_size = sizeof(struct erdma_reg_mr_sqe) + |
| MTT_SIZE(mr->mem.mtt_nents); |
| } else { |
| attrs |= FIELD_PREP(ERDMA_SQE_MR_MTT_TYPE_MASK, 1); |
| wqe_size = sizeof(struct erdma_reg_mr_sqe); |
| } |
| |
| regmr_sge->attrs = cpu_to_le32(attrs); |
| goto out; |
| case IB_WR_LOCAL_INV: |
| wqe_hdr |= FIELD_PREP(ERDMA_SQE_HDR_OPCODE_MASK, |
| ERDMA_OP_LOCAL_INV); |
| regmr_sge = (struct erdma_reg_mr_sqe *)entry; |
| regmr_sge->stag = cpu_to_le32(send_wr->ex.invalidate_rkey); |
| wqe_size = sizeof(struct erdma_reg_mr_sqe); |
| goto out; |
| case IB_WR_ATOMIC_CMP_AND_SWP: |
| case IB_WR_ATOMIC_FETCH_AND_ADD: |
| atomic_sqe = (struct erdma_atomic_sqe *)entry; |
| if (op == IB_WR_ATOMIC_CMP_AND_SWP) { |
| wqe_hdr |= FIELD_PREP(ERDMA_SQE_HDR_OPCODE_MASK, |
| ERDMA_OP_ATOMIC_CAS); |
| atomic_sqe->fetchadd_swap_data = |
| cpu_to_le64(atomic_wr(send_wr)->swap); |
| atomic_sqe->cmp_data = |
| cpu_to_le64(atomic_wr(send_wr)->compare_add); |
| } else { |
| wqe_hdr |= FIELD_PREP(ERDMA_SQE_HDR_OPCODE_MASK, |
| ERDMA_OP_ATOMIC_FAA); |
| atomic_sqe->fetchadd_swap_data = |
| cpu_to_le64(atomic_wr(send_wr)->compare_add); |
| } |
| |
| sge = get_queue_entry(qp->kern_qp.sq_buf, idx + 1, |
| qp->attrs.sq_size, SQEBB_SHIFT); |
| sge->addr = cpu_to_le64(atomic_wr(send_wr)->remote_addr); |
| sge->key = cpu_to_le32(atomic_wr(send_wr)->rkey); |
| sge++; |
| |
| sge->addr = cpu_to_le64(send_wr->sg_list[0].addr); |
| sge->key = cpu_to_le32(send_wr->sg_list[0].lkey); |
| sge->length = cpu_to_le32(send_wr->sg_list[0].length); |
| |
| wqe_size = sizeof(*atomic_sqe); |
| goto out; |
| default: |
| return -EOPNOTSUPP; |
| } |
| |
| if (flags & IB_SEND_INLINE) { |
| ret = fill_inline_data(qp, send_wr, idx, sgl_offset, |
| length_field); |
| if (ret < 0) |
| return -EINVAL; |
| wqe_size += ret; |
| wqe_hdr |= FIELD_PREP(ERDMA_SQE_HDR_SGL_LEN_MASK, ret); |
| } else { |
| ret = fill_sgl(qp, send_wr, idx, sgl_offset, length_field); |
| if (ret) |
| return -EINVAL; |
| wqe_size += send_wr->num_sge * sizeof(struct ib_sge); |
| wqe_hdr |= FIELD_PREP(ERDMA_SQE_HDR_SGL_LEN_MASK, |
| send_wr->num_sge); |
| } |
| |
| out: |
| wqebb_cnt = SQEBB_COUNT(wqe_size); |
| wqe_hdr |= FIELD_PREP(ERDMA_SQE_HDR_WQEBB_CNT_MASK, wqebb_cnt - 1); |
| *pi += wqebb_cnt; |
| wqe_hdr |= FIELD_PREP(ERDMA_SQE_HDR_WQEBB_INDEX_MASK, *pi); |
| |
| *entry = wqe_hdr; |
| |
| return 0; |
| } |
| |
| static void kick_sq_db(struct erdma_qp *qp, u16 pi) |
| { |
| u64 db_data = FIELD_PREP(ERDMA_SQE_HDR_QPN_MASK, QP_ID(qp)) | |
| FIELD_PREP(ERDMA_SQE_HDR_WQEBB_INDEX_MASK, pi); |
| |
| *(u64 *)qp->kern_qp.sq_db_info = db_data; |
| writeq(db_data, qp->kern_qp.hw_sq_db); |
| } |
| |
| int erdma_post_send(struct ib_qp *ibqp, const struct ib_send_wr *send_wr, |
| const struct ib_send_wr **bad_send_wr) |
| { |
| struct erdma_qp *qp = to_eqp(ibqp); |
| int ret = 0; |
| const struct ib_send_wr *wr = send_wr; |
| unsigned long flags; |
| u16 sq_pi; |
| |
| if (!send_wr) |
| return -EINVAL; |
| |
| spin_lock_irqsave(&qp->lock, flags); |
| sq_pi = qp->kern_qp.sq_pi; |
| |
| while (wr) { |
| if ((u16)(sq_pi - qp->kern_qp.sq_ci) >= qp->attrs.sq_size) { |
| ret = -ENOMEM; |
| *bad_send_wr = send_wr; |
| break; |
| } |
| |
| ret = erdma_push_one_sqe(qp, &sq_pi, wr); |
| if (ret) { |
| *bad_send_wr = wr; |
| break; |
| } |
| qp->kern_qp.sq_pi = sq_pi; |
| kick_sq_db(qp, sq_pi); |
| |
| wr = wr->next; |
| } |
| spin_unlock_irqrestore(&qp->lock, flags); |
| |
| if (unlikely(qp->flags & ERDMA_QP_IN_FLUSHING)) |
| mod_delayed_work(qp->dev->reflush_wq, &qp->reflush_dwork, |
| usecs_to_jiffies(100)); |
| |
| return ret; |
| } |
| |
| static int erdma_post_recv_one(struct erdma_qp *qp, |
| const struct ib_recv_wr *recv_wr) |
| { |
| struct erdma_rqe *rqe = |
| get_queue_entry(qp->kern_qp.rq_buf, qp->kern_qp.rq_pi, |
| qp->attrs.rq_size, RQE_SHIFT); |
| |
| rqe->qe_idx = cpu_to_le16(qp->kern_qp.rq_pi + 1); |
| rqe->qpn = cpu_to_le32(QP_ID(qp)); |
| |
| if (recv_wr->num_sge == 0) { |
| rqe->length = 0; |
| } else if (recv_wr->num_sge == 1) { |
| rqe->stag = cpu_to_le32(recv_wr->sg_list[0].lkey); |
| rqe->to = cpu_to_le64(recv_wr->sg_list[0].addr); |
| rqe->length = cpu_to_le32(recv_wr->sg_list[0].length); |
| } else { |
| return -EINVAL; |
| } |
| |
| *(u64 *)qp->kern_qp.rq_db_info = *(u64 *)rqe; |
| writeq(*(u64 *)rqe, qp->kern_qp.hw_rq_db); |
| |
| qp->kern_qp.rwr_tbl[qp->kern_qp.rq_pi & (qp->attrs.rq_size - 1)] = |
| recv_wr->wr_id; |
| qp->kern_qp.rq_pi++; |
| |
| return 0; |
| } |
| |
| int erdma_post_recv(struct ib_qp *ibqp, const struct ib_recv_wr *recv_wr, |
| const struct ib_recv_wr **bad_recv_wr) |
| { |
| const struct ib_recv_wr *wr = recv_wr; |
| struct erdma_qp *qp = to_eqp(ibqp); |
| unsigned long flags; |
| int ret; |
| |
| spin_lock_irqsave(&qp->lock, flags); |
| |
| while (wr) { |
| ret = erdma_post_recv_one(qp, wr); |
| if (ret) { |
| *bad_recv_wr = wr; |
| break; |
| } |
| wr = wr->next; |
| } |
| |
| spin_unlock_irqrestore(&qp->lock, flags); |
| |
| if (unlikely(qp->flags & ERDMA_QP_IN_FLUSHING)) |
| mod_delayed_work(qp->dev->reflush_wq, &qp->reflush_dwork, |
| usecs_to_jiffies(100)); |
| |
| return ret; |
| } |