qlogic/qed/qed_iwarp.c

0001 // SPDX-License-Identifier: (GPL-2.0-only OR BSD-3-Clause)
0002 /* QLogic qed NIC Driver
0003  * Copyright (c) 2015-2017  QLogic Corporation
0004  * Copyright (c) 2019-2020 Marvell International Ltd.
0005  */
0006
0007 #include <linux/if_ether.h>
0008 #include <linux/if_vlan.h>
0009 #include <linux/ip.h>
0010 #include <linux/ipv6.h>
0011 #include <linux/spinlock.h>
0012 #include <linux/tcp.h>
0013 #include "qed_cxt.h"
0014 #include "qed_hw.h"
0015 #include "qed_ll2.h"
0016 #include "qed_rdma.h"
0017 #include "qed_reg_addr.h"
0018 #include "qed_sp.h"
0019 #include "qed_ooo.h"
0020
0021 #define QED_IWARP_ORD_DEFAULT       32
0022 #define QED_IWARP_IRD_DEFAULT       32
0023 #define QED_IWARP_MAX_FW_MSS        4120
0024
0025 #define QED_EP_SIG 0xecabcdef
0026
0027 struct mpa_v2_hdr {
0028     __be16 ird;
0029     __be16 ord;
0030 };
0031
0032 #define MPA_V2_PEER2PEER_MODEL  0x8000
0033 #define MPA_V2_SEND_RTR         0x4000  /* on ird */
0034 #define MPA_V2_READ_RTR         0x4000  /* on ord */
0035 #define MPA_V2_WRITE_RTR        0x8000
0036 #define MPA_V2_IRD_ORD_MASK     0x3FFF
0037
0038 #define MPA_REV2(_mpa_rev) ((_mpa_rev) == MPA_NEGOTIATION_TYPE_ENHANCED)
0039
0040 #define QED_IWARP_INVALID_TCP_CID   0xffffffff
0041
0042 #define QED_IWARP_RCV_WND_SIZE_DEF_BB_2P (200 * 1024)
0043 #define QED_IWARP_RCV_WND_SIZE_DEF_BB_4P (100 * 1024)
0044 #define QED_IWARP_RCV_WND_SIZE_DEF_AH_2P (150 * 1024)
0045 #define QED_IWARP_RCV_WND_SIZE_DEF_AH_4P (90 * 1024)
0046
0047 #define QED_IWARP_RCV_WND_SIZE_MIN  (0xffff)
0048 #define TIMESTAMP_HEADER_SIZE       (12)
0049 #define QED_IWARP_MAX_FIN_RT_DEFAULT    (2)
0050
0051 #define QED_IWARP_TS_EN         BIT(0)
0052 #define QED_IWARP_DA_EN         BIT(1)
0053 #define QED_IWARP_PARAM_CRC_NEEDED  (1)
0054 #define QED_IWARP_PARAM_P2P     (1)
0055
0056 #define QED_IWARP_DEF_MAX_RT_TIME   (0)
0057 #define QED_IWARP_DEF_CWND_FACTOR   (4)
0058 #define QED_IWARP_DEF_KA_MAX_PROBE_CNT  (5)
0059 #define QED_IWARP_DEF_KA_TIMEOUT    (1200000)   /* 20 min */
0060 #define QED_IWARP_DEF_KA_INTERVAL   (1000)      /* 1 sec */
0061
0062 static int qed_iwarp_async_event(struct qed_hwfn *p_hwfn, u8 fw_event_code,
0063                  __le16 echo, union event_ring_data *data,
0064                  u8 fw_return_code);
0065
0066 /* Override devinfo with iWARP specific values */
0067 void qed_iwarp_init_devinfo(struct qed_hwfn *p_hwfn)
0068 {
0069     struct qed_rdma_device *dev = p_hwfn->p_rdma_info->dev;
0070
0071     dev->max_inline = IWARP_REQ_MAX_INLINE_DATA_SIZE;
0072     dev->max_qp = min_t(u32,
0073                 IWARP_MAX_QPS,
0074                 p_hwfn->p_rdma_info->num_qps) -
0075               QED_IWARP_PREALLOC_CNT;
0076
0077     dev->max_cq = dev->max_qp;
0078
0079     dev->max_qp_resp_rd_atomic_resc = QED_IWARP_IRD_DEFAULT;
0080     dev->max_qp_req_rd_atomic_resc = QED_IWARP_ORD_DEFAULT;
0081 }
0082
0083 void qed_iwarp_init_hw(struct qed_hwfn *p_hwfn, struct qed_ptt *p_ptt)
0084 {
0085     p_hwfn->rdma_prs_search_reg = PRS_REG_SEARCH_TCP;
0086     qed_wr(p_hwfn, p_ptt, p_hwfn->rdma_prs_search_reg, 1);
0087     p_hwfn->b_rdma_enabled_in_prs = true;
0088 }
0089
0090 /* We have two cid maps, one for tcp which should be used only from passive
0091  * syn processing and replacing a pre-allocated ep in the list. The second
0092  * for active tcp and for QPs.
0093  */
0094 static void qed_iwarp_cid_cleaned(struct qed_hwfn *p_hwfn, u32 cid)
0095 {
0096     cid -= qed_cxt_get_proto_cid_start(p_hwfn, p_hwfn->p_rdma_info->proto);
0097
0098     spin_lock_bh(&p_hwfn->p_rdma_info->lock);
0099
0100     if (cid < QED_IWARP_PREALLOC_CNT)
0101         qed_bmap_release_id(p_hwfn, &p_hwfn->p_rdma_info->tcp_cid_map,
0102                     cid);
0103     else
0104         qed_bmap_release_id(p_hwfn, &p_hwfn->p_rdma_info->cid_map, cid);
0105
0106     spin_unlock_bh(&p_hwfn->p_rdma_info->lock);
0107 }
0108
0109 void
0110 qed_iwarp_init_fw_ramrod(struct qed_hwfn *p_hwfn,
0111              struct iwarp_init_func_ramrod_data *p_ramrod)
0112 {
0113     p_ramrod->iwarp.ll2_ooo_q_index =
0114         RESC_START(p_hwfn, QED_LL2_RAM_QUEUE) +
0115         p_hwfn->p_rdma_info->iwarp.ll2_ooo_handle;
0116
0117     p_ramrod->tcp.tx_sws_timer = cpu_to_le16(QED_TX_SWS_TIMER_DFLT);
0118     p_ramrod->tcp.two_msl_timer = cpu_to_le32(QED_TWO_MSL_TIMER_DFLT);
0119     p_ramrod->tcp.max_fin_rt = QED_IWARP_MAX_FIN_RT_DEFAULT;
0120
0121     return;
0122 }
0123
0124 static int qed_iwarp_alloc_cid(struct qed_hwfn *p_hwfn, u32 *cid)
0125 {
0126     int rc;
0127
0128     spin_lock_bh(&p_hwfn->p_rdma_info->lock);
0129     rc = qed_rdma_bmap_alloc_id(p_hwfn, &p_hwfn->p_rdma_info->cid_map, cid);
0130     spin_unlock_bh(&p_hwfn->p_rdma_info->lock);
0131     if (rc) {
0132         DP_NOTICE(p_hwfn, "Failed in allocating iwarp cid\n");
0133         return rc;
0134     }
0135     *cid += qed_cxt_get_proto_cid_start(p_hwfn, p_hwfn->p_rdma_info->proto);
0136
0137     rc = qed_cxt_dynamic_ilt_alloc(p_hwfn, QED_ELEM_CXT, *cid);
0138     if (rc)
0139         qed_iwarp_cid_cleaned(p_hwfn, *cid);
0140
0141     return rc;
0142 }
0143
0144 static void qed_iwarp_set_tcp_cid(struct qed_hwfn *p_hwfn, u32 cid)
0145 {
0146     cid -= qed_cxt_get_proto_cid_start(p_hwfn, p_hwfn->p_rdma_info->proto);
0147
0148     spin_lock_bh(&p_hwfn->p_rdma_info->lock);
0149     qed_bmap_set_id(p_hwfn, &p_hwfn->p_rdma_info->tcp_cid_map, cid);
0150     spin_unlock_bh(&p_hwfn->p_rdma_info->lock);
0151 }
0152
0153 /* This function allocates a cid for passive tcp (called from syn receive)
0154  * the reason it's separate from the regular cid allocation is because it
0155  * is assured that these cids already have ilt allocated. They are preallocated
0156  * to ensure that we won't need to allocate memory during syn processing
0157  */
0158 static int qed_iwarp_alloc_tcp_cid(struct qed_hwfn *p_hwfn, u32 *cid)
0159 {
0160     int rc;
0161
0162     spin_lock_bh(&p_hwfn->p_rdma_info->lock);
0163
0164     rc = qed_rdma_bmap_alloc_id(p_hwfn,
0165                     &p_hwfn->p_rdma_info->tcp_cid_map, cid);
0166
0167     spin_unlock_bh(&p_hwfn->p_rdma_info->lock);
0168
0169     if (rc) {
0170         DP_VERBOSE(p_hwfn, QED_MSG_RDMA,
0171                "can't allocate iwarp tcp cid max-count=%d\n",
0172                p_hwfn->p_rdma_info->tcp_cid_map.max_count);
0173
0174         *cid = QED_IWARP_INVALID_TCP_CID;
0175         return rc;
0176     }
0177
0178     *cid += qed_cxt_get_proto_cid_start(p_hwfn,
0179                         p_hwfn->p_rdma_info->proto);
0180     return 0;
0181 }
0182
0183 int qed_iwarp_create_qp(struct qed_hwfn *p_hwfn,
0184             struct qed_rdma_qp *qp,
0185             struct qed_rdma_create_qp_out_params *out_params)
0186 {
0187     struct iwarp_create_qp_ramrod_data *p_ramrod;
0188     struct qed_sp_init_data init_data;
0189     struct qed_spq_entry *p_ent;
0190     u16 physical_queue;
0191     u32 cid;
0192     int rc;
0193
0194     qp->shared_queue = dma_alloc_coherent(&p_hwfn->cdev->pdev->dev,
0195                           IWARP_SHARED_QUEUE_PAGE_SIZE,
0196                           &qp->shared_queue_phys_addr,
0197                           GFP_KERNEL);
0198     if (!qp->shared_queue)
0199         return -ENOMEM;
0200
0201     out_params->sq_pbl_virt = (u8 *)qp->shared_queue +
0202         IWARP_SHARED_QUEUE_PAGE_SQ_PBL_OFFSET;
0203     out_params->sq_pbl_phys = qp->shared_queue_phys_addr +
0204         IWARP_SHARED_QUEUE_PAGE_SQ_PBL_OFFSET;
0205     out_params->rq_pbl_virt = (u8 *)qp->shared_queue +
0206         IWARP_SHARED_QUEUE_PAGE_RQ_PBL_OFFSET;
0207     out_params->rq_pbl_phys = qp->shared_queue_phys_addr +
0208         IWARP_SHARED_QUEUE_PAGE_RQ_PBL_OFFSET;
0209
0210     rc = qed_iwarp_alloc_cid(p_hwfn, &cid);
0211     if (rc)
0212         goto err1;
0213
0214     qp->icid = (u16)cid;
0215
0216     memset(&init_data, 0, sizeof(init_data));
0217     init_data.opaque_fid = p_hwfn->hw_info.opaque_fid;
0218     init_data.cid = qp->icid;
0219     init_data.comp_mode = QED_SPQ_MODE_EBLOCK;
0220
0221     rc = qed_sp_init_request(p_hwfn, &p_ent,
0222                  IWARP_RAMROD_CMD_ID_CREATE_QP,
0223                  PROTOCOLID_IWARP, &init_data);
0224     if (rc)
0225         goto err2;
0226
0227     p_ramrod = &p_ent->ramrod.iwarp_create_qp;
0228
0229     SET_FIELD(p_ramrod->flags,
0230           IWARP_CREATE_QP_RAMROD_DATA_FMR_AND_RESERVED_EN,
0231           qp->fmr_and_reserved_lkey);
0232
0233     SET_FIELD(p_ramrod->flags,
0234           IWARP_CREATE_QP_RAMROD_DATA_SIGNALED_COMP, qp->signal_all);
0235
0236     SET_FIELD(p_ramrod->flags,
0237           IWARP_CREATE_QP_RAMROD_DATA_RDMA_RD_EN,
0238           qp->incoming_rdma_read_en);
0239
0240     SET_FIELD(p_ramrod->flags,
0241           IWARP_CREATE_QP_RAMROD_DATA_RDMA_WR_EN,
0242           qp->incoming_rdma_write_en);
0243
0244     SET_FIELD(p_ramrod->flags,
0245           IWARP_CREATE_QP_RAMROD_DATA_ATOMIC_EN,
0246           qp->incoming_atomic_en);
0247
0248     SET_FIELD(p_ramrod->flags,
0249           IWARP_CREATE_QP_RAMROD_DATA_SRQ_FLG, qp->use_srq);
0250
0251     p_ramrod->pd = cpu_to_le16(qp->pd);
0252     p_ramrod->sq_num_pages = cpu_to_le16(qp->sq_num_pages);
0253     p_ramrod->rq_num_pages = cpu_to_le16(qp->rq_num_pages);
0254
0255     p_ramrod->srq_id.srq_idx = cpu_to_le16(qp->srq_id);
0256     p_ramrod->srq_id.opaque_fid = cpu_to_le16(p_hwfn->hw_info.opaque_fid);
0257     p_ramrod->qp_handle_for_cqe.hi = qp->qp_handle.hi;
0258     p_ramrod->qp_handle_for_cqe.lo = qp->qp_handle.lo;
0259
0260     p_ramrod->cq_cid_for_sq =
0261         cpu_to_le32((p_hwfn->hw_info.opaque_fid << 16) | qp->sq_cq_id);
0262     p_ramrod->cq_cid_for_rq =
0263         cpu_to_le32((p_hwfn->hw_info.opaque_fid << 16) | qp->rq_cq_id);
0264
0265     p_ramrod->dpi = cpu_to_le16(qp->dpi);
0266
0267     physical_queue = qed_get_cm_pq_idx(p_hwfn, PQ_FLAGS_OFLD);
0268     p_ramrod->physical_q0 = cpu_to_le16(physical_queue);
0269     physical_queue = qed_get_cm_pq_idx(p_hwfn, PQ_FLAGS_ACK);
0270     p_ramrod->physical_q1 = cpu_to_le16(physical_queue);
0271
0272     rc = qed_spq_post(p_hwfn, p_ent, NULL);
0273     if (rc)
0274         goto err2;
0275
0276     return rc;
0277
0278 err2:
0279     qed_iwarp_cid_cleaned(p_hwfn, cid);
0280 err1:
0281     dma_free_coherent(&p_hwfn->cdev->pdev->dev,
0282               IWARP_SHARED_QUEUE_PAGE_SIZE,
0283               qp->shared_queue, qp->shared_queue_phys_addr);
0284
0285     return rc;
0286 }
0287
0288 static int qed_iwarp_modify_fw(struct qed_hwfn *p_hwfn, struct qed_rdma_qp *qp)
0289 {
0290     struct iwarp_modify_qp_ramrod_data *p_ramrod;
0291     struct qed_sp_init_data init_data;
0292     struct qed_spq_entry *p_ent;
0293     u16 flags, trans_to_state;
0294     int rc;
0295
0296     /* Get SPQ entry */
0297     memset(&init_data, 0, sizeof(init_data));
0298     init_data.cid = qp->icid;
0299     init_data.opaque_fid = p_hwfn->hw_info.opaque_fid;
0300     init_data.comp_mode = QED_SPQ_MODE_EBLOCK;
0301
0302     rc = qed_sp_init_request(p_hwfn, &p_ent,
0303                  IWARP_RAMROD_CMD_ID_MODIFY_QP,
0304                  p_hwfn->p_rdma_info->proto, &init_data);
0305     if (rc)
0306         return rc;
0307
0308     p_ramrod = &p_ent->ramrod.iwarp_modify_qp;
0309
0310     flags = le16_to_cpu(p_ramrod->flags);
0311     SET_FIELD(flags, IWARP_MODIFY_QP_RAMROD_DATA_STATE_TRANS_EN, 0x1);
0312     p_ramrod->flags = cpu_to_le16(flags);
0313
0314     if (qp->iwarp_state == QED_IWARP_QP_STATE_CLOSING)
0315         trans_to_state = IWARP_MODIFY_QP_STATE_CLOSING;
0316     else
0317         trans_to_state = IWARP_MODIFY_QP_STATE_ERROR;
0318
0319     p_ramrod->transition_to_state = cpu_to_le16(trans_to_state);
0320
0321     rc = qed_spq_post(p_hwfn, p_ent, NULL);
0322
0323     DP_VERBOSE(p_hwfn, QED_MSG_RDMA, "QP(0x%x)rc=%d\n", qp->icid, rc);
0324
0325     return rc;
0326 }
0327
0328 enum qed_iwarp_qp_state qed_roce2iwarp_state(enum qed_roce_qp_state state)
0329 {
0330     switch (state) {
0331     case QED_ROCE_QP_STATE_RESET:
0332     case QED_ROCE_QP_STATE_INIT:
0333     case QED_ROCE_QP_STATE_RTR:
0334         return QED_IWARP_QP_STATE_IDLE;
0335     case QED_ROCE_QP_STATE_RTS:
0336         return QED_IWARP_QP_STATE_RTS;
0337     case QED_ROCE_QP_STATE_SQD:
0338         return QED_IWARP_QP_STATE_CLOSING;
0339     case QED_ROCE_QP_STATE_ERR:
0340         return QED_IWARP_QP_STATE_ERROR;
0341     case QED_ROCE_QP_STATE_SQE:
0342         return QED_IWARP_QP_STATE_TERMINATE;
0343     default:
0344         return QED_IWARP_QP_STATE_ERROR;
0345     }
0346 }
0347
0348 static enum qed_roce_qp_state
0349 qed_iwarp2roce_state(enum qed_iwarp_qp_state state)
0350 {
0351     switch (state) {
0352     case QED_IWARP_QP_STATE_IDLE:
0353         return QED_ROCE_QP_STATE_INIT;
0354     case QED_IWARP_QP_STATE_RTS:
0355         return QED_ROCE_QP_STATE_RTS;
0356     case QED_IWARP_QP_STATE_TERMINATE:
0357         return QED_ROCE_QP_STATE_SQE;
0358     case QED_IWARP_QP_STATE_CLOSING:
0359         return QED_ROCE_QP_STATE_SQD;
0360     case QED_IWARP_QP_STATE_ERROR:
0361         return QED_ROCE_QP_STATE_ERR;
0362     default:
0363         return QED_ROCE_QP_STATE_ERR;
0364     }
0365 }
0366
0367 static const char * const iwarp_state_names[] = {
0368     "IDLE",
0369     "RTS",
0370     "TERMINATE",
0371     "CLOSING",
0372     "ERROR",
0373 };
0374
0375 int
0376 qed_iwarp_modify_qp(struct qed_hwfn *p_hwfn,
0377             struct qed_rdma_qp *qp,
0378             enum qed_iwarp_qp_state new_state, bool internal)
0379 {
0380     enum qed_iwarp_qp_state prev_iw_state;
0381     bool modify_fw = false;
0382     int rc = 0;
0383
0384     /* modify QP can be called from upper-layer or as a result of async
0385      * RST/FIN... therefore need to protect
0386      */
0387     spin_lock_bh(&p_hwfn->p_rdma_info->iwarp.qp_lock);
0388     prev_iw_state = qp->iwarp_state;
0389
0390     if (prev_iw_state == new_state) {
0391         spin_unlock_bh(&p_hwfn->p_rdma_info->iwarp.qp_lock);
0392         return 0;
0393     }
0394
0395     switch (prev_iw_state) {
0396     case QED_IWARP_QP_STATE_IDLE:
0397         switch (new_state) {
0398         case QED_IWARP_QP_STATE_RTS:
0399             qp->iwarp_state = QED_IWARP_QP_STATE_RTS;
0400             break;
0401         case QED_IWARP_QP_STATE_ERROR:
0402             qp->iwarp_state = QED_IWARP_QP_STATE_ERROR;
0403             if (!internal)
0404                 modify_fw = true;
0405             break;
0406         default:
0407             break;
0408         }
0409         break;
0410     case QED_IWARP_QP_STATE_RTS:
0411         switch (new_state) {
0412         case QED_IWARP_QP_STATE_CLOSING:
0413             if (!internal)
0414                 modify_fw = true;
0415
0416             qp->iwarp_state = QED_IWARP_QP_STATE_CLOSING;
0417             break;
0418         case QED_IWARP_QP_STATE_ERROR:
0419             if (!internal)
0420                 modify_fw = true;
0421             qp->iwarp_state = QED_IWARP_QP_STATE_ERROR;
0422             break;
0423         default:
0424             break;
0425         }
0426         break;
0427     case QED_IWARP_QP_STATE_ERROR:
0428         switch (new_state) {
0429         case QED_IWARP_QP_STATE_IDLE:
0430
0431             qp->iwarp_state = new_state;
0432             break;
0433         case QED_IWARP_QP_STATE_CLOSING:
0434             /* could happen due to race... do nothing.... */
0435             break;
0436         default:
0437             rc = -EINVAL;
0438         }
0439         break;
0440     case QED_IWARP_QP_STATE_TERMINATE:
0441     case QED_IWARP_QP_STATE_CLOSING:
0442         qp->iwarp_state = new_state;
0443         break;
0444     default:
0445         break;
0446     }
0447
0448     DP_VERBOSE(p_hwfn, QED_MSG_RDMA, "QP(0x%x) %s --> %s%s\n",
0449            qp->icid,
0450            iwarp_state_names[prev_iw_state],
0451            iwarp_state_names[qp->iwarp_state],
0452            internal ? "internal" : "");
0453
0454     spin_unlock_bh(&p_hwfn->p_rdma_info->iwarp.qp_lock);
0455
0456     if (modify_fw)
0457         rc = qed_iwarp_modify_fw(p_hwfn, qp);
0458
0459     return rc;
0460 }
0461
0462 int qed_iwarp_fw_destroy(struct qed_hwfn *p_hwfn, struct qed_rdma_qp *qp)
0463 {
0464     struct qed_sp_init_data init_data;
0465     struct qed_spq_entry *p_ent;
0466     int rc;
0467
0468     /* Get SPQ entry */
0469     memset(&init_data, 0, sizeof(init_data));
0470     init_data.cid = qp->icid;
0471     init_data.opaque_fid = p_hwfn->hw_info.opaque_fid;
0472     init_data.comp_mode = QED_SPQ_MODE_EBLOCK;
0473
0474     rc = qed_sp_init_request(p_hwfn, &p_ent,
0475                  IWARP_RAMROD_CMD_ID_DESTROY_QP,
0476                  p_hwfn->p_rdma_info->proto, &init_data);
0477     if (rc)
0478         return rc;
0479
0480     rc = qed_spq_post(p_hwfn, p_ent, NULL);
0481
0482     DP_VERBOSE(p_hwfn, QED_MSG_RDMA, "QP(0x%x) rc = %d\n", qp->icid, rc);
0483
0484     return rc;
0485 }
0486
0487 static void qed_iwarp_destroy_ep(struct qed_hwfn *p_hwfn,
0488                  struct qed_iwarp_ep *ep,
0489                  bool remove_from_active_list)
0490 {
0491     dma_free_coherent(&p_hwfn->cdev->pdev->dev,
0492               sizeof(*ep->ep_buffer_virt),
0493               ep->ep_buffer_virt, ep->ep_buffer_phys);
0494
0495     if (remove_from_active_list) {
0496         spin_lock_bh(&p_hwfn->p_rdma_info->iwarp.iw_lock);
0497         list_del(&ep->list_entry);
0498         spin_unlock_bh(&p_hwfn->p_rdma_info->iwarp.iw_lock);
0499     }
0500
0501     if (ep->qp)
0502         ep->qp->ep = NULL;
0503
0504     kfree(ep);
0505 }
0506
0507 int qed_iwarp_destroy_qp(struct qed_hwfn *p_hwfn, struct qed_rdma_qp *qp)
0508 {
0509     struct qed_iwarp_ep *ep = qp->ep;
0510     int wait_count = 0;
0511     int rc = 0;
0512
0513     if (qp->iwarp_state != QED_IWARP_QP_STATE_ERROR) {
0514         rc = qed_iwarp_modify_qp(p_hwfn, qp,
0515                      QED_IWARP_QP_STATE_ERROR, false);
0516         if (rc)
0517             return rc;
0518     }
0519
0520     /* Make sure ep is closed before returning and freeing memory. */
0521     if (ep) {
0522         while (READ_ONCE(ep->state) != QED_IWARP_EP_CLOSED &&
0523                wait_count++ < 200)
0524             msleep(100);
0525
0526         if (ep->state != QED_IWARP_EP_CLOSED)
0527             DP_NOTICE(p_hwfn, "ep state close timeout state=%x\n",
0528                   ep->state);
0529
0530         qed_iwarp_destroy_ep(p_hwfn, ep, false);
0531     }
0532
0533     rc = qed_iwarp_fw_destroy(p_hwfn, qp);
0534
0535     if (qp->shared_queue)
0536         dma_free_coherent(&p_hwfn->cdev->pdev->dev,
0537                   IWARP_SHARED_QUEUE_PAGE_SIZE,
0538                   qp->shared_queue, qp->shared_queue_phys_addr);
0539
0540     return rc;
0541 }
0542
0543 static int
0544 qed_iwarp_create_ep(struct qed_hwfn *p_hwfn, struct qed_iwarp_ep **ep_out)
0545 {
0546     struct qed_iwarp_ep *ep;
0547     int rc;
0548
0549     ep = kzalloc(sizeof(*ep), GFP_KERNEL);
0550     if (!ep)
0551         return -ENOMEM;
0552
0553     ep->state = QED_IWARP_EP_INIT;
0554
0555     ep->ep_buffer_virt = dma_alloc_coherent(&p_hwfn->cdev->pdev->dev,
0556                         sizeof(*ep->ep_buffer_virt),
0557                         &ep->ep_buffer_phys,
0558                         GFP_KERNEL);
0559     if (!ep->ep_buffer_virt) {
0560         rc = -ENOMEM;
0561         goto err;
0562     }
0563
0564     ep->sig = QED_EP_SIG;
0565
0566     *ep_out = ep;
0567
0568     return 0;
0569
0570 err:
0571     kfree(ep);
0572     return rc;
0573 }
0574
0575 static void
0576 qed_iwarp_print_tcp_ramrod(struct qed_hwfn *p_hwfn,
0577                struct iwarp_tcp_offload_ramrod_data *p_tcp_ramrod)
0578 {
0579     DP_VERBOSE(p_hwfn, QED_MSG_RDMA, "local_mac=%x %x %x, remote_mac=%x %x %x\n",
0580            p_tcp_ramrod->tcp.local_mac_addr_lo,
0581            p_tcp_ramrod->tcp.local_mac_addr_mid,
0582            p_tcp_ramrod->tcp.local_mac_addr_hi,
0583            p_tcp_ramrod->tcp.remote_mac_addr_lo,
0584            p_tcp_ramrod->tcp.remote_mac_addr_mid,
0585            p_tcp_ramrod->tcp.remote_mac_addr_hi);
0586
0587     if (p_tcp_ramrod->tcp.ip_version == TCP_IPV4) {
0588         DP_VERBOSE(p_hwfn, QED_MSG_RDMA,
0589                "local_ip=%pI4h:%x, remote_ip=%pI4h:%x, vlan=%x\n",
0590                p_tcp_ramrod->tcp.local_ip,
0591                p_tcp_ramrod->tcp.local_port,
0592                p_tcp_ramrod->tcp.remote_ip,
0593                p_tcp_ramrod->tcp.remote_port,
0594                p_tcp_ramrod->tcp.vlan_id);
0595     } else {
0596         DP_VERBOSE(p_hwfn, QED_MSG_RDMA,
0597                "local_ip=%pI6:%x, remote_ip=%pI6:%x, vlan=%x\n",
0598                p_tcp_ramrod->tcp.local_ip,
0599                p_tcp_ramrod->tcp.local_port,
0600                p_tcp_ramrod->tcp.remote_ip,
0601                p_tcp_ramrod->tcp.remote_port,
0602                p_tcp_ramrod->tcp.vlan_id);
0603     }
0604
0605     DP_VERBOSE(p_hwfn, QED_MSG_RDMA,
0606            "flow_label=%x, ttl=%x, tos_or_tc=%x, mss=%x, rcv_wnd_scale=%x, connect_mode=%x, flags=%x\n",
0607            p_tcp_ramrod->tcp.flow_label,
0608            p_tcp_ramrod->tcp.ttl,
0609            p_tcp_ramrod->tcp.tos_or_tc,
0610            p_tcp_ramrod->tcp.mss,
0611            p_tcp_ramrod->tcp.rcv_wnd_scale,
0612            p_tcp_ramrod->tcp.connect_mode,
0613            p_tcp_ramrod->tcp.flags);
0614
0615     DP_VERBOSE(p_hwfn, QED_MSG_RDMA, "syn_ip_payload_length=%x, lo=%x, hi=%x\n",
0616            p_tcp_ramrod->tcp.syn_ip_payload_length,
0617            p_tcp_ramrod->tcp.syn_phy_addr_lo,
0618            p_tcp_ramrod->tcp.syn_phy_addr_hi);
0619 }
0620
0621 static int
0622 qed_iwarp_tcp_offload(struct qed_hwfn *p_hwfn, struct qed_iwarp_ep *ep)
0623 {
0624     struct qed_iwarp_info *iwarp_info = &p_hwfn->p_rdma_info->iwarp;
0625     struct iwarp_tcp_offload_ramrod_data *p_tcp_ramrod;
0626     struct tcp_offload_params_opt2 *tcp;
0627     struct qed_sp_init_data init_data;
0628     struct qed_spq_entry *p_ent;
0629     dma_addr_t async_output_phys;
0630     dma_addr_t in_pdata_phys;
0631     u16 physical_q;
0632     u16 flags = 0;
0633     u8 tcp_flags;
0634     int rc;
0635     int i;
0636
0637     memset(&init_data, 0, sizeof(init_data));
0638     init_data.cid = ep->tcp_cid;
0639     init_data.opaque_fid = p_hwfn->hw_info.opaque_fid;
0640     if (ep->connect_mode == TCP_CONNECT_PASSIVE)
0641         init_data.comp_mode = QED_SPQ_MODE_CB;
0642     else
0643         init_data.comp_mode = QED_SPQ_MODE_EBLOCK;
0644
0645     rc = qed_sp_init_request(p_hwfn, &p_ent,
0646                  IWARP_RAMROD_CMD_ID_TCP_OFFLOAD,
0647                  PROTOCOLID_IWARP, &init_data);
0648     if (rc)
0649         return rc;
0650
0651     p_tcp_ramrod = &p_ent->ramrod.iwarp_tcp_offload;
0652
0653     in_pdata_phys = ep->ep_buffer_phys +
0654             offsetof(struct qed_iwarp_ep_memory, in_pdata);
0655     DMA_REGPAIR_LE(p_tcp_ramrod->iwarp.incoming_ulp_buffer.addr,
0656                in_pdata_phys);
0657
0658     p_tcp_ramrod->iwarp.incoming_ulp_buffer.len =
0659         cpu_to_le16(sizeof(ep->ep_buffer_virt->in_pdata));
0660
0661     async_output_phys = ep->ep_buffer_phys +
0662                 offsetof(struct qed_iwarp_ep_memory, async_output);
0663     DMA_REGPAIR_LE(p_tcp_ramrod->iwarp.async_eqe_output_buf,
0664                async_output_phys);
0665
0666     p_tcp_ramrod->iwarp.handle_for_async.hi = cpu_to_le32(PTR_HI(ep));
0667     p_tcp_ramrod->iwarp.handle_for_async.lo = cpu_to_le32(PTR_LO(ep));
0668
0669     physical_q = qed_get_cm_pq_idx(p_hwfn, PQ_FLAGS_OFLD);
0670     p_tcp_ramrod->iwarp.physical_q0 = cpu_to_le16(physical_q);
0671     physical_q = qed_get_cm_pq_idx(p_hwfn, PQ_FLAGS_ACK);
0672     p_tcp_ramrod->iwarp.physical_q1 = cpu_to_le16(physical_q);
0673     p_tcp_ramrod->iwarp.mpa_mode = iwarp_info->mpa_rev;
0674
0675     tcp = &p_tcp_ramrod->tcp;
0676     qed_set_fw_mac_addr(&tcp->remote_mac_addr_hi,
0677                 &tcp->remote_mac_addr_mid,
0678                 &tcp->remote_mac_addr_lo, ep->remote_mac_addr);
0679     qed_set_fw_mac_addr(&tcp->local_mac_addr_hi, &tcp->local_mac_addr_mid,
0680                 &tcp->local_mac_addr_lo, ep->local_mac_addr);
0681
0682     tcp->vlan_id = cpu_to_le16(ep->cm_info.vlan);
0683
0684     tcp_flags = p_hwfn->p_rdma_info->iwarp.tcp_flags;
0685
0686     SET_FIELD(flags, TCP_OFFLOAD_PARAMS_OPT2_TS_EN,
0687           !!(tcp_flags & QED_IWARP_TS_EN));
0688
0689     SET_FIELD(flags, TCP_OFFLOAD_PARAMS_OPT2_DA_EN,
0690           !!(tcp_flags & QED_IWARP_DA_EN));
0691
0692     tcp->flags = cpu_to_le16(flags);
0693     tcp->ip_version = ep->cm_info.ip_version;
0694
0695     for (i = 0; i < 4; i++) {
0696         tcp->remote_ip[i] = cpu_to_le32(ep->cm_info.remote_ip[i]);
0697         tcp->local_ip[i] = cpu_to_le32(ep->cm_info.local_ip[i]);
0698     }
0699
0700     tcp->remote_port = cpu_to_le16(ep->cm_info.remote_port);
0701     tcp->local_port = cpu_to_le16(ep->cm_info.local_port);
0702     tcp->mss = cpu_to_le16(ep->mss);
0703     tcp->flow_label = 0;
0704     tcp->ttl = 0x40;
0705     tcp->tos_or_tc = 0;
0706
0707     tcp->max_rt_time = QED_IWARP_DEF_MAX_RT_TIME;
0708     tcp->cwnd = cpu_to_le32(QED_IWARP_DEF_CWND_FACTOR * ep->mss);
0709     tcp->ka_max_probe_cnt = QED_IWARP_DEF_KA_MAX_PROBE_CNT;
0710     tcp->ka_timeout = cpu_to_le32(QED_IWARP_DEF_KA_TIMEOUT);
0711     tcp->ka_interval = cpu_to_le32(QED_IWARP_DEF_KA_INTERVAL);
0712
0713     tcp->rcv_wnd_scale = (u8)p_hwfn->p_rdma_info->iwarp.rcv_wnd_scale;
0714     tcp->connect_mode = ep->connect_mode;
0715
0716     if (ep->connect_mode == TCP_CONNECT_PASSIVE) {
0717         tcp->syn_ip_payload_length =
0718             cpu_to_le16(ep->syn_ip_payload_length);
0719         tcp->syn_phy_addr_hi = DMA_HI_LE(ep->syn_phy_addr);
0720         tcp->syn_phy_addr_lo = DMA_LO_LE(ep->syn_phy_addr);
0721     }
0722
0723     qed_iwarp_print_tcp_ramrod(p_hwfn, p_tcp_ramrod);
0724
0725     rc = qed_spq_post(p_hwfn, p_ent, NULL);
0726
0727     DP_VERBOSE(p_hwfn, QED_MSG_RDMA,
0728            "EP(0x%x) Offload completed rc=%d\n", ep->tcp_cid, rc);
0729
0730     return rc;
0731 }
0732
0733 static void
0734 qed_iwarp_mpa_received(struct qed_hwfn *p_hwfn, struct qed_iwarp_ep *ep)
0735 {
0736     struct qed_iwarp_info *iwarp_info = &p_hwfn->p_rdma_info->iwarp;
0737     struct qed_iwarp_cm_event_params params;
0738     struct mpa_v2_hdr *mpa_v2;
0739     union async_output *async_data;
0740     u16 mpa_ord, mpa_ird;
0741     u8 mpa_hdr_size = 0;
0742     u16 ulp_data_len;
0743     u8 mpa_rev;
0744
0745     async_data = &ep->ep_buffer_virt->async_output;
0746
0747     mpa_rev = async_data->mpa_request.mpa_handshake_mode;
0748     DP_VERBOSE(p_hwfn, QED_MSG_RDMA,
0749            "private_data_len=%x handshake_mode=%x private_data=(%x)\n",
0750            async_data->mpa_request.ulp_data_len,
0751            mpa_rev, *((u32 *)(ep->ep_buffer_virt->in_pdata)));
0752
0753     if (mpa_rev == MPA_NEGOTIATION_TYPE_ENHANCED) {
0754         /* Read ord/ird values from private data buffer */
0755         mpa_v2 = (struct mpa_v2_hdr *)ep->ep_buffer_virt->in_pdata;
0756         mpa_hdr_size = sizeof(*mpa_v2);
0757
0758         mpa_ord = ntohs(mpa_v2->ord);
0759         mpa_ird = ntohs(mpa_v2->ird);
0760
0761         /* Temprary store in cm_info incoming ord/ird requested, later
0762          * replace with negotiated value during accept
0763          */
0764         ep->cm_info.ord = (u8)min_t(u16,
0765                         (mpa_ord & MPA_V2_IRD_ORD_MASK),
0766                         QED_IWARP_ORD_DEFAULT);
0767
0768         ep->cm_info.ird = (u8)min_t(u16,
0769                         (mpa_ird & MPA_V2_IRD_ORD_MASK),
0770                         QED_IWARP_IRD_DEFAULT);
0771
0772         /* Peer2Peer negotiation */
0773         ep->rtr_type = MPA_RTR_TYPE_NONE;
0774         if (mpa_ird & MPA_V2_PEER2PEER_MODEL) {
0775             if (mpa_ord & MPA_V2_WRITE_RTR)
0776                 ep->rtr_type |= MPA_RTR_TYPE_ZERO_WRITE;
0777
0778             if (mpa_ord & MPA_V2_READ_RTR)
0779                 ep->rtr_type |= MPA_RTR_TYPE_ZERO_READ;
0780
0781             if (mpa_ird & MPA_V2_SEND_RTR)
0782                 ep->rtr_type |= MPA_RTR_TYPE_ZERO_SEND;
0783
0784             ep->rtr_type &= iwarp_info->rtr_type;
0785
0786             /* if we're left with no match send our capabilities */
0787             if (ep->rtr_type == MPA_RTR_TYPE_NONE)
0788                 ep->rtr_type = iwarp_info->rtr_type;
0789         }
0790
0791         ep->mpa_rev = MPA_NEGOTIATION_TYPE_ENHANCED;
0792     } else {
0793         ep->cm_info.ord = QED_IWARP_ORD_DEFAULT;
0794         ep->cm_info.ird = QED_IWARP_IRD_DEFAULT;
0795         ep->mpa_rev = MPA_NEGOTIATION_TYPE_BASIC;
0796     }
0797
0798     DP_VERBOSE(p_hwfn, QED_MSG_RDMA,
0799            "MPA_NEGOTIATE (v%d): ORD: 0x%x IRD: 0x%x rtr:0x%x ulp_data_len = %x mpa_hdr_size = %x\n",
0800            mpa_rev, ep->cm_info.ord, ep->cm_info.ird, ep->rtr_type,
0801            async_data->mpa_request.ulp_data_len, mpa_hdr_size);
0802
0803     /* Strip mpa v2 hdr from private data before sending to upper layer */
0804     ep->cm_info.private_data = ep->ep_buffer_virt->in_pdata + mpa_hdr_size;
0805
0806     ulp_data_len = le16_to_cpu(async_data->mpa_request.ulp_data_len);
0807     ep->cm_info.private_data_len = ulp_data_len - mpa_hdr_size;
0808
0809     params.event = QED_IWARP_EVENT_MPA_REQUEST;
0810     params.cm_info = &ep->cm_info;
0811     params.ep_context = ep;
0812     params.status = 0;
0813
0814     ep->state = QED_IWARP_EP_MPA_REQ_RCVD;
0815     ep->event_cb(ep->cb_context, &params);
0816 }
0817
0818 static int
0819 qed_iwarp_mpa_offload(struct qed_hwfn *p_hwfn, struct qed_iwarp_ep *ep)
0820 {
0821     struct iwarp_mpa_offload_ramrod_data *p_mpa_ramrod;
0822     struct mpa_outgoing_params *common;
0823     struct qed_iwarp_info *iwarp_info;
0824     struct qed_sp_init_data init_data;
0825     dma_addr_t async_output_phys;
0826     struct qed_spq_entry *p_ent;
0827     dma_addr_t out_pdata_phys;
0828     dma_addr_t in_pdata_phys;
0829     struct qed_rdma_qp *qp;
0830     bool reject;
0831     u32 val;
0832     int rc;
0833
0834     if (!ep)
0835         return -EINVAL;
0836
0837     qp = ep->qp;
0838     reject = !qp;
0839
0840     memset(&init_data, 0, sizeof(init_data));
0841     init_data.cid = reject ? ep->tcp_cid : qp->icid;
0842     init_data.opaque_fid = p_hwfn->hw_info.opaque_fid;
0843
0844     if (ep->connect_mode == TCP_CONNECT_ACTIVE)
0845         init_data.comp_mode = QED_SPQ_MODE_CB;
0846     else
0847         init_data.comp_mode = QED_SPQ_MODE_EBLOCK;
0848
0849     rc = qed_sp_init_request(p_hwfn, &p_ent,
0850                  IWARP_RAMROD_CMD_ID_MPA_OFFLOAD,
0851                  PROTOCOLID_IWARP, &init_data);
0852     if (rc)
0853         return rc;
0854
0855     p_mpa_ramrod = &p_ent->ramrod.iwarp_mpa_offload;
0856     common = &p_mpa_ramrod->common;
0857
0858     out_pdata_phys = ep->ep_buffer_phys +
0859              offsetof(struct qed_iwarp_ep_memory, out_pdata);
0860     DMA_REGPAIR_LE(common->outgoing_ulp_buffer.addr, out_pdata_phys);
0861
0862     val = ep->cm_info.private_data_len;
0863     common->outgoing_ulp_buffer.len = cpu_to_le16(val);
0864     common->crc_needed = p_hwfn->p_rdma_info->iwarp.crc_needed;
0865
0866     common->out_rq.ord = cpu_to_le32(ep->cm_info.ord);
0867     common->out_rq.ird = cpu_to_le32(ep->cm_info.ird);
0868
0869     val = p_hwfn->hw_info.opaque_fid << 16 | ep->tcp_cid;
0870     p_mpa_ramrod->tcp_cid = cpu_to_le32(val);
0871
0872     in_pdata_phys = ep->ep_buffer_phys +
0873             offsetof(struct qed_iwarp_ep_memory, in_pdata);
0874     p_mpa_ramrod->tcp_connect_side = ep->connect_mode;
0875     DMA_REGPAIR_LE(p_mpa_ramrod->incoming_ulp_buffer.addr,
0876                in_pdata_phys);
0877     p_mpa_ramrod->incoming_ulp_buffer.len =
0878         cpu_to_le16(sizeof(ep->ep_buffer_virt->in_pdata));
0879     async_output_phys = ep->ep_buffer_phys +
0880                 offsetof(struct qed_iwarp_ep_memory, async_output);
0881     DMA_REGPAIR_LE(p_mpa_ramrod->async_eqe_output_buf,
0882                async_output_phys);
0883     p_mpa_ramrod->handle_for_async.hi = cpu_to_le32(PTR_HI(ep));
0884     p_mpa_ramrod->handle_for_async.lo = cpu_to_le32(PTR_LO(ep));
0885
0886     if (!reject) {
0887         DMA_REGPAIR_LE(p_mpa_ramrod->shared_queue_addr,
0888                    qp->shared_queue_phys_addr);
0889         p_mpa_ramrod->stats_counter_id =
0890             RESC_START(p_hwfn, QED_RDMA_STATS_QUEUE) + qp->stats_queue;
0891     } else {
0892         common->reject = 1;
0893     }
0894
0895     iwarp_info = &p_hwfn->p_rdma_info->iwarp;
0896     p_mpa_ramrod->rcv_wnd = cpu_to_le16(iwarp_info->rcv_wnd_size);
0897     p_mpa_ramrod->mode = ep->mpa_rev;
0898     SET_FIELD(p_mpa_ramrod->rtr_pref,
0899           IWARP_MPA_OFFLOAD_RAMROD_DATA_RTR_SUPPORTED, ep->rtr_type);
0900
0901     ep->state = QED_IWARP_EP_MPA_OFFLOADED;
0902     rc = qed_spq_post(p_hwfn, p_ent, NULL);
0903     if (!reject)
0904         ep->cid = qp->icid; /* Now they're migrated. */
0905
0906     DP_VERBOSE(p_hwfn,
0907            QED_MSG_RDMA,
0908            "QP(0x%x) EP(0x%x) MPA Offload rc = %d IRD=0x%x ORD=0x%x rtr_type=%d mpa_rev=%d reject=%d\n",
0909            reject ? 0xffff : qp->icid,
0910            ep->tcp_cid,
0911            rc,
0912            ep->cm_info.ird,
0913            ep->cm_info.ord, ep->rtr_type, ep->mpa_rev, reject);
0914     return rc;
0915 }
0916
0917 static void
0918 qed_iwarp_return_ep(struct qed_hwfn *p_hwfn, struct qed_iwarp_ep *ep)
0919 {
0920     ep->state = QED_IWARP_EP_INIT;
0921     if (ep->qp)
0922         ep->qp->ep = NULL;
0923     ep->qp = NULL;
0924     memset(&ep->cm_info, 0, sizeof(ep->cm_info));
0925
0926     if (ep->tcp_cid == QED_IWARP_INVALID_TCP_CID) {
0927         /* We don't care about the return code, it's ok if tcp_cid
0928          * remains invalid...in this case we'll defer allocation
0929          */
0930         qed_iwarp_alloc_tcp_cid(p_hwfn, &ep->tcp_cid);
0931     }
0932     spin_lock_bh(&p_hwfn->p_rdma_info->iwarp.iw_lock);
0933
0934     list_move_tail(&ep->list_entry,
0935                &p_hwfn->p_rdma_info->iwarp.ep_free_list);
0936
0937     spin_unlock_bh(&p_hwfn->p_rdma_info->iwarp.iw_lock);
0938 }
0939
0940 static void
0941 qed_iwarp_parse_private_data(struct qed_hwfn *p_hwfn, struct qed_iwarp_ep *ep)
0942 {
0943     struct mpa_v2_hdr *mpa_v2_params;
0944     union async_output *async_data;
0945     u16 mpa_ird, mpa_ord;
0946     u8 mpa_data_size = 0;
0947     u16 ulp_data_len;
0948
0949     if (MPA_REV2(p_hwfn->p_rdma_info->iwarp.mpa_rev)) {
0950         mpa_v2_params =
0951             (struct mpa_v2_hdr *)(ep->ep_buffer_virt->in_pdata);
0952         mpa_data_size = sizeof(*mpa_v2_params);
0953         mpa_ird = ntohs(mpa_v2_params->ird);
0954         mpa_ord = ntohs(mpa_v2_params->ord);
0955
0956         ep->cm_info.ird = (u8)(mpa_ord & MPA_V2_IRD_ORD_MASK);
0957         ep->cm_info.ord = (u8)(mpa_ird & MPA_V2_IRD_ORD_MASK);
0958     }
0959
0960     async_data = &ep->ep_buffer_virt->async_output;
0961     ep->cm_info.private_data = ep->ep_buffer_virt->in_pdata + mpa_data_size;
0962
0963     ulp_data_len = le16_to_cpu(async_data->mpa_response.ulp_data_len);
0964     ep->cm_info.private_data_len = ulp_data_len - mpa_data_size;
0965 }
0966
0967 static void
0968 qed_iwarp_mpa_reply_arrived(struct qed_hwfn *p_hwfn, struct qed_iwarp_ep *ep)
0969 {
0970     struct qed_iwarp_cm_event_params params;
0971
0972     if (ep->connect_mode == TCP_CONNECT_PASSIVE) {
0973         DP_NOTICE(p_hwfn,
0974               "MPA reply event not expected on passive side!\n");
0975         return;
0976     }
0977
0978     params.event = QED_IWARP_EVENT_ACTIVE_MPA_REPLY;
0979
0980     qed_iwarp_parse_private_data(p_hwfn, ep);
0981
0982     DP_VERBOSE(p_hwfn, QED_MSG_RDMA,
0983            "MPA_NEGOTIATE (v%d): ORD: 0x%x IRD: 0x%x\n",
0984            ep->mpa_rev, ep->cm_info.ord, ep->cm_info.ird);
0985
0986     params.cm_info = &ep->cm_info;
0987     params.ep_context = ep;
0988     params.status = 0;
0989
0990     ep->mpa_reply_processed = true;
0991
0992     ep->event_cb(ep->cb_context, &params);
0993 }
0994
0995 #define QED_IWARP_CONNECT_MODE_STRING(ep) \
0996     ((ep)->connect_mode == TCP_CONNECT_PASSIVE) ? "Passive" : "Active"
0997
0998 /* Called as a result of the event:
0999  * IWARP_EVENT_TYPE_ASYNC_MPA_HANDSHAKE_COMPLETE
1000  */
1001 static void
1002 qed_iwarp_mpa_complete(struct qed_hwfn *p_hwfn,
1003                struct qed_iwarp_ep *ep, u8 fw_return_code)
1004 {
1005     struct qed_iwarp_cm_event_params params;
1006
1007     if (ep->connect_mode == TCP_CONNECT_ACTIVE)
1008         params.event = QED_IWARP_EVENT_ACTIVE_COMPLETE;
1009     else
1010         params.event = QED_IWARP_EVENT_PASSIVE_COMPLETE;
1011
1012     if (ep->connect_mode == TCP_CONNECT_ACTIVE && !ep->mpa_reply_processed)
1013         qed_iwarp_parse_private_data(p_hwfn, ep);
1014
1015     DP_VERBOSE(p_hwfn, QED_MSG_RDMA,
1016            "MPA_NEGOTIATE (v%d): ORD: 0x%x IRD: 0x%x\n",
1017            ep->mpa_rev, ep->cm_info.ord, ep->cm_info.ird);
1018
1019     params.cm_info = &ep->cm_info;
1020
1021     params.ep_context = ep;
1022
1023     switch (fw_return_code) {
1024     case RDMA_RETURN_OK:
1025         ep->qp->max_rd_atomic_req = ep->cm_info.ord;
1026         ep->qp->max_rd_atomic_resp = ep->cm_info.ird;
1027         qed_iwarp_modify_qp(p_hwfn, ep->qp, QED_IWARP_QP_STATE_RTS, 1);
1028         ep->state = QED_IWARP_EP_ESTABLISHED;
1029         params.status = 0;
1030         break;
1031     case IWARP_CONN_ERROR_MPA_TIMEOUT:
1032         DP_NOTICE(p_hwfn, "%s(0x%x) MPA timeout\n",
1033               QED_IWARP_CONNECT_MODE_STRING(ep), ep->cid);
1034         params.status = -EBUSY;
1035         break;
1036     case IWARP_CONN_ERROR_MPA_ERROR_REJECT:
1037         DP_NOTICE(p_hwfn, "%s(0x%x) MPA Reject\n",
1038               QED_IWARP_CONNECT_MODE_STRING(ep), ep->cid);
1039         params.status = -ECONNREFUSED;
1040         break;
1041     case IWARP_CONN_ERROR_MPA_RST:
1042         DP_NOTICE(p_hwfn, "%s(0x%x) MPA reset(tcp cid: 0x%x)\n",
1043               QED_IWARP_CONNECT_MODE_STRING(ep), ep->cid,
1044               ep->tcp_cid);
1045         params.status = -ECONNRESET;
1046         break;
1047     case IWARP_CONN_ERROR_MPA_FIN:
1048         DP_NOTICE(p_hwfn, "%s(0x%x) MPA received FIN\n",
1049               QED_IWARP_CONNECT_MODE_STRING(ep), ep->cid);
1050         params.status = -ECONNREFUSED;
1051         break;
1052     case IWARP_CONN_ERROR_MPA_INSUF_IRD:
1053         DP_NOTICE(p_hwfn, "%s(0x%x) MPA insufficient ird\n",
1054               QED_IWARP_CONNECT_MODE_STRING(ep), ep->cid);
1055         params.status = -ECONNREFUSED;
1056         break;
1057     case IWARP_CONN_ERROR_MPA_RTR_MISMATCH:
1058         DP_NOTICE(p_hwfn, "%s(0x%x) MPA RTR MISMATCH\n",
1059               QED_IWARP_CONNECT_MODE_STRING(ep), ep->cid);
1060         params.status = -ECONNREFUSED;
1061         break;
1062     case IWARP_CONN_ERROR_MPA_INVALID_PACKET:
1063         DP_NOTICE(p_hwfn, "%s(0x%x) MPA Invalid Packet\n",
1064               QED_IWARP_CONNECT_MODE_STRING(ep), ep->cid);
1065         params.status = -ECONNREFUSED;
1066         break;
1067     case IWARP_CONN_ERROR_MPA_LOCAL_ERROR:
1068         DP_NOTICE(p_hwfn, "%s(0x%x) MPA Local Error\n",
1069               QED_IWARP_CONNECT_MODE_STRING(ep), ep->cid);
1070         params.status = -ECONNREFUSED;
1071         break;
1072     case IWARP_CONN_ERROR_MPA_TERMINATE:
1073         DP_NOTICE(p_hwfn, "%s(0x%x) MPA TERMINATE\n",
1074               QED_IWARP_CONNECT_MODE_STRING(ep), ep->cid);
1075         params.status = -ECONNREFUSED;
1076         break;
1077     default:
1078         params.status = -ECONNRESET;
1079         break;
1080     }
1081
1082     if (fw_return_code != RDMA_RETURN_OK)
1083         /* paired with READ_ONCE in destroy_qp */
1084         smp_store_release(&ep->state, QED_IWARP_EP_CLOSED);
1085
1086     ep->event_cb(ep->cb_context, &params);
1087
1088     /* on passive side, if there is no associated QP (REJECT) we need to
1089      * return the ep to the pool, (in the regular case we add an element
1090      * in accept instead of this one.
1091      * In both cases we need to remove it from the ep_list.
1092      */
1093     if (fw_return_code != RDMA_RETURN_OK) {
1094         ep->tcp_cid = QED_IWARP_INVALID_TCP_CID;
1095         if ((ep->connect_mode == TCP_CONNECT_PASSIVE) &&
1096             (!ep->qp)) {    /* Rejected */
1097             qed_iwarp_return_ep(p_hwfn, ep);
1098         } else {
1099             spin_lock_bh(&p_hwfn->p_rdma_info->iwarp.iw_lock);
1100             list_del(&ep->list_entry);
1101             spin_unlock_bh(&p_hwfn->p_rdma_info->iwarp.iw_lock);
1102         }
1103     }
1104 }
1105
1106 static void
1107 qed_iwarp_mpa_v2_set_private(struct qed_hwfn *p_hwfn,
1108                  struct qed_iwarp_ep *ep, u8 *mpa_data_size)
1109 {
1110     struct mpa_v2_hdr *mpa_v2_params;
1111     u16 mpa_ird, mpa_ord;
1112
1113     *mpa_data_size = 0;
1114     if (MPA_REV2(ep->mpa_rev)) {
1115         mpa_v2_params =
1116             (struct mpa_v2_hdr *)ep->ep_buffer_virt->out_pdata;
1117         *mpa_data_size = sizeof(*mpa_v2_params);
1118
1119         mpa_ird = (u16)ep->cm_info.ird;
1120         mpa_ord = (u16)ep->cm_info.ord;
1121
1122         if (ep->rtr_type != MPA_RTR_TYPE_NONE) {
1123             mpa_ird |= MPA_V2_PEER2PEER_MODEL;
1124
1125             if (ep->rtr_type & MPA_RTR_TYPE_ZERO_SEND)
1126                 mpa_ird |= MPA_V2_SEND_RTR;
1127
1128             if (ep->rtr_type & MPA_RTR_TYPE_ZERO_WRITE)
1129                 mpa_ord |= MPA_V2_WRITE_RTR;
1130
1131             if (ep->rtr_type & MPA_RTR_TYPE_ZERO_READ)
1132                 mpa_ord |= MPA_V2_READ_RTR;
1133         }
1134
1135         mpa_v2_params->ird = htons(mpa_ird);
1136         mpa_v2_params->ord = htons(mpa_ord);
1137
1138         DP_VERBOSE(p_hwfn,
1139                QED_MSG_RDMA,
1140                "MPA_NEGOTIATE Header: [%x ord:%x ird] %x ord:%x ird:%x peer2peer:%x rtr_send:%x rtr_write:%x rtr_read:%x\n",
1141                mpa_v2_params->ird,
1142                mpa_v2_params->ord,
1143                *((u32 *)mpa_v2_params),
1144                mpa_ord & MPA_V2_IRD_ORD_MASK,
1145                mpa_ird & MPA_V2_IRD_ORD_MASK,
1146                !!(mpa_ird & MPA_V2_PEER2PEER_MODEL),
1147                !!(mpa_ird & MPA_V2_SEND_RTR),
1148                !!(mpa_ord & MPA_V2_WRITE_RTR),
1149                !!(mpa_ord & MPA_V2_READ_RTR));
1150     }
1151 }
1152
1153 int qed_iwarp_connect(void *rdma_cxt,
1154               struct qed_iwarp_connect_in *iparams,
1155               struct qed_iwarp_connect_out *oparams)
1156 {
1157     struct qed_hwfn *p_hwfn = rdma_cxt;
1158     struct qed_iwarp_info *iwarp_info;
1159     struct qed_iwarp_ep *ep;
1160     u8 mpa_data_size = 0;
1161     u32 cid;
1162     int rc;
1163
1164     if ((iparams->cm_info.ord > QED_IWARP_ORD_DEFAULT) ||
1165         (iparams->cm_info.ird > QED_IWARP_IRD_DEFAULT)) {
1166         DP_NOTICE(p_hwfn,
1167               "QP(0x%x) ERROR: Invalid ord(0x%x)/ird(0x%x)\n",
1168               iparams->qp->icid, iparams->cm_info.ord,
1169               iparams->cm_info.ird);
1170
1171         return -EINVAL;
1172     }
1173
1174     iwarp_info = &p_hwfn->p_rdma_info->iwarp;
1175
1176     /* Allocate ep object */
1177     rc = qed_iwarp_alloc_cid(p_hwfn, &cid);
1178     if (rc)
1179         return rc;
1180
1181     rc = qed_iwarp_create_ep(p_hwfn, &ep);
1182     if (rc)
1183         goto err;
1184
1185     ep->tcp_cid = cid;
1186
1187     spin_lock_bh(&p_hwfn->p_rdma_info->iwarp.iw_lock);
1188     list_add_tail(&ep->list_entry, &p_hwfn->p_rdma_info->iwarp.ep_list);
1189     spin_unlock_bh(&p_hwfn->p_rdma_info->iwarp.iw_lock);
1190
1191     ep->qp = iparams->qp;
1192     ep->qp->ep = ep;
1193     ether_addr_copy(ep->remote_mac_addr, iparams->remote_mac_addr);
1194     ether_addr_copy(ep->local_mac_addr, iparams->local_mac_addr);
1195     memcpy(&ep->cm_info, &iparams->cm_info, sizeof(ep->cm_info));
1196
1197     ep->cm_info.ord = iparams->cm_info.ord;
1198     ep->cm_info.ird = iparams->cm_info.ird;
1199
1200     ep->rtr_type = iwarp_info->rtr_type;
1201     if (!iwarp_info->peer2peer)
1202         ep->rtr_type = MPA_RTR_TYPE_NONE;
1203
1204     if ((ep->rtr_type & MPA_RTR_TYPE_ZERO_READ) && (ep->cm_info.ord == 0))
1205         ep->cm_info.ord = 1;
1206
1207     ep->mpa_rev = iwarp_info->mpa_rev;
1208
1209     qed_iwarp_mpa_v2_set_private(p_hwfn, ep, &mpa_data_size);
1210
1211     ep->cm_info.private_data = ep->ep_buffer_virt->out_pdata;
1212     ep->cm_info.private_data_len = iparams->cm_info.private_data_len +
1213                        mpa_data_size;
1214
1215     memcpy((u8 *)ep->ep_buffer_virt->out_pdata + mpa_data_size,
1216            iparams->cm_info.private_data,
1217            iparams->cm_info.private_data_len);
1218
1219     ep->mss = iparams->mss;
1220     ep->mss = min_t(u16, QED_IWARP_MAX_FW_MSS, ep->mss);
1221
1222     ep->event_cb = iparams->event_cb;
1223     ep->cb_context = iparams->cb_context;
1224     ep->connect_mode = TCP_CONNECT_ACTIVE;
1225
1226     oparams->ep_context = ep;
1227
1228     rc = qed_iwarp_tcp_offload(p_hwfn, ep);
1229
1230     DP_VERBOSE(p_hwfn, QED_MSG_RDMA, "QP(0x%x) EP(0x%x) rc = %d\n",
1231            iparams->qp->icid, ep->tcp_cid, rc);
1232
1233     if (rc) {
1234         qed_iwarp_destroy_ep(p_hwfn, ep, true);
1235         goto err;
1236     }
1237
1238     return rc;
1239 err:
1240     qed_iwarp_cid_cleaned(p_hwfn, cid);
1241
1242     return rc;
1243 }
1244
1245 static struct qed_iwarp_ep *qed_iwarp_get_free_ep(struct qed_hwfn *p_hwfn)
1246 {
1247     struct qed_iwarp_ep *ep = NULL;
1248     int rc;
1249
1250     spin_lock_bh(&p_hwfn->p_rdma_info->iwarp.iw_lock);
1251
1252     if (list_empty(&p_hwfn->p_rdma_info->iwarp.ep_free_list)) {
1253         DP_ERR(p_hwfn, "Ep list is empty\n");
1254         goto out;
1255     }
1256
1257     ep = list_first_entry(&p_hwfn->p_rdma_info->iwarp.ep_free_list,
1258                   struct qed_iwarp_ep, list_entry);
1259
1260     /* in some cases we could have failed allocating a tcp cid when added
1261      * from accept / failure... retry now..this is not the common case.
1262      */
1263     if (ep->tcp_cid == QED_IWARP_INVALID_TCP_CID) {
1264         rc = qed_iwarp_alloc_tcp_cid(p_hwfn, &ep->tcp_cid);
1265
1266         /* if we fail we could look for another entry with a valid
1267          * tcp_cid, but since we don't expect to reach this anyway
1268          * it's not worth the handling
1269          */
1270         if (rc) {
1271             ep->tcp_cid = QED_IWARP_INVALID_TCP_CID;
1272             ep = NULL;
1273             goto out;
1274         }
1275     }
1276
1277     list_del(&ep->list_entry);
1278
1279 out:
1280     spin_unlock_bh(&p_hwfn->p_rdma_info->iwarp.iw_lock);
1281     return ep;
1282 }
1283
1284 #define QED_IWARP_MAX_CID_CLEAN_TIME  100
1285 #define QED_IWARP_MAX_NO_PROGRESS_CNT 5
1286
1287 /* This function waits for all the bits of a bmap to be cleared, as long as
1288  * there is progress ( i.e. the number of bits left to be cleared decreases )
1289  * the function continues.
1290  */
1291 static int
1292 qed_iwarp_wait_cid_map_cleared(struct qed_hwfn *p_hwfn, struct qed_bmap *bmap)
1293 {
1294     int prev_weight = 0;
1295     int wait_count = 0;
1296     int weight = 0;
1297
1298     weight = bitmap_weight(bmap->bitmap, bmap->max_count);
1299     prev_weight = weight;
1300
1301     while (weight) {
1302         /* If the HW device is during recovery, all resources are
1303          * immediately reset without receiving a per-cid indication
1304          * from HW. In this case we don't expect the cid_map to be
1305          * cleared.
1306          */
1307         if (p_hwfn->cdev->recov_in_prog)
1308             return 0;
1309
1310         msleep(QED_IWARP_MAX_CID_CLEAN_TIME);
1311
1312         weight = bitmap_weight(bmap->bitmap, bmap->max_count);
1313
1314         if (prev_weight == weight) {
1315             wait_count++;
1316         } else {
1317             prev_weight = weight;
1318             wait_count = 0;
1319         }
1320
1321         if (wait_count > QED_IWARP_MAX_NO_PROGRESS_CNT) {
1322             DP_NOTICE(p_hwfn,
1323                   "%s bitmap wait timed out (%d cids pending)\n",
1324                   bmap->name, weight);
1325             return -EBUSY;
1326         }
1327     }
1328     return 0;
1329 }
1330
1331 static int qed_iwarp_wait_for_all_cids(struct qed_hwfn *p_hwfn)
1332 {
1333     int rc;
1334     int i;
1335
1336     rc = qed_iwarp_wait_cid_map_cleared(p_hwfn,
1337                         &p_hwfn->p_rdma_info->tcp_cid_map);
1338     if (rc)
1339         return rc;
1340
1341     /* Now free the tcp cids from the main cid map */
1342     for (i = 0; i < QED_IWARP_PREALLOC_CNT; i++)
1343         qed_bmap_release_id(p_hwfn, &p_hwfn->p_rdma_info->cid_map, i);
1344
1345     /* Now wait for all cids to be completed */
1346     return qed_iwarp_wait_cid_map_cleared(p_hwfn,
1347                           &p_hwfn->p_rdma_info->cid_map);
1348 }
1349
1350 static void qed_iwarp_free_prealloc_ep(struct qed_hwfn *p_hwfn)
1351 {
1352     struct qed_iwarp_ep *ep;
1353
1354     while (!list_empty(&p_hwfn->p_rdma_info->iwarp.ep_free_list)) {
1355         spin_lock_bh(&p_hwfn->p_rdma_info->iwarp.iw_lock);
1356
1357         ep = list_first_entry(&p_hwfn->p_rdma_info->iwarp.ep_free_list,
1358                       struct qed_iwarp_ep, list_entry);
1359
1360         if (!ep) {
1361             spin_unlock_bh(&p_hwfn->p_rdma_info->iwarp.iw_lock);
1362             break;
1363         }
1364         list_del(&ep->list_entry);
1365
1366         spin_unlock_bh(&p_hwfn->p_rdma_info->iwarp.iw_lock);
1367
1368         if (ep->tcp_cid != QED_IWARP_INVALID_TCP_CID)
1369             qed_iwarp_cid_cleaned(p_hwfn, ep->tcp_cid);
1370
1371         qed_iwarp_destroy_ep(p_hwfn, ep, false);
1372     }
1373 }
1374
1375 static int qed_iwarp_prealloc_ep(struct qed_hwfn *p_hwfn, bool init)
1376 {
1377     struct qed_iwarp_ep *ep;
1378     int rc = 0;
1379     int count;
1380     u32 cid;
1381     int i;
1382
1383     count = init ? QED_IWARP_PREALLOC_CNT : 1;
1384     for (i = 0; i < count; i++) {
1385         rc = qed_iwarp_create_ep(p_hwfn, &ep);
1386         if (rc)
1387             return rc;
1388
1389         /* During initialization we allocate from the main pool,
1390          * afterwards we allocate only from the tcp_cid.
1391          */
1392         if (init) {
1393             rc = qed_iwarp_alloc_cid(p_hwfn, &cid);
1394             if (rc)
1395                 goto err;
1396             qed_iwarp_set_tcp_cid(p_hwfn, cid);
1397         } else {
1398             /* We don't care about the return code, it's ok if
1399              * tcp_cid remains invalid...in this case we'll
1400              * defer allocation
1401              */
1402             qed_iwarp_alloc_tcp_cid(p_hwfn, &cid);
1403         }
1404
1405         ep->tcp_cid = cid;
1406
1407         spin_lock_bh(&p_hwfn->p_rdma_info->iwarp.iw_lock);
1408         list_add_tail(&ep->list_entry,
1409                   &p_hwfn->p_rdma_info->iwarp.ep_free_list);
1410         spin_unlock_bh(&p_hwfn->p_rdma_info->iwarp.iw_lock);
1411     }
1412
1413     return rc;
1414
1415 err:
1416     qed_iwarp_destroy_ep(p_hwfn, ep, false);
1417
1418     return rc;
1419 }
1420
1421 int qed_iwarp_alloc(struct qed_hwfn *p_hwfn)
1422 {
1423     int rc;
1424
1425     /* Allocate bitmap for tcp cid. These are used by passive side
1426      * to ensure it can allocate a tcp cid during dpc that was
1427      * pre-acquired and doesn't require dynamic allocation of ilt
1428      */
1429     rc = qed_rdma_bmap_alloc(p_hwfn, &p_hwfn->p_rdma_info->tcp_cid_map,
1430                  QED_IWARP_PREALLOC_CNT, "TCP_CID");
1431     if (rc) {
1432         DP_VERBOSE(p_hwfn, QED_MSG_RDMA,
1433                "Failed to allocate tcp cid, rc = %d\n", rc);
1434         return rc;
1435     }
1436
1437     INIT_LIST_HEAD(&p_hwfn->p_rdma_info->iwarp.ep_free_list);
1438     spin_lock_init(&p_hwfn->p_rdma_info->iwarp.iw_lock);
1439
1440     rc = qed_iwarp_prealloc_ep(p_hwfn, true);
1441     if (rc)
1442         return rc;
1443
1444     return qed_ooo_alloc(p_hwfn);
1445 }
1446
1447 void qed_iwarp_resc_free(struct qed_hwfn *p_hwfn)
1448 {
1449     struct qed_iwarp_info *iwarp_info = &p_hwfn->p_rdma_info->iwarp;
1450
1451     qed_ooo_free(p_hwfn);
1452     qed_rdma_bmap_free(p_hwfn, &p_hwfn->p_rdma_info->tcp_cid_map, 1);
1453     kfree(iwarp_info->mpa_bufs);
1454     kfree(iwarp_info->partial_fpdus);
1455     kfree(iwarp_info->mpa_intermediate_buf);
1456 }
1457
1458 int qed_iwarp_accept(void *rdma_cxt, struct qed_iwarp_accept_in *iparams)
1459 {
1460     struct qed_hwfn *p_hwfn = rdma_cxt;
1461     struct qed_iwarp_ep *ep;
1462     u8 mpa_data_size = 0;
1463     int rc;
1464
1465     ep = iparams->ep_context;
1466     if (!ep) {
1467         DP_ERR(p_hwfn, "Ep Context receive in accept is NULL\n");
1468         return -EINVAL;
1469     }
1470
1471     DP_VERBOSE(p_hwfn, QED_MSG_RDMA, "QP(0x%x) EP(0x%x)\n",
1472            iparams->qp->icid, ep->tcp_cid);
1473
1474     if ((iparams->ord > QED_IWARP_ORD_DEFAULT) ||
1475         (iparams->ird > QED_IWARP_IRD_DEFAULT)) {
1476         DP_VERBOSE(p_hwfn,
1477                QED_MSG_RDMA,
1478                "QP(0x%x) EP(0x%x) ERROR: Invalid ord(0x%x)/ird(0x%x)\n",
1479                iparams->qp->icid,
1480                ep->tcp_cid, iparams->ord, iparams->ord);
1481         return -EINVAL;
1482     }
1483
1484     qed_iwarp_prealloc_ep(p_hwfn, false);
1485
1486     ep->cb_context = iparams->cb_context;
1487     ep->qp = iparams->qp;
1488     ep->qp->ep = ep;
1489
1490     if (ep->mpa_rev == MPA_NEGOTIATION_TYPE_ENHANCED) {
1491         /* Negotiate ord/ird: if upperlayer requested ord larger than
1492          * ird advertised by remote, we need to decrease our ord
1493          */
1494         if (iparams->ord > ep->cm_info.ird)
1495             iparams->ord = ep->cm_info.ird;
1496
1497         if ((ep->rtr_type & MPA_RTR_TYPE_ZERO_READ) &&
1498             (iparams->ird == 0))
1499             iparams->ird = 1;
1500     }
1501
1502     /* Update cm_info ord/ird to be negotiated values */
1503     ep->cm_info.ord = iparams->ord;
1504     ep->cm_info.ird = iparams->ird;
1505
1506     qed_iwarp_mpa_v2_set_private(p_hwfn, ep, &mpa_data_size);
1507
1508     ep->cm_info.private_data = ep->ep_buffer_virt->out_pdata;
1509     ep->cm_info.private_data_len = iparams->private_data_len +
1510                        mpa_data_size;
1511
1512     memcpy((u8 *)ep->ep_buffer_virt->out_pdata + mpa_data_size,
1513            iparams->private_data, iparams->private_data_len);
1514
1515     rc = qed_iwarp_mpa_offload(p_hwfn, ep);
1516     if (rc)
1517         qed_iwarp_modify_qp(p_hwfn,
1518                     iparams->qp, QED_IWARP_QP_STATE_ERROR, 1);
1519
1520     return rc;
1521 }
1522
1523 int qed_iwarp_reject(void *rdma_cxt, struct qed_iwarp_reject_in *iparams)
1524 {
1525     struct qed_hwfn *p_hwfn = rdma_cxt;
1526     struct qed_iwarp_ep *ep;
1527     u8 mpa_data_size = 0;
1528
1529     ep = iparams->ep_context;
1530     if (!ep) {
1531         DP_ERR(p_hwfn, "Ep Context receive in reject is NULL\n");
1532         return -EINVAL;
1533     }
1534
1535     DP_VERBOSE(p_hwfn, QED_MSG_RDMA, "EP(0x%x)\n", ep->tcp_cid);
1536
1537     ep->cb_context = iparams->cb_context;
1538     ep->qp = NULL;
1539
1540     qed_iwarp_mpa_v2_set_private(p_hwfn, ep, &mpa_data_size);
1541
1542     ep->cm_info.private_data = ep->ep_buffer_virt->out_pdata;
1543     ep->cm_info.private_data_len = iparams->private_data_len +
1544                        mpa_data_size;
1545
1546     memcpy((u8 *)ep->ep_buffer_virt->out_pdata + mpa_data_size,
1547            iparams->private_data, iparams->private_data_len);
1548
1549     return qed_iwarp_mpa_offload(p_hwfn, ep);
1550 }
1551
1552 static void
1553 qed_iwarp_print_cm_info(struct qed_hwfn *p_hwfn,
1554             struct qed_iwarp_cm_info *cm_info)
1555 {
1556     DP_VERBOSE(p_hwfn, QED_MSG_RDMA, "ip_version = %d\n",
1557            cm_info->ip_version);
1558
1559     if (cm_info->ip_version == QED_TCP_IPV4)
1560         DP_VERBOSE(p_hwfn, QED_MSG_RDMA,
1561                "remote_ip %pI4h:%x, local_ip %pI4h:%x vlan=%x\n",
1562                cm_info->remote_ip, cm_info->remote_port,
1563                cm_info->local_ip, cm_info->local_port,
1564                cm_info->vlan);
1565     else
1566         DP_VERBOSE(p_hwfn, QED_MSG_RDMA,
1567                "remote_ip %pI6:%x, local_ip %pI6:%x vlan=%x\n",
1568                cm_info->remote_ip, cm_info->remote_port,
1569                cm_info->local_ip, cm_info->local_port,
1570                cm_info->vlan);
1571
1572     DP_VERBOSE(p_hwfn, QED_MSG_RDMA,
1573            "private_data_len = %x ord = %d, ird = %d\n",
1574            cm_info->private_data_len, cm_info->ord, cm_info->ird);
1575 }
1576
1577 static int
1578 qed_iwarp_ll2_post_rx(struct qed_hwfn *p_hwfn,
1579               struct qed_iwarp_ll2_buff *buf, u8 handle)
1580 {
1581     int rc;
1582
1583     rc = qed_ll2_post_rx_buffer(p_hwfn, handle, buf->data_phys_addr,
1584                     (u16)buf->buff_size, buf, 1);
1585     if (rc) {
1586         DP_NOTICE(p_hwfn,
1587               "Failed to repost rx buffer to ll2 rc = %d, handle=%d\n",
1588               rc, handle);
1589         dma_free_coherent(&p_hwfn->cdev->pdev->dev, buf->buff_size,
1590                   buf->data, buf->data_phys_addr);
1591         kfree(buf);
1592     }
1593
1594     return rc;
1595 }
1596
1597 static bool
1598 qed_iwarp_ep_exists(struct qed_hwfn *p_hwfn, struct qed_iwarp_cm_info *cm_info)
1599 {
1600     struct qed_iwarp_ep *ep = NULL;
1601     bool found = false;
1602
1603     list_for_each_entry(ep,
1604                 &p_hwfn->p_rdma_info->iwarp.ep_list,
1605                 list_entry) {
1606         if ((ep->cm_info.local_port == cm_info->local_port) &&
1607             (ep->cm_info.remote_port == cm_info->remote_port) &&
1608             (ep->cm_info.vlan == cm_info->vlan) &&
1609             !memcmp(&ep->cm_info.local_ip, cm_info->local_ip,
1610                 sizeof(cm_info->local_ip)) &&
1611             !memcmp(&ep->cm_info.remote_ip, cm_info->remote_ip,
1612                 sizeof(cm_info->remote_ip))) {
1613             found = true;
1614             break;
1615         }
1616     }
1617
1618     if (found) {
1619         DP_NOTICE(p_hwfn,
1620               "SYN received on active connection - dropping\n");
1621         qed_iwarp_print_cm_info(p_hwfn, cm_info);
1622
1623         return true;
1624     }
1625
1626     return false;
1627 }
1628
1629 static struct qed_iwarp_listener *
1630 qed_iwarp_get_listener(struct qed_hwfn *p_hwfn,
1631                struct qed_iwarp_cm_info *cm_info)
1632 {
1633     struct qed_iwarp_listener *listener = NULL;
1634     static const u32 ip_zero[4] = { 0, 0, 0, 0 };
1635     bool found = false;
1636
1637     list_for_each_entry(listener,
1638                 &p_hwfn->p_rdma_info->iwarp.listen_list,
1639                 list_entry) {
1640         if (listener->port == cm_info->local_port) {
1641             if (!memcmp(listener->ip_addr,
1642                     ip_zero, sizeof(ip_zero))) {
1643                 found = true;
1644                 break;
1645             }
1646
1647             if (!memcmp(listener->ip_addr,
1648                     cm_info->local_ip,
1649                     sizeof(cm_info->local_ip)) &&
1650                 (listener->vlan == cm_info->vlan)) {
1651                 found = true;
1652                 break;
1653             }
1654         }
1655     }
1656
1657     if (found) {
1658         DP_VERBOSE(p_hwfn, QED_MSG_RDMA, "listener found = %p\n",
1659                listener);
1660         return listener;
1661     }
1662
1663     DP_VERBOSE(p_hwfn, QED_MSG_RDMA, "listener not found\n");
1664     return NULL;
1665 }
1666
1667 static int
1668 qed_iwarp_parse_rx_pkt(struct qed_hwfn *p_hwfn,
1669                struct qed_iwarp_cm_info *cm_info,
1670                void *buf,
1671                u8 *remote_mac_addr,
1672                u8 *local_mac_addr,
1673                int *payload_len, int *tcp_start_offset)
1674 {
1675     struct vlan_ethhdr *vethh;
1676     bool vlan_valid = false;
1677     struct ipv6hdr *ip6h;
1678     struct ethhdr *ethh;
1679     struct tcphdr *tcph;
1680     struct iphdr *iph;
1681     int eth_hlen;
1682     int ip_hlen;
1683     int eth_type;
1684     int i;
1685
1686     ethh = buf;
1687     eth_type = ntohs(ethh->h_proto);
1688     if (eth_type == ETH_P_8021Q) {
1689         vlan_valid = true;
1690         vethh = (struct vlan_ethhdr *)ethh;
1691         cm_info->vlan = ntohs(vethh->h_vlan_TCI) & VLAN_VID_MASK;
1692         eth_type = ntohs(vethh->h_vlan_encapsulated_proto);
1693     }
1694
1695     eth_hlen = ETH_HLEN + (vlan_valid ? sizeof(u32) : 0);
1696
1697     if (!ether_addr_equal(ethh->h_dest,
1698                   p_hwfn->p_rdma_info->iwarp.mac_addr)) {
1699         DP_VERBOSE(p_hwfn,
1700                QED_MSG_RDMA,
1701                "Got unexpected mac %pM instead of %pM\n",
1702                ethh->h_dest, p_hwfn->p_rdma_info->iwarp.mac_addr);
1703         return -EINVAL;
1704     }
1705
1706     ether_addr_copy(remote_mac_addr, ethh->h_source);
1707     ether_addr_copy(local_mac_addr, ethh->h_dest);
1708
1709     DP_VERBOSE(p_hwfn, QED_MSG_RDMA, "eth_type =%d source mac: %pM\n",
1710            eth_type, ethh->h_source);
1711
1712     DP_VERBOSE(p_hwfn, QED_MSG_RDMA, "eth_hlen=%d destination mac: %pM\n",
1713            eth_hlen, ethh->h_dest);
1714
1715     iph = (struct iphdr *)((u8 *)(ethh) + eth_hlen);
1716
1717     if (eth_type == ETH_P_IP) {
1718         if (iph->protocol != IPPROTO_TCP) {
1719             DP_NOTICE(p_hwfn,
1720                   "Unexpected ip protocol on ll2 %x\n",
1721                   iph->protocol);
1722             return -EINVAL;
1723         }
1724
1725         cm_info->local_ip[0] = ntohl(iph->daddr);
1726         cm_info->remote_ip[0] = ntohl(iph->saddr);
1727         cm_info->ip_version = QED_TCP_IPV4;
1728
1729         ip_hlen = (iph->ihl) * sizeof(u32);
1730         *payload_len = ntohs(iph->tot_len) - ip_hlen;
1731     } else if (eth_type == ETH_P_IPV6) {
1732         ip6h = (struct ipv6hdr *)iph;
1733
1734         if (ip6h->nexthdr != IPPROTO_TCP) {
1735             DP_NOTICE(p_hwfn,
1736                   "Unexpected ip protocol on ll2 %x\n",
1737                   iph->protocol);
1738             return -EINVAL;
1739         }
1740
1741         for (i = 0; i < 4; i++) {
1742             cm_info->local_ip[i] =
1743                 ntohl(ip6h->daddr.in6_u.u6_addr32[i]);
1744             cm_info->remote_ip[i] =
1745                 ntohl(ip6h->saddr.in6_u.u6_addr32[i]);
1746         }
1747         cm_info->ip_version = QED_TCP_IPV6;
1748
1749         ip_hlen = sizeof(*ip6h);
1750         *payload_len = ntohs(ip6h->payload_len);
1751     } else {
1752         DP_NOTICE(p_hwfn, "Unexpected ethertype on ll2 %x\n", eth_type);
1753         return -EINVAL;
1754     }
1755
1756     tcph = (struct tcphdr *)((u8 *)iph + ip_hlen);
1757
1758     if (!tcph->syn) {
1759         DP_NOTICE(p_hwfn,
1760               "Only SYN type packet expected on this ll2 conn, iph->ihl=%d source=%d dest=%d\n",
1761               iph->ihl, tcph->source, tcph->dest);
1762         return -EINVAL;
1763     }
1764
1765     cm_info->local_port = ntohs(tcph->dest);
1766     cm_info->remote_port = ntohs(tcph->source);
1767
1768     qed_iwarp_print_cm_info(p_hwfn, cm_info);
1769
1770     *tcp_start_offset = eth_hlen + ip_hlen;
1771
1772     return 0;
1773 }
1774
1775 static struct qed_iwarp_fpdu *qed_iwarp_get_curr_fpdu(struct qed_hwfn *p_hwfn,
1776                               u16 cid)
1777 {
1778     struct qed_iwarp_info *iwarp_info = &p_hwfn->p_rdma_info->iwarp;
1779     struct qed_iwarp_fpdu *partial_fpdu;
1780     u32 idx;
1781
1782     idx = cid - qed_cxt_get_proto_cid_start(p_hwfn, PROTOCOLID_IWARP);
1783     if (idx >= iwarp_info->max_num_partial_fpdus) {
1784         DP_ERR(p_hwfn, "Invalid cid %x max_num_partial_fpdus=%x\n", cid,
1785                iwarp_info->max_num_partial_fpdus);
1786         return NULL;
1787     }
1788
1789     partial_fpdu = &iwarp_info->partial_fpdus[idx];
1790
1791     return partial_fpdu;
1792 }
1793
1794 enum qed_iwarp_mpa_pkt_type {
1795     QED_IWARP_MPA_PKT_PACKED,
1796     QED_IWARP_MPA_PKT_PARTIAL,
1797     QED_IWARP_MPA_PKT_UNALIGNED
1798 };
1799
1800 #define QED_IWARP_INVALID_FPDU_LENGTH 0xffff
1801 #define QED_IWARP_MPA_FPDU_LENGTH_SIZE (2)
1802 #define QED_IWARP_MPA_CRC32_DIGEST_SIZE (4)
1803
1804 /* Pad to multiple of 4 */
1805 #define QED_IWARP_PDU_DATA_LEN_WITH_PAD(data_len) ALIGN(data_len, 4)
1806 #define QED_IWARP_FPDU_LEN_WITH_PAD(_mpa_len)                  \
1807     (QED_IWARP_PDU_DATA_LEN_WITH_PAD((_mpa_len) +              \
1808                      QED_IWARP_MPA_FPDU_LENGTH_SIZE) + \
1809                      QED_IWARP_MPA_CRC32_DIGEST_SIZE)
1810
1811 /* fpdu can be fragmented over maximum 3 bds: header, partial mpa, unaligned */
1812 #define QED_IWARP_MAX_BDS_PER_FPDU 3
1813
1814 static const char * const pkt_type_str[] = {
1815     "QED_IWARP_MPA_PKT_PACKED",
1816     "QED_IWARP_MPA_PKT_PARTIAL",
1817     "QED_IWARP_MPA_PKT_UNALIGNED"
1818 };
1819
1820 static int
1821 qed_iwarp_recycle_pkt(struct qed_hwfn *p_hwfn,
1822               struct qed_iwarp_fpdu *fpdu,
1823               struct qed_iwarp_ll2_buff *buf);
1824
1825 static enum qed_iwarp_mpa_pkt_type
1826 qed_iwarp_mpa_classify(struct qed_hwfn *p_hwfn,
1827                struct qed_iwarp_fpdu *fpdu,
1828                u16 tcp_payload_len, u8 *mpa_data)
1829 {
1830     enum qed_iwarp_mpa_pkt_type pkt_type;
1831     u16 mpa_len;
1832
1833     if (fpdu->incomplete_bytes) {
1834         pkt_type = QED_IWARP_MPA_PKT_UNALIGNED;
1835         goto out;
1836     }
1837
1838     /* special case of one byte remaining...
1839      * lower byte will be read next packet
1840      */
1841     if (tcp_payload_len == 1) {
1842         fpdu->fpdu_length = *mpa_data << BITS_PER_BYTE;
1843         pkt_type = QED_IWARP_MPA_PKT_PARTIAL;
1844         goto out;
1845     }
1846
1847     mpa_len = ntohs(*(__force __be16 *)mpa_data);
1848     fpdu->fpdu_length = QED_IWARP_FPDU_LEN_WITH_PAD(mpa_len);
1849
1850     if (fpdu->fpdu_length <= tcp_payload_len)
1851         pkt_type = QED_IWARP_MPA_PKT_PACKED;
1852     else
1853         pkt_type = QED_IWARP_MPA_PKT_PARTIAL;
1854
1855 out:
1856     DP_VERBOSE(p_hwfn, QED_MSG_RDMA,
1857            "MPA_ALIGN: %s: fpdu_length=0x%x tcp_payload_len:0x%x\n",
1858            pkt_type_str[pkt_type], fpdu->fpdu_length, tcp_payload_len);
1859
1860     return pkt_type;
1861 }
1862
1863 static void
1864 qed_iwarp_init_fpdu(struct qed_iwarp_ll2_buff *buf,
1865             struct qed_iwarp_fpdu *fpdu,
1866             struct unaligned_opaque_data *pkt_data,
1867             u16 tcp_payload_size, u8 placement_offset)
1868 {
1869     u16 first_mpa_offset = le16_to_cpu(pkt_data->first_mpa_offset);
1870
1871     fpdu->mpa_buf = buf;
1872     fpdu->pkt_hdr = buf->data_phys_addr + placement_offset;
1873     fpdu->pkt_hdr_size = pkt_data->tcp_payload_offset;
1874     fpdu->mpa_frag = buf->data_phys_addr + first_mpa_offset;
1875     fpdu->mpa_frag_virt = (u8 *)(buf->data) + first_mpa_offset;
1876
1877     if (tcp_payload_size == 1)
1878         fpdu->incomplete_bytes = QED_IWARP_INVALID_FPDU_LENGTH;
1879     else if (tcp_payload_size < fpdu->fpdu_length)
1880         fpdu->incomplete_bytes = fpdu->fpdu_length - tcp_payload_size;
1881     else
1882         fpdu->incomplete_bytes = 0; /* complete fpdu */
1883
1884     fpdu->mpa_frag_len = fpdu->fpdu_length - fpdu->incomplete_bytes;
1885 }
1886
1887 static int
1888 qed_iwarp_cp_pkt(struct qed_hwfn *p_hwfn,
1889          struct qed_iwarp_fpdu *fpdu,
1890          struct unaligned_opaque_data *pkt_data,
1891          struct qed_iwarp_ll2_buff *buf, u16 tcp_payload_size)
1892 {
1893     u16 first_mpa_offset = le16_to_cpu(pkt_data->first_mpa_offset);
1894     u8 *tmp_buf = p_hwfn->p_rdma_info->iwarp.mpa_intermediate_buf;
1895     int rc;
1896
1897     /* need to copy the data from the partial packet stored in fpdu
1898      * to the new buf, for this we also need to move the data currently
1899      * placed on the buf. The assumption is that the buffer is big enough
1900      * since fpdu_length <= mss, we use an intermediate buffer since
1901      * we may need to copy the new data to an overlapping location
1902      */
1903     if ((fpdu->mpa_frag_len + tcp_payload_size) > (u16)buf->buff_size) {
1904         DP_ERR(p_hwfn,
1905                "MPA ALIGN: Unexpected: buffer is not large enough for split fpdu buff_size = %d mpa_frag_len = %d, tcp_payload_size = %d, incomplete_bytes = %d\n",
1906                buf->buff_size, fpdu->mpa_frag_len,
1907                tcp_payload_size, fpdu->incomplete_bytes);
1908         return -EINVAL;
1909     }
1910
1911     DP_VERBOSE(p_hwfn, QED_MSG_RDMA,
1912            "MPA ALIGN Copying fpdu: [%p, %d] [%p, %d]\n",
1913            fpdu->mpa_frag_virt, fpdu->mpa_frag_len,
1914            (u8 *)(buf->data) + first_mpa_offset, tcp_payload_size);
1915
1916     memcpy(tmp_buf, fpdu->mpa_frag_virt, fpdu->mpa_frag_len);
1917     memcpy(tmp_buf + fpdu->mpa_frag_len,
1918            (u8 *)(buf->data) + first_mpa_offset, tcp_payload_size);
1919
1920     rc = qed_iwarp_recycle_pkt(p_hwfn, fpdu, fpdu->mpa_buf);
1921     if (rc)
1922         return rc;
1923
1924     /* If we managed to post the buffer copy the data to the new buffer
1925      * o/w this will occur in the next round...
1926      */
1927     memcpy((u8 *)(buf->data), tmp_buf,
1928            fpdu->mpa_frag_len + tcp_payload_size);
1929
1930     fpdu->mpa_buf = buf;
1931     /* fpdu->pkt_hdr remains as is */
1932     /* fpdu->mpa_frag is overridden with new buf */
1933     fpdu->mpa_frag = buf->data_phys_addr;
1934     fpdu->mpa_frag_virt = buf->data;
1935     fpdu->mpa_frag_len += tcp_payload_size;
1936
1937     fpdu->incomplete_bytes -= tcp_payload_size;
1938
1939     DP_VERBOSE(p_hwfn,
1940            QED_MSG_RDMA,
1941            "MPA ALIGN: split fpdu buff_size = %d mpa_frag_len = %d, tcp_payload_size = %d, incomplete_bytes = %d\n",
1942            buf->buff_size, fpdu->mpa_frag_len, tcp_payload_size,
1943            fpdu->incomplete_bytes);
1944
1945     return 0;
1946 }
1947
1948 static void
1949 qed_iwarp_update_fpdu_length(struct qed_hwfn *p_hwfn,
1950                  struct qed_iwarp_fpdu *fpdu, u8 *mpa_data)
1951 {
1952     u16 mpa_len;
1953
1954     /* Update incomplete packets if needed */
1955     if (fpdu->incomplete_bytes == QED_IWARP_INVALID_FPDU_LENGTH) {
1956         /* Missing lower byte is now available */
1957         mpa_len = fpdu->fpdu_length | *mpa_data;
1958         fpdu->fpdu_length = QED_IWARP_FPDU_LEN_WITH_PAD(mpa_len);
1959         /* one byte of hdr */
1960         fpdu->mpa_frag_len = 1;
1961         fpdu->incomplete_bytes = fpdu->fpdu_length - 1;
1962         DP_VERBOSE(p_hwfn,
1963                QED_MSG_RDMA,
1964                "MPA_ALIGN: Partial header mpa_len=%x fpdu_length=%x incomplete_bytes=%x\n",
1965                mpa_len, fpdu->fpdu_length, fpdu->incomplete_bytes);
1966     }
1967 }
1968
1969 #define QED_IWARP_IS_RIGHT_EDGE(_curr_pkt) \
1970     (GET_FIELD((_curr_pkt)->flags,     \
1971            UNALIGNED_OPAQUE_DATA_PKT_REACHED_WIN_RIGHT_EDGE))
1972
1973 /* This function is used to recycle a buffer using the ll2 drop option. It
1974  * uses the mechanism to ensure that all buffers posted to tx before this one
1975  * were completed. The buffer sent here will be sent as a cookie in the tx
1976  * completion function and can then be reposted to rx chain when done. The flow
1977  * that requires this is the flow where a FPDU splits over more than 3 tcp
1978  * segments. In this case the driver needs to re-post a rx buffer instead of
1979  * the one received, but driver can't simply repost a buffer it copied from
1980  * as there is a case where the buffer was originally a packed FPDU, and is
1981  * partially posted to FW. Driver needs to ensure FW is done with it.
1982  */
1983 static int
1984 qed_iwarp_recycle_pkt(struct qed_hwfn *p_hwfn,
1985               struct qed_iwarp_fpdu *fpdu,
1986               struct qed_iwarp_ll2_buff *buf)
1987 {
1988     struct qed_ll2_tx_pkt_info tx_pkt;
1989     u8 ll2_handle;
1990     int rc;
1991
1992     memset(&tx_pkt, 0, sizeof(tx_pkt));
1993     tx_pkt.num_of_bds = 1;
1994     tx_pkt.tx_dest = QED_LL2_TX_DEST_DROP;
1995     tx_pkt.l4_hdr_offset_w = fpdu->pkt_hdr_size >> 2;
1996     tx_pkt.first_frag = fpdu->pkt_hdr;
1997     tx_pkt.first_frag_len = fpdu->pkt_hdr_size;
1998     buf->piggy_buf = NULL;
1999     tx_pkt.cookie = buf;
2000
2001     ll2_handle = p_hwfn->p_rdma_info->iwarp.ll2_mpa_handle;
2002
2003     rc = qed_ll2_prepare_tx_packet(p_hwfn, ll2_handle, &tx_pkt, true);
2004     if (rc)
2005         DP_VERBOSE(p_hwfn, QED_MSG_RDMA,
2006                "Can't drop packet rc=%d\n", rc);
2007
2008     DP_VERBOSE(p_hwfn,
2009            QED_MSG_RDMA,
2010            "MPA_ALIGN: send drop tx packet [%lx, 0x%x], buf=%p, rc=%d\n",
2011            (unsigned long int)tx_pkt.first_frag,
2012            tx_pkt.first_frag_len, buf, rc);
2013
2014     return rc;
2015 }
2016
2017 static int
2018 qed_iwarp_win_right_edge(struct qed_hwfn *p_hwfn, struct qed_iwarp_fpdu *fpdu)
2019 {
2020     struct qed_ll2_tx_pkt_info tx_pkt;
2021     u8 ll2_handle;
2022     int rc;
2023
2024     memset(&tx_pkt, 0, sizeof(tx_pkt));
2025     tx_pkt.num_of_bds = 1;
2026     tx_pkt.tx_dest = QED_LL2_TX_DEST_LB;
2027     tx_pkt.l4_hdr_offset_w = fpdu->pkt_hdr_size >> 2;
2028
2029     tx_pkt.first_frag = fpdu->pkt_hdr;
2030     tx_pkt.first_frag_len = fpdu->pkt_hdr_size;
2031     tx_pkt.enable_ip_cksum = true;
2032     tx_pkt.enable_l4_cksum = true;
2033     tx_pkt.calc_ip_len = true;
2034     /* vlan overload with enum iwarp_ll2_tx_queues */
2035     tx_pkt.vlan = IWARP_LL2_ALIGNED_RIGHT_TRIMMED_TX_QUEUE;
2036
2037     ll2_handle = p_hwfn->p_rdma_info->iwarp.ll2_mpa_handle;
2038
2039     rc = qed_ll2_prepare_tx_packet(p_hwfn, ll2_handle, &tx_pkt, true);
2040     if (rc)
2041         DP_VERBOSE(p_hwfn, QED_MSG_RDMA,
2042                "Can't send right edge rc=%d\n", rc);
2043     DP_VERBOSE(p_hwfn,
2044            QED_MSG_RDMA,
2045            "MPA_ALIGN: Sent right edge FPDU num_bds=%d [%lx, 0x%x], rc=%d\n",
2046            tx_pkt.num_of_bds,
2047            (unsigned long int)tx_pkt.first_frag,
2048            tx_pkt.first_frag_len, rc);
2049
2050     return rc;
2051 }
2052
2053 static int
2054 qed_iwarp_send_fpdu(struct qed_hwfn *p_hwfn,
2055             struct qed_iwarp_fpdu *fpdu,
2056             struct unaligned_opaque_data *curr_pkt,
2057             struct qed_iwarp_ll2_buff *buf,
2058             u16 tcp_payload_size, enum qed_iwarp_mpa_pkt_type pkt_type)
2059 {
2060     struct qed_ll2_tx_pkt_info tx_pkt;
2061     u16 first_mpa_offset;
2062     u8 ll2_handle;
2063     int rc;
2064
2065     memset(&tx_pkt, 0, sizeof(tx_pkt));
2066
2067     /* An unaligned packet means it's split over two tcp segments. So the
2068      * complete packet requires 3 bds, one for the header, one for the
2069      * part of the fpdu of the first tcp segment, and the last fragment
2070      * will point to the remainder of the fpdu. A packed pdu, requires only
2071      * two bds, one for the header and one for the data.
2072      */
2073     tx_pkt.num_of_bds = (pkt_type == QED_IWARP_MPA_PKT_UNALIGNED) ? 3 : 2;
2074     tx_pkt.tx_dest = QED_LL2_TX_DEST_LB;
2075     tx_pkt.l4_hdr_offset_w = fpdu->pkt_hdr_size >> 2; /* offset in words */
2076
2077     /* Send the mpa_buf only with the last fpdu (in case of packed) */
2078     if (pkt_type == QED_IWARP_MPA_PKT_UNALIGNED ||
2079         tcp_payload_size <= fpdu->fpdu_length)
2080         tx_pkt.cookie = fpdu->mpa_buf;
2081
2082     tx_pkt.first_frag = fpdu->pkt_hdr;
2083     tx_pkt.first_frag_len = fpdu->pkt_hdr_size;
2084     tx_pkt.enable_ip_cksum = true;
2085     tx_pkt.enable_l4_cksum = true;
2086     tx_pkt.calc_ip_len = true;
2087     /* vlan overload with enum iwarp_ll2_tx_queues */
2088     tx_pkt.vlan = IWARP_LL2_ALIGNED_TX_QUEUE;
2089
2090     /* special case of unaligned packet and not packed, need to send
2091      * both buffers as cookie to release.
2092      */
2093     if (tcp_payload_size == fpdu->incomplete_bytes)
2094         fpdu->mpa_buf->piggy_buf = buf;
2095
2096     ll2_handle = p_hwfn->p_rdma_info->iwarp.ll2_mpa_handle;
2097
2098     /* Set first fragment to header */
2099     rc = qed_ll2_prepare_tx_packet(p_hwfn, ll2_handle, &tx_pkt, true);
2100     if (rc)
2101         goto out;
2102
2103     /* Set second fragment to first part of packet */
2104     rc = qed_ll2_set_fragment_of_tx_packet(p_hwfn, ll2_handle,
2105                            fpdu->mpa_frag,
2106                            fpdu->mpa_frag_len);
2107     if (rc)
2108         goto out;
2109
2110     if (!fpdu->incomplete_bytes)
2111         goto out;
2112
2113     first_mpa_offset = le16_to_cpu(curr_pkt->first_mpa_offset);
2114
2115     /* Set third fragment to second part of the packet */
2116     rc = qed_ll2_set_fragment_of_tx_packet(p_hwfn,
2117                            ll2_handle,
2118                            buf->data_phys_addr +
2119                            first_mpa_offset,
2120                            fpdu->incomplete_bytes);
2121 out:
2122     DP_VERBOSE(p_hwfn,
2123            QED_MSG_RDMA,
2124            "MPA_ALIGN: Sent FPDU num_bds=%d first_frag_len=%x, mpa_frag_len=0x%x, incomplete_bytes:0x%x rc=%d\n",
2125            tx_pkt.num_of_bds,
2126            tx_pkt.first_frag_len,
2127            fpdu->mpa_frag_len,
2128            fpdu->incomplete_bytes, rc);
2129
2130     return rc;
2131 }
2132
2133 static void
2134 qed_iwarp_mpa_get_data(struct qed_hwfn *p_hwfn,
2135                struct unaligned_opaque_data *curr_pkt,
2136                u32 opaque_data0, u32 opaque_data1)
2137 {
2138     u64 opaque_data;
2139
2140     opaque_data = HILO_64(cpu_to_le32(opaque_data1),
2141                   cpu_to_le32(opaque_data0));
2142     *curr_pkt = *((struct unaligned_opaque_data *)&opaque_data);
2143
2144     le16_add_cpu(&curr_pkt->first_mpa_offset,
2145              curr_pkt->tcp_payload_offset);
2146 }
2147
2148 /* This function is called when an unaligned or incomplete MPA packet arrives
2149  * driver needs to align the packet, perhaps using previous data and send
2150  * it down to FW once it is aligned.
2151  */
2152 static int
2153 qed_iwarp_process_mpa_pkt(struct qed_hwfn *p_hwfn,
2154               struct qed_iwarp_ll2_mpa_buf *mpa_buf)
2155 {
2156     struct unaligned_opaque_data *curr_pkt = &mpa_buf->data;
2157     struct qed_iwarp_ll2_buff *buf = mpa_buf->ll2_buf;
2158     enum qed_iwarp_mpa_pkt_type pkt_type;
2159     struct qed_iwarp_fpdu *fpdu;
2160     u16 cid, first_mpa_offset;
2161     int rc = -EINVAL;
2162     u8 *mpa_data;
2163
2164     cid = le32_to_cpu(curr_pkt->cid);
2165
2166     fpdu = qed_iwarp_get_curr_fpdu(p_hwfn, (u16)cid);
2167     if (!fpdu) { /* something corrupt with cid, post rx back */
2168         DP_ERR(p_hwfn, "Invalid cid, drop and post back to rx cid=%x\n",
2169                cid);
2170         goto err;
2171     }
2172
2173     do {
2174         first_mpa_offset = le16_to_cpu(curr_pkt->first_mpa_offset);
2175         mpa_data = ((u8 *)(buf->data) + first_mpa_offset);
2176
2177         pkt_type = qed_iwarp_mpa_classify(p_hwfn, fpdu,
2178                           mpa_buf->tcp_payload_len,
2179                           mpa_data);
2180
2181         switch (pkt_type) {
2182         case QED_IWARP_MPA_PKT_PARTIAL:
2183             qed_iwarp_init_fpdu(buf, fpdu,
2184                         curr_pkt,
2185                         mpa_buf->tcp_payload_len,
2186                         mpa_buf->placement_offset);
2187
2188             if (!QED_IWARP_IS_RIGHT_EDGE(curr_pkt)) {
2189                 mpa_buf->tcp_payload_len = 0;
2190                 break;
2191             }
2192
2193             rc = qed_iwarp_win_right_edge(p_hwfn, fpdu);
2194
2195             if (rc) {
2196                 DP_VERBOSE(p_hwfn, QED_MSG_RDMA,
2197                        "Can't send FPDU:reset rc=%d\n", rc);
2198                 memset(fpdu, 0, sizeof(*fpdu));
2199                 break;
2200             }
2201
2202             mpa_buf->tcp_payload_len = 0;
2203             break;
2204         case QED_IWARP_MPA_PKT_PACKED:
2205             qed_iwarp_init_fpdu(buf, fpdu,
2206                         curr_pkt,
2207                         mpa_buf->tcp_payload_len,
2208                         mpa_buf->placement_offset);
2209
2210             rc = qed_iwarp_send_fpdu(p_hwfn, fpdu, curr_pkt, buf,
2211                          mpa_buf->tcp_payload_len,
2212                          pkt_type);
2213             if (rc) {
2214                 DP_VERBOSE(p_hwfn, QED_MSG_RDMA,
2215                        "Can't send FPDU:reset rc=%d\n", rc);
2216                 memset(fpdu, 0, sizeof(*fpdu));
2217                 break;
2218             }
2219
2220             mpa_buf->tcp_payload_len -= fpdu->fpdu_length;
2221             le16_add_cpu(&curr_pkt->first_mpa_offset,
2222                      fpdu->fpdu_length);
2223             break;
2224         case QED_IWARP_MPA_PKT_UNALIGNED:
2225             qed_iwarp_update_fpdu_length(p_hwfn, fpdu, mpa_data);
2226             if (mpa_buf->tcp_payload_len < fpdu->incomplete_bytes) {
2227                 /* special handling of fpdu split over more
2228                  * than 2 segments
2229                  */
2230                 if (QED_IWARP_IS_RIGHT_EDGE(curr_pkt)) {
2231                     rc = qed_iwarp_win_right_edge(p_hwfn,
2232                                       fpdu);
2233                     /* packet will be re-processed later */
2234                     if (rc)
2235                         return rc;
2236                 }
2237
2238                 rc = qed_iwarp_cp_pkt(p_hwfn, fpdu, curr_pkt,
2239                               buf,
2240                               mpa_buf->tcp_payload_len);
2241                 if (rc) /* packet will be re-processed later */
2242                     return rc;
2243
2244                 mpa_buf->tcp_payload_len = 0;
2245                 break;
2246             }
2247
2248             rc = qed_iwarp_send_fpdu(p_hwfn, fpdu, curr_pkt, buf,
2249                          mpa_buf->tcp_payload_len,
2250                          pkt_type);
2251             if (rc) {
2252                 DP_VERBOSE(p_hwfn, QED_MSG_RDMA,
2253                        "Can't send FPDU:delay rc=%d\n", rc);
2254                 /* don't reset fpdu -> we need it for next
2255                  * classify
2256                  */
2257                 break;
2258             }
2259
2260             mpa_buf->tcp_payload_len -= fpdu->incomplete_bytes;
2261             le16_add_cpu(&curr_pkt->first_mpa_offset,
2262                      fpdu->incomplete_bytes);
2263
2264             /* The framed PDU was sent - no more incomplete bytes */
2265             fpdu->incomplete_bytes = 0;
2266             break;
2267         }
2268     } while (mpa_buf->tcp_payload_len && !rc);
2269
2270     return rc;
2271
2272 err:
2273     qed_iwarp_ll2_post_rx(p_hwfn,
2274                   buf,
2275                   p_hwfn->p_rdma_info->iwarp.ll2_mpa_handle);
2276     return rc;
2277 }
2278
2279 static void qed_iwarp_process_pending_pkts(struct qed_hwfn *p_hwfn)
2280 {
2281     struct qed_iwarp_info *iwarp_info = &p_hwfn->p_rdma_info->iwarp;
2282     struct qed_iwarp_ll2_mpa_buf *mpa_buf = NULL;
2283     int rc;
2284
2285     while (!list_empty(&iwarp_info->mpa_buf_pending_list)) {
2286         mpa_buf = list_first_entry(&iwarp_info->mpa_buf_pending_list,
2287                        struct qed_iwarp_ll2_mpa_buf,
2288                        list_entry);
2289
2290         rc = qed_iwarp_process_mpa_pkt(p_hwfn, mpa_buf);
2291
2292         /* busy means break and continue processing later, don't
2293          * remove the buf from the pending list.
2294          */
2295         if (rc == -EBUSY)
2296             break;
2297
2298         list_move_tail(&mpa_buf->list_entry,
2299                    &iwarp_info->mpa_buf_list);
2300
2301         if (rc) {   /* different error, don't continue */
2302             DP_NOTICE(p_hwfn, "process pkts failed rc=%d\n", rc);
2303             break;
2304         }
2305     }
2306 }
2307
2308 static void
2309 qed_iwarp_ll2_comp_mpa_pkt(void *cxt, struct qed_ll2_comp_rx_data *data)
2310 {
2311     struct qed_iwarp_ll2_mpa_buf *mpa_buf;
2312     struct qed_iwarp_info *iwarp_info;
2313     struct qed_hwfn *p_hwfn = cxt;
2314     u16 first_mpa_offset;
2315
2316     iwarp_info = &p_hwfn->p_rdma_info->iwarp;
2317     mpa_buf = list_first_entry(&iwarp_info->mpa_buf_list,
2318                    struct qed_iwarp_ll2_mpa_buf, list_entry);
2319     if (!mpa_buf) {
2320         DP_ERR(p_hwfn, "No free mpa buf\n");
2321         goto err;
2322     }
2323
2324     list_del(&mpa_buf->list_entry);
2325     qed_iwarp_mpa_get_data(p_hwfn, &mpa_buf->data,
2326                    data->opaque_data_0, data->opaque_data_1);
2327
2328     first_mpa_offset = le16_to_cpu(mpa_buf->data.first_mpa_offset);
2329
2330     DP_VERBOSE(p_hwfn,
2331            QED_MSG_RDMA,
2332            "LL2 MPA CompRx payload_len:0x%x\tfirst_mpa_offset:0x%x\ttcp_payload_offset:0x%x\tflags:0x%x\tcid:0x%x\n",
2333            data->length.packet_length, first_mpa_offset,
2334            mpa_buf->data.tcp_payload_offset, mpa_buf->data.flags,
2335            mpa_buf->data.cid);
2336
2337     mpa_buf->ll2_buf = data->cookie;
2338     mpa_buf->tcp_payload_len = data->length.packet_length -
2339                    first_mpa_offset;
2340
2341     first_mpa_offset += data->u.placement_offset;
2342     mpa_buf->data.first_mpa_offset = cpu_to_le16(first_mpa_offset);
2343     mpa_buf->placement_offset = data->u.placement_offset;
2344
2345     list_add_tail(&mpa_buf->list_entry, &iwarp_info->mpa_buf_pending_list);
2346
2347     qed_iwarp_process_pending_pkts(p_hwfn);
2348     return;
2349 err:
2350     qed_iwarp_ll2_post_rx(p_hwfn, data->cookie,
2351                   iwarp_info->ll2_mpa_handle);
2352 }
2353
2354 static void
2355 qed_iwarp_ll2_comp_syn_pkt(void *cxt, struct qed_ll2_comp_rx_data *data)
2356 {
2357     struct qed_iwarp_ll2_buff *buf = data->cookie;
2358     struct qed_iwarp_listener *listener;
2359     struct qed_ll2_tx_pkt_info tx_pkt;
2360     struct qed_iwarp_cm_info cm_info;
2361     struct qed_hwfn *p_hwfn = cxt;
2362     u8 remote_mac_addr[ETH_ALEN];
2363     u8 local_mac_addr[ETH_ALEN];
2364     struct qed_iwarp_ep *ep;
2365     int tcp_start_offset;
2366     u8 ll2_syn_handle;
2367     int payload_len;
2368     u32 hdr_size;
2369     int rc;
2370
2371     memset(&cm_info, 0, sizeof(cm_info));
2372     ll2_syn_handle = p_hwfn->p_rdma_info->iwarp.ll2_syn_handle;
2373
2374     /* Check if packet was received with errors... */
2375     if (data->err_flags) {
2376         DP_NOTICE(p_hwfn, "Error received on SYN packet: 0x%x\n",
2377               data->err_flags);
2378         goto err;
2379     }
2380
2381     if (GET_FIELD(data->parse_flags,
2382               PARSING_AND_ERR_FLAGS_L4CHKSMWASCALCULATED) &&
2383         GET_FIELD(data->parse_flags, PARSING_AND_ERR_FLAGS_L4CHKSMERROR)) {
2384         DP_NOTICE(p_hwfn, "Syn packet received with checksum error\n");
2385         goto err;
2386     }
2387
2388     rc = qed_iwarp_parse_rx_pkt(p_hwfn, &cm_info, (u8 *)(buf->data) +
2389                     data->u.placement_offset, remote_mac_addr,
2390                     local_mac_addr, &payload_len,
2391                     &tcp_start_offset);
2392     if (rc)
2393         goto err;
2394
2395     /* Check if there is a listener for this 4-tuple+vlan */
2396     listener = qed_iwarp_get_listener(p_hwfn, &cm_info);
2397     if (!listener) {
2398         DP_VERBOSE(p_hwfn,
2399                QED_MSG_RDMA,
2400                "SYN received on tuple not listened on parse_flags=%d packet len=%d\n",
2401                data->parse_flags, data->length.packet_length);
2402
2403         memset(&tx_pkt, 0, sizeof(tx_pkt));
2404         tx_pkt.num_of_bds = 1;
2405         tx_pkt.l4_hdr_offset_w = (data->length.packet_length) >> 2;
2406         tx_pkt.tx_dest = QED_LL2_TX_DEST_LB;
2407         tx_pkt.first_frag = buf->data_phys_addr +
2408                     data->u.placement_offset;
2409         tx_pkt.first_frag_len = data->length.packet_length;
2410         tx_pkt.cookie = buf;
2411
2412         rc = qed_ll2_prepare_tx_packet(p_hwfn, ll2_syn_handle,
2413                            &tx_pkt, true);
2414
2415         if (rc) {
2416             DP_NOTICE(p_hwfn,
2417                   "Can't post SYN back to chip rc=%d\n", rc);
2418             goto err;
2419         }
2420         return;
2421     }
2422
2423     DP_VERBOSE(p_hwfn, QED_MSG_RDMA, "Received syn on listening port\n");
2424     /* There may be an open ep on this connection if this is a syn
2425      * retrasnmit... need to make sure there isn't...
2426      */
2427     if (qed_iwarp_ep_exists(p_hwfn, &cm_info))
2428         goto err;
2429
2430     ep = qed_iwarp_get_free_ep(p_hwfn);
2431     if (!ep)
2432         goto err;
2433
2434     spin_lock_bh(&p_hwfn->p_rdma_info->iwarp.iw_lock);
2435     list_add_tail(&ep->list_entry, &p_hwfn->p_rdma_info->iwarp.ep_list);
2436     spin_unlock_bh(&p_hwfn->p_rdma_info->iwarp.iw_lock);
2437
2438     ether_addr_copy(ep->remote_mac_addr, remote_mac_addr);
2439     ether_addr_copy(ep->local_mac_addr, local_mac_addr);
2440
2441     memcpy(&ep->cm_info, &cm_info, sizeof(ep->cm_info));
2442
2443     hdr_size = ((cm_info.ip_version == QED_TCP_IPV4) ? 40 : 60);
2444     ep->mss = p_hwfn->p_rdma_info->iwarp.max_mtu - hdr_size;
2445     ep->mss = min_t(u16, QED_IWARP_MAX_FW_MSS, ep->mss);
2446
2447     ep->event_cb = listener->event_cb;
2448     ep->cb_context = listener->cb_context;
2449     ep->connect_mode = TCP_CONNECT_PASSIVE;
2450
2451     ep->syn = buf;
2452     ep->syn_ip_payload_length = (u16)payload_len;
2453     ep->syn_phy_addr = buf->data_phys_addr + data->u.placement_offset +
2454                tcp_start_offset;
2455
2456     rc = qed_iwarp_tcp_offload(p_hwfn, ep);
2457     if (rc) {
2458         qed_iwarp_return_ep(p_hwfn, ep);
2459         goto err;
2460     }
2461
2462     return;
2463 err:
2464     qed_iwarp_ll2_post_rx(p_hwfn, buf, ll2_syn_handle);
2465 }
2466
2467 static void qed_iwarp_ll2_rel_rx_pkt(void *cxt, u8 connection_handle,
2468                      void *cookie, dma_addr_t rx_buf_addr,
2469                      bool b_last_packet)
2470 {
2471     struct qed_iwarp_ll2_buff *buffer = cookie;
2472     struct qed_hwfn *p_hwfn = cxt;
2473
2474     dma_free_coherent(&p_hwfn->cdev->pdev->dev, buffer->buff_size,
2475               buffer->data, buffer->data_phys_addr);
2476     kfree(buffer);
2477 }
2478
2479 static void qed_iwarp_ll2_comp_tx_pkt(void *cxt, u8 connection_handle,
2480                       void *cookie, dma_addr_t first_frag_addr,
2481                       bool b_last_fragment, bool b_last_packet)
2482 {
2483     struct qed_iwarp_ll2_buff *buffer = cookie;
2484     struct qed_iwarp_ll2_buff *piggy;
2485     struct qed_hwfn *p_hwfn = cxt;
2486
2487     if (!buffer)        /* can happen in packed mpa unaligned... */
2488         return;
2489
2490     /* this was originally an rx packet, post it back */
2491     piggy = buffer->piggy_buf;
2492     if (piggy) {
2493         buffer->piggy_buf = NULL;
2494         qed_iwarp_ll2_post_rx(p_hwfn, piggy, connection_handle);
2495     }
2496
2497     qed_iwarp_ll2_post_rx(p_hwfn, buffer, connection_handle);
2498
2499     if (connection_handle == p_hwfn->p_rdma_info->iwarp.ll2_mpa_handle)
2500         qed_iwarp_process_pending_pkts(p_hwfn);
2501
2502     return;
2503 }
2504
2505 static void qed_iwarp_ll2_rel_tx_pkt(void *cxt, u8 connection_handle,
2506                      void *cookie, dma_addr_t first_frag_addr,
2507                      bool b_last_fragment, bool b_last_packet)
2508 {
2509     struct qed_iwarp_ll2_buff *buffer = cookie;
2510     struct qed_hwfn *p_hwfn = cxt;
2511
2512     if (!buffer)
2513         return;
2514
2515     if (buffer->piggy_buf) {
2516         dma_free_coherent(&p_hwfn->cdev->pdev->dev,
2517                   buffer->piggy_buf->buff_size,
2518                   buffer->piggy_buf->data,
2519                   buffer->piggy_buf->data_phys_addr);
2520
2521         kfree(buffer->piggy_buf);
2522     }
2523
2524     dma_free_coherent(&p_hwfn->cdev->pdev->dev, buffer->buff_size,
2525               buffer->data, buffer->data_phys_addr);
2526
2527     kfree(buffer);
2528 }
2529
2530 /* The only slowpath for iwarp ll2 is unalign flush. When this completion
2531  * is received, need to reset the FPDU.
2532  */
2533 static void
2534 qed_iwarp_ll2_slowpath(void *cxt,
2535                u8 connection_handle,
2536                u32 opaque_data_0, u32 opaque_data_1)
2537 {
2538     struct unaligned_opaque_data unalign_data;
2539     struct qed_hwfn *p_hwfn = cxt;
2540     struct qed_iwarp_fpdu *fpdu;
2541     u32 cid;
2542
2543     qed_iwarp_mpa_get_data(p_hwfn, &unalign_data,
2544                    opaque_data_0, opaque_data_1);
2545
2546     cid = le32_to_cpu(unalign_data.cid);
2547
2548     DP_VERBOSE(p_hwfn, QED_MSG_RDMA, "(0x%x) Flush fpdu\n", cid);
2549
2550     fpdu = qed_iwarp_get_curr_fpdu(p_hwfn, (u16)cid);
2551     if (fpdu)
2552         memset(fpdu, 0, sizeof(*fpdu));
2553 }
2554
2555 static int qed_iwarp_ll2_stop(struct qed_hwfn *p_hwfn)
2556 {
2557     struct qed_iwarp_info *iwarp_info = &p_hwfn->p_rdma_info->iwarp;
2558     int rc = 0;
2559
2560     if (iwarp_info->ll2_syn_handle != QED_IWARP_HANDLE_INVAL) {
2561         rc = qed_ll2_terminate_connection(p_hwfn,
2562                           iwarp_info->ll2_syn_handle);
2563         if (rc)
2564             DP_INFO(p_hwfn, "Failed to terminate syn connection\n");
2565
2566         qed_ll2_release_connection(p_hwfn, iwarp_info->ll2_syn_handle);
2567         iwarp_info->ll2_syn_handle = QED_IWARP_HANDLE_INVAL;
2568     }
2569
2570     if (iwarp_info->ll2_ooo_handle != QED_IWARP_HANDLE_INVAL) {
2571         rc = qed_ll2_terminate_connection(p_hwfn,
2572                           iwarp_info->ll2_ooo_handle);
2573         if (rc)
2574             DP_INFO(p_hwfn, "Failed to terminate ooo connection\n");
2575
2576         qed_ll2_release_connection(p_hwfn, iwarp_info->ll2_ooo_handle);
2577         iwarp_info->ll2_ooo_handle = QED_IWARP_HANDLE_INVAL;
2578     }
2579
2580     if (iwarp_info->ll2_mpa_handle != QED_IWARP_HANDLE_INVAL) {
2581         rc = qed_ll2_terminate_connection(p_hwfn,
2582                           iwarp_info->ll2_mpa_handle);
2583         if (rc)
2584             DP_INFO(p_hwfn, "Failed to terminate mpa connection\n");
2585
2586         qed_ll2_release_connection(p_hwfn, iwarp_info->ll2_mpa_handle);
2587         iwarp_info->ll2_mpa_handle = QED_IWARP_HANDLE_INVAL;
2588     }
2589
2590     qed_llh_remove_mac_filter(p_hwfn->cdev, 0,
2591                   p_hwfn->p_rdma_info->iwarp.mac_addr);
2592
2593     return rc;
2594 }
2595
2596 static int
2597 qed_iwarp_ll2_alloc_buffers(struct qed_hwfn *p_hwfn,
2598                 int num_rx_bufs, int buff_size, u8 ll2_handle)
2599 {
2600     struct qed_iwarp_ll2_buff *buffer;
2601     int rc = 0;
2602     int i;
2603
2604     for (i = 0; i < num_rx_bufs; i++) {
2605         buffer = kzalloc(sizeof(*buffer), GFP_KERNEL);
2606         if (!buffer) {
2607             rc = -ENOMEM;
2608             break;
2609         }
2610
2611         buffer->data = dma_alloc_coherent(&p_hwfn->cdev->pdev->dev,
2612                           buff_size,
2613                           &buffer->data_phys_addr,
2614                           GFP_KERNEL);
2615         if (!buffer->data) {
2616             kfree(buffer);
2617             rc = -ENOMEM;
2618             break;
2619         }
2620
2621         buffer->buff_size = buff_size;
2622         rc = qed_iwarp_ll2_post_rx(p_hwfn, buffer, ll2_handle);
2623         if (rc)
2624             /* buffers will be deallocated by qed_ll2 */
2625             break;
2626     }
2627     return rc;
2628 }
2629
2630 #define QED_IWARP_MAX_BUF_SIZE(mtu)                  \
2631     ALIGN((mtu) + ETH_HLEN + 2 * VLAN_HLEN + 2 + ETH_CACHE_LINE_SIZE, \
2632         ETH_CACHE_LINE_SIZE)
2633
2634 static int
2635 qed_iwarp_ll2_start(struct qed_hwfn *p_hwfn,
2636             struct qed_rdma_start_in_params *params,
2637             u32 rcv_wnd_size)
2638 {
2639     struct qed_iwarp_info *iwarp_info;
2640     struct qed_ll2_acquire_data data;
2641     struct qed_ll2_cbs cbs;
2642     u32 buff_size;
2643     u16 n_ooo_bufs;
2644     int rc = 0;
2645     int i;
2646
2647     iwarp_info = &p_hwfn->p_rdma_info->iwarp;
2648     iwarp_info->ll2_syn_handle = QED_IWARP_HANDLE_INVAL;
2649     iwarp_info->ll2_ooo_handle = QED_IWARP_HANDLE_INVAL;
2650     iwarp_info->ll2_mpa_handle = QED_IWARP_HANDLE_INVAL;
2651
2652     iwarp_info->max_mtu = params->max_mtu;
2653
2654     ether_addr_copy(p_hwfn->p_rdma_info->iwarp.mac_addr, params->mac_addr);
2655
2656     rc = qed_llh_add_mac_filter(p_hwfn->cdev, 0, params->mac_addr);
2657     if (rc)
2658         return rc;
2659
2660     /* Start SYN connection */
2661     cbs.rx_comp_cb = qed_iwarp_ll2_comp_syn_pkt;
2662     cbs.rx_release_cb = qed_iwarp_ll2_rel_rx_pkt;
2663     cbs.tx_comp_cb = qed_iwarp_ll2_comp_tx_pkt;
2664     cbs.tx_release_cb = qed_iwarp_ll2_rel_tx_pkt;
2665     cbs.slowpath_cb = NULL;
2666     cbs.cookie = p_hwfn;
2667
2668     memset(&data, 0, sizeof(data));
2669     data.input.conn_type = QED_LL2_TYPE_IWARP;
2670     /* SYN will use ctx based queues */
2671     data.input.rx_conn_type = QED_LL2_RX_TYPE_CTX;
2672     data.input.mtu = params->max_mtu;
2673     data.input.rx_num_desc = QED_IWARP_LL2_SYN_RX_SIZE;
2674     data.input.tx_num_desc = QED_IWARP_LL2_SYN_TX_SIZE;
2675     data.input.tx_max_bds_per_packet = 1;   /* will never be fragmented */
2676     data.input.tx_tc = PKT_LB_TC;
2677     data.input.tx_dest = QED_LL2_TX_DEST_LB;
2678     data.p_connection_handle = &iwarp_info->ll2_syn_handle;
2679     data.cbs = &cbs;
2680
2681     rc = qed_ll2_acquire_connection(p_hwfn, &data);
2682     if (rc) {
2683         DP_NOTICE(p_hwfn, "Failed to acquire LL2 connection\n");
2684         qed_llh_remove_mac_filter(p_hwfn->cdev, 0, params->mac_addr);
2685         return rc;
2686     }
2687
2688     rc = qed_ll2_establish_connection(p_hwfn, iwarp_info->ll2_syn_handle);
2689     if (rc) {
2690         DP_NOTICE(p_hwfn, "Failed to establish LL2 connection\n");
2691         goto err;
2692     }
2693
2694     buff_size = QED_IWARP_MAX_BUF_SIZE(params->max_mtu);
2695     rc = qed_iwarp_ll2_alloc_buffers(p_hwfn,
2696                      QED_IWARP_LL2_SYN_RX_SIZE,
2697                      buff_size,
2698                      iwarp_info->ll2_syn_handle);
2699     if (rc)
2700         goto err;
2701
2702     /* Start OOO connection */
2703     data.input.conn_type = QED_LL2_TYPE_OOO;
2704     /* OOO/unaligned will use legacy ll2 queues (ram based) */
2705     data.input.rx_conn_type = QED_LL2_RX_TYPE_LEGACY;
2706     data.input.mtu = params->max_mtu;
2707
2708     n_ooo_bufs = (QED_IWARP_MAX_OOO * rcv_wnd_size) /
2709              iwarp_info->max_mtu;
2710     n_ooo_bufs = min_t(u32, n_ooo_bufs, QED_IWARP_LL2_OOO_MAX_RX_SIZE);
2711
2712     data.input.rx_num_desc = n_ooo_bufs;
2713     data.input.rx_num_ooo_buffers = n_ooo_bufs;
2714
2715     data.input.tx_max_bds_per_packet = 1;   /* will never be fragmented */
2716     data.input.tx_num_desc = QED_IWARP_LL2_OOO_DEF_TX_SIZE;
2717     data.p_connection_handle = &iwarp_info->ll2_ooo_handle;
2718
2719     rc = qed_ll2_acquire_connection(p_hwfn, &data);
2720     if (rc)
2721         goto err;
2722
2723     rc = qed_ll2_establish_connection(p_hwfn, iwarp_info->ll2_ooo_handle);
2724     if (rc)
2725         goto err;
2726
2727     /* Start Unaligned MPA connection */
2728     cbs.rx_comp_cb = qed_iwarp_ll2_comp_mpa_pkt;
2729     cbs.slowpath_cb = qed_iwarp_ll2_slowpath;
2730
2731     memset(&data, 0, sizeof(data));
2732     data.input.conn_type = QED_LL2_TYPE_IWARP;
2733     data.input.mtu = params->max_mtu;
2734     /* FW requires that once a packet arrives OOO, it must have at
2735      * least 2 rx buffers available on the unaligned connection
2736      * for handling the case that it is a partial fpdu.
2737      */
2738     data.input.rx_num_desc = n_ooo_bufs * 2;
2739     data.input.tx_num_desc = data.input.rx_num_desc;
2740     data.input.tx_max_bds_per_packet = QED_IWARP_MAX_BDS_PER_FPDU;
2741     data.input.tx_tc = PKT_LB_TC;
2742     data.input.tx_dest = QED_LL2_TX_DEST_LB;
2743     data.p_connection_handle = &iwarp_info->ll2_mpa_handle;
2744     data.input.secondary_queue = true;
2745     data.cbs = &cbs;
2746
2747     rc = qed_ll2_acquire_connection(p_hwfn, &data);
2748     if (rc)
2749         goto err;
2750
2751     rc = qed_ll2_establish_connection(p_hwfn, iwarp_info->ll2_mpa_handle);
2752     if (rc)
2753         goto err;
2754
2755     rc = qed_iwarp_ll2_alloc_buffers(p_hwfn,
2756                      data.input.rx_num_desc,
2757                      buff_size,
2758                      iwarp_info->ll2_mpa_handle);
2759     if (rc)
2760         goto err;
2761
2762     iwarp_info->partial_fpdus = kcalloc((u16)p_hwfn->p_rdma_info->num_qps,
2763                         sizeof(*iwarp_info->partial_fpdus),
2764                         GFP_KERNEL);
2765     if (!iwarp_info->partial_fpdus) {
2766         rc = -ENOMEM;
2767         goto err;
2768     }
2769
2770     iwarp_info->max_num_partial_fpdus = (u16)p_hwfn->p_rdma_info->num_qps;
2771
2772     iwarp_info->mpa_intermediate_buf = kzalloc(buff_size, GFP_KERNEL);
2773     if (!iwarp_info->mpa_intermediate_buf) {
2774         rc = -ENOMEM;
2775         goto err;
2776     }
2777
2778     /* The mpa_bufs array serves for pending RX packets received on the
2779      * mpa ll2 that don't have place on the tx ring and require later
2780      * processing. We can't fail on allocation of such a struct therefore
2781      * we allocate enough to take care of all rx packets
2782      */
2783     iwarp_info->mpa_bufs = kcalloc(data.input.rx_num_desc,
2784                        sizeof(*iwarp_info->mpa_bufs),
2785                        GFP_KERNEL);
2786     if (!iwarp_info->mpa_bufs) {
2787         rc = -ENOMEM;
2788         goto err;
2789     }
2790
2791     INIT_LIST_HEAD(&iwarp_info->mpa_buf_pending_list);
2792     INIT_LIST_HEAD(&iwarp_info->mpa_buf_list);
2793     for (i = 0; i < data.input.rx_num_desc; i++)
2794         list_add_tail(&iwarp_info->mpa_bufs[i].list_entry,
2795                   &iwarp_info->mpa_buf_list);
2796     return rc;
2797 err:
2798     qed_iwarp_ll2_stop(p_hwfn);
2799
2800     return rc;
2801 }
2802
2803 static struct {
2804     u32 two_ports;
2805     u32 four_ports;
2806 } qed_iwarp_rcv_wnd_size[MAX_CHIP_IDS] = {
2807     {QED_IWARP_RCV_WND_SIZE_DEF_BB_2P, QED_IWARP_RCV_WND_SIZE_DEF_BB_4P},
2808     {QED_IWARP_RCV_WND_SIZE_DEF_AH_2P, QED_IWARP_RCV_WND_SIZE_DEF_AH_4P}
2809 };
2810
2811 int qed_iwarp_setup(struct qed_hwfn *p_hwfn,
2812             struct qed_rdma_start_in_params *params)
2813 {
2814     struct qed_dev *cdev = p_hwfn->cdev;
2815     struct qed_iwarp_info *iwarp_info;
2816     enum chip_ids chip_id;
2817     u32 rcv_wnd_size;
2818
2819     iwarp_info = &p_hwfn->p_rdma_info->iwarp;
2820
2821     iwarp_info->tcp_flags = QED_IWARP_TS_EN;
2822
2823     chip_id = QED_IS_BB(cdev) ? CHIP_BB : CHIP_K2;
2824     rcv_wnd_size = (qed_device_num_ports(cdev) == 4) ?
2825         qed_iwarp_rcv_wnd_size[chip_id].four_ports :
2826         qed_iwarp_rcv_wnd_size[chip_id].two_ports;
2827
2828     /* value 0 is used for ilog2(QED_IWARP_RCV_WND_SIZE_MIN) */
2829     iwarp_info->rcv_wnd_scale = ilog2(rcv_wnd_size) -
2830         ilog2(QED_IWARP_RCV_WND_SIZE_MIN);
2831     iwarp_info->rcv_wnd_size = rcv_wnd_size >> iwarp_info->rcv_wnd_scale;
2832     iwarp_info->crc_needed = QED_IWARP_PARAM_CRC_NEEDED;
2833     iwarp_info->mpa_rev = MPA_NEGOTIATION_TYPE_ENHANCED;
2834
2835     iwarp_info->peer2peer = QED_IWARP_PARAM_P2P;
2836
2837     iwarp_info->rtr_type =  MPA_RTR_TYPE_ZERO_SEND |
2838                 MPA_RTR_TYPE_ZERO_WRITE |
2839                 MPA_RTR_TYPE_ZERO_READ;
2840
2841     spin_lock_init(&p_hwfn->p_rdma_info->iwarp.qp_lock);
2842     INIT_LIST_HEAD(&p_hwfn->p_rdma_info->iwarp.ep_list);
2843     INIT_LIST_HEAD(&p_hwfn->p_rdma_info->iwarp.listen_list);
2844
2845     qed_spq_register_async_cb(p_hwfn, PROTOCOLID_IWARP,
2846                   qed_iwarp_async_event);
2847     qed_ooo_setup(p_hwfn);
2848
2849     return qed_iwarp_ll2_start(p_hwfn, params, rcv_wnd_size);
2850 }
2851
2852 int qed_iwarp_stop(struct qed_hwfn *p_hwfn)
2853 {
2854     int rc;
2855
2856     qed_iwarp_free_prealloc_ep(p_hwfn);
2857     rc = qed_iwarp_wait_for_all_cids(p_hwfn);
2858     if (rc)
2859         return rc;
2860
2861     return qed_iwarp_ll2_stop(p_hwfn);
2862 }
2863
2864 static void qed_iwarp_qp_in_error(struct qed_hwfn *p_hwfn,
2865                   struct qed_iwarp_ep *ep,
2866                   u8 fw_return_code)
2867 {
2868     struct qed_iwarp_cm_event_params params;
2869
2870     qed_iwarp_modify_qp(p_hwfn, ep->qp, QED_IWARP_QP_STATE_ERROR, true);
2871
2872     params.event = QED_IWARP_EVENT_CLOSE;
2873     params.ep_context = ep;
2874     params.cm_info = &ep->cm_info;
2875     params.status = (fw_return_code == IWARP_QP_IN_ERROR_GOOD_CLOSE) ?
2876              0 : -ECONNRESET;
2877
2878     /* paired with READ_ONCE in destroy_qp */
2879     smp_store_release(&ep->state, QED_IWARP_EP_CLOSED);
2880
2881     spin_lock_bh(&p_hwfn->p_rdma_info->iwarp.iw_lock);
2882     list_del(&ep->list_entry);
2883     spin_unlock_bh(&p_hwfn->p_rdma_info->iwarp.iw_lock);
2884
2885     ep->event_cb(ep->cb_context, &params);
2886 }
2887
2888 static void qed_iwarp_exception_received(struct qed_hwfn *p_hwfn,
2889                      struct qed_iwarp_ep *ep,
2890                      int fw_ret_code)
2891 {
2892     struct qed_iwarp_cm_event_params params;
2893     bool event_cb = false;
2894
2895     DP_VERBOSE(p_hwfn, QED_MSG_RDMA, "EP(0x%x) fw_ret_code=%d\n",
2896            ep->cid, fw_ret_code);
2897
2898     switch (fw_ret_code) {
2899     case IWARP_EXCEPTION_DETECTED_LLP_CLOSED:
2900         params.status = 0;
2901         params.event = QED_IWARP_EVENT_DISCONNECT;
2902         event_cb = true;
2903         break;
2904     case IWARP_EXCEPTION_DETECTED_LLP_RESET:
2905         params.status = -ECONNRESET;
2906         params.event = QED_IWARP_EVENT_DISCONNECT;
2907         event_cb = true;
2908         break;
2909     case IWARP_EXCEPTION_DETECTED_RQ_EMPTY:
2910         params.event = QED_IWARP_EVENT_RQ_EMPTY;
2911         event_cb = true;
2912         break;
2913     case IWARP_EXCEPTION_DETECTED_IRQ_FULL:
2914         params.event = QED_IWARP_EVENT_IRQ_FULL;
2915         event_cb = true;
2916         break;
2917     case IWARP_EXCEPTION_DETECTED_LLP_TIMEOUT:
2918         params.event = QED_IWARP_EVENT_LLP_TIMEOUT;
2919         event_cb = true;
2920         break;
2921     case IWARP_EXCEPTION_DETECTED_REMOTE_PROTECTION_ERROR:
2922         params.event = QED_IWARP_EVENT_REMOTE_PROTECTION_ERROR;
2923         event_cb = true;
2924         break;
2925     case IWARP_EXCEPTION_DETECTED_CQ_OVERFLOW:
2926         params.event = QED_IWARP_EVENT_CQ_OVERFLOW;
2927         event_cb = true;
2928         break;
2929     case IWARP_EXCEPTION_DETECTED_LOCAL_CATASTROPHIC:
2930         params.event = QED_IWARP_EVENT_QP_CATASTROPHIC;
2931         event_cb = true;
2932         break;
2933     case IWARP_EXCEPTION_DETECTED_LOCAL_ACCESS_ERROR:
2934         params.event = QED_IWARP_EVENT_LOCAL_ACCESS_ERROR;
2935         event_cb = true;
2936         break;
2937     case IWARP_EXCEPTION_DETECTED_REMOTE_OPERATION_ERROR:
2938         params.event = QED_IWARP_EVENT_REMOTE_OPERATION_ERROR;
2939         event_cb = true;
2940         break;
2941     case IWARP_EXCEPTION_DETECTED_TERMINATE_RECEIVED:
2942         params.event = QED_IWARP_EVENT_TERMINATE_RECEIVED;
2943         event_cb = true;
2944         break;
2945     default:
2946         DP_VERBOSE(p_hwfn, QED_MSG_RDMA,
2947                "Unhandled exception received...fw_ret_code=%d\n",
2948                fw_ret_code);
2949         break;
2950     }
2951
2952     if (event_cb) {
2953         params.ep_context = ep;
2954         params.cm_info = &ep->cm_info;
2955         ep->event_cb(ep->cb_context, &params);
2956     }
2957 }
2958
2959 static void
2960 qed_iwarp_tcp_connect_unsuccessful(struct qed_hwfn *p_hwfn,
2961                    struct qed_iwarp_ep *ep, u8 fw_return_code)
2962 {
2963     struct qed_iwarp_cm_event_params params;
2964
2965     memset(&params, 0, sizeof(params));
2966     params.event = QED_IWARP_EVENT_ACTIVE_COMPLETE;
2967     params.ep_context = ep;
2968     params.cm_info = &ep->cm_info;
2969     /* paired with READ_ONCE in destroy_qp */
2970     smp_store_release(&ep->state, QED_IWARP_EP_CLOSED);
2971
2972     switch (fw_return_code) {
2973     case IWARP_CONN_ERROR_TCP_CONNECT_INVALID_PACKET:
2974         DP_VERBOSE(p_hwfn, QED_MSG_RDMA,
2975                "%s(0x%x) TCP connect got invalid packet\n",
2976                QED_IWARP_CONNECT_MODE_STRING(ep), ep->tcp_cid);
2977         params.status = -ECONNRESET;
2978         break;
2979     case IWARP_CONN_ERROR_TCP_CONNECTION_RST:
2980         DP_VERBOSE(p_hwfn, QED_MSG_RDMA,
2981                "%s(0x%x) TCP Connection Reset\n",
2982                QED_IWARP_CONNECT_MODE_STRING(ep), ep->tcp_cid);
2983         params.status = -ECONNRESET;
2984         break;
2985     case IWARP_CONN_ERROR_TCP_CONNECT_TIMEOUT:
2986         DP_NOTICE(p_hwfn, "%s(0x%x) TCP timeout\n",
2987               QED_IWARP_CONNECT_MODE_STRING(ep), ep->tcp_cid);
2988         params.status = -EBUSY;
2989         break;
2990     case IWARP_CONN_ERROR_MPA_NOT_SUPPORTED_VER:
2991         DP_NOTICE(p_hwfn, "%s(0x%x) MPA not supported VER\n",
2992               QED_IWARP_CONNECT_MODE_STRING(ep), ep->tcp_cid);
2993         params.status = -ECONNREFUSED;
2994         break;
2995     case IWARP_CONN_ERROR_MPA_INVALID_PACKET:
2996         DP_NOTICE(p_hwfn, "%s(0x%x) MPA Invalid Packet\n",
2997               QED_IWARP_CONNECT_MODE_STRING(ep), ep->tcp_cid);
2998         params.status = -ECONNRESET;
2999         break;
3000     default:
3001         DP_ERR(p_hwfn,
3002                "%s(0x%x) Unexpected return code tcp connect: %d\n",
3003                QED_IWARP_CONNECT_MODE_STRING(ep),
3004                ep->tcp_cid, fw_return_code);
3005         params.status = -ECONNRESET;
3006         break;
3007     }
3008
3009     if (ep->connect_mode == TCP_CONNECT_PASSIVE) {
3010         ep->tcp_cid = QED_IWARP_INVALID_TCP_CID;
3011         qed_iwarp_return_ep(p_hwfn, ep);
3012     } else {
3013         ep->event_cb(ep->cb_context, &params);
3014         spin_lock_bh(&p_hwfn->p_rdma_info->iwarp.iw_lock);
3015         list_del(&ep->list_entry);
3016         spin_unlock_bh(&p_hwfn->p_rdma_info->iwarp.iw_lock);
3017     }
3018 }
3019
3020 static void
3021 qed_iwarp_connect_complete(struct qed_hwfn *p_hwfn,
3022                struct qed_iwarp_ep *ep, u8 fw_return_code)
3023 {
3024     u8 ll2_syn_handle = p_hwfn->p_rdma_info->iwarp.ll2_syn_handle;
3025
3026     if (ep->connect_mode == TCP_CONNECT_PASSIVE) {
3027         /* Done with the SYN packet, post back to ll2 rx */
3028         qed_iwarp_ll2_post_rx(p_hwfn, ep->syn, ll2_syn_handle);
3029
3030         ep->syn = NULL;
3031
3032         /* If connect failed - upper layer doesn't know about it */
3033         if (fw_return_code == RDMA_RETURN_OK)
3034             qed_iwarp_mpa_received(p_hwfn, ep);
3035         else
3036             qed_iwarp_tcp_connect_unsuccessful(p_hwfn, ep,
3037                                fw_return_code);
3038     } else {
3039         if (fw_return_code == RDMA_RETURN_OK)
3040             qed_iwarp_mpa_offload(p_hwfn, ep);
3041         else
3042             qed_iwarp_tcp_connect_unsuccessful(p_hwfn, ep,
3043                                fw_return_code);
3044     }
3045 }
3046
3047 static inline bool
3048 qed_iwarp_check_ep_ok(struct qed_hwfn *p_hwfn, struct qed_iwarp_ep *ep)
3049 {
3050     if (!ep || (ep->sig != QED_EP_SIG)) {
3051         DP_ERR(p_hwfn, "ERROR ON ASYNC ep=%p\n", ep);
3052         return false;
3053     }
3054
3055     return true;
3056 }
3057
3058 static int qed_iwarp_async_event(struct qed_hwfn *p_hwfn, u8 fw_event_code,
3059                  __le16 echo, union event_ring_data *data,
3060                  u8 fw_return_code)
3061 {
3062     struct qed_rdma_events events = p_hwfn->p_rdma_info->events;
3063     struct regpair *fw_handle = &data->rdma_data.async_handle;
3064     struct qed_iwarp_ep *ep = NULL;
3065     u16 srq_offset;
3066     u16 srq_id;
3067     u16 cid;
3068
3069     ep = (struct qed_iwarp_ep *)(uintptr_t)HILO_64(fw_handle->hi,
3070                                fw_handle->lo);
3071
3072     switch (fw_event_code) {
3073     case IWARP_EVENT_TYPE_ASYNC_CONNECT_COMPLETE:
3074         /* Async completion after TCP 3-way handshake */
3075         if (!qed_iwarp_check_ep_ok(p_hwfn, ep))
3076             return -EINVAL;
3077         DP_VERBOSE(p_hwfn,
3078                QED_MSG_RDMA,
3079                "EP(0x%x) IWARP_EVENT_TYPE_ASYNC_CONNECT_COMPLETE fw_ret_code=%d\n",
3080                ep->tcp_cid, fw_return_code);
3081         qed_iwarp_connect_complete(p_hwfn, ep, fw_return_code);
3082         break;
3083     case IWARP_EVENT_TYPE_ASYNC_EXCEPTION_DETECTED:
3084         if (!qed_iwarp_check_ep_ok(p_hwfn, ep))
3085             return -EINVAL;
3086         DP_VERBOSE(p_hwfn,
3087                QED_MSG_RDMA,
3088                "QP(0x%x) IWARP_EVENT_TYPE_ASYNC_EXCEPTION_DETECTED fw_ret_code=%d\n",
3089                ep->cid, fw_return_code);
3090         qed_iwarp_exception_received(p_hwfn, ep, fw_return_code);
3091         break;
3092     case IWARP_EVENT_TYPE_ASYNC_QP_IN_ERROR_STATE:
3093         /* Async completion for Close Connection ramrod */
3094         if (!qed_iwarp_check_ep_ok(p_hwfn, ep))
3095             return -EINVAL;
3096         DP_VERBOSE(p_hwfn,
3097                QED_MSG_RDMA,
3098                "QP(0x%x) IWARP_EVENT_TYPE_ASYNC_QP_IN_ERROR_STATE fw_ret_code=%d\n",
3099                ep->cid, fw_return_code);
3100         qed_iwarp_qp_in_error(p_hwfn, ep, fw_return_code);
3101         break;
3102     case IWARP_EVENT_TYPE_ASYNC_ENHANCED_MPA_REPLY_ARRIVED:
3103         /* Async event for active side only */
3104         if (!qed_iwarp_check_ep_ok(p_hwfn, ep))
3105             return -EINVAL;
3106         DP_VERBOSE(p_hwfn,
3107                QED_MSG_RDMA,
3108                "QP(0x%x) IWARP_EVENT_TYPE_ASYNC_MPA_HANDSHAKE_MPA_REPLY_ARRIVED fw_ret_code=%d\n",
3109                ep->cid, fw_return_code);
3110         qed_iwarp_mpa_reply_arrived(p_hwfn, ep);
3111         break;
3112     case IWARP_EVENT_TYPE_ASYNC_MPA_HANDSHAKE_COMPLETE:
3113         if (!qed_iwarp_check_ep_ok(p_hwfn, ep))
3114             return -EINVAL;
3115         DP_VERBOSE(p_hwfn,
3116                QED_MSG_RDMA,
3117                "QP(0x%x) IWARP_EVENT_TYPE_ASYNC_MPA_HANDSHAKE_COMPLETE fw_ret_code=%d\n",
3118                ep->cid, fw_return_code);
3119         qed_iwarp_mpa_complete(p_hwfn, ep, fw_return_code);
3120         break;
3121     case IWARP_EVENT_TYPE_ASYNC_CID_CLEANED:
3122         cid = (u16)le32_to_cpu(fw_handle->lo);
3123         DP_VERBOSE(p_hwfn, QED_MSG_RDMA,
3124                "(0x%x)IWARP_EVENT_TYPE_ASYNC_CID_CLEANED\n", cid);
3125         qed_iwarp_cid_cleaned(p_hwfn, cid);
3126
3127         break;
3128     case IWARP_EVENT_TYPE_ASYNC_SRQ_EMPTY:
3129         DP_NOTICE(p_hwfn, "IWARP_EVENT_TYPE_ASYNC_SRQ_EMPTY\n");
3130         srq_offset = p_hwfn->p_rdma_info->srq_id_offset;
3131         /* FW assigns value that is no greater than u16 */
3132         srq_id = ((u16)le32_to_cpu(fw_handle->lo)) - srq_offset;
3133         events.affiliated_event(events.context,
3134                     QED_IWARP_EVENT_SRQ_EMPTY,
3135                     &srq_id);
3136         break;
3137     case IWARP_EVENT_TYPE_ASYNC_SRQ_LIMIT:
3138         DP_NOTICE(p_hwfn, "IWARP_EVENT_TYPE_ASYNC_SRQ_LIMIT\n");
3139         srq_offset = p_hwfn->p_rdma_info->srq_id_offset;
3140         /* FW assigns value that is no greater than u16 */
3141         srq_id = ((u16)le32_to_cpu(fw_handle->lo)) - srq_offset;
3142         events.affiliated_event(events.context,
3143                     QED_IWARP_EVENT_SRQ_LIMIT,
3144                     &srq_id);
3145         break;
3146     case IWARP_EVENT_TYPE_ASYNC_CQ_OVERFLOW:
3147         DP_NOTICE(p_hwfn, "IWARP_EVENT_TYPE_ASYNC_CQ_OVERFLOW\n");
3148
3149         p_hwfn->p_rdma_info->events.affiliated_event(
3150             p_hwfn->p_rdma_info->events.context,
3151             QED_IWARP_EVENT_CQ_OVERFLOW,
3152             (void *)fw_handle);
3153         break;
3154     default:
3155         DP_ERR(p_hwfn, "Received unexpected async iwarp event %d\n",
3156                fw_event_code);
3157         return -EINVAL;
3158     }
3159     return 0;
3160 }
3161
3162 int
3163 qed_iwarp_create_listen(void *rdma_cxt,
3164             struct qed_iwarp_listen_in *iparams,
3165             struct qed_iwarp_listen_out *oparams)
3166 {
3167     struct qed_hwfn *p_hwfn = rdma_cxt;
3168     struct qed_iwarp_listener *listener;
3169
3170     listener = kzalloc(sizeof(*listener), GFP_KERNEL);
3171     if (!listener)
3172         return -ENOMEM;
3173
3174     listener->ip_version = iparams->ip_version;
3175     memcpy(listener->ip_addr, iparams->ip_addr, sizeof(listener->ip_addr));
3176     listener->port = iparams->port;
3177     listener->vlan = iparams->vlan;
3178
3179     listener->event_cb = iparams->event_cb;
3180     listener->cb_context = iparams->cb_context;
3181     listener->max_backlog = iparams->max_backlog;
3182     oparams->handle = listener;
3183
3184     spin_lock_bh(&p_hwfn->p_rdma_info->iwarp.iw_lock);
3185     list_add_tail(&listener->list_entry,
3186               &p_hwfn->p_rdma_info->iwarp.listen_list);
3187     spin_unlock_bh(&p_hwfn->p_rdma_info->iwarp.iw_lock);
3188
3189     DP_VERBOSE(p_hwfn,
3190            QED_MSG_RDMA,
3191            "callback=%p handle=%p ip=%x:%x:%x:%x port=0x%x vlan=0x%x\n",
3192            listener->event_cb,
3193            listener,
3194            listener->ip_addr[0],
3195            listener->ip_addr[1],
3196            listener->ip_addr[2],
3197            listener->ip_addr[3], listener->port, listener->vlan);
3198
3199     return 0;
3200 }
3201
3202 int qed_iwarp_destroy_listen(void *rdma_cxt, void *handle)
3203 {
3204     struct qed_iwarp_listener *listener = handle;
3205     struct qed_hwfn *p_hwfn = rdma_cxt;
3206
3207     DP_VERBOSE(p_hwfn, QED_MSG_RDMA, "handle=%p\n", handle);
3208
3209     spin_lock_bh(&p_hwfn->p_rdma_info->iwarp.iw_lock);
3210     list_del(&listener->list_entry);
3211     spin_unlock_bh(&p_hwfn->p_rdma_info->iwarp.iw_lock);
3212
3213     kfree(listener);
3214
3215     return 0;
3216 }
3217
3218 int qed_iwarp_send_rtr(void *rdma_cxt, struct qed_iwarp_send_rtr_in *iparams)
3219 {
3220     struct qed_hwfn *p_hwfn = rdma_cxt;
3221     struct qed_sp_init_data init_data;
3222     struct qed_spq_entry *p_ent;
3223     struct qed_iwarp_ep *ep;
3224     struct qed_rdma_qp *qp;
3225     int rc;
3226
3227     ep = iparams->ep_context;
3228     if (!ep) {
3229         DP_ERR(p_hwfn, "Ep Context receive in send_rtr is NULL\n");
3230         return -EINVAL;
3231     }
3232
3233     qp = ep->qp;
3234
3235     DP_VERBOSE(p_hwfn, QED_MSG_RDMA, "QP(0x%x) EP(0x%x)\n",
3236            qp->icid, ep->tcp_cid);
3237
3238     memset(&init_data, 0, sizeof(init_data));
3239     init_data.cid = qp->icid;
3240     init_data.opaque_fid = p_hwfn->hw_info.opaque_fid;
3241     init_data.comp_mode = QED_SPQ_MODE_CB;
3242
3243     rc = qed_sp_init_request(p_hwfn, &p_ent,
3244                  IWARP_RAMROD_CMD_ID_MPA_OFFLOAD_SEND_RTR,
3245                  PROTOCOLID_IWARP, &init_data);
3246
3247     if (rc)
3248         return rc;
3249
3250     rc = qed_spq_post(p_hwfn, p_ent, NULL);
3251
3252     DP_VERBOSE(p_hwfn, QED_MSG_RDMA, "rc = 0x%x\n", rc);
3253
3254     return rc;
3255 }
3256
3257 void
3258 qed_iwarp_query_qp(struct qed_rdma_qp *qp,
3259            struct qed_rdma_query_qp_out_params *out_params)
3260 {
3261     out_params->state = qed_iwarp2roce_state(qp->iwarp_state);
3262 }