drivers/infiniband/hw/irdma/hw.c

   1 // SPDX-License-Identifier: GPL-2.0 or Linux-OpenIB
   2 /* Copyright (c) 2015 - 2021 Intel Corporation */
   3 #include "main.h"
   4
   5 static struct irdma_rsrc_limits rsrc_limits_table[] = {
   6         [0] = {
   7                 .qplimit = SZ_128,
   8         },
   9         [1] = {
  10                 .qplimit = SZ_1K,
  11         },
  12         [2] = {
  13                 .qplimit = SZ_2K,
  14         },
  15         [3] = {
  16                 .qplimit = SZ_4K,
  17         },
  18         [4] = {
  19                 .qplimit = SZ_16K,
  20         },
  21         [5] = {
  22                 .qplimit = SZ_64K,
  23         },
  24         [6] = {
  25                 .qplimit = SZ_128K,
  26         },
  27         [7] = {
  28                 .qplimit = SZ_256K,
  29         },
  30 };
  31
  32 /* types of hmc objects */
  33 static enum irdma_hmc_rsrc_type iw_hmc_obj_types[] = {
  34         IRDMA_HMC_IW_QP,
  35         IRDMA_HMC_IW_CQ,
  36         IRDMA_HMC_IW_HTE,
  37         IRDMA_HMC_IW_ARP,
  38         IRDMA_HMC_IW_APBVT_ENTRY,
  39         IRDMA_HMC_IW_MR,
  40         IRDMA_HMC_IW_XF,
  41         IRDMA_HMC_IW_XFFL,
  42         IRDMA_HMC_IW_Q1,
  43         IRDMA_HMC_IW_Q1FL,
  44         IRDMA_HMC_IW_TIMER,
  45         IRDMA_HMC_IW_FSIMC,
  46         IRDMA_HMC_IW_FSIAV,
  47         IRDMA_HMC_IW_RRF,
  48         IRDMA_HMC_IW_RRFFL,
  49         IRDMA_HMC_IW_HDR,
  50         IRDMA_HMC_IW_MD,
  51         IRDMA_HMC_IW_OOISC,
  52         IRDMA_HMC_IW_OOISCFFL,
  53 };
  54
  55 /**
  56  * irdma_iwarp_ce_handler - handle iwarp completions
  57  * @iwcq: iwarp cq receiving event
  58  */
  59 static void irdma_iwarp_ce_handler(struct irdma_sc_cq *iwcq)
  60 {
  61         struct irdma_cq *cq = iwcq->back_cq;
  62
  63         if (!cq->user_mode)
  64                 cq->armed = false;
  65         if (cq->ibcq.comp_handler)
  66                 cq->ibcq.comp_handler(&cq->ibcq, cq->ibcq.cq_context);
  67 }
  68
  69 /**
  70  * irdma_puda_ce_handler - handle puda completion events
  71  * @rf: RDMA PCI function
  72  * @cq: puda completion q for event
  73  */
  74 static void irdma_puda_ce_handler(struct irdma_pci_f *rf,
  75                                   struct irdma_sc_cq *cq)
  76 {
  77         struct irdma_sc_dev *dev = &rf->sc_dev;
  78         enum irdma_status_code status;
  79         u32 compl_error;
  80
  81         do {
  82                 status = irdma_puda_poll_cmpl(dev, cq, &compl_error);
  83                 if (status == IRDMA_ERR_Q_EMPTY)
  84                         break;
  85                 if (status) {
  86                         ibdev_dbg(to_ibdev(dev), "ERR: puda status = %d\n", status);
  87                         break;
  88                 }
  89                 if (compl_error) {
  90                         ibdev_dbg(to_ibdev(dev), "ERR: puda compl_err  =0x%x\n",
  91                                   compl_error);
  92                         break;
  93                 }
  94         } while (1);
  95
  96         irdma_sc_ccq_arm(cq);
  97 }
  98
  99 /**
 100  * irdma_process_ceq - handle ceq for completions
 101  * @rf: RDMA PCI function
 102  * @ceq: ceq having cq for completion
 103  */
 104 static void irdma_process_ceq(struct irdma_pci_f *rf, struct irdma_ceq *ceq)
 105 {
 106         struct irdma_sc_dev *dev = &rf->sc_dev;
 107         struct irdma_sc_ceq *sc_ceq;
 108         struct irdma_sc_cq *cq;
 109         unsigned long flags;
 110
 111         sc_ceq = &ceq->sc_ceq;
 112         do {
 113                 spin_lock_irqsave(&ceq->ce_lock, flags);
 114                 cq = irdma_sc_process_ceq(dev, sc_ceq);
 115                 if (!cq) {
 116                         spin_unlock_irqrestore(&ceq->ce_lock, flags);
 117                         break;
 118                 }
 119
 120                 if (cq->cq_type == IRDMA_CQ_TYPE_IWARP)
 121                         irdma_iwarp_ce_handler(cq);
 122
 123                 spin_unlock_irqrestore(&ceq->ce_lock, flags);
 124
 125                 if (cq->cq_type == IRDMA_CQ_TYPE_CQP)
 126                         queue_work(rf->cqp_cmpl_wq, &rf->cqp_cmpl_work);
 127                 else if (cq->cq_type == IRDMA_CQ_TYPE_ILQ ||
 128                          cq->cq_type == IRDMA_CQ_TYPE_IEQ)
 129                         irdma_puda_ce_handler(rf, cq);
 130         } while (1);
 131 }
 132
 133 static void irdma_set_flush_fields(struct irdma_sc_qp *qp,
 134                                    struct irdma_aeqe_info *info)
 135 {
 136         qp->sq_flush_code = info->sq;
 137         qp->rq_flush_code = info->rq;
 138         qp->event_type = IRDMA_QP_EVENT_CATASTROPHIC;
 139
 140         switch (info->ae_id) {
 141         case IRDMA_AE_AMP_UNALLOCATED_STAG:
 142         case IRDMA_AE_AMP_BOUNDS_VIOLATION:
 143         case IRDMA_AE_AMP_INVALID_STAG:
 144                 qp->event_type = IRDMA_QP_EVENT_ACCESS_ERR;
 145                 fallthrough;
 146         case IRDMA_AE_AMP_BAD_PD:
 147         case IRDMA_AE_UDA_XMIT_BAD_PD:
 148                 qp->flush_code = FLUSH_PROT_ERR;
 149                 break;
 150         case IRDMA_AE_AMP_BAD_QP:
 151         case IRDMA_AE_WQE_UNEXPECTED_OPCODE:
 152                 qp->flush_code = FLUSH_LOC_QP_OP_ERR;
 153                 break;
 154         case IRDMA_AE_AMP_BAD_STAG_KEY:
 155         case IRDMA_AE_AMP_BAD_STAG_INDEX:
 156         case IRDMA_AE_AMP_TO_WRAP:
 157         case IRDMA_AE_AMP_RIGHTS_VIOLATION:
 158         case IRDMA_AE_AMP_INVALIDATE_NO_REMOTE_ACCESS_RIGHTS:
 159         case IRDMA_AE_PRIV_OPERATION_DENIED:
 160         case IRDMA_AE_IB_INVALID_REQUEST:
 161         case IRDMA_AE_IB_REMOTE_ACCESS_ERROR:
 162                 qp->flush_code = FLUSH_REM_ACCESS_ERR;
 163                 qp->event_type = IRDMA_QP_EVENT_ACCESS_ERR;
 164                 break;
 165         case IRDMA_AE_LLP_SEGMENT_TOO_SMALL:
 166         case IRDMA_AE_DDP_UBE_DDP_MESSAGE_TOO_LONG_FOR_AVAILABLE_BUFFER:
 167         case IRDMA_AE_UDA_XMIT_DGRAM_TOO_LONG:
 168         case IRDMA_AE_UDA_XMIT_DGRAM_TOO_SHORT:
 169         case IRDMA_AE_UDA_L4LEN_INVALID:
 170         case IRDMA_AE_ROCE_RSP_LENGTH_ERROR:
 171                 qp->flush_code = FLUSH_LOC_LEN_ERR;
 172                 break;
 173         case IRDMA_AE_LCE_QP_CATASTROPHIC:
 174                 qp->flush_code = FLUSH_FATAL_ERR;
 175                 break;
 176         case IRDMA_AE_DDP_UBE_INVALID_MO:
 177         case IRDMA_AE_IB_RREQ_AND_Q1_FULL:
 178         case IRDMA_AE_LLP_RECEIVED_MPA_CRC_ERROR:
 179                 qp->flush_code = FLUSH_GENERAL_ERR;
 180                 break;
 181         case IRDMA_AE_LLP_TOO_MANY_RETRIES:
 182                 qp->flush_code = FLUSH_RETRY_EXC_ERR;
 183                 break;
 184         case IRDMA_AE_AMP_MWBIND_INVALID_RIGHTS:
 185         case IRDMA_AE_AMP_MWBIND_BIND_DISABLED:
 186         case IRDMA_AE_AMP_MWBIND_INVALID_BOUNDS:
 187                 qp->flush_code = FLUSH_MW_BIND_ERR;
 188                 break;
 189         case IRDMA_AE_IB_REMOTE_OP_ERROR:
 190                 qp->flush_code = FLUSH_REM_OP_ERR;
 191                 break;
 192         default:
 193                 qp->flush_code = FLUSH_FATAL_ERR;
 194                 break;
 195         }
 196 }
 197
 198 /**
 199  * irdma_process_aeq - handle aeq events
 200  * @rf: RDMA PCI function
 201  */
 202 static void irdma_process_aeq(struct irdma_pci_f *rf)
 203 {
 204         struct irdma_sc_dev *dev = &rf->sc_dev;
 205         struct irdma_aeq *aeq = &rf->aeq;
 206         struct irdma_sc_aeq *sc_aeq = &aeq->sc_aeq;
 207         struct irdma_aeqe_info aeinfo;
 208         struct irdma_aeqe_info *info = &aeinfo;
 209         int ret;
 210         struct irdma_qp *iwqp = NULL;
 211         struct irdma_sc_cq *cq = NULL;
 212         struct irdma_cq *iwcq = NULL;
 213         struct irdma_sc_qp *qp = NULL;
 214         struct irdma_qp_host_ctx_info *ctx_info = NULL;
 215         struct irdma_device *iwdev = rf->iwdev;
 216         unsigned long flags;
 217
 218         u32 aeqcnt = 0;
 219
 220         if (!sc_aeq->size)
 221                 return;
 222
 223         do {
 224                 memset(info, 0, sizeof(*info));
 225                 ret = irdma_sc_get_next_aeqe(sc_aeq, info);
 226                 if (ret)
 227                         break;
 228
 229                 aeqcnt++;
 230                 ibdev_dbg(&iwdev->ibdev,
 231                           "AEQ: ae_id = 0x%x bool qp=%d qp_id = %d tcp_state=%d iwarp_state=%d ae_src=%d\n",
 232                           info->ae_id, info->qp, info->qp_cq_id, info->tcp_state,
 233                           info->iwarp_state, info->ae_src);
 234
 235                 if (info->qp) {
 236                         spin_lock_irqsave(&rf->qptable_lock, flags);
 237                         iwqp = rf->qp_table[info->qp_cq_id];
 238                         if (!iwqp) {
 239                                 spin_unlock_irqrestore(&rf->qptable_lock,
 240                                                        flags);
 241                                 if (info->ae_id == IRDMA_AE_QP_SUSPEND_COMPLETE) {
 242                                         atomic_dec(&iwdev->vsi.qp_suspend_reqs);
 243                                         wake_up(&iwdev->suspend_wq);
 244                                         continue;
 245                                 }
 246                                 ibdev_dbg(&iwdev->ibdev, "AEQ: qp_id %d is already freed\n",
 247                                           info->qp_cq_id);
 248                                 continue;
 249                         }
 250                         irdma_qp_add_ref(&iwqp->ibqp);
 251                         spin_unlock_irqrestore(&rf->qptable_lock, flags);
 252                         qp = &iwqp->sc_qp;
 253                         spin_lock_irqsave(&iwqp->lock, flags);
 254                         iwqp->hw_tcp_state = info->tcp_state;
 255                         iwqp->hw_iwarp_state = info->iwarp_state;
 256                         if (info->ae_id != IRDMA_AE_QP_SUSPEND_COMPLETE)
 257                                 iwqp->last_aeq = info->ae_id;
 258                         spin_unlock_irqrestore(&iwqp->lock, flags);
 259                         ctx_info = &iwqp->ctx_info;
 260                         if (rdma_protocol_roce(&iwqp->iwdev->ibdev, 1))
 261                                 ctx_info->roce_info->err_rq_idx_valid = true;
 262                         else
 263                                 ctx_info->iwarp_info->err_rq_idx_valid = true;
 264                 } else {
 265                         if (info->ae_id != IRDMA_AE_CQ_OPERATION_ERROR)
 266                                 continue;
 267                 }
 268
 269                 switch (info->ae_id) {
 270                         struct irdma_cm_node *cm_node;
 271                 case IRDMA_AE_LLP_CONNECTION_ESTABLISHED:
 272                         cm_node = iwqp->cm_node;
 273                         if (cm_node->accept_pend) {
 274                                 atomic_dec(&cm_node->listener->pend_accepts_cnt);
 275                                 cm_node->accept_pend = 0;
 276                         }
 277                         iwqp->rts_ae_rcvd = 1;
 278                         wake_up_interruptible(&iwqp->waitq);
 279                         break;
 280                 case IRDMA_AE_LLP_FIN_RECEIVED:
 281                 case IRDMA_AE_RDMAP_ROE_BAD_LLP_CLOSE:
 282                         if (qp->term_flags)
 283                                 break;
 284                         if (atomic_inc_return(&iwqp->close_timer_started) == 1) {
 285                                 iwqp->hw_tcp_state = IRDMA_TCP_STATE_CLOSE_WAIT;
 286                                 if (iwqp->hw_tcp_state == IRDMA_TCP_STATE_CLOSE_WAIT &&
 287                                     iwqp->ibqp_state == IB_QPS_RTS) {
 288                                         irdma_next_iw_state(iwqp,
 289                                                             IRDMA_QP_STATE_CLOSING,
 290                                                             0, 0, 0);
 291                                         irdma_cm_disconn(iwqp);
 292                                 }
 293                                 irdma_schedule_cm_timer(iwqp->cm_node,
 294                                                         (struct irdma_puda_buf *)iwqp,
 295                                                         IRDMA_TIMER_TYPE_CLOSE,
 296                                                         1, 0);
 297                         }
 298                         break;
 299                 case IRDMA_AE_LLP_CLOSE_COMPLETE:
 300                         if (qp->term_flags)
 301                                 irdma_terminate_done(qp, 0);
 302                         else
 303                                 irdma_cm_disconn(iwqp);
 304                         break;
 305                 case IRDMA_AE_BAD_CLOSE:
 306                 case IRDMA_AE_RESET_SENT:
 307                         irdma_next_iw_state(iwqp, IRDMA_QP_STATE_ERROR, 1, 0,
 308                                             0);
 309                         irdma_cm_disconn(iwqp);
 310                         break;
 311                 case IRDMA_AE_LLP_CONNECTION_RESET:
 312                         if (atomic_read(&iwqp->close_timer_started))
 313                                 break;
 314                         irdma_cm_disconn(iwqp);
 315                         break;
 316                 case IRDMA_AE_QP_SUSPEND_COMPLETE:
 317                         if (iwqp->iwdev->vsi.tc_change_pending) {
 318                                 atomic_dec(&iwqp->sc_qp.vsi->qp_suspend_reqs);
 319                                 wake_up(&iwqp->iwdev->suspend_wq);
 320                         }
 321                         break;
 322                 case IRDMA_AE_TERMINATE_SENT:
 323                         irdma_terminate_send_fin(qp);
 324                         break;
 325                 case IRDMA_AE_LLP_TERMINATE_RECEIVED:
 326                         irdma_terminate_received(qp, info);
 327                         break;
 328                 case IRDMA_AE_CQ_OPERATION_ERROR:
 329                         ibdev_err(&iwdev->ibdev,
 330                                   "Processing an iWARP related AE for CQ misc = 0x%04X\n",
 331                                   info->ae_id);
 332                         cq = (struct irdma_sc_cq *)(unsigned long)
 333                              info->compl_ctx;
 334
 335                         iwcq = cq->back_cq;
 336
 337                         if (iwcq->ibcq.event_handler) {
 338                                 struct ib_event ibevent;
 339
 340                                 ibevent.device = iwcq->ibcq.device;
 341                                 ibevent.event = IB_EVENT_CQ_ERR;
 342                                 ibevent.element.cq = &iwcq->ibcq;
 343                                 iwcq->ibcq.event_handler(&ibevent,
 344                                                          iwcq->ibcq.cq_context);
 345                         }
 346                         break;
 347                 case IRDMA_AE_RESET_NOT_SENT:
 348                 case IRDMA_AE_LLP_DOUBT_REACHABILITY:
 349                 case IRDMA_AE_RESOURCE_EXHAUSTION:
 350                         break;
 351                 case IRDMA_AE_PRIV_OPERATION_DENIED:
 352                 case IRDMA_AE_STAG_ZERO_INVALID:
 353                 case IRDMA_AE_IB_RREQ_AND_Q1_FULL:
 354                 case IRDMA_AE_DDP_UBE_INVALID_DDP_VERSION:
 355                 case IRDMA_AE_DDP_UBE_INVALID_MO:
 356                 case IRDMA_AE_DDP_UBE_INVALID_QN:
 357                 case IRDMA_AE_DDP_NO_L_BIT:
 358                 case IRDMA_AE_RDMAP_ROE_INVALID_RDMAP_VERSION:
 359                 case IRDMA_AE_RDMAP_ROE_UNEXPECTED_OPCODE:
 360                 case IRDMA_AE_ROE_INVALID_RDMA_READ_REQUEST:
 361                 case IRDMA_AE_ROE_INVALID_RDMA_WRITE_OR_READ_RESP:
 362                 case IRDMA_AE_INVALID_ARP_ENTRY:
 363                 case IRDMA_AE_INVALID_TCP_OPTION_RCVD:
 364                 case IRDMA_AE_STALE_ARP_ENTRY:
 365                 case IRDMA_AE_LLP_RECEIVED_MPA_CRC_ERROR:
 366                 case IRDMA_AE_LLP_SEGMENT_TOO_SMALL:
 367                 case IRDMA_AE_LLP_SYN_RECEIVED:
 368                 case IRDMA_AE_LLP_TOO_MANY_RETRIES:
 369                 case IRDMA_AE_LCE_QP_CATASTROPHIC:
 370                 case IRDMA_AE_LCE_FUNCTION_CATASTROPHIC:
 371                 case IRDMA_AE_LCE_CQ_CATASTROPHIC:
 372                 case IRDMA_AE_UDA_XMIT_DGRAM_TOO_LONG:
 373                         if (rdma_protocol_roce(&iwdev->ibdev, 1))
 374                                 ctx_info->roce_info->err_rq_idx_valid = false;
 375                         else
 376                                 ctx_info->iwarp_info->err_rq_idx_valid = false;
 377                         fallthrough;
 378                 default:
 379                         ibdev_err(&iwdev->ibdev, "abnormal ae_id = 0x%x bool qp=%d qp_id = %d\n",
 380                                   info->ae_id, info->qp, info->qp_cq_id);
 381                         if (rdma_protocol_roce(&iwdev->ibdev, 1)) {
 382                                 if (!info->sq && ctx_info->roce_info->err_rq_idx_valid) {
 383                                         ctx_info->roce_info->err_rq_idx = info->wqe_idx;
 384                                         irdma_sc_qp_setctx_roce(&iwqp->sc_qp, iwqp->host_ctx.va,
 385                                                                 ctx_info);
 386                                 }
 387                                 irdma_set_flush_fields(qp, info);
 388                                 irdma_cm_disconn(iwqp);
 389                                 break;
 390                         }
 391                         if (!info->sq && ctx_info->iwarp_info->err_rq_idx_valid) {
 392                                 ctx_info->iwarp_info->err_rq_idx = info->wqe_idx;
 393                                 ctx_info->tcp_info_valid = false;
 394                                 ctx_info->iwarp_info_valid = true;
 395                                 irdma_sc_qp_setctx(&iwqp->sc_qp, iwqp->host_ctx.va,
 396                                                    ctx_info);
 397                         }
 398                         if (iwqp->hw_iwarp_state != IRDMA_QP_STATE_RTS &&
 399                             iwqp->hw_iwarp_state != IRDMA_QP_STATE_TERMINATE) {
 400                                 irdma_next_iw_state(iwqp, IRDMA_QP_STATE_ERROR, 1, 0, 0);
 401                                 irdma_cm_disconn(iwqp);
 402                         } else {
 403                                 irdma_terminate_connection(qp, info);
 404                         }
 405                         break;
 406                 }
 407                 if (info->qp)
 408                         irdma_qp_rem_ref(&iwqp->ibqp);
 409         } while (1);
 410
 411         if (aeqcnt)
 412                 irdma_sc_repost_aeq_entries(dev, aeqcnt);
 413 }
 414
 415 /**
 416  * irdma_ena_intr - set up device interrupts
 417  * @dev: hardware control device structure
 418  * @msix_id: id of the interrupt to be enabled
 419  */
 420 static void irdma_ena_intr(struct irdma_sc_dev *dev, u32 msix_id)
 421 {
 422         dev->irq_ops->irdma_en_irq(dev, msix_id);
 423 }
 424
 425 /**
 426  * irdma_dpc - tasklet for aeq and ceq 0
 427  * @t: tasklet_struct ptr
 428  */
 429 static void irdma_dpc(struct tasklet_struct *t)
 430 {
 431         struct irdma_pci_f *rf = from_tasklet(rf, t, dpc_tasklet);
 432
 433         if (rf->msix_shared)
 434                 irdma_process_ceq(rf, rf->ceqlist);
 435         irdma_process_aeq(rf);
 436         irdma_ena_intr(&rf->sc_dev, rf->iw_msixtbl[0].idx);
 437 }
 438
 439 /**
 440  * irdma_ceq_dpc - dpc handler for CEQ
 441  * @t: tasklet_struct ptr
 442  */
 443 static void irdma_ceq_dpc(struct tasklet_struct *t)
 444 {
 445         struct irdma_ceq *iwceq = from_tasklet(iwceq, t, dpc_tasklet);
 446         struct irdma_pci_f *rf = iwceq->rf;
 447
 448         irdma_process_ceq(rf, iwceq);
 449         irdma_ena_intr(&rf->sc_dev, iwceq->msix_idx);
 450 }
 451
 452 /**
 453  * irdma_save_msix_info - copy msix vector information to iwarp device
 454  * @rf: RDMA PCI function
 455  *
 456  * Allocate iwdev msix table and copy the msix info to the table
 457  * Return 0 if successful, otherwise return error
 458  */
 459 static enum irdma_status_code irdma_save_msix_info(struct irdma_pci_f *rf)
 460 {
 461         struct irdma_qvlist_info *iw_qvlist;
 462         struct irdma_qv_info *iw_qvinfo;
 463         struct msix_entry *pmsix;
 464         u32 ceq_idx;
 465         u32 i;
 466         size_t size;
 467
 468         if (!rf->msix_count)
 469                 return IRDMA_ERR_NO_INTR;
 470
 471         size = sizeof(struct irdma_msix_vector) * rf->msix_count;
 472         size += struct_size(iw_qvlist, qv_info, rf->msix_count);
 473         rf->iw_msixtbl = kzalloc(size, GFP_KERNEL);
 474         if (!rf->iw_msixtbl)
 475                 return IRDMA_ERR_NO_MEMORY;
 476
 477         rf->iw_qvlist = (struct irdma_qvlist_info *)
 478                         (&rf->iw_msixtbl[rf->msix_count]);
 479         iw_qvlist = rf->iw_qvlist;
 480         iw_qvinfo = iw_qvlist->qv_info;
 481         iw_qvlist->num_vectors = rf->msix_count;
 482         if (rf->msix_count <= num_online_cpus())
 483                 rf->msix_shared = true;
 484
 485         pmsix = rf->msix_entries;
 486         for (i = 0, ceq_idx = 0; i < rf->msix_count; i++, iw_qvinfo++) {
 487                 rf->iw_msixtbl[i].idx = pmsix->entry;
 488                 rf->iw_msixtbl[i].irq = pmsix->vector;
 489                 rf->iw_msixtbl[i].cpu_affinity = ceq_idx;
 490                 if (!i) {
 491                         iw_qvinfo->aeq_idx = 0;
 492                         if (rf->msix_shared)
 493                                 iw_qvinfo->ceq_idx = ceq_idx++;
 494                         else
 495                                 iw_qvinfo->ceq_idx = IRDMA_Q_INVALID_IDX;
 496                 } else {
 497                         iw_qvinfo->aeq_idx = IRDMA_Q_INVALID_IDX;
 498                         iw_qvinfo->ceq_idx = ceq_idx++;
 499                 }
 500                 iw_qvinfo->itr_idx = 3;
 501                 iw_qvinfo->v_idx = rf->iw_msixtbl[i].idx;
 502                 pmsix++;
 503         }
 504
 505         return 0;
 506 }
 507
 508 /**
 509  * irdma_irq_handler - interrupt handler for aeq and ceq0
 510  * @irq: Interrupt request number
 511  * @data: RDMA PCI function
 512  */
 513 static irqreturn_t irdma_irq_handler(int irq, void *data)
 514 {
 515         struct irdma_pci_f *rf = data;
 516
 517         tasklet_schedule(&rf->dpc_tasklet);
 518
 519         return IRQ_HANDLED;
 520 }
 521
 522 /**
 523  * irdma_ceq_handler - interrupt handler for ceq
 524  * @irq: interrupt request number
 525  * @data: ceq pointer
 526  */
 527 static irqreturn_t irdma_ceq_handler(int irq, void *data)
 528 {
 529         struct irdma_ceq *iwceq = data;
 530
 531         if (iwceq->irq != irq)
 532                 ibdev_err(to_ibdev(&iwceq->rf->sc_dev), "expected irq = %d received irq = %d\n",
 533                           iwceq->irq, irq);
 534         tasklet_schedule(&iwceq->dpc_tasklet);
 535
 536         return IRQ_HANDLED;
 537 }
 538
 539 /**
 540  * irdma_destroy_irq - destroy device interrupts
 541  * @rf: RDMA PCI function
 542  * @msix_vec: msix vector to disable irq
 543  * @dev_id: parameter to pass to free_irq (used during irq setup)
 544  *
 545  * The function is called when destroying aeq/ceq
 546  */
 547 static void irdma_destroy_irq(struct irdma_pci_f *rf,
 548                               struct irdma_msix_vector *msix_vec, void *dev_id)
 549 {
 550         struct irdma_sc_dev *dev = &rf->sc_dev;
 551
 552         dev->irq_ops->irdma_dis_irq(dev, msix_vec->idx);
 553         irq_update_affinity_hint(msix_vec->irq, NULL);
 554         free_irq(msix_vec->irq, dev_id);
 555 }
 556
 557 /**
 558  * irdma_destroy_cqp  - destroy control qp
 559  * @rf: RDMA PCI function
 560  * @free_hwcqp: 1 if hw cqp should be freed
 561  *
 562  * Issue destroy cqp request and
 563  * free the resources associated with the cqp
 564  */
 565 static void irdma_destroy_cqp(struct irdma_pci_f *rf, bool free_hwcqp)
 566 {
 567         enum irdma_status_code status = 0;
 568         struct irdma_sc_dev *dev = &rf->sc_dev;
 569         struct irdma_cqp *cqp = &rf->cqp;
 570
 571         if (rf->cqp_cmpl_wq)
 572                 destroy_workqueue(rf->cqp_cmpl_wq);
 573         if (free_hwcqp)
 574                 status = irdma_sc_cqp_destroy(dev->cqp);
 575         if (status)
 576                 ibdev_dbg(to_ibdev(dev), "ERR: Destroy CQP failed %d\n", status);
 577
 578         irdma_cleanup_pending_cqp_op(rf);
 579         dma_free_coherent(dev->hw->device, cqp->sq.size, cqp->sq.va,
 580                           cqp->sq.pa);
 581         cqp->sq.va = NULL;
 582         kfree(cqp->scratch_array);
 583         cqp->scratch_array = NULL;
 584         kfree(cqp->cqp_requests);
 585         cqp->cqp_requests = NULL;
 586 }
 587
 588 static void irdma_destroy_virt_aeq(struct irdma_pci_f *rf)
 589 {
 590         struct irdma_aeq *aeq = &rf->aeq;
 591         u32 pg_cnt = DIV_ROUND_UP(aeq->mem.size, PAGE_SIZE);
 592         dma_addr_t *pg_arr = (dma_addr_t *)aeq->palloc.level1.addr;
 593
 594         irdma_unmap_vm_page_list(&rf->hw, pg_arr, pg_cnt);
 595         irdma_free_pble(rf->pble_rsrc, &aeq->palloc);
 596         vfree(aeq->mem.va);
 597 }
 598
 599 /**
 600  * irdma_destroy_aeq - destroy aeq
 601  * @rf: RDMA PCI function
 602  *
 603  * Issue a destroy aeq request and
 604  * free the resources associated with the aeq
 605  * The function is called during driver unload
 606  */
 607 static void irdma_destroy_aeq(struct irdma_pci_f *rf)
 608 {
 609         enum irdma_status_code status = IRDMA_ERR_NOT_READY;
 610         struct irdma_sc_dev *dev = &rf->sc_dev;
 611         struct irdma_aeq *aeq = &rf->aeq;
 612
 613         if (!rf->msix_shared) {
 614                 rf->sc_dev.irq_ops->irdma_cfg_aeq(&rf->sc_dev, rf->iw_msixtbl->idx, false);
 615                 irdma_destroy_irq(rf, rf->iw_msixtbl, rf);
 616         }
 617         if (rf->reset)
 618                 goto exit;
 619
 620         aeq->sc_aeq.size = 0;
 621         status = irdma_cqp_aeq_cmd(dev, &aeq->sc_aeq, IRDMA_OP_AEQ_DESTROY);
 622         if (status)
 623                 ibdev_dbg(to_ibdev(dev), "ERR: Destroy AEQ failed %d\n", status);
 624
 625 exit:
 626         if (aeq->virtual_map) {
 627                 irdma_destroy_virt_aeq(rf);
 628         } else {
 629                 dma_free_coherent(dev->hw->device, aeq->mem.size, aeq->mem.va,
 630                                   aeq->mem.pa);
 631                 aeq->mem.va = NULL;
 632         }
 633 }
 634
 635 /**
 636  * irdma_destroy_ceq - destroy ceq
 637  * @rf: RDMA PCI function
 638  * @iwceq: ceq to be destroyed
 639  *
 640  * Issue a destroy ceq request and
 641  * free the resources associated with the ceq
 642  */
 643 static void irdma_destroy_ceq(struct irdma_pci_f *rf, struct irdma_ceq *iwceq)
 644 {
 645         enum irdma_status_code status;
 646         struct irdma_sc_dev *dev = &rf->sc_dev;
 647
 648         if (rf->reset)
 649                 goto exit;
 650
 651         status = irdma_sc_ceq_destroy(&iwceq->sc_ceq, 0, 1);
 652         if (status) {
 653                 ibdev_dbg(to_ibdev(dev), "ERR: CEQ destroy command failed %d\n", status);
 654                 goto exit;
 655         }
 656
 657         status = irdma_sc_cceq_destroy_done(&iwceq->sc_ceq);
 658         if (status)
 659                 ibdev_dbg(to_ibdev(dev), "ERR: CEQ destroy completion failed %d\n",
 660                           status);
 661 exit:
 662         dma_free_coherent(dev->hw->device, iwceq->mem.size, iwceq->mem.va,
 663                           iwceq->mem.pa);
 664         iwceq->mem.va = NULL;
 665 }
 666
 667 /**
 668  * irdma_del_ceq_0 - destroy ceq 0
 669  * @rf: RDMA PCI function
 670  *
 671  * Disable the ceq 0 interrupt and destroy the ceq 0
 672  */
 673 static void irdma_del_ceq_0(struct irdma_pci_f *rf)
 674 {
 675         struct irdma_ceq *iwceq = rf->ceqlist;
 676         struct irdma_msix_vector *msix_vec;
 677
 678         if (rf->msix_shared) {
 679                 msix_vec = &rf->iw_msixtbl[0];
 680                 rf->sc_dev.irq_ops->irdma_cfg_ceq(&rf->sc_dev,
 681                                                   msix_vec->ceq_id,
 682                                                   msix_vec->idx, false);
 683                 irdma_destroy_irq(rf, msix_vec, rf);
 684         } else {
 685                 msix_vec = &rf->iw_msixtbl[1];
 686                 irdma_destroy_irq(rf, msix_vec, iwceq);
 687         }
 688
 689         irdma_destroy_ceq(rf, iwceq);
 690         rf->sc_dev.ceq_valid = false;
 691         rf->ceqs_count = 0;
 692 }
 693
 694 /**
 695  * irdma_del_ceqs - destroy all ceq's except CEQ 0
 696  * @rf: RDMA PCI function
 697  *
 698  * Go through all of the device ceq's, except 0, and for each
 699  * ceq disable the ceq interrupt and destroy the ceq
 700  */
 701 static void irdma_del_ceqs(struct irdma_pci_f *rf)
 702 {
 703         struct irdma_ceq *iwceq = &rf->ceqlist[1];
 704         struct irdma_msix_vector *msix_vec;
 705         u32 i = 0;
 706
 707         if (rf->msix_shared)
 708                 msix_vec = &rf->iw_msixtbl[1];
 709         else
 710                 msix_vec = &rf->iw_msixtbl[2];
 711
 712         for (i = 1; i < rf->ceqs_count; i++, msix_vec++, iwceq++) {
 713                 rf->sc_dev.irq_ops->irdma_cfg_ceq(&rf->sc_dev, msix_vec->ceq_id,
 714                                                   msix_vec->idx, false);
 715                 irdma_destroy_irq(rf, msix_vec, iwceq);
 716                 irdma_cqp_ceq_cmd(&rf->sc_dev, &iwceq->sc_ceq,
 717                                   IRDMA_OP_CEQ_DESTROY);
 718                 dma_free_coherent(rf->sc_dev.hw->device, iwceq->mem.size,
 719                                   iwceq->mem.va, iwceq->mem.pa);
 720                 iwceq->mem.va = NULL;
 721         }
 722         rf->ceqs_count = 1;
 723 }
 724
 725 /**
 726  * irdma_destroy_ccq - destroy control cq
 727  * @rf: RDMA PCI function
 728  *
 729  * Issue destroy ccq request and
 730  * free the resources associated with the ccq
 731  */
 732 static void irdma_destroy_ccq(struct irdma_pci_f *rf)
 733 {
 734         struct irdma_sc_dev *dev = &rf->sc_dev;
 735         struct irdma_ccq *ccq = &rf->ccq;
 736         enum irdma_status_code status = 0;
 737
 738         if (!rf->reset)
 739                 status = irdma_sc_ccq_destroy(dev->ccq, 0, true);
 740         if (status)
 741                 ibdev_dbg(to_ibdev(dev), "ERR: CCQ destroy failed %d\n", status);
 742         dma_free_coherent(dev->hw->device, ccq->mem_cq.size, ccq->mem_cq.va,
 743                           ccq->mem_cq.pa);
 744         ccq->mem_cq.va = NULL;
 745 }
 746
 747 /**
 748  * irdma_close_hmc_objects_type - delete hmc objects of a given type
 749  * @dev: iwarp device
 750  * @obj_type: the hmc object type to be deleted
 751  * @hmc_info: host memory info struct
 752  * @privileged: permission to close HMC objects
 753  * @reset: true if called before reset
 754  */
 755 static void irdma_close_hmc_objects_type(struct irdma_sc_dev *dev,
 756                                          enum irdma_hmc_rsrc_type obj_type,
 757                                          struct irdma_hmc_info *hmc_info,
 758                                          bool privileged, bool reset)
 759 {
 760         struct irdma_hmc_del_obj_info info = {};
 761
 762         info.hmc_info = hmc_info;
 763         info.rsrc_type = obj_type;
 764         info.count = hmc_info->hmc_obj[obj_type].cnt;
 765         info.privileged = privileged;
 766         if (irdma_sc_del_hmc_obj(dev, &info, reset))
 767                 ibdev_dbg(to_ibdev(dev), "ERR: del HMC obj of type %d failed\n",
 768                           obj_type);
 769 }
 770
 771 /**
 772  * irdma_del_hmc_objects - remove all device hmc objects
 773  * @dev: iwarp device
 774  * @hmc_info: hmc_info to free
 775  * @privileged: permission to delete HMC objects
 776  * @reset: true if called before reset
 777  * @vers: hardware version
 778  */
 779 static void irdma_del_hmc_objects(struct irdma_sc_dev *dev,
 780                                   struct irdma_hmc_info *hmc_info, bool privileged,
 781                                   bool reset, enum irdma_vers vers)
 782 {
 783         unsigned int i;
 784
 785         for (i = 0; i < IW_HMC_OBJ_TYPE_NUM; i++) {
 786                 if (dev->hmc_info->hmc_obj[iw_hmc_obj_types[i]].cnt)
 787                         irdma_close_hmc_objects_type(dev, iw_hmc_obj_types[i],
 788                                                      hmc_info, privileged, reset);
 789                 if (vers == IRDMA_GEN_1 && i == IRDMA_HMC_IW_TIMER)
 790                         break;
 791         }
 792 }
 793
 794 /**
 795  * irdma_create_hmc_obj_type - create hmc object of a given type
 796  * @dev: hardware control device structure
 797  * @info: information for the hmc object to create
 798  */
 799 static enum irdma_status_code
 800 irdma_create_hmc_obj_type(struct irdma_sc_dev *dev,
 801                           struct irdma_hmc_create_obj_info *info)
 802 {
 803         return irdma_sc_create_hmc_obj(dev, info);
 804 }
 805
 806 /**
 807  * irdma_create_hmc_objs - create all hmc objects for the device
 808  * @rf: RDMA PCI function
 809  * @privileged: permission to create HMC objects
 810  * @vers: HW version
 811  *
 812  * Create the device hmc objects and allocate hmc pages
 813  * Return 0 if successful, otherwise clean up and return error
 814  */
 815 static enum irdma_status_code
 816 irdma_create_hmc_objs(struct irdma_pci_f *rf, bool privileged, enum irdma_vers vers)
 817 {
 818         struct irdma_sc_dev *dev = &rf->sc_dev;
 819         struct irdma_hmc_create_obj_info info = {};
 820         enum irdma_status_code status = 0;
 821         int i;
 822
 823         info.hmc_info = dev->hmc_info;
 824         info.privileged = privileged;
 825         info.entry_type = rf->sd_type;
 826
 827         for (i = 0; i < IW_HMC_OBJ_TYPE_NUM; i++) {
 828                 if (dev->hmc_info->hmc_obj[iw_hmc_obj_types[i]].cnt) {
 829                         info.rsrc_type = iw_hmc_obj_types[i];
 830                         info.count = dev->hmc_info->hmc_obj[info.rsrc_type].cnt;
 831                         info.add_sd_cnt = 0;
 832                         status = irdma_create_hmc_obj_type(dev, &info);
 833                         if (status) {
 834                                 ibdev_dbg(to_ibdev(dev),
 835                                           "ERR: create obj type %d status = %d\n",
 836                                           iw_hmc_obj_types[i], status);
 837                                 break;
 838                         }
 839                 }
 840                 if (vers == IRDMA_GEN_1 && i == IRDMA_HMC_IW_TIMER)
 841                         break;
 842         }
 843
 844         if (!status)
 845                 return irdma_sc_static_hmc_pages_allocated(dev->cqp, 0, dev->hmc_fn_id,
 846                                                            true, true);
 847
 848         while (i) {
 849                 i--;
 850                 /* destroy the hmc objects of a given type */
 851                 if (dev->hmc_info->hmc_obj[iw_hmc_obj_types[i]].cnt)
 852                         irdma_close_hmc_objects_type(dev, iw_hmc_obj_types[i],
 853                                                      dev->hmc_info, privileged,
 854                                                      false);
 855         }
 856
 857         return status;
 858 }
 859
 860 /**
 861  * irdma_obj_aligned_mem - get aligned memory from device allocated memory
 862  * @rf: RDMA PCI function
 863  * @memptr: points to the memory addresses
 864  * @size: size of memory needed
 865  * @mask: mask for the aligned memory
 866  *
 867  * Get aligned memory of the requested size and
 868  * update the memptr to point to the new aligned memory
 869  * Return 0 if successful, otherwise return no memory error
 870  */
 871 static enum irdma_status_code
 872 irdma_obj_aligned_mem(struct irdma_pci_f *rf, struct irdma_dma_mem *memptr,
 873                       u32 size, u32 mask)
 874 {
 875         unsigned long va, newva;
 876         unsigned long extra;
 877
 878         va = (unsigned long)rf->obj_next.va;
 879         newva = va;
 880         if (mask)
 881                 newva = ALIGN(va, (unsigned long)mask + 1ULL);
 882         extra = newva - va;
 883         memptr->va = (u8 *)va + extra;
 884         memptr->pa = rf->obj_next.pa + extra;
 885         memptr->size = size;
 886         if (((u8 *)memptr->va + size) > ((u8 *)rf->obj_mem.va + rf->obj_mem.size))
 887                 return IRDMA_ERR_NO_MEMORY;
 888
 889         rf->obj_next.va = (u8 *)memptr->va + size;
 890         rf->obj_next.pa = memptr->pa + size;
 891
 892         return 0;
 893 }
 894
 895 /**
 896  * irdma_create_cqp - create control qp
 897  * @rf: RDMA PCI function
 898  *
 899  * Return 0, if the cqp and all the resources associated with it
 900  * are successfully created, otherwise return error
 901  */
 902 static enum irdma_status_code irdma_create_cqp(struct irdma_pci_f *rf)
 903 {
 904         enum irdma_status_code status;
 905         u32 sqsize = IRDMA_CQP_SW_SQSIZE_2048;
 906         struct irdma_dma_mem mem;
 907         struct irdma_sc_dev *dev = &rf->sc_dev;
 908         struct irdma_cqp_init_info cqp_init_info = {};
 909         struct irdma_cqp *cqp = &rf->cqp;
 910         u16 maj_err, min_err;
 911         int i;
 912
 913         cqp->cqp_requests = kcalloc(sqsize, sizeof(*cqp->cqp_requests), GFP_KERNEL);
 914         if (!cqp->cqp_requests)
 915                 return IRDMA_ERR_NO_MEMORY;
 916
 917         cqp->scratch_array = kcalloc(sqsize, sizeof(*cqp->scratch_array), GFP_KERNEL);
 918         if (!cqp->scratch_array) {
 919                 kfree(cqp->cqp_requests);
 920                 return IRDMA_ERR_NO_MEMORY;
 921         }
 922
 923         dev->cqp = &cqp->sc_cqp;
 924         dev->cqp->dev = dev;
 925         cqp->sq.size = ALIGN(sizeof(struct irdma_cqp_sq_wqe) * sqsize,
 926                              IRDMA_CQP_ALIGNMENT);
 927         cqp->sq.va = dma_alloc_coherent(dev->hw->device, cqp->sq.size,
 928                                         &cqp->sq.pa, GFP_KERNEL);
 929         if (!cqp->sq.va) {
 930                 kfree(cqp->scratch_array);
 931                 kfree(cqp->cqp_requests);
 932                 return IRDMA_ERR_NO_MEMORY;
 933         }
 934
 935         status = irdma_obj_aligned_mem(rf, &mem, sizeof(struct irdma_cqp_ctx),
 936                                        IRDMA_HOST_CTX_ALIGNMENT_M);
 937         if (status)
 938                 goto exit;
 939
 940         dev->cqp->host_ctx_pa = mem.pa;
 941         dev->cqp->host_ctx = mem.va;
 942         /* populate the cqp init info */
 943         cqp_init_info.dev = dev;
 944         cqp_init_info.sq_size = sqsize;
 945         cqp_init_info.sq = cqp->sq.va;
 946         cqp_init_info.sq_pa = cqp->sq.pa;
 947         cqp_init_info.host_ctx_pa = mem.pa;
 948         cqp_init_info.host_ctx = mem.va;
 949         cqp_init_info.hmc_profile = rf->rsrc_profile;
 950         cqp_init_info.scratch_array = cqp->scratch_array;
 951         cqp_init_info.protocol_used = rf->protocol_used;
 952
 953         switch (rf->rdma_ver) {
 954         case IRDMA_GEN_1:
 955                 cqp_init_info.hw_maj_ver = IRDMA_CQPHC_HW_MAJVER_GEN_1;
 956                 break;
 957         case IRDMA_GEN_2:
 958                 cqp_init_info.hw_maj_ver = IRDMA_CQPHC_HW_MAJVER_GEN_2;
 959                 break;
 960         }
 961         status = irdma_sc_cqp_init(dev->cqp, &cqp_init_info);
 962         if (status) {
 963                 ibdev_dbg(to_ibdev(dev), "ERR: cqp init status %d\n", status);
 964                 goto exit;
 965         }
 966
 967         spin_lock_init(&cqp->req_lock);
 968         spin_lock_init(&cqp->compl_lock);
 969
 970         status = irdma_sc_cqp_create(dev->cqp, &maj_err, &min_err);
 971         if (status) {
 972                 ibdev_dbg(to_ibdev(dev),
 973                           "ERR: cqp create failed - status %d maj_err %d min_err %d\n",
 974                           status, maj_err, min_err);
 975                 goto exit;
 976         }
 977
 978         INIT_LIST_HEAD(&cqp->cqp_avail_reqs);
 979         INIT_LIST_HEAD(&cqp->cqp_pending_reqs);
 980
 981         /* init the waitqueue of the cqp_requests and add them to the list */
 982         for (i = 0; i < sqsize; i++) {
 983                 init_waitqueue_head(&cqp->cqp_requests[i].waitq);
 984                 list_add_tail(&cqp->cqp_requests[i].list, &cqp->cqp_avail_reqs);
 985         }
 986         init_waitqueue_head(&cqp->remove_wq);
 987         return 0;
 988
 989 exit:
 990         irdma_destroy_cqp(rf, false);
 991
 992         return status;
 993 }
 994
 995 /**
 996  * irdma_create_ccq - create control cq
 997  * @rf: RDMA PCI function
 998  *
 999  * Return 0, if the ccq and the resources associated with it
1000  * are successfully created, otherwise return error
1001  */
1002 static enum irdma_status_code irdma_create_ccq(struct irdma_pci_f *rf)
1003 {
1004         struct irdma_sc_dev *dev = &rf->sc_dev;
1005         enum irdma_status_code status;
1006         struct irdma_ccq_init_info info = {};
1007         struct irdma_ccq *ccq = &rf->ccq;
1008
1009         dev->ccq = &ccq->sc_cq;
1010         dev->ccq->dev = dev;
1011         info.dev = dev;
1012         ccq->shadow_area.size = sizeof(struct irdma_cq_shadow_area);
1013         ccq->mem_cq.size = ALIGN(sizeof(struct irdma_cqe) * IW_CCQ_SIZE,
1014                                  IRDMA_CQ0_ALIGNMENT);
1015         ccq->mem_cq.va = dma_alloc_coherent(dev->hw->device, ccq->mem_cq.size,
1016                                             &ccq->mem_cq.pa, GFP_KERNEL);
1017         if (!ccq->mem_cq.va)
1018                 return IRDMA_ERR_NO_MEMORY;
1019
1020         status = irdma_obj_aligned_mem(rf, &ccq->shadow_area,
1021                                        ccq->shadow_area.size,
1022                                        IRDMA_SHADOWAREA_M);
1023         if (status)
1024                 goto exit;
1025
1026         ccq->sc_cq.back_cq = ccq;
1027         /* populate the ccq init info */
1028         info.cq_base = ccq->mem_cq.va;
1029         info.cq_pa = ccq->mem_cq.pa;
1030         info.num_elem = IW_CCQ_SIZE;
1031         info.shadow_area = ccq->shadow_area.va;
1032         info.shadow_area_pa = ccq->shadow_area.pa;
1033         info.ceqe_mask = false;
1034         info.ceq_id_valid = true;
1035         info.shadow_read_threshold = 16;
1036         info.vsi = &rf->default_vsi;
1037         status = irdma_sc_ccq_init(dev->ccq, &info);
1038         if (!status)
1039                 status = irdma_sc_ccq_create(dev->ccq, 0, true, true);
1040 exit:
1041         if (status) {
1042                 dma_free_coherent(dev->hw->device, ccq->mem_cq.size,
1043                                   ccq->mem_cq.va, ccq->mem_cq.pa);
1044                 ccq->mem_cq.va = NULL;
1045         }
1046
1047         return status;
1048 }
1049
1050 /**
1051  * irdma_alloc_set_mac - set up a mac address table entry
1052  * @iwdev: irdma device
1053  *
1054  * Allocate a mac ip entry and add it to the hw table Return 0
1055  * if successful, otherwise return error
1056  */
1057 static enum irdma_status_code irdma_alloc_set_mac(struct irdma_device *iwdev)
1058 {
1059         enum irdma_status_code status;
1060
1061         status = irdma_alloc_local_mac_entry(iwdev->rf,
1062                                              &iwdev->mac_ip_table_idx);
1063         if (!status) {
1064                 status = irdma_add_local_mac_entry(iwdev->rf,
1065                                                    (const u8 *)iwdev->netdev->dev_addr,
1066                                                    (u8)iwdev->mac_ip_table_idx);
1067                 if (status)
1068                         irdma_del_local_mac_entry(iwdev->rf,
1069                                                   (u8)iwdev->mac_ip_table_idx);
1070         }
1071         return status;
1072 }
1073
1074 /**
1075  * irdma_cfg_ceq_vector - set up the msix interrupt vector for
1076  * ceq
1077  * @rf: RDMA PCI function
1078  * @iwceq: ceq associated with the vector
1079  * @ceq_id: the id number of the iwceq
1080  * @msix_vec: interrupt vector information
1081  *
1082  * Allocate interrupt resources and enable irq handling
1083  * Return 0 if successful, otherwise return error
1084  */
1085 static enum irdma_status_code
1086 irdma_cfg_ceq_vector(struct irdma_pci_f *rf, struct irdma_ceq *iwceq,
1087                      u32 ceq_id, struct irdma_msix_vector *msix_vec)
1088 {
1089         int status;
1090
1091         if (rf->msix_shared && !ceq_id) {
1092                 tasklet_setup(&rf->dpc_tasklet, irdma_dpc);
1093                 status = request_irq(msix_vec->irq, irdma_irq_handler, 0,
1094                                      "AEQCEQ", rf);
1095         } else {
1096                 tasklet_setup(&iwceq->dpc_tasklet, irdma_ceq_dpc);
1097
1098                 status = request_irq(msix_vec->irq, irdma_ceq_handler, 0,
1099                                      "CEQ", iwceq);
1100         }
1101         cpumask_clear(&msix_vec->mask);
1102         cpumask_set_cpu(msix_vec->cpu_affinity, &msix_vec->mask);
1103         irq_update_affinity_hint(msix_vec->irq, &msix_vec->mask);
1104         if (status) {
1105                 ibdev_dbg(&rf->iwdev->ibdev, "ERR: ceq irq config fail\n");
1106                 return IRDMA_ERR_CFG;
1107         }
1108
1109         msix_vec->ceq_id = ceq_id;
1110         rf->sc_dev.irq_ops->irdma_cfg_ceq(&rf->sc_dev, ceq_id, msix_vec->idx, true);
1111
1112         return 0;
1113 }
1114
1115 /**
1116  * irdma_cfg_aeq_vector - set up the msix vector for aeq
1117  * @rf: RDMA PCI function
1118  *
1119  * Allocate interrupt resources and enable irq handling
1120  * Return 0 if successful, otherwise return error
1121  */
1122 static enum irdma_status_code irdma_cfg_aeq_vector(struct irdma_pci_f *rf)
1123 {
1124         struct irdma_msix_vector *msix_vec = rf->iw_msixtbl;
1125         u32 ret = 0;
1126
1127         if (!rf->msix_shared) {
1128                 tasklet_setup(&rf->dpc_tasklet, irdma_dpc);
1129                 ret = request_irq(msix_vec->irq, irdma_irq_handler, 0,
1130                                   "irdma", rf);
1131         }
1132         if (ret) {
1133                 ibdev_dbg(&rf->iwdev->ibdev, "ERR: aeq irq config fail\n");
1134                 return IRDMA_ERR_CFG;
1135         }
1136
1137         rf->sc_dev.irq_ops->irdma_cfg_aeq(&rf->sc_dev, msix_vec->idx, true);
1138
1139         return 0;
1140 }
1141
1142 /**
1143  * irdma_create_ceq - create completion event queue
1144  * @rf: RDMA PCI function
1145  * @iwceq: pointer to the ceq resources to be created
1146  * @ceq_id: the id number of the iwceq
1147  * @vsi: SC vsi struct
1148  *
1149  * Return 0, if the ceq and the resources associated with it
1150  * are successfully created, otherwise return error
1151  */
1152 static enum irdma_status_code irdma_create_ceq(struct irdma_pci_f *rf,
1153                                                struct irdma_ceq *iwceq,
1154                                                u32 ceq_id,
1155                                                struct irdma_sc_vsi *vsi)
1156 {
1157         enum irdma_status_code status;
1158         struct irdma_ceq_init_info info = {};
1159         struct irdma_sc_dev *dev = &rf->sc_dev;
1160         u64 scratch;
1161         u32 ceq_size;
1162
1163         info.ceq_id = ceq_id;
1164         iwceq->rf = rf;
1165         ceq_size = min(rf->sc_dev.hmc_info->hmc_obj[IRDMA_HMC_IW_CQ].cnt,
1166                        dev->hw_attrs.max_hw_ceq_size);
1167         iwceq->mem.size = ALIGN(sizeof(struct irdma_ceqe) * ceq_size,
1168                                 IRDMA_CEQ_ALIGNMENT);
1169         iwceq->mem.va = dma_alloc_coherent(dev->hw->device, iwceq->mem.size,
1170                                            &iwceq->mem.pa, GFP_KERNEL);
1171         if (!iwceq->mem.va)
1172                 return IRDMA_ERR_NO_MEMORY;
1173
1174         info.ceq_id = ceq_id;
1175         info.ceqe_base = iwceq->mem.va;
1176         info.ceqe_pa = iwceq->mem.pa;
1177         info.elem_cnt = ceq_size;
1178         iwceq->sc_ceq.ceq_id = ceq_id;
1179         info.dev = dev;
1180         info.vsi = vsi;
1181         scratch = (uintptr_t)&rf->cqp.sc_cqp;
1182         status = irdma_sc_ceq_init(&iwceq->sc_ceq, &info);
1183         if (!status) {
1184                 if (dev->ceq_valid)
1185                         status = irdma_cqp_ceq_cmd(&rf->sc_dev, &iwceq->sc_ceq,
1186                                                    IRDMA_OP_CEQ_CREATE);
1187                 else
1188                         status = irdma_sc_cceq_create(&iwceq->sc_ceq, scratch);
1189         }
1190
1191         if (status) {
1192                 dma_free_coherent(dev->hw->device, iwceq->mem.size,
1193                                   iwceq->mem.va, iwceq->mem.pa);
1194                 iwceq->mem.va = NULL;
1195         }
1196
1197         return status;
1198 }
1199
1200 /**
1201  * irdma_setup_ceq_0 - create CEQ 0 and it's interrupt resource
1202  * @rf: RDMA PCI function
1203  *
1204  * Allocate a list for all device completion event queues
1205  * Create the ceq 0 and configure it's msix interrupt vector
1206  * Return 0, if successfully set up, otherwise return error
1207  */
1208 static enum irdma_status_code irdma_setup_ceq_0(struct irdma_pci_f *rf)
1209 {
1210         struct irdma_ceq *iwceq;
1211         struct irdma_msix_vector *msix_vec;
1212         u32 i;
1213         enum irdma_status_code status = 0;
1214         u32 num_ceqs;
1215
1216         num_ceqs = min(rf->msix_count, rf->sc_dev.hmc_fpm_misc.max_ceqs);
1217         rf->ceqlist = kcalloc(num_ceqs, sizeof(*rf->ceqlist), GFP_KERNEL);
1218         if (!rf->ceqlist) {
1219                 status = IRDMA_ERR_NO_MEMORY;
1220                 goto exit;
1221         }
1222
1223         iwceq = &rf->ceqlist[0];
1224         status = irdma_create_ceq(rf, iwceq, 0, &rf->default_vsi);
1225         if (status) {
1226                 ibdev_dbg(&rf->iwdev->ibdev, "ERR: create ceq status = %d\n",
1227                           status);
1228                 goto exit;
1229         }
1230
1231         spin_lock_init(&iwceq->ce_lock);
1232         i = rf->msix_shared ? 0 : 1;
1233         msix_vec = &rf->iw_msixtbl[i];
1234         iwceq->irq = msix_vec->irq;
1235         iwceq->msix_idx = msix_vec->idx;
1236         status = irdma_cfg_ceq_vector(rf, iwceq, 0, msix_vec);
1237         if (status) {
1238                 irdma_destroy_ceq(rf, iwceq);
1239                 goto exit;
1240         }
1241
1242         irdma_ena_intr(&rf->sc_dev, msix_vec->idx);
1243         rf->ceqs_count++;
1244
1245 exit:
1246         if (status && !rf->ceqs_count) {
1247                 kfree(rf->ceqlist);
1248                 rf->ceqlist = NULL;
1249                 return status;
1250         }
1251         rf->sc_dev.ceq_valid = true;
1252
1253         return 0;
1254 }
1255
1256 /**
1257  * irdma_setup_ceqs - manage the device ceq's and their interrupt resources
1258  * @rf: RDMA PCI function
1259  * @vsi: VSI structure for this CEQ
1260  *
1261  * Allocate a list for all device completion event queues
1262  * Create the ceq's and configure their msix interrupt vectors
1263  * Return 0, if ceqs are successfully set up, otherwise return error
1264  */
1265 static enum irdma_status_code irdma_setup_ceqs(struct irdma_pci_f *rf,
1266                                                struct irdma_sc_vsi *vsi)
1267 {
1268         u32 i;
1269         u32 ceq_id;
1270         struct irdma_ceq *iwceq;
1271         struct irdma_msix_vector *msix_vec;
1272         enum irdma_status_code status;
1273         u32 num_ceqs;
1274
1275         num_ceqs = min(rf->msix_count, rf->sc_dev.hmc_fpm_misc.max_ceqs);
1276         i = (rf->msix_shared) ? 1 : 2;
1277         for (ceq_id = 1; i < num_ceqs; i++, ceq_id++) {
1278                 iwceq = &rf->ceqlist[ceq_id];
1279                 status = irdma_create_ceq(rf, iwceq, ceq_id, vsi);
1280                 if (status) {
1281                         ibdev_dbg(&rf->iwdev->ibdev,
1282                                   "ERR: create ceq status = %d\n", status);
1283                         goto del_ceqs;
1284                 }
1285                 spin_lock_init(&iwceq->ce_lock);
1286                 msix_vec = &rf->iw_msixtbl[i];
1287                 iwceq->irq = msix_vec->irq;
1288                 iwceq->msix_idx = msix_vec->idx;
1289                 status = irdma_cfg_ceq_vector(rf, iwceq, ceq_id, msix_vec);
1290                 if (status) {
1291                         irdma_destroy_ceq(rf, iwceq);
1292                         goto del_ceqs;
1293                 }
1294                 irdma_ena_intr(&rf->sc_dev, msix_vec->idx);
1295                 rf->ceqs_count++;
1296         }
1297
1298         return 0;
1299
1300 del_ceqs:
1301         irdma_del_ceqs(rf);
1302
1303         return status;
1304 }
1305
1306 static enum irdma_status_code irdma_create_virt_aeq(struct irdma_pci_f *rf,
1307                                                     u32 size)
1308 {
1309         enum irdma_status_code status = IRDMA_ERR_NO_MEMORY;
1310         struct irdma_aeq *aeq = &rf->aeq;
1311         dma_addr_t *pg_arr;
1312         u32 pg_cnt;
1313
1314         if (rf->rdma_ver < IRDMA_GEN_2)
1315                 return IRDMA_NOT_SUPPORTED;
1316
1317         aeq->mem.size = sizeof(struct irdma_sc_aeqe) * size;
1318         aeq->mem.va = vzalloc(aeq->mem.size);
1319
1320         if (!aeq->mem.va)
1321                 return status;
1322
1323         pg_cnt = DIV_ROUND_UP(aeq->mem.size, PAGE_SIZE);
1324         status = irdma_get_pble(rf->pble_rsrc, &aeq->palloc, pg_cnt, true);
1325         if (status) {
1326                 vfree(aeq->mem.va);
1327                 return status;
1328         }
1329
1330         pg_arr = (dma_addr_t *)aeq->palloc.level1.addr;
1331         status = irdma_map_vm_page_list(&rf->hw, aeq->mem.va, pg_arr, pg_cnt);
1332         if (status) {
1333                 irdma_free_pble(rf->pble_rsrc, &aeq->palloc);
1334                 vfree(aeq->mem.va);
1335                 return status;
1336         }
1337
1338         return 0;
1339 }
1340
1341 /**
1342  * irdma_create_aeq - create async event queue
1343  * @rf: RDMA PCI function
1344  *
1345  * Return 0, if the aeq and the resources associated with it
1346  * are successfully created, otherwise return error
1347  */
1348 static enum irdma_status_code irdma_create_aeq(struct irdma_pci_f *rf)
1349 {
1350         enum irdma_status_code status;
1351         struct irdma_aeq_init_info info = {};
1352         struct irdma_sc_dev *dev = &rf->sc_dev;
1353         struct irdma_aeq *aeq = &rf->aeq;
1354         struct irdma_hmc_info *hmc_info = rf->sc_dev.hmc_info;
1355         u32 aeq_size;
1356         u8 multiplier = (rf->protocol_used == IRDMA_IWARP_PROTOCOL_ONLY) ? 2 : 1;
1357
1358         aeq_size = multiplier * hmc_info->hmc_obj[IRDMA_HMC_IW_QP].cnt +
1359                    hmc_info->hmc_obj[IRDMA_HMC_IW_CQ].cnt;
1360         aeq_size = min(aeq_size, dev->hw_attrs.max_hw_aeq_size);
1361
1362         aeq->mem.size = ALIGN(sizeof(struct irdma_sc_aeqe) * aeq_size,
1363                               IRDMA_AEQ_ALIGNMENT);
1364         aeq->mem.va = dma_alloc_coherent(dev->hw->device, aeq->mem.size,
1365                                          &aeq->mem.pa,
1366                                          GFP_KERNEL | __GFP_NOWARN);
1367         if (aeq->mem.va)
1368                 goto skip_virt_aeq;
1369
1370         /* physically mapped aeq failed. setup virtual aeq */
1371         status = irdma_create_virt_aeq(rf, aeq_size);
1372         if (status)
1373                 return status;
1374
1375         info.virtual_map = true;
1376         aeq->virtual_map = info.virtual_map;
1377         info.pbl_chunk_size = 1;
1378         info.first_pm_pbl_idx = aeq->palloc.level1.idx;
1379
1380 skip_virt_aeq:
1381         info.aeqe_base = aeq->mem.va;
1382         info.aeq_elem_pa = aeq->mem.pa;
1383         info.elem_cnt = aeq_size;
1384         info.dev = dev;
1385         info.msix_idx = rf->iw_msixtbl->idx;
1386         status = irdma_sc_aeq_init(&aeq->sc_aeq, &info);
1387         if (status)
1388                 goto err;
1389
1390         status = irdma_cqp_aeq_cmd(dev, &aeq->sc_aeq, IRDMA_OP_AEQ_CREATE);
1391         if (status)
1392                 goto err;
1393
1394         return 0;
1395
1396 err:
1397         if (aeq->virtual_map) {
1398                 irdma_destroy_virt_aeq(rf);
1399         } else {
1400                 dma_free_coherent(dev->hw->device, aeq->mem.size, aeq->mem.va,
1401                                   aeq->mem.pa);
1402                 aeq->mem.va = NULL;
1403         }
1404
1405         return status;
1406 }
1407
1408 /**
1409  * irdma_setup_aeq - set up the device aeq
1410  * @rf: RDMA PCI function
1411  *
1412  * Create the aeq and configure its msix interrupt vector
1413  * Return 0 if successful, otherwise return error
1414  */
1415 static enum irdma_status_code irdma_setup_aeq(struct irdma_pci_f *rf)
1416 {
1417         struct irdma_sc_dev *dev = &rf->sc_dev;
1418         enum irdma_status_code status;
1419
1420         status = irdma_create_aeq(rf);
1421         if (status)
1422                 return status;
1423
1424         status = irdma_cfg_aeq_vector(rf);
1425         if (status) {
1426                 irdma_destroy_aeq(rf);
1427                 return status;
1428         }
1429
1430         if (!rf->msix_shared)
1431                 irdma_ena_intr(dev, rf->iw_msixtbl[0].idx);
1432
1433         return 0;
1434 }
1435
1436 /**
1437  * irdma_initialize_ilq - create iwarp local queue for cm
1438  * @iwdev: irdma device
1439  *
1440  * Return 0 if successful, otherwise return error
1441  */
1442 static enum irdma_status_code irdma_initialize_ilq(struct irdma_device *iwdev)
1443 {
1444         struct irdma_puda_rsrc_info info = {};
1445         enum irdma_status_code status;
1446
1447         info.type = IRDMA_PUDA_RSRC_TYPE_ILQ;
1448         info.cq_id = 1;
1449         info.qp_id = 1;
1450         info.count = 1;
1451         info.pd_id = 1;
1452         info.abi_ver = IRDMA_ABI_VER;
1453         info.sq_size = min(iwdev->rf->max_qp / 2, (u32)32768);
1454         info.rq_size = info.sq_size;
1455         info.buf_size = 1024;
1456         info.tx_buf_cnt = 2 * info.sq_size;
1457         info.receive = irdma_receive_ilq;
1458         info.xmit_complete = irdma_free_sqbuf;
1459         status = irdma_puda_create_rsrc(&iwdev->vsi, &info);
1460         if (status)
1461                 ibdev_dbg(&iwdev->ibdev, "ERR: ilq create fail\n");
1462
1463         return status;
1464 }
1465
1466 /**
1467  * irdma_initialize_ieq - create iwarp exception queue
1468  * @iwdev: irdma device
1469  *
1470  * Return 0 if successful, otherwise return error
1471  */
1472 static enum irdma_status_code irdma_initialize_ieq(struct irdma_device *iwdev)
1473 {
1474         struct irdma_puda_rsrc_info info = {};
1475         enum irdma_status_code status;
1476
1477         info.type = IRDMA_PUDA_RSRC_TYPE_IEQ;
1478         info.cq_id = 2;
1479         info.qp_id = iwdev->vsi.exception_lan_q;
1480         info.count = 1;
1481         info.pd_id = 2;
1482         info.abi_ver = IRDMA_ABI_VER;
1483         info.sq_size = min(iwdev->rf->max_qp / 2, (u32)32768);
1484         info.rq_size = info.sq_size;
1485         info.buf_size = iwdev->vsi.mtu + IRDMA_IPV4_PAD;
1486         info.tx_buf_cnt = 4096;
1487         status = irdma_puda_create_rsrc(&iwdev->vsi, &info);
1488         if (status)
1489                 ibdev_dbg(&iwdev->ibdev, "ERR: ieq create fail\n");
1490
1491         return status;
1492 }
1493
1494 /**
1495  * irdma_reinitialize_ieq - destroy and re-create ieq
1496  * @vsi: VSI structure
1497  */
1498 void irdma_reinitialize_ieq(struct irdma_sc_vsi *vsi)
1499 {
1500         struct irdma_device *iwdev = vsi->back_vsi;
1501         struct irdma_pci_f *rf = iwdev->rf;
1502
1503         irdma_puda_dele_rsrc(vsi, IRDMA_PUDA_RSRC_TYPE_IEQ, false);
1504         if (irdma_initialize_ieq(iwdev)) {
1505                 iwdev->rf->reset = true;
1506                 rf->gen_ops.request_reset(rf);
1507         }
1508 }
1509
1510 /**
1511  * irdma_hmc_setup - create hmc objects for the device
1512  * @rf: RDMA PCI function
1513  *
1514  * Set up the device private memory space for the number and size of
1515  * the hmc objects and create the objects
1516  * Return 0 if successful, otherwise return error
1517  */
1518 static enum irdma_status_code irdma_hmc_setup(struct irdma_pci_f *rf)
1519 {
1520         enum irdma_status_code status;
1521         u32 qpcnt;
1522
1523         if (rf->rdma_ver == IRDMA_GEN_1)
1524                 qpcnt = rsrc_limits_table[rf->limits_sel].qplimit * 2;
1525         else
1526                 qpcnt = rsrc_limits_table[rf->limits_sel].qplimit;
1527
1528         rf->sd_type = IRDMA_SD_TYPE_DIRECT;
1529         status = irdma_cfg_fpm_val(&rf->sc_dev, qpcnt);
1530         if (status)
1531                 return status;
1532
1533         status = irdma_create_hmc_objs(rf, true, rf->rdma_ver);
1534
1535         return status;
1536 }
1537
1538 /**
1539  * irdma_del_init_mem - deallocate memory resources
1540  * @rf: RDMA PCI function
1541  */
1542 static void irdma_del_init_mem(struct irdma_pci_f *rf)
1543 {
1544         struct irdma_sc_dev *dev = &rf->sc_dev;
1545
1546         kfree(dev->hmc_info->sd_table.sd_entry);
1547         dev->hmc_info->sd_table.sd_entry = NULL;
1548         kfree(rf->mem_rsrc);
1549         rf->mem_rsrc = NULL;
1550         dma_free_coherent(rf->hw.device, rf->obj_mem.size, rf->obj_mem.va,
1551                           rf->obj_mem.pa);
1552         rf->obj_mem.va = NULL;
1553         if (rf->rdma_ver != IRDMA_GEN_1) {
1554                 kfree(rf->allocated_ws_nodes);
1555                 rf->allocated_ws_nodes = NULL;
1556         }
1557         kfree(rf->ceqlist);
1558         rf->ceqlist = NULL;
1559         kfree(rf->iw_msixtbl);
1560         rf->iw_msixtbl = NULL;
1561         kfree(rf->hmc_info_mem);
1562         rf->hmc_info_mem = NULL;
1563 }
1564
1565 /**
1566  * irdma_initialize_dev - initialize device
1567  * @rf: RDMA PCI function
1568  *
1569  * Allocate memory for the hmc objects and initialize iwdev
1570  * Return 0 if successful, otherwise clean up the resources
1571  * and return error
1572  */
1573 static enum irdma_status_code irdma_initialize_dev(struct irdma_pci_f *rf)
1574 {
1575         enum irdma_status_code status;
1576         struct irdma_sc_dev *dev = &rf->sc_dev;
1577         struct irdma_device_init_info info = {};
1578         struct irdma_dma_mem mem;
1579         u32 size;
1580
1581         size = sizeof(struct irdma_hmc_pble_rsrc) +
1582                sizeof(struct irdma_hmc_info) +
1583                (sizeof(struct irdma_hmc_obj_info) * IRDMA_HMC_IW_MAX);
1584
1585         rf->hmc_info_mem = kzalloc(size, GFP_KERNEL);
1586         if (!rf->hmc_info_mem)
1587                 return IRDMA_ERR_NO_MEMORY;
1588
1589         rf->pble_rsrc = (struct irdma_hmc_pble_rsrc *)rf->hmc_info_mem;
1590         dev->hmc_info = &rf->hw.hmc;
1591         dev->hmc_info->hmc_obj = (struct irdma_hmc_obj_info *)
1592                                  (rf->pble_rsrc + 1);
1593
1594         status = irdma_obj_aligned_mem(rf, &mem, IRDMA_QUERY_FPM_BUF_SIZE,
1595                                        IRDMA_FPM_QUERY_BUF_ALIGNMENT_M);
1596         if (status)
1597                 goto error;
1598
1599         info.fpm_query_buf_pa = mem.pa;
1600         info.fpm_query_buf = mem.va;
1601
1602         status = irdma_obj_aligned_mem(rf, &mem, IRDMA_COMMIT_FPM_BUF_SIZE,
1603                                        IRDMA_FPM_COMMIT_BUF_ALIGNMENT_M);
1604         if (status)
1605                 goto error;
1606
1607         info.fpm_commit_buf_pa = mem.pa;
1608         info.fpm_commit_buf = mem.va;
1609
1610         info.bar0 = rf->hw.hw_addr;
1611         info.hmc_fn_id = PCI_FUNC(rf->pcidev->devfn);
1612         info.hw = &rf->hw;
1613         status = irdma_sc_dev_init(rf->rdma_ver, &rf->sc_dev, &info);
1614         if (status)
1615                 goto error;
1616
1617         return status;
1618 error:
1619         kfree(rf->hmc_info_mem);
1620         rf->hmc_info_mem = NULL;
1621
1622         return status;
1623 }
1624
1625 /**
1626  * irdma_rt_deinit_hw - clean up the irdma device resources
1627  * @iwdev: irdma device
1628  *
1629  * remove the mac ip entry and ipv4/ipv6 addresses, destroy the
1630  * device queues and free the pble and the hmc objects
1631  */
1632 void irdma_rt_deinit_hw(struct irdma_device *iwdev)
1633 {
1634         ibdev_dbg(&iwdev->ibdev, "INIT: state = %d\n", iwdev->init_state);
1635
1636         switch (iwdev->init_state) {
1637         case IP_ADDR_REGISTERED:
1638                 if (iwdev->rf->sc_dev.hw_attrs.uk_attrs.hw_rev == IRDMA_GEN_1)
1639                         irdma_del_local_mac_entry(iwdev->rf,
1640                                                   (u8)iwdev->mac_ip_table_idx);
1641                 fallthrough;
1642         case AEQ_CREATED:
1643         case PBLE_CHUNK_MEM:
1644         case CEQS_CREATED:
1645         case IEQ_CREATED:
1646                 if (!iwdev->roce_mode)
1647                         irdma_puda_dele_rsrc(&iwdev->vsi, IRDMA_PUDA_RSRC_TYPE_IEQ,
1648                                              iwdev->rf->reset);
1649                 fallthrough;
1650         case ILQ_CREATED:
1651                 if (!iwdev->roce_mode)
1652                         irdma_puda_dele_rsrc(&iwdev->vsi,
1653                                              IRDMA_PUDA_RSRC_TYPE_ILQ,
1654                                              iwdev->rf->reset);
1655                 break;
1656         default:
1657                 ibdev_warn(&iwdev->ibdev, "bad init_state = %d\n", iwdev->init_state);
1658                 break;
1659         }
1660
1661         irdma_cleanup_cm_core(&iwdev->cm_core);
1662         if (iwdev->vsi.pestat) {
1663                 irdma_vsi_stats_free(&iwdev->vsi);
1664                 kfree(iwdev->vsi.pestat);
1665         }
1666         if (iwdev->cleanup_wq)
1667                 destroy_workqueue(iwdev->cleanup_wq);
1668 }
1669
1670 static enum irdma_status_code irdma_setup_init_state(struct irdma_pci_f *rf)
1671 {
1672         enum irdma_status_code status;
1673
1674         status = irdma_save_msix_info(rf);
1675         if (status)
1676                 return status;
1677
1678         rf->hw.device = &rf->pcidev->dev;
1679         rf->obj_mem.size = ALIGN(8192, IRDMA_HW_PAGE_SIZE);
1680         rf->obj_mem.va = dma_alloc_coherent(rf->hw.device, rf->obj_mem.size,
1681                                             &rf->obj_mem.pa, GFP_KERNEL);
1682         if (!rf->obj_mem.va) {
1683                 status = IRDMA_ERR_NO_MEMORY;
1684                 goto clean_msixtbl;
1685         }
1686
1687         rf->obj_next = rf->obj_mem;
1688         status = irdma_initialize_dev(rf);
1689         if (status)
1690                 goto clean_obj_mem;
1691
1692         return 0;
1693
1694 clean_obj_mem:
1695         dma_free_coherent(rf->hw.device, rf->obj_mem.size, rf->obj_mem.va,
1696                           rf->obj_mem.pa);
1697         rf->obj_mem.va = NULL;
1698 clean_msixtbl:
1699         kfree(rf->iw_msixtbl);
1700         rf->iw_msixtbl = NULL;
1701         return status;
1702 }
1703
1704 /**
1705  * irdma_get_used_rsrc - determine resources used internally
1706  * @iwdev: irdma device
1707  *
1708  * Called at the end of open to get all internal allocations
1709  */
1710 static void irdma_get_used_rsrc(struct irdma_device *iwdev)
1711 {
1712         iwdev->rf->used_pds = find_first_zero_bit(iwdev->rf->allocated_pds,
1713                                                  iwdev->rf->max_pd);
1714         iwdev->rf->used_qps = find_first_zero_bit(iwdev->rf->allocated_qps,
1715                                                  iwdev->rf->max_qp);
1716         iwdev->rf->used_cqs = find_first_zero_bit(iwdev->rf->allocated_cqs,
1717                                                  iwdev->rf->max_cq);
1718         iwdev->rf->used_mrs = find_first_zero_bit(iwdev->rf->allocated_mrs,
1719                                                  iwdev->rf->max_mr);
1720 }
1721
1722 void irdma_ctrl_deinit_hw(struct irdma_pci_f *rf)
1723 {
1724         enum init_completion_state state = rf->init_state;
1725
1726         rf->init_state = INVALID_STATE;
1727         if (rf->rsrc_created) {
1728                 irdma_destroy_aeq(rf);
1729                 irdma_destroy_pble_prm(rf->pble_rsrc);
1730                 irdma_del_ceqs(rf);
1731                 rf->rsrc_created = false;
1732         }
1733         switch (state) {
1734         case CEQ0_CREATED:
1735                 irdma_del_ceq_0(rf);
1736                 fallthrough;
1737         case CCQ_CREATED:
1738                 irdma_destroy_ccq(rf);
1739                 fallthrough;
1740         case HW_RSRC_INITIALIZED:
1741         case HMC_OBJS_CREATED:
1742                 irdma_del_hmc_objects(&rf->sc_dev, rf->sc_dev.hmc_info, true,
1743                                       rf->reset, rf->rdma_ver);
1744                 fallthrough;
1745         case CQP_CREATED:
1746                 irdma_destroy_cqp(rf, true);
1747                 fallthrough;
1748         case INITIAL_STATE:
1749                 irdma_del_init_mem(rf);
1750                 break;
1751         case INVALID_STATE:
1752         default:
1753                 ibdev_warn(&rf->iwdev->ibdev, "bad init_state = %d\n", rf->init_state);
1754                 break;
1755         }
1756 }
1757
1758 /**
1759  * irdma_rt_init_hw - Initializes runtime portion of HW
1760  * @iwdev: irdma device
1761  * @l2params: qos, tc, mtu info from netdev driver
1762  *
1763  * Create device queues ILQ, IEQ, CEQs and PBLEs. Setup irdma
1764  * device resource objects.
1765  */
1766 enum irdma_status_code irdma_rt_init_hw(struct irdma_device *iwdev,
1767                                         struct irdma_l2params *l2params)
1768 {
1769         struct irdma_pci_f *rf = iwdev->rf;
1770         struct irdma_sc_dev *dev = &rf->sc_dev;
1771         enum irdma_status_code status;
1772         struct irdma_vsi_init_info vsi_info = {};
1773         struct irdma_vsi_stats_info stats_info = {};
1774
1775         vsi_info.dev = dev;
1776         vsi_info.back_vsi = iwdev;
1777         vsi_info.params = l2params;
1778         vsi_info.pf_data_vsi_num = iwdev->vsi_num;
1779         vsi_info.register_qset = rf->gen_ops.register_qset;
1780         vsi_info.unregister_qset = rf->gen_ops.unregister_qset;
1781         vsi_info.exception_lan_q = 2;
1782         irdma_sc_vsi_init(&iwdev->vsi, &vsi_info);
1783
1784         status = irdma_setup_cm_core(iwdev, rf->rdma_ver);
1785         if (status)
1786                 return status;
1787
1788         stats_info.pestat = kzalloc(sizeof(*stats_info.pestat), GFP_KERNEL);
1789         if (!stats_info.pestat) {
1790                 irdma_cleanup_cm_core(&iwdev->cm_core);
1791                 return IRDMA_ERR_NO_MEMORY;
1792         }
1793         stats_info.fcn_id = dev->hmc_fn_id;
1794         status = irdma_vsi_stats_init(&iwdev->vsi, &stats_info);
1795         if (status) {
1796                 irdma_cleanup_cm_core(&iwdev->cm_core);
1797                 kfree(stats_info.pestat);
1798                 return status;
1799         }
1800
1801         do {
1802                 if (!iwdev->roce_mode) {
1803                         status = irdma_initialize_ilq(iwdev);
1804                         if (status)
1805                                 break;
1806                         iwdev->init_state = ILQ_CREATED;
1807                         status = irdma_initialize_ieq(iwdev);
1808                         if (status)
1809                                 break;
1810                         iwdev->init_state = IEQ_CREATED;
1811                 }
1812                 if (!rf->rsrc_created) {
1813                         status = irdma_setup_ceqs(rf, &iwdev->vsi);
1814                         if (status)
1815                                 break;
1816
1817                         iwdev->init_state = CEQS_CREATED;
1818
1819                         status = irdma_hmc_init_pble(&rf->sc_dev,
1820                                                      rf->pble_rsrc);
1821                         if (status) {
1822                                 irdma_del_ceqs(rf);
1823                                 break;
1824                         }
1825
1826                         iwdev->init_state = PBLE_CHUNK_MEM;
1827
1828                         status = irdma_setup_aeq(rf);
1829                         if (status) {
1830                                 irdma_destroy_pble_prm(rf->pble_rsrc);
1831                                 irdma_del_ceqs(rf);
1832                                 break;
1833                         }
1834                         iwdev->init_state = AEQ_CREATED;
1835                         rf->rsrc_created = true;
1836                 }
1837
1838                 iwdev->device_cap_flags = IB_DEVICE_LOCAL_DMA_LKEY |
1839                                           IB_DEVICE_MEM_WINDOW |
1840                                           IB_DEVICE_MEM_MGT_EXTENSIONS;
1841
1842                 if (iwdev->rf->sc_dev.hw_attrs.uk_attrs.hw_rev == IRDMA_GEN_1)
1843                         irdma_alloc_set_mac(iwdev);
1844                 irdma_add_ip(iwdev);
1845                 iwdev->init_state = IP_ADDR_REGISTERED;
1846
1847                 /* handles asynch cleanup tasks - disconnect CM , free qp,
1848                  * free cq bufs
1849                  */
1850                 iwdev->cleanup_wq = alloc_workqueue("irdma-cleanup-wq",
1851                                         WQ_UNBOUND, WQ_UNBOUND_MAX_ACTIVE);
1852                 if (!iwdev->cleanup_wq)
1853                         return IRDMA_ERR_NO_MEMORY;
1854                 irdma_get_used_rsrc(iwdev);
1855                 init_waitqueue_head(&iwdev->suspend_wq);
1856
1857                 return 0;
1858         } while (0);
1859
1860         dev_err(&rf->pcidev->dev, "HW runtime init FAIL status = %d last cmpl = %d\n",
1861                 status, iwdev->init_state);
1862         irdma_rt_deinit_hw(iwdev);
1863
1864         return status;
1865 }
1866
1867 /**
1868  * irdma_ctrl_init_hw - Initializes control portion of HW
1869  * @rf: RDMA PCI function
1870  *
1871  * Create admin queues, HMC obejcts and RF resource objects
1872  */
1873 enum irdma_status_code irdma_ctrl_init_hw(struct irdma_pci_f *rf)
1874 {
1875         struct irdma_sc_dev *dev = &rf->sc_dev;
1876         enum irdma_status_code status;
1877         do {
1878                 status = irdma_setup_init_state(rf);
1879                 if (status)
1880                         break;
1881                 rf->init_state = INITIAL_STATE;
1882
1883                 status = irdma_create_cqp(rf);
1884                 if (status)
1885                         break;
1886                 rf->init_state = CQP_CREATED;
1887
1888                 status = irdma_hmc_setup(rf);
1889                 if (status)
1890                         break;
1891                 rf->init_state = HMC_OBJS_CREATED;
1892
1893                 status = irdma_initialize_hw_rsrc(rf);
1894                 if (status)
1895                         break;
1896                 rf->init_state = HW_RSRC_INITIALIZED;
1897
1898                 status = irdma_create_ccq(rf);
1899                 if (status)
1900                         break;
1901                 rf->init_state = CCQ_CREATED;
1902
1903                 dev->feature_info[IRDMA_FEATURE_FW_INFO] = IRDMA_FW_VER_DEFAULT;
1904                 if (rf->rdma_ver != IRDMA_GEN_1) {
1905                         status = irdma_get_rdma_features(dev);
1906                         if (status)
1907                                 break;
1908                 }
1909
1910                 status = irdma_setup_ceq_0(rf);
1911                 if (status)
1912                         break;
1913                 rf->init_state = CEQ0_CREATED;
1914                 /* Handles processing of CQP completions */
1915                 rf->cqp_cmpl_wq = alloc_ordered_workqueue("cqp_cmpl_wq",
1916                                                 WQ_HIGHPRI | WQ_UNBOUND);
1917                 if (!rf->cqp_cmpl_wq) {
1918                         status = IRDMA_ERR_NO_MEMORY;
1919                         break;
1920                 }
1921                 INIT_WORK(&rf->cqp_cmpl_work, cqp_compl_worker);
1922                 irdma_sc_ccq_arm(dev->ccq);
1923                 return 0;
1924         } while (0);
1925
1926         dev_err(&rf->pcidev->dev, "IRDMA hardware initialization FAILED init_state=%d status=%d\n",
1927                 rf->init_state, status);
1928         irdma_ctrl_deinit_hw(rf);
1929         return status;
1930 }
1931
1932 /**
1933  * irdma_set_hw_rsrc - set hw memory resources.
1934  * @rf: RDMA PCI function
1935  */
1936 static void irdma_set_hw_rsrc(struct irdma_pci_f *rf)
1937 {
1938         rf->allocated_qps = (void *)(rf->mem_rsrc +
1939                    (sizeof(struct irdma_arp_entry) * rf->arp_table_size));
1940         rf->allocated_cqs = &rf->allocated_qps[BITS_TO_LONGS(rf->max_qp)];
1941         rf->allocated_mrs = &rf->allocated_cqs[BITS_TO_LONGS(rf->max_cq)];
1942         rf->allocated_pds = &rf->allocated_mrs[BITS_TO_LONGS(rf->max_mr)];
1943         rf->allocated_ahs = &rf->allocated_pds[BITS_TO_LONGS(rf->max_pd)];
1944         rf->allocated_mcgs = &rf->allocated_ahs[BITS_TO_LONGS(rf->max_ah)];
1945         rf->allocated_arps = &rf->allocated_mcgs[BITS_TO_LONGS(rf->max_mcg)];
1946         rf->qp_table = (struct irdma_qp **)
1947                 (&rf->allocated_arps[BITS_TO_LONGS(rf->arp_table_size)]);
1948
1949         spin_lock_init(&rf->rsrc_lock);
1950         spin_lock_init(&rf->arp_lock);
1951         spin_lock_init(&rf->qptable_lock);
1952         spin_lock_init(&rf->qh_list_lock);
1953 }
1954
1955 /**
1956  * irdma_calc_mem_rsrc_size - calculate memory resources size.
1957  * @rf: RDMA PCI function
1958  */
1959 static u32 irdma_calc_mem_rsrc_size(struct irdma_pci_f *rf)
1960 {
1961         u32 rsrc_size;
1962
1963         rsrc_size = sizeof(struct irdma_arp_entry) * rf->arp_table_size;
1964         rsrc_size += sizeof(unsigned long) * BITS_TO_LONGS(rf->max_qp);
1965         rsrc_size += sizeof(unsigned long) * BITS_TO_LONGS(rf->max_mr);
1966         rsrc_size += sizeof(unsigned long) * BITS_TO_LONGS(rf->max_cq);
1967         rsrc_size += sizeof(unsigned long) * BITS_TO_LONGS(rf->max_pd);
1968         rsrc_size += sizeof(unsigned long) * BITS_TO_LONGS(rf->arp_table_size);
1969         rsrc_size += sizeof(unsigned long) * BITS_TO_LONGS(rf->max_ah);
1970         rsrc_size += sizeof(unsigned long) * BITS_TO_LONGS(rf->max_mcg);
1971         rsrc_size += sizeof(struct irdma_qp **) * rf->max_qp;
1972
1973         return rsrc_size;
1974 }
1975
1976 /**
1977  * irdma_initialize_hw_rsrc - initialize hw resource tracking array
1978  * @rf: RDMA PCI function
1979  */
1980 u32 irdma_initialize_hw_rsrc(struct irdma_pci_f *rf)
1981 {
1982         u32 rsrc_size;
1983         u32 mrdrvbits;
1984         u32 ret;
1985
1986         if (rf->rdma_ver != IRDMA_GEN_1) {
1987                 rf->allocated_ws_nodes =
1988                         kcalloc(BITS_TO_LONGS(IRDMA_MAX_WS_NODES),
1989                                 sizeof(unsigned long), GFP_KERNEL);
1990                 if (!rf->allocated_ws_nodes)
1991                         return -ENOMEM;
1992
1993                 set_bit(0, rf->allocated_ws_nodes);
1994                 rf->max_ws_node_id = IRDMA_MAX_WS_NODES;
1995         }
1996         rf->max_cqe = rf->sc_dev.hw_attrs.uk_attrs.max_hw_cq_size;
1997         rf->max_qp = rf->sc_dev.hmc_info->hmc_obj[IRDMA_HMC_IW_QP].cnt;
1998         rf->max_mr = rf->sc_dev.hmc_info->hmc_obj[IRDMA_HMC_IW_MR].cnt;
1999         rf->max_cq = rf->sc_dev.hmc_info->hmc_obj[IRDMA_HMC_IW_CQ].cnt;
2000         rf->max_pd = rf->sc_dev.hw_attrs.max_hw_pds;
2001         rf->arp_table_size = rf->sc_dev.hmc_info->hmc_obj[IRDMA_HMC_IW_ARP].cnt;
2002         rf->max_ah = rf->sc_dev.hmc_info->hmc_obj[IRDMA_HMC_IW_FSIAV].cnt;
2003         rf->max_mcg = rf->max_qp;
2004
2005         rsrc_size = irdma_calc_mem_rsrc_size(rf);
2006         rf->mem_rsrc = kzalloc(rsrc_size, GFP_KERNEL);
2007         if (!rf->mem_rsrc) {
2008                 ret = -ENOMEM;
2009                 goto mem_rsrc_kzalloc_fail;
2010         }
2011
2012         rf->arp_table = (struct irdma_arp_entry *)rf->mem_rsrc;
2013
2014         irdma_set_hw_rsrc(rf);
2015
2016         set_bit(0, rf->allocated_mrs);
2017         set_bit(0, rf->allocated_qps);
2018         set_bit(0, rf->allocated_cqs);
2019         set_bit(0, rf->allocated_pds);
2020         set_bit(0, rf->allocated_arps);
2021         set_bit(0, rf->allocated_ahs);
2022         set_bit(0, rf->allocated_mcgs);
2023         set_bit(2, rf->allocated_qps); /* qp 2 IEQ */
2024         set_bit(1, rf->allocated_qps); /* qp 1 ILQ */
2025         set_bit(1, rf->allocated_cqs);
2026         set_bit(1, rf->allocated_pds);
2027         set_bit(2, rf->allocated_cqs);
2028         set_bit(2, rf->allocated_pds);
2029
2030         INIT_LIST_HEAD(&rf->mc_qht_list.list);
2031         /* stag index mask has a minimum of 14 bits */
2032         mrdrvbits = 24 - max(get_count_order(rf->max_mr), 14);
2033         rf->mr_stagmask = ~(((1 << mrdrvbits) - 1) << (32 - mrdrvbits));
2034
2035         return 0;
2036
2037 mem_rsrc_kzalloc_fail:
2038         kfree(rf->allocated_ws_nodes);
2039         rf->allocated_ws_nodes = NULL;
2040
2041         return ret;
2042 }
2043
2044 /**
2045  * irdma_cqp_ce_handler - handle cqp completions
2046  * @rf: RDMA PCI function
2047  * @cq: cq for cqp completions
2048  */
2049 void irdma_cqp_ce_handler(struct irdma_pci_f *rf, struct irdma_sc_cq *cq)
2050 {
2051         struct irdma_cqp_request *cqp_request;
2052         struct irdma_sc_dev *dev = &rf->sc_dev;
2053         u32 cqe_count = 0;
2054         struct irdma_ccq_cqe_info info;
2055         unsigned long flags;
2056         int ret;
2057
2058         do {
2059                 memset(&info, 0, sizeof(info));
2060                 spin_lock_irqsave(&rf->cqp.compl_lock, flags);
2061                 ret = irdma_sc_ccq_get_cqe_info(cq, &info);
2062                 spin_unlock_irqrestore(&rf->cqp.compl_lock, flags);
2063                 if (ret)
2064                         break;
2065
2066                 cqp_request = (struct irdma_cqp_request *)
2067                               (unsigned long)info.scratch;
2068                 if (info.error && irdma_cqp_crit_err(dev, cqp_request->info.cqp_cmd,
2069                                                      info.maj_err_code,
2070                                                      info.min_err_code))
2071                         ibdev_err(&rf->iwdev->ibdev, "cqp opcode = 0x%x maj_err_code = 0x%x min_err_code = 0x%x\n",
2072                                   info.op_code, info.maj_err_code, info.min_err_code);
2073                 if (cqp_request) {
2074                         cqp_request->compl_info.maj_err_code = info.maj_err_code;
2075                         cqp_request->compl_info.min_err_code = info.min_err_code;
2076                         cqp_request->compl_info.op_ret_val = info.op_ret_val;
2077                         cqp_request->compl_info.error = info.error;
2078
2079                         if (cqp_request->waiting) {
2080                                 cqp_request->request_done = true;
2081                                 wake_up(&cqp_request->waitq);
2082                                 irdma_put_cqp_request(&rf->cqp, cqp_request);
2083                         } else {
2084                                 if (cqp_request->callback_fcn)
2085                                         cqp_request->callback_fcn(cqp_request);
2086                                 irdma_put_cqp_request(&rf->cqp, cqp_request);
2087                         }
2088                 }
2089
2090                 cqe_count++;
2091         } while (1);
2092
2093         if (cqe_count) {
2094                 irdma_process_bh(dev);
2095                 irdma_sc_ccq_arm(cq);
2096         }
2097 }
2098
2099 /**
2100  * cqp_compl_worker - Handle cqp completions
2101  * @work: Pointer to work structure
2102  */
2103 void cqp_compl_worker(struct work_struct *work)
2104 {
2105         struct irdma_pci_f *rf = container_of(work, struct irdma_pci_f,
2106                                               cqp_cmpl_work);
2107         struct irdma_sc_cq *cq = &rf->ccq.sc_cq;
2108
2109         irdma_cqp_ce_handler(rf, cq);
2110 }
2111
2112 /**
2113  * irdma_lookup_apbvt_entry - lookup hash table for an existing apbvt entry corresponding to port
2114  * @cm_core: cm's core
2115  * @port: port to identify apbvt entry
2116  */
2117 static struct irdma_apbvt_entry *irdma_lookup_apbvt_entry(struct irdma_cm_core *cm_core,
2118                                                           u16 port)
2119 {
2120         struct irdma_apbvt_entry *entry;
2121
2122         hash_for_each_possible(cm_core->apbvt_hash_tbl, entry, hlist, port) {
2123                 if (entry->port == port) {
2124                         entry->use_cnt++;
2125                         return entry;
2126                 }
2127         }
2128
2129         return NULL;
2130 }
2131
2132 /**
2133  * irdma_next_iw_state - modify qp state
2134  * @iwqp: iwarp qp to modify
2135  * @state: next state for qp
2136  * @del_hash: del hash
2137  * @term: term message
2138  * @termlen: length of term message
2139  */
2140 void irdma_next_iw_state(struct irdma_qp *iwqp, u8 state, u8 del_hash, u8 term,
2141                          u8 termlen)
2142 {
2143         struct irdma_modify_qp_info info = {};
2144
2145         info.next_iwarp_state = state;
2146         info.remove_hash_idx = del_hash;
2147         info.cq_num_valid = true;
2148         info.arp_cache_idx_valid = true;
2149         info.dont_send_term = true;
2150         info.dont_send_fin = true;
2151         info.termlen = termlen;
2152
2153         if (term & IRDMAQP_TERM_SEND_TERM_ONLY)
2154                 info.dont_send_term = false;
2155         if (term & IRDMAQP_TERM_SEND_FIN_ONLY)
2156                 info.dont_send_fin = false;
2157         if (iwqp->sc_qp.term_flags && state == IRDMA_QP_STATE_ERROR)
2158                 info.reset_tcp_conn = true;
2159         iwqp->hw_iwarp_state = state;
2160         irdma_hw_modify_qp(iwqp->iwdev, iwqp, &info, 0);
2161         iwqp->iwarp_state = info.next_iwarp_state;
2162 }
2163
2164 /**
2165  * irdma_del_local_mac_entry - remove a mac entry from the hw
2166  * table
2167  * @rf: RDMA PCI function
2168  * @idx: the index of the mac ip address to delete
2169  */
2170 void irdma_del_local_mac_entry(struct irdma_pci_f *rf, u16 idx)
2171 {
2172         struct irdma_cqp *iwcqp = &rf->cqp;
2173         struct irdma_cqp_request *cqp_request;
2174         struct cqp_cmds_info *cqp_info;
2175
2176         cqp_request = irdma_alloc_and_get_cqp_request(iwcqp, true);
2177         if (!cqp_request)
2178                 return;
2179
2180         cqp_info = &cqp_request->info;
2181         cqp_info->cqp_cmd = IRDMA_OP_DELETE_LOCAL_MAC_ENTRY;
2182         cqp_info->post_sq = 1;
2183         cqp_info->in.u.del_local_mac_entry.cqp = &iwcqp->sc_cqp;
2184         cqp_info->in.u.del_local_mac_entry.scratch = (uintptr_t)cqp_request;
2185         cqp_info->in.u.del_local_mac_entry.entry_idx = idx;
2186         cqp_info->in.u.del_local_mac_entry.ignore_ref_count = 0;
2187
2188         irdma_handle_cqp_op(rf, cqp_request);
2189         irdma_put_cqp_request(iwcqp, cqp_request);
2190 }
2191
2192 /**
2193  * irdma_add_local_mac_entry - add a mac ip address entry to the
2194  * hw table
2195  * @rf: RDMA PCI function
2196  * @mac_addr: pointer to mac address
2197  * @idx: the index of the mac ip address to add
2198  */
2199 int irdma_add_local_mac_entry(struct irdma_pci_f *rf, const u8 *mac_addr, u16 idx)
2200 {
2201         struct irdma_local_mac_entry_info *info;
2202         struct irdma_cqp *iwcqp = &rf->cqp;
2203         struct irdma_cqp_request *cqp_request;
2204         struct cqp_cmds_info *cqp_info;
2205         enum irdma_status_code status;
2206
2207         cqp_request = irdma_alloc_and_get_cqp_request(iwcqp, true);
2208         if (!cqp_request)
2209                 return IRDMA_ERR_NO_MEMORY;
2210
2211         cqp_info = &cqp_request->info;
2212         cqp_info->post_sq = 1;
2213         info = &cqp_info->in.u.add_local_mac_entry.info;
2214         ether_addr_copy(info->mac_addr, mac_addr);
2215         info->entry_idx = idx;
2216         cqp_info->in.u.add_local_mac_entry.scratch = (uintptr_t)cqp_request;
2217         cqp_info->cqp_cmd = IRDMA_OP_ADD_LOCAL_MAC_ENTRY;
2218         cqp_info->in.u.add_local_mac_entry.cqp = &iwcqp->sc_cqp;
2219         cqp_info->in.u.add_local_mac_entry.scratch = (uintptr_t)cqp_request;
2220
2221         status = irdma_handle_cqp_op(rf, cqp_request);
2222         irdma_put_cqp_request(iwcqp, cqp_request);
2223
2224         return status;
2225 }
2226
2227 /**
2228  * irdma_alloc_local_mac_entry - allocate a mac entry
2229  * @rf: RDMA PCI function
2230  * @mac_tbl_idx: the index of the new mac address
2231  *
2232  * Allocate a mac address entry and update the mac_tbl_idx
2233  * to hold the index of the newly created mac address
2234  * Return 0 if successful, otherwise return error
2235  */
2236 int irdma_alloc_local_mac_entry(struct irdma_pci_f *rf, u16 *mac_tbl_idx)
2237 {
2238         struct irdma_cqp *iwcqp = &rf->cqp;
2239         struct irdma_cqp_request *cqp_request;
2240         struct cqp_cmds_info *cqp_info;
2241         enum irdma_status_code status = 0;
2242
2243         cqp_request = irdma_alloc_and_get_cqp_request(iwcqp, true);
2244         if (!cqp_request)
2245                 return IRDMA_ERR_NO_MEMORY;
2246
2247         cqp_info = &cqp_request->info;
2248         cqp_info->cqp_cmd = IRDMA_OP_ALLOC_LOCAL_MAC_ENTRY;
2249         cqp_info->post_sq = 1;
2250         cqp_info->in.u.alloc_local_mac_entry.cqp = &iwcqp->sc_cqp;
2251         cqp_info->in.u.alloc_local_mac_entry.scratch = (uintptr_t)cqp_request;
2252         status = irdma_handle_cqp_op(rf, cqp_request);
2253         if (!status)
2254                 *mac_tbl_idx = (u16)cqp_request->compl_info.op_ret_val;
2255
2256         irdma_put_cqp_request(iwcqp, cqp_request);
2257
2258         return status;
2259 }
2260
2261 /**
2262  * irdma_cqp_manage_apbvt_cmd - send cqp command manage apbvt
2263  * @iwdev: irdma device
2264  * @accel_local_port: port for apbvt
2265  * @add_port: add ordelete port
2266  */
2267 static enum irdma_status_code
2268 irdma_cqp_manage_apbvt_cmd(struct irdma_device *iwdev, u16 accel_local_port,
2269                            bool add_port)
2270 {
2271         struct irdma_apbvt_info *info;
2272         struct irdma_cqp_request *cqp_request;
2273         struct cqp_cmds_info *cqp_info;
2274         enum irdma_status_code status;
2275
2276         cqp_request = irdma_alloc_and_get_cqp_request(&iwdev->rf->cqp, add_port);
2277         if (!cqp_request)
2278                 return IRDMA_ERR_NO_MEMORY;
2279
2280         cqp_info = &cqp_request->info;
2281         info = &cqp_info->in.u.manage_apbvt_entry.info;
2282         memset(info, 0, sizeof(*info));
2283         info->add = add_port;
2284         info->port = accel_local_port;
2285         cqp_info->cqp_cmd = IRDMA_OP_MANAGE_APBVT_ENTRY;
2286         cqp_info->post_sq = 1;
2287         cqp_info->in.u.manage_apbvt_entry.cqp = &iwdev->rf->cqp.sc_cqp;
2288         cqp_info->in.u.manage_apbvt_entry.scratch = (uintptr_t)cqp_request;
2289         ibdev_dbg(&iwdev->ibdev, "DEV: %s: port=0x%04x\n",
2290                   (!add_port) ? "DELETE" : "ADD", accel_local_port);
2291
2292         status = irdma_handle_cqp_op(iwdev->rf, cqp_request);
2293         irdma_put_cqp_request(&iwdev->rf->cqp, cqp_request);
2294
2295         return status;
2296 }
2297
2298 /**
2299  * irdma_add_apbvt - add tcp port to HW apbvt table
2300  * @iwdev: irdma device
2301  * @port: port for apbvt
2302  */
2303 struct irdma_apbvt_entry *irdma_add_apbvt(struct irdma_device *iwdev, u16 port)
2304 {
2305         struct irdma_cm_core *cm_core = &iwdev->cm_core;
2306         struct irdma_apbvt_entry *entry;
2307         unsigned long flags;
2308
2309         spin_lock_irqsave(&cm_core->apbvt_lock, flags);
2310         entry = irdma_lookup_apbvt_entry(cm_core, port);
2311         if (entry) {
2312                 spin_unlock_irqrestore(&cm_core->apbvt_lock, flags);
2313                 return entry;
2314         }
2315
2316         entry = kzalloc(sizeof(*entry), GFP_ATOMIC);
2317         if (!entry) {
2318                 spin_unlock_irqrestore(&cm_core->apbvt_lock, flags);
2319                 return NULL;
2320         }
2321
2322         entry->port = port;
2323         entry->use_cnt = 1;
2324         hash_add(cm_core->apbvt_hash_tbl, &entry->hlist, entry->port);
2325         spin_unlock_irqrestore(&cm_core->apbvt_lock, flags);
2326
2327         if (irdma_cqp_manage_apbvt_cmd(iwdev, port, true)) {
2328                 kfree(entry);
2329                 return NULL;
2330         }
2331
2332         return entry;
2333 }
2334
2335 /**
2336  * irdma_del_apbvt - delete tcp port from HW apbvt table
2337  * @iwdev: irdma device
2338  * @entry: apbvt entry object
2339  */
2340 void irdma_del_apbvt(struct irdma_device *iwdev,
2341                      struct irdma_apbvt_entry *entry)
2342 {
2343         struct irdma_cm_core *cm_core = &iwdev->cm_core;
2344         unsigned long flags;
2345
2346         spin_lock_irqsave(&cm_core->apbvt_lock, flags);
2347         if (--entry->use_cnt) {
2348                 spin_unlock_irqrestore(&cm_core->apbvt_lock, flags);
2349                 return;
2350         }
2351
2352         hash_del(&entry->hlist);
2353         /* apbvt_lock is held across CQP delete APBVT OP (non-waiting) to
2354          * protect against race where add APBVT CQP can race ahead of the delete
2355          * APBVT for same port.
2356          */
2357         irdma_cqp_manage_apbvt_cmd(iwdev, entry->port, false);
2358         kfree(entry);
2359         spin_unlock_irqrestore(&cm_core->apbvt_lock, flags);
2360 }
2361
2362 /**
2363  * irdma_manage_arp_cache - manage hw arp cache
2364  * @rf: RDMA PCI function
2365  * @mac_addr: mac address ptr
2366  * @ip_addr: ip addr for arp cache
2367  * @ipv4: flag inicating IPv4
2368  * @action: add, delete or modify
2369  */
2370 void irdma_manage_arp_cache(struct irdma_pci_f *rf,
2371                             const unsigned char *mac_addr,
2372                             u32 *ip_addr, bool ipv4, u32 action)
2373 {
2374         struct irdma_add_arp_cache_entry_info *info;
2375         struct irdma_cqp_request *cqp_request;
2376         struct cqp_cmds_info *cqp_info;
2377         int arp_index;
2378
2379         arp_index = irdma_arp_table(rf, ip_addr, ipv4, mac_addr, action);
2380         if (arp_index == -1)
2381                 return;
2382
2383         cqp_request = irdma_alloc_and_get_cqp_request(&rf->cqp, false);
2384         if (!cqp_request)
2385                 return;
2386
2387         cqp_info = &cqp_request->info;
2388         if (action == IRDMA_ARP_ADD) {
2389                 cqp_info->cqp_cmd = IRDMA_OP_ADD_ARP_CACHE_ENTRY;
2390                 info = &cqp_info->in.u.add_arp_cache_entry.info;
2391                 memset(info, 0, sizeof(*info));
2392                 info->arp_index = (u16)arp_index;
2393                 info->permanent = true;
2394                 ether_addr_copy(info->mac_addr, mac_addr);
2395                 cqp_info->in.u.add_arp_cache_entry.scratch =
2396                         (uintptr_t)cqp_request;
2397                 cqp_info->in.u.add_arp_cache_entry.cqp = &rf->cqp.sc_cqp;
2398         } else {
2399                 cqp_info->cqp_cmd = IRDMA_OP_DELETE_ARP_CACHE_ENTRY;
2400                 cqp_info->in.u.del_arp_cache_entry.scratch =
2401                         (uintptr_t)cqp_request;
2402                 cqp_info->in.u.del_arp_cache_entry.cqp = &rf->cqp.sc_cqp;
2403                 cqp_info->in.u.del_arp_cache_entry.arp_index = arp_index;
2404         }
2405
2406         cqp_info->post_sq = 1;
2407         irdma_handle_cqp_op(rf, cqp_request);
2408         irdma_put_cqp_request(&rf->cqp, cqp_request);
2409 }
2410
2411 /**
2412  * irdma_send_syn_cqp_callback - do syn/ack after qhash
2413  * @cqp_request: qhash cqp completion
2414  */
2415 static void irdma_send_syn_cqp_callback(struct irdma_cqp_request *cqp_request)
2416 {
2417         struct irdma_cm_node *cm_node = cqp_request->param;
2418
2419         irdma_send_syn(cm_node, 1);
2420         irdma_rem_ref_cm_node(cm_node);
2421 }
2422
2423 /**
2424  * irdma_manage_qhash - add or modify qhash
2425  * @iwdev: irdma device
2426  * @cminfo: cm info for qhash
2427  * @etype: type (syn or quad)
2428  * @mtype: type of qhash
2429  * @cmnode: cmnode associated with connection
2430  * @wait: wait for completion
2431  */
2432 enum irdma_status_code
2433 irdma_manage_qhash(struct irdma_device *iwdev, struct irdma_cm_info *cminfo,
2434                    enum irdma_quad_entry_type etype,
2435                    enum irdma_quad_hash_manage_type mtype, void *cmnode,
2436                    bool wait)
2437 {
2438         struct irdma_qhash_table_info *info;
2439         enum irdma_status_code status;
2440         struct irdma_cqp *iwcqp = &iwdev->rf->cqp;
2441         struct irdma_cqp_request *cqp_request;
2442         struct cqp_cmds_info *cqp_info;
2443         struct irdma_cm_node *cm_node = cmnode;
2444
2445         cqp_request = irdma_alloc_and_get_cqp_request(iwcqp, wait);
2446         if (!cqp_request)
2447                 return IRDMA_ERR_NO_MEMORY;
2448
2449         cqp_info = &cqp_request->info;
2450         info = &cqp_info->in.u.manage_qhash_table_entry.info;
2451         memset(info, 0, sizeof(*info));
2452         info->vsi = &iwdev->vsi;
2453         info->manage = mtype;
2454         info->entry_type = etype;
2455         if (cminfo->vlan_id < VLAN_N_VID) {
2456                 info->vlan_valid = true;
2457                 info->vlan_id = cminfo->vlan_id;
2458         } else {
2459                 info->vlan_valid = false;
2460         }
2461         info->ipv4_valid = cminfo->ipv4;
2462         info->user_pri = cminfo->user_pri;
2463         ether_addr_copy(info->mac_addr, iwdev->netdev->dev_addr);
2464         info->qp_num = cminfo->qh_qpid;
2465         info->dest_port = cminfo->loc_port;
2466         info->dest_ip[0] = cminfo->loc_addr[0];
2467         info->dest_ip[1] = cminfo->loc_addr[1];
2468         info->dest_ip[2] = cminfo->loc_addr[2];
2469         info->dest_ip[3] = cminfo->loc_addr[3];
2470         if (etype == IRDMA_QHASH_TYPE_TCP_ESTABLISHED ||
2471             etype == IRDMA_QHASH_TYPE_UDP_UNICAST ||
2472             etype == IRDMA_QHASH_TYPE_UDP_MCAST ||
2473             etype == IRDMA_QHASH_TYPE_ROCE_MCAST ||
2474             etype == IRDMA_QHASH_TYPE_ROCEV2_HW) {
2475                 info->src_port = cminfo->rem_port;
2476                 info->src_ip[0] = cminfo->rem_addr[0];
2477                 info->src_ip[1] = cminfo->rem_addr[1];
2478                 info->src_ip[2] = cminfo->rem_addr[2];
2479                 info->src_ip[3] = cminfo->rem_addr[3];
2480         }
2481         if (cmnode) {
2482                 cqp_request->callback_fcn = irdma_send_syn_cqp_callback;
2483                 cqp_request->param = cmnode;
2484                 if (!wait)
2485                         refcount_inc(&cm_node->refcnt);
2486         }
2487         if (info->ipv4_valid)
2488                 ibdev_dbg(&iwdev->ibdev,
2489                           "CM: %s caller: %pS loc_port=0x%04x rem_port=0x%04x loc_addr=%pI4 rem_addr=%pI4 mac=%pM, vlan_id=%d cm_node=%p\n",
2490                           (!mtype) ? "DELETE" : "ADD",
2491                           __builtin_return_address(0), info->dest_port,
2492                           info->src_port, info->dest_ip, info->src_ip,
2493                           info->mac_addr, cminfo->vlan_id,
2494                           cmnode ? cmnode : NULL);
2495         else
2496                 ibdev_dbg(&iwdev->ibdev,
2497                           "CM: %s caller: %pS loc_port=0x%04x rem_port=0x%04x loc_addr=%pI6 rem_addr=%pI6 mac=%pM, vlan_id=%d cm_node=%p\n",
2498                           (!mtype) ? "DELETE" : "ADD",
2499                           __builtin_return_address(0), info->dest_port,
2500                           info->src_port, info->dest_ip, info->src_ip,
2501                           info->mac_addr, cminfo->vlan_id,
2502                           cmnode ? cmnode : NULL);
2503
2504         cqp_info->in.u.manage_qhash_table_entry.cqp = &iwdev->rf->cqp.sc_cqp;
2505         cqp_info->in.u.manage_qhash_table_entry.scratch = (uintptr_t)cqp_request;
2506         cqp_info->cqp_cmd = IRDMA_OP_MANAGE_QHASH_TABLE_ENTRY;
2507         cqp_info->post_sq = 1;
2508         status = irdma_handle_cqp_op(iwdev->rf, cqp_request);
2509         if (status && cm_node && !wait)
2510                 irdma_rem_ref_cm_node(cm_node);
2511
2512         irdma_put_cqp_request(iwcqp, cqp_request);
2513
2514         return status;
2515 }
2516
2517 /**
2518  * irdma_hw_flush_wqes_callback - Check return code after flush
2519  * @cqp_request: qhash cqp completion
2520  */
2521 static void irdma_hw_flush_wqes_callback(struct irdma_cqp_request *cqp_request)
2522 {
2523         struct irdma_qp_flush_info *hw_info;
2524         struct irdma_sc_qp *qp;
2525         struct irdma_qp *iwqp;
2526         struct cqp_cmds_info *cqp_info;
2527
2528         cqp_info = &cqp_request->info;
2529         hw_info = &cqp_info->in.u.qp_flush_wqes.info;
2530         qp = cqp_info->in.u.qp_flush_wqes.qp;
2531         iwqp = qp->qp_uk.back_qp;
2532
2533         if (cqp_request->compl_info.maj_err_code)
2534                 return;
2535
2536         if (hw_info->rq &&
2537             (cqp_request->compl_info.min_err_code == IRDMA_CQP_COMPL_SQ_WQE_FLUSHED ||
2538              cqp_request->compl_info.min_err_code == 0)) {
2539                 /* RQ WQE flush was requested but did not happen */
2540                 qp->qp_uk.rq_flush_complete = true;
2541         }
2542         if (hw_info->sq &&
2543             (cqp_request->compl_info.min_err_code == IRDMA_CQP_COMPL_RQ_WQE_FLUSHED ||
2544              cqp_request->compl_info.min_err_code == 0)) {
2545                 if (IRDMA_RING_MORE_WORK(qp->qp_uk.sq_ring)) {
2546                         ibdev_err(&iwqp->iwdev->ibdev, "Flush QP[%d] failed, SQ has more work",
2547                                   qp->qp_uk.qp_id);
2548                         irdma_ib_qp_event(iwqp, IRDMA_QP_EVENT_CATASTROPHIC);
2549                 }
2550                 qp->qp_uk.sq_flush_complete = true;
2551         }
2552 }
2553
2554 /**
2555  * irdma_hw_flush_wqes - flush qp's wqe
2556  * @rf: RDMA PCI function
2557  * @qp: hardware control qp
2558  * @info: info for flush
2559  * @wait: flag wait for completion
2560  */
2561 enum irdma_status_code irdma_hw_flush_wqes(struct irdma_pci_f *rf,
2562                                            struct irdma_sc_qp *qp,
2563                                            struct irdma_qp_flush_info *info,
2564                                            bool wait)
2565 {
2566         enum irdma_status_code status;
2567         struct irdma_qp_flush_info *hw_info;
2568         struct irdma_cqp_request *cqp_request;
2569         struct cqp_cmds_info *cqp_info;
2570         struct irdma_qp *iwqp = qp->qp_uk.back_qp;
2571
2572         cqp_request = irdma_alloc_and_get_cqp_request(&rf->cqp, wait);
2573         if (!cqp_request)
2574                 return IRDMA_ERR_NO_MEMORY;
2575
2576         cqp_info = &cqp_request->info;
2577         if (!wait)
2578                 cqp_request->callback_fcn = irdma_hw_flush_wqes_callback;
2579         hw_info = &cqp_request->info.in.u.qp_flush_wqes.info;
2580         memcpy(hw_info, info, sizeof(*hw_info));
2581         cqp_info->cqp_cmd = IRDMA_OP_QP_FLUSH_WQES;
2582         cqp_info->post_sq = 1;
2583         cqp_info->in.u.qp_flush_wqes.qp = qp;
2584         cqp_info->in.u.qp_flush_wqes.scratch = (uintptr_t)cqp_request;
2585         status = irdma_handle_cqp_op(rf, cqp_request);
2586         if (status) {
2587                 qp->qp_uk.sq_flush_complete = true;
2588                 qp->qp_uk.rq_flush_complete = true;
2589                 irdma_put_cqp_request(&rf->cqp, cqp_request);
2590                 return status;
2591         }
2592
2593         if (!wait || cqp_request->compl_info.maj_err_code)
2594                 goto put_cqp;
2595
2596         if (info->rq) {
2597                 if (cqp_request->compl_info.min_err_code == IRDMA_CQP_COMPL_SQ_WQE_FLUSHED ||
2598                     cqp_request->compl_info.min_err_code == 0) {
2599                         /* RQ WQE flush was requested but did not happen */
2600                         qp->qp_uk.rq_flush_complete = true;
2601                 }
2602         }
2603         if (info->sq) {
2604                 if (cqp_request->compl_info.min_err_code == IRDMA_CQP_COMPL_RQ_WQE_FLUSHED ||
2605                     cqp_request->compl_info.min_err_code == 0) {
2606                         /*
2607                          * Handling case where WQE is posted to empty SQ when
2608                          * flush has not completed
2609                          */
2610                         if (IRDMA_RING_MORE_WORK(qp->qp_uk.sq_ring)) {
2611                                 struct irdma_cqp_request *new_req;
2612
2613                                 if (!qp->qp_uk.sq_flush_complete)
2614                                         goto put_cqp;
2615                                 qp->qp_uk.sq_flush_complete = false;
2616                                 qp->flush_sq = false;
2617
2618                                 info->rq = false;
2619                                 info->sq = true;
2620                                 new_req = irdma_alloc_and_get_cqp_request(&rf->cqp, true);
2621                                 if (!new_req) {
2622                                         status = IRDMA_ERR_NO_MEMORY;
2623                                         goto put_cqp;
2624                                 }
2625                                 cqp_info = &new_req->info;
2626                                 hw_info = &new_req->info.in.u.qp_flush_wqes.info;
2627                                 memcpy(hw_info, info, sizeof(*hw_info));
2628                                 cqp_info->cqp_cmd = IRDMA_OP_QP_FLUSH_WQES;
2629                                 cqp_info->post_sq = 1;
2630                                 cqp_info->in.u.qp_flush_wqes.qp = qp;
2631                                 cqp_info->in.u.qp_flush_wqes.scratch = (uintptr_t)new_req;
2632
2633                                 status = irdma_handle_cqp_op(rf, new_req);
2634                                 if (new_req->compl_info.maj_err_code ||
2635                                     new_req->compl_info.min_err_code != IRDMA_CQP_COMPL_SQ_WQE_FLUSHED ||
2636                                     status) {
2637                                         ibdev_err(&iwqp->iwdev->ibdev, "fatal QP event: SQ in error but not flushed, qp: %d",
2638                                                   iwqp->ibqp.qp_num);
2639                                         qp->qp_uk.sq_flush_complete = false;
2640                                         irdma_ib_qp_event(iwqp, IRDMA_QP_EVENT_CATASTROPHIC);
2641                                 }
2642                                 irdma_put_cqp_request(&rf->cqp, new_req);
2643                         } else {
2644                                 /* SQ WQE flush was requested but did not happen */
2645                                 qp->qp_uk.sq_flush_complete = true;
2646                         }
2647                 } else {
2648                         if (!IRDMA_RING_MORE_WORK(qp->qp_uk.sq_ring))
2649                                 qp->qp_uk.sq_flush_complete = true;
2650                 }
2651         }
2652
2653         ibdev_dbg(&rf->iwdev->ibdev,
2654                   "VERBS: qp_id=%d qp_type=%d qpstate=%d ibqpstate=%d last_aeq=%d hw_iw_state=%d maj_err_code=%d min_err_code=%d\n",
2655                   iwqp->ibqp.qp_num, rf->protocol_used, iwqp->iwarp_state,
2656                   iwqp->ibqp_state, iwqp->last_aeq, iwqp->hw_iwarp_state,
2657                   cqp_request->compl_info.maj_err_code,
2658                   cqp_request->compl_info.min_err_code);
2659 put_cqp:
2660         irdma_put_cqp_request(&rf->cqp, cqp_request);
2661
2662         return status;
2663 }
2664
2665 /**
2666  * irdma_gen_ae - generate AE
2667  * @rf: RDMA PCI function
2668  * @qp: qp associated with AE
2669  * @info: info for ae
2670  * @wait: wait for completion
2671  */
2672 void irdma_gen_ae(struct irdma_pci_f *rf, struct irdma_sc_qp *qp,
2673                   struct irdma_gen_ae_info *info, bool wait)
2674 {
2675         struct irdma_gen_ae_info *ae_info;
2676         struct irdma_cqp_request *cqp_request;
2677         struct cqp_cmds_info *cqp_info;
2678
2679         cqp_request = irdma_alloc_and_get_cqp_request(&rf->cqp, wait);
2680         if (!cqp_request)
2681                 return;
2682
2683         cqp_info = &cqp_request->info;
2684         ae_info = &cqp_request->info.in.u.gen_ae.info;
2685         memcpy(ae_info, info, sizeof(*ae_info));
2686         cqp_info->cqp_cmd = IRDMA_OP_GEN_AE;
2687         cqp_info->post_sq = 1;
2688         cqp_info->in.u.gen_ae.qp = qp;
2689         cqp_info->in.u.gen_ae.scratch = (uintptr_t)cqp_request;
2690
2691         irdma_handle_cqp_op(rf, cqp_request);
2692         irdma_put_cqp_request(&rf->cqp, cqp_request);
2693 }
2694
2695 void irdma_flush_wqes(struct irdma_qp *iwqp, u32 flush_mask)
2696 {
2697         struct irdma_qp_flush_info info = {};
2698         struct irdma_pci_f *rf = iwqp->iwdev->rf;
2699         u8 flush_code = iwqp->sc_qp.flush_code;
2700
2701         if (!(flush_mask & IRDMA_FLUSH_SQ) && !(flush_mask & IRDMA_FLUSH_RQ))
2702                 return;
2703
2704         /* Set flush info fields*/
2705         info.sq = flush_mask & IRDMA_FLUSH_SQ;
2706         info.rq = flush_mask & IRDMA_FLUSH_RQ;
2707
2708         if (flush_mask & IRDMA_REFLUSH) {
2709                 if (info.sq)
2710                         iwqp->sc_qp.flush_sq = false;
2711                 if (info.rq)
2712                         iwqp->sc_qp.flush_rq = false;
2713         }
2714
2715         /* Generate userflush errors in CQE */
2716         info.sq_major_code = IRDMA_FLUSH_MAJOR_ERR;
2717         info.sq_minor_code = FLUSH_GENERAL_ERR;
2718         info.rq_major_code = IRDMA_FLUSH_MAJOR_ERR;
2719         info.rq_minor_code = FLUSH_GENERAL_ERR;
2720         info.userflushcode = true;
2721         if (flush_code) {
2722                 if (info.sq && iwqp->sc_qp.sq_flush_code)
2723                         info.sq_minor_code = flush_code;
2724                 if (info.rq && iwqp->sc_qp.rq_flush_code)
2725                         info.rq_minor_code = flush_code;
2726         }
2727
2728         /* Issue flush */
2729         (void)irdma_hw_flush_wqes(rf, &iwqp->sc_qp, &info,
2730                                   flush_mask & IRDMA_FLUSH_WAIT);
2731         iwqp->flush_issued = true;
2732 }