drivers/scsi/bnx2i/bnx2i_hwi.c

   1 /* bnx2i_hwi.c: Broadcom NetXtreme II iSCSI driver.
   2  *
   3  * Copyright (c) 2006 - 2013 Broadcom Corporation
   4  * Copyright (c) 2007, 2008 Red Hat, Inc.  All rights reserved.
   5  * Copyright (c) 2007, 2008 Mike Christie
   6  *
   7  * This program is free software; you can redistribute it and/or modify
   8  * it under the terms of the GNU General Public License as published by
   9  * the Free Software Foundation.
  10  *
  11  * Written by: Anil Veerabhadrappa (anilgv@broadcom.com)
  12  * Maintained by: Eddie Wai (eddie.wai@broadcom.com)
  13  */
  14
  15 #include <linux/gfp.h>
  16 #include <scsi/scsi_tcq.h>
  17 #include <scsi/libiscsi.h>
  18 #include "bnx2i.h"
  19
  20 DECLARE_PER_CPU(struct bnx2i_percpu_s, bnx2i_percpu);
  21
  22 /**
  23  * bnx2i_get_cid_num - get cid from ep
  24  * @ep:         endpoint pointer
  25  *
  26  * Only applicable to 57710 family of devices
  27  */
  28 static u32 bnx2i_get_cid_num(struct bnx2i_endpoint *ep)
  29 {
  30         u32 cid;
  31
  32         if (test_bit(BNX2I_NX2_DEV_57710, &ep->hba->cnic_dev_type))
  33                 cid = ep->ep_cid;
  34         else
  35                 cid = GET_CID_NUM(ep->ep_cid);
  36         return cid;
  37 }
  38
  39
  40 /**
  41  * bnx2i_adjust_qp_size - Adjust SQ/RQ/CQ size for 57710 device type
  42  * @hba:                Adapter for which adjustments is to be made
  43  *
  44  * Only applicable to 57710 family of devices
  45  */
  46 static void bnx2i_adjust_qp_size(struct bnx2i_hba *hba)
  47 {
  48         u32 num_elements_per_pg;
  49
  50         if (test_bit(BNX2I_NX2_DEV_5706, &hba->cnic_dev_type) ||
  51             test_bit(BNX2I_NX2_DEV_5708, &hba->cnic_dev_type) ||
  52             test_bit(BNX2I_NX2_DEV_5709, &hba->cnic_dev_type)) {
  53                 if (!is_power_of_2(hba->max_sqes))
  54                         hba->max_sqes = rounddown_pow_of_two(hba->max_sqes);
  55
  56                 if (!is_power_of_2(hba->max_rqes))
  57                         hba->max_rqes = rounddown_pow_of_two(hba->max_rqes);
  58         }
  59
  60         /* Adjust each queue size if the user selection does not
  61          * yield integral num of page buffers
  62          */
  63         /* adjust SQ */
  64         num_elements_per_pg = PAGE_SIZE / BNX2I_SQ_WQE_SIZE;
  65         if (hba->max_sqes < num_elements_per_pg)
  66                 hba->max_sqes = num_elements_per_pg;
  67         else if (hba->max_sqes % num_elements_per_pg)
  68                 hba->max_sqes = (hba->max_sqes + num_elements_per_pg - 1) &
  69                                  ~(num_elements_per_pg - 1);
  70
  71         /* adjust CQ */
  72         num_elements_per_pg = PAGE_SIZE / BNX2I_CQE_SIZE;
  73         if (hba->max_cqes < num_elements_per_pg)
  74                 hba->max_cqes = num_elements_per_pg;
  75         else if (hba->max_cqes % num_elements_per_pg)
  76                 hba->max_cqes = (hba->max_cqes + num_elements_per_pg - 1) &
  77                                  ~(num_elements_per_pg - 1);
  78
  79         /* adjust RQ */
  80         num_elements_per_pg = PAGE_SIZE / BNX2I_RQ_WQE_SIZE;
  81         if (hba->max_rqes < num_elements_per_pg)
  82                 hba->max_rqes = num_elements_per_pg;
  83         else if (hba->max_rqes % num_elements_per_pg)
  84                 hba->max_rqes = (hba->max_rqes + num_elements_per_pg - 1) &
  85                                  ~(num_elements_per_pg - 1);
  86 }
  87
  88
  89 /**
  90  * bnx2i_get_link_state - get network interface link state
  91  * @hba:        adapter instance pointer
  92  *
  93  * updates adapter structure flag based on netdev state
  94  */
  95 static void bnx2i_get_link_state(struct bnx2i_hba *hba)
  96 {
  97         if (test_bit(__LINK_STATE_NOCARRIER, &hba->netdev->state))
  98                 set_bit(ADAPTER_STATE_LINK_DOWN, &hba->adapter_state);
  99         else
 100                 clear_bit(ADAPTER_STATE_LINK_DOWN, &hba->adapter_state);
 101 }
 102
 103
 104 /**
 105  * bnx2i_iscsi_license_error - displays iscsi license related error message
 106  * @hba:                adapter instance pointer
 107  * @error_code:         error classification
 108  *
 109  * Puts out an error log when driver is unable to offload iscsi connection
 110  *      due to license restrictions
 111  */
 112 static void bnx2i_iscsi_license_error(struct bnx2i_hba *hba, u32 error_code)
 113 {
 114         if (error_code == ISCSI_KCQE_COMPLETION_STATUS_ISCSI_NOT_SUPPORTED)
 115                 /* iSCSI offload not supported on this device */
 116                 printk(KERN_ERR "bnx2i: iSCSI not supported, dev=%s\n",
 117                                 hba->netdev->name);
 118         if (error_code == ISCSI_KCQE_COMPLETION_STATUS_LOM_ISCSI_NOT_ENABLED)
 119                 /* iSCSI offload not supported on this LOM device */
 120                 printk(KERN_ERR "bnx2i: LOM is not enable to "
 121                                 "offload iSCSI connections, dev=%s\n",
 122                                 hba->netdev->name);
 123         set_bit(ADAPTER_STATE_INIT_FAILED, &hba->adapter_state);
 124 }
 125
 126
 127 /**
 128  * bnx2i_arm_cq_event_coalescing - arms CQ to enable EQ notification
 129  * @ep:         endpoint (transport identifier) structure
 130  * @action:     action, ARM or DISARM. For now only ARM_CQE is used
 131  *
 132  * Arm'ing CQ will enable chip to generate global EQ events inorder to interrupt
 133  *      the driver. EQ event is generated CQ index is hit or at least 1 CQ is
 134  *      outstanding and on chip timer expires
 135  */
 136 int bnx2i_arm_cq_event_coalescing(struct bnx2i_endpoint *ep, u8 action)
 137 {
 138         struct bnx2i_5771x_cq_db *cq_db;
 139         u16 cq_index;
 140         u16 next_index = 0;
 141         u32 num_active_cmds;
 142
 143         /* Coalesce CQ entries only on 10G devices */
 144         if (!test_bit(BNX2I_NX2_DEV_57710, &ep->hba->cnic_dev_type))
 145                 return 0;
 146
 147         /* Do not update CQ DB multiple times before firmware writes
 148          * '0xFFFF' to CQDB->SQN field. Deviation may cause spurious
 149          * interrupts and other unwanted results
 150          */
 151         cq_db = (struct bnx2i_5771x_cq_db *) ep->qp.cq_pgtbl_virt;
 152
 153         if (action != CNIC_ARM_CQE_FP)
 154                 if (cq_db->sqn[0] && cq_db->sqn[0] != 0xFFFF)
 155                         return 0;
 156
 157         if (action == CNIC_ARM_CQE || action == CNIC_ARM_CQE_FP) {
 158                 num_active_cmds = atomic_read(&ep->num_active_cmds);
 159                 if (num_active_cmds <= event_coal_min)
 160                         next_index = 1;
 161                 else {
 162                         next_index = num_active_cmds >> ep->ec_shift;
 163                         if (next_index > num_active_cmds - event_coal_min)
 164                                 next_index = num_active_cmds - event_coal_min;
 165                 }
 166                 if (!next_index)
 167                         next_index = 1;
 168                 cq_index = ep->qp.cqe_exp_seq_sn + next_index - 1;
 169                 if (cq_index > ep->qp.cqe_size * 2)
 170                         cq_index -= ep->qp.cqe_size * 2;
 171                 if (!cq_index)
 172                         cq_index = 1;
 173
 174                 cq_db->sqn[0] = cq_index;
 175         }
 176         return next_index;
 177 }
 178
 179
 180 /**
 181  * bnx2i_get_rq_buf - copy RQ buffer contents to driver buffer
 182  * @conn:               iscsi connection on which RQ event occurred
 183  * @ptr:                driver buffer to which RQ buffer contents is to
 184  *                      be copied
 185  * @len:                length of valid data inside RQ buf
 186  *
 187  * Copies RQ buffer contents from shared (DMA'able) memory region to
 188  *      driver buffer. RQ is used to DMA unsolicitated iscsi pdu's and
 189  *      scsi sense info
 190  */
 191 void bnx2i_get_rq_buf(struct bnx2i_conn *bnx2i_conn, char *ptr, int len)
 192 {
 193         if (!bnx2i_conn->ep->qp.rqe_left)
 194                 return;
 195
 196         bnx2i_conn->ep->qp.rqe_left--;
 197         memcpy(ptr, (u8 *) bnx2i_conn->ep->qp.rq_cons_qe, len);
 198         if (bnx2i_conn->ep->qp.rq_cons_qe == bnx2i_conn->ep->qp.rq_last_qe) {
 199                 bnx2i_conn->ep->qp.rq_cons_qe = bnx2i_conn->ep->qp.rq_first_qe;
 200                 bnx2i_conn->ep->qp.rq_cons_idx = 0;
 201         } else {
 202                 bnx2i_conn->ep->qp.rq_cons_qe++;
 203                 bnx2i_conn->ep->qp.rq_cons_idx++;
 204         }
 205 }
 206
 207
 208 static void bnx2i_ring_577xx_doorbell(struct bnx2i_conn *conn)
 209 {
 210         struct bnx2i_5771x_dbell dbell;
 211         u32 msg;
 212
 213         memset(&dbell, 0, sizeof(dbell));
 214         dbell.dbell.header = (B577XX_ISCSI_CONNECTION_TYPE <<
 215                               B577XX_DOORBELL_HDR_CONN_TYPE_SHIFT);
 216         msg = *((u32 *)&dbell);
 217         /* TODO : get doorbell register mapping */
 218         writel(cpu_to_le32(msg), conn->ep->qp.ctx_base);
 219 }
 220
 221
 222 /**
 223  * bnx2i_put_rq_buf - Replenish RQ buffer, if required ring on chip doorbell
 224  * @conn:       iscsi connection on which event to post
 225  * @count:      number of RQ buffer being posted to chip
 226  *
 227  * No need to ring hardware doorbell for 57710 family of devices
 228  */
 229 void bnx2i_put_rq_buf(struct bnx2i_conn *bnx2i_conn, int count)
 230 {
 231         struct bnx2i_5771x_sq_rq_db *rq_db;
 232         u16 hi_bit = (bnx2i_conn->ep->qp.rq_prod_idx & 0x8000);
 233         struct bnx2i_endpoint *ep = bnx2i_conn->ep;
 234
 235         ep->qp.rqe_left += count;
 236         ep->qp.rq_prod_idx &= 0x7FFF;
 237         ep->qp.rq_prod_idx += count;
 238
 239         if (ep->qp.rq_prod_idx > bnx2i_conn->hba->max_rqes) {
 240                 ep->qp.rq_prod_idx %= bnx2i_conn->hba->max_rqes;
 241                 if (!hi_bit)
 242                         ep->qp.rq_prod_idx |= 0x8000;
 243         } else
 244                 ep->qp.rq_prod_idx |= hi_bit;
 245
 246         if (test_bit(BNX2I_NX2_DEV_57710, &ep->hba->cnic_dev_type)) {
 247                 rq_db = (struct bnx2i_5771x_sq_rq_db *) ep->qp.rq_pgtbl_virt;
 248                 rq_db->prod_idx = ep->qp.rq_prod_idx;
 249                 /* no need to ring hardware doorbell for 57710 */
 250         } else {
 251                 writew(ep->qp.rq_prod_idx,
 252                        ep->qp.ctx_base + CNIC_RECV_DOORBELL);
 253         }
 254         mmiowb();
 255 }
 256
 257
 258 /**
 259  * bnx2i_ring_sq_dbell - Ring SQ doorbell to wake-up the processing engine
 260  * @conn:               iscsi connection to which new SQ entries belong
 261  * @count:              number of SQ WQEs to post
 262  *
 263  * SQ DB is updated in host memory and TX Doorbell is rung for 57710 family
 264  *      of devices. For 5706/5708/5709 new SQ WQE count is written into the
 265  *      doorbell register
 266  */
 267 static void bnx2i_ring_sq_dbell(struct bnx2i_conn *bnx2i_conn, int count)
 268 {
 269         struct bnx2i_5771x_sq_rq_db *sq_db;
 270         struct bnx2i_endpoint *ep = bnx2i_conn->ep;
 271
 272         atomic_inc(&ep->num_active_cmds);
 273         wmb();  /* flush SQ WQE memory before the doorbell is rung */
 274         if (test_bit(BNX2I_NX2_DEV_57710, &ep->hba->cnic_dev_type)) {
 275                 sq_db = (struct bnx2i_5771x_sq_rq_db *) ep->qp.sq_pgtbl_virt;
 276                 sq_db->prod_idx = ep->qp.sq_prod_idx;
 277                 bnx2i_ring_577xx_doorbell(bnx2i_conn);
 278         } else
 279                 writew(count, ep->qp.ctx_base + CNIC_SEND_DOORBELL);
 280
 281         mmiowb(); /* flush posted PCI writes */
 282 }
 283
 284
 285 /**
 286  * bnx2i_ring_dbell_update_sq_params - update SQ driver parameters
 287  * @conn:       iscsi connection to which new SQ entries belong
 288  * @count:      number of SQ WQEs to post
 289  *
 290  * this routine will update SQ driver parameters and ring the doorbell
 291  */
 292 static void bnx2i_ring_dbell_update_sq_params(struct bnx2i_conn *bnx2i_conn,
 293                                               int count)
 294 {
 295         int tmp_cnt;
 296
 297         if (count == 1) {
 298                 if (bnx2i_conn->ep->qp.sq_prod_qe ==
 299                     bnx2i_conn->ep->qp.sq_last_qe)
 300                         bnx2i_conn->ep->qp.sq_prod_qe =
 301                                                 bnx2i_conn->ep->qp.sq_first_qe;
 302                 else
 303                         bnx2i_conn->ep->qp.sq_prod_qe++;
 304         } else {
 305                 if ((bnx2i_conn->ep->qp.sq_prod_qe + count) <=
 306                     bnx2i_conn->ep->qp.sq_last_qe)
 307                         bnx2i_conn->ep->qp.sq_prod_qe += count;
 308                 else {
 309                         tmp_cnt = bnx2i_conn->ep->qp.sq_last_qe -
 310                                 bnx2i_conn->ep->qp.sq_prod_qe;
 311                         bnx2i_conn->ep->qp.sq_prod_qe =
 312                                 &bnx2i_conn->ep->qp.sq_first_qe[count -
 313                                                                 (tmp_cnt + 1)];
 314                 }
 315         }
 316         bnx2i_conn->ep->qp.sq_prod_idx += count;
 317         /* Ring the doorbell */
 318         bnx2i_ring_sq_dbell(bnx2i_conn, bnx2i_conn->ep->qp.sq_prod_idx);
 319 }
 320
 321
 322 /**
 323  * bnx2i_send_iscsi_login - post iSCSI login request MP WQE to hardware
 324  * @conn:       iscsi connection
 325  * @cmd:        driver command structure which is requesting
 326  *              a WQE to sent to chip for further processing
 327  *
 328  * prepare and post an iSCSI Login request WQE to CNIC firmware
 329  */
 330 int bnx2i_send_iscsi_login(struct bnx2i_conn *bnx2i_conn,
 331                            struct iscsi_task *task)
 332 {
 333         struct bnx2i_cmd *bnx2i_cmd;
 334         struct bnx2i_login_request *login_wqe;
 335         struct iscsi_login_req *login_hdr;
 336         u32 dword;
 337
 338         bnx2i_cmd = (struct bnx2i_cmd *)task->dd_data;
 339         login_hdr = (struct iscsi_login_req *)task->hdr;
 340         login_wqe = (struct bnx2i_login_request *)
 341                                                 bnx2i_conn->ep->qp.sq_prod_qe;
 342
 343         login_wqe->op_code = login_hdr->opcode;
 344         login_wqe->op_attr = login_hdr->flags;
 345         login_wqe->version_max = login_hdr->max_version;
 346         login_wqe->version_min = login_hdr->min_version;
 347         login_wqe->data_length = ntoh24(login_hdr->dlength);
 348         login_wqe->isid_lo = *((u32 *) login_hdr->isid);
 349         login_wqe->isid_hi = *((u16 *) login_hdr->isid + 2);
 350         login_wqe->tsih = login_hdr->tsih;
 351         login_wqe->itt = task->itt |
 352                 (ISCSI_TASK_TYPE_MPATH << ISCSI_LOGIN_REQUEST_TYPE_SHIFT);
 353         login_wqe->cid = login_hdr->cid;
 354
 355         login_wqe->cmd_sn = be32_to_cpu(login_hdr->cmdsn);
 356         login_wqe->exp_stat_sn = be32_to_cpu(login_hdr->exp_statsn);
 357         login_wqe->flags = ISCSI_LOGIN_REQUEST_UPDATE_EXP_STAT_SN;
 358
 359         login_wqe->resp_bd_list_addr_lo = (u32) bnx2i_conn->gen_pdu.resp_bd_dma;
 360         login_wqe->resp_bd_list_addr_hi =
 361                 (u32) ((u64) bnx2i_conn->gen_pdu.resp_bd_dma >> 32);
 362
 363         dword = ((1 << ISCSI_LOGIN_REQUEST_NUM_RESP_BDS_SHIFT) |
 364                  (bnx2i_conn->gen_pdu.resp_buf_size <<
 365                   ISCSI_LOGIN_REQUEST_RESP_BUFFER_LENGTH_SHIFT));
 366         login_wqe->resp_buffer = dword;
 367         login_wqe->bd_list_addr_lo = (u32) bnx2i_conn->gen_pdu.req_bd_dma;
 368         login_wqe->bd_list_addr_hi =
 369                 (u32) ((u64) bnx2i_conn->gen_pdu.req_bd_dma >> 32);
 370         login_wqe->num_bds = 1;
 371         login_wqe->cq_index = 0; /* CQ# used for completion, 5771x only */
 372
 373         bnx2i_ring_dbell_update_sq_params(bnx2i_conn, 1);
 374         return 0;
 375 }
 376
 377 /**
 378  * bnx2i_send_iscsi_tmf - post iSCSI task management request MP WQE to hardware
 379  * @conn:       iscsi connection
 380  * @mtask:      driver command structure which is requesting
 381  *              a WQE to sent to chip for further processing
 382  *
 383  * prepare and post an iSCSI Login request WQE to CNIC firmware
 384  */
 385 int bnx2i_send_iscsi_tmf(struct bnx2i_conn *bnx2i_conn,
 386                          struct iscsi_task *mtask)
 387 {
 388         struct iscsi_conn *conn = bnx2i_conn->cls_conn->dd_data;
 389         struct iscsi_tm *tmfabort_hdr;
 390         struct scsi_cmnd *ref_sc;
 391         struct iscsi_task *ctask;
 392         struct bnx2i_cmd *bnx2i_cmd;
 393         struct bnx2i_tmf_request *tmfabort_wqe;
 394         u32 dword;
 395         u32 scsi_lun[2];
 396
 397         bnx2i_cmd = (struct bnx2i_cmd *)mtask->dd_data;
 398         tmfabort_hdr = (struct iscsi_tm *)mtask->hdr;
 399         tmfabort_wqe = (struct bnx2i_tmf_request *)
 400                                                 bnx2i_conn->ep->qp.sq_prod_qe;
 401
 402         tmfabort_wqe->op_code = tmfabort_hdr->opcode;
 403         tmfabort_wqe->op_attr = tmfabort_hdr->flags;
 404
 405         tmfabort_wqe->itt = (mtask->itt | (ISCSI_TASK_TYPE_MPATH << 14));
 406         tmfabort_wqe->reserved2 = 0;
 407         tmfabort_wqe->cmd_sn = be32_to_cpu(tmfabort_hdr->cmdsn);
 408
 409         switch (tmfabort_hdr->flags & ISCSI_FLAG_TM_FUNC_MASK) {
 410         case ISCSI_TM_FUNC_ABORT_TASK:
 411         case ISCSI_TM_FUNC_TASK_REASSIGN:
 412                 ctask = iscsi_itt_to_task(conn, tmfabort_hdr->rtt);
 413                 if (!ctask || !ctask->sc)
 414                         /*
 415                          * the iscsi layer must have completed the cmd while
 416                          * was starting up.
 417                          *
 418                          * Note: In the case of a SCSI cmd timeout, the task's
 419                          *       sc is still active; hence ctask->sc != 0
 420                          *       In this case, the task must be aborted
 421                          */
 422                         return 0;
 423
 424                 ref_sc = ctask->sc;
 425                 if (ref_sc->sc_data_direction == DMA_TO_DEVICE)
 426                         dword = (ISCSI_TASK_TYPE_WRITE <<
 427                                  ISCSI_CMD_REQUEST_TYPE_SHIFT);
 428                 else
 429                         dword = (ISCSI_TASK_TYPE_READ <<
 430                                  ISCSI_CMD_REQUEST_TYPE_SHIFT);
 431                 tmfabort_wqe->ref_itt = (dword |
 432                                         (tmfabort_hdr->rtt & ISCSI_ITT_MASK));
 433                 break;
 434         default:
 435                 tmfabort_wqe->ref_itt = RESERVED_ITT;
 436         }
 437         memcpy(scsi_lun, &tmfabort_hdr->lun, sizeof(struct scsi_lun));
 438         tmfabort_wqe->lun[0] = be32_to_cpu(scsi_lun[0]);
 439         tmfabort_wqe->lun[1] = be32_to_cpu(scsi_lun[1]);
 440
 441         tmfabort_wqe->ref_cmd_sn = be32_to_cpu(tmfabort_hdr->refcmdsn);
 442
 443         tmfabort_wqe->bd_list_addr_lo = (u32) bnx2i_conn->hba->mp_bd_dma;
 444         tmfabort_wqe->bd_list_addr_hi = (u32)
 445                                 ((u64) bnx2i_conn->hba->mp_bd_dma >> 32);
 446         tmfabort_wqe->num_bds = 1;
 447         tmfabort_wqe->cq_index = 0; /* CQ# used for completion, 5771x only */
 448
 449         bnx2i_ring_dbell_update_sq_params(bnx2i_conn, 1);
 450         return 0;
 451 }
 452
 453 /**
 454  * bnx2i_send_iscsi_text - post iSCSI text WQE to hardware
 455  * @conn:       iscsi connection
 456  * @mtask:      driver command structure which is requesting
 457  *              a WQE to sent to chip for further processing
 458  *
 459  * prepare and post an iSCSI Text request WQE to CNIC firmware
 460  */
 461 int bnx2i_send_iscsi_text(struct bnx2i_conn *bnx2i_conn,
 462                           struct iscsi_task *mtask)
 463 {
 464         struct bnx2i_cmd *bnx2i_cmd;
 465         struct bnx2i_text_request *text_wqe;
 466         struct iscsi_text *text_hdr;
 467         u32 dword;
 468
 469         bnx2i_cmd = (struct bnx2i_cmd *)mtask->dd_data;
 470         text_hdr = (struct iscsi_text *)mtask->hdr;
 471         text_wqe = (struct bnx2i_text_request *) bnx2i_conn->ep->qp.sq_prod_qe;
 472
 473         memset(text_wqe, 0, sizeof(struct bnx2i_text_request));
 474
 475         text_wqe->op_code = text_hdr->opcode;
 476         text_wqe->op_attr = text_hdr->flags;
 477         text_wqe->data_length = ntoh24(text_hdr->dlength);
 478         text_wqe->itt = mtask->itt |
 479                 (ISCSI_TASK_TYPE_MPATH << ISCSI_TEXT_REQUEST_TYPE_SHIFT);
 480         text_wqe->ttt = be32_to_cpu(text_hdr->ttt);
 481
 482         text_wqe->cmd_sn = be32_to_cpu(text_hdr->cmdsn);
 483
 484         text_wqe->resp_bd_list_addr_lo = (u32) bnx2i_conn->gen_pdu.resp_bd_dma;
 485         text_wqe->resp_bd_list_addr_hi =
 486                         (u32) ((u64) bnx2i_conn->gen_pdu.resp_bd_dma >> 32);
 487
 488         dword = ((1 << ISCSI_TEXT_REQUEST_NUM_RESP_BDS_SHIFT) |
 489                  (bnx2i_conn->gen_pdu.resp_buf_size <<
 490                   ISCSI_TEXT_REQUEST_RESP_BUFFER_LENGTH_SHIFT));
 491         text_wqe->resp_buffer = dword;
 492         text_wqe->bd_list_addr_lo = (u32) bnx2i_conn->gen_pdu.req_bd_dma;
 493         text_wqe->bd_list_addr_hi =
 494                         (u32) ((u64) bnx2i_conn->gen_pdu.req_bd_dma >> 32);
 495         text_wqe->num_bds = 1;
 496         text_wqe->cq_index = 0; /* CQ# used for completion, 5771x only */
 497
 498         bnx2i_ring_dbell_update_sq_params(bnx2i_conn, 1);
 499         return 0;
 500 }
 501
 502
 503 /**
 504  * bnx2i_send_iscsi_scsicmd - post iSCSI scsicmd request WQE to hardware
 505  * @conn:       iscsi connection
 506  * @cmd:        driver command structure which is requesting
 507  *              a WQE to sent to chip for further processing
 508  *
 509  * prepare and post an iSCSI SCSI-CMD request WQE to CNIC firmware
 510  */
 511 int bnx2i_send_iscsi_scsicmd(struct bnx2i_conn *bnx2i_conn,
 512                              struct bnx2i_cmd *cmd)
 513 {
 514         struct bnx2i_cmd_request *scsi_cmd_wqe;
 515
 516         scsi_cmd_wqe = (struct bnx2i_cmd_request *)
 517                                                 bnx2i_conn->ep->qp.sq_prod_qe;
 518         memcpy(scsi_cmd_wqe, &cmd->req, sizeof(struct bnx2i_cmd_request));
 519         scsi_cmd_wqe->cq_index = 0; /* CQ# used for completion, 5771x only */
 520
 521         bnx2i_ring_dbell_update_sq_params(bnx2i_conn, 1);
 522         return 0;
 523 }
 524
 525 /**
 526  * bnx2i_send_iscsi_nopout - post iSCSI NOPOUT request WQE to hardware
 527  * @conn:               iscsi connection
 528  * @cmd:                driver command structure which is requesting
 529  *                      a WQE to sent to chip for further processing
 530  * @datap:              payload buffer pointer
 531  * @data_len:           payload data length
 532  * @unsol:              indicated whether nopout pdu is unsolicited pdu or
 533  *                      in response to target's NOPIN w/ TTT != FFFFFFFF
 534  *
 535  * prepare and post a nopout request WQE to CNIC firmware
 536  */
 537 int bnx2i_send_iscsi_nopout(struct bnx2i_conn *bnx2i_conn,
 538                             struct iscsi_task *task,
 539                             char *datap, int data_len, int unsol)
 540 {
 541         struct bnx2i_endpoint *ep = bnx2i_conn->ep;
 542         struct bnx2i_cmd *bnx2i_cmd;
 543         struct bnx2i_nop_out_request *nopout_wqe;
 544         struct iscsi_nopout *nopout_hdr;
 545
 546         bnx2i_cmd = (struct bnx2i_cmd *)task->dd_data;
 547         nopout_hdr = (struct iscsi_nopout *)task->hdr;
 548         nopout_wqe = (struct bnx2i_nop_out_request *)ep->qp.sq_prod_qe;
 549
 550         memset(nopout_wqe, 0x00, sizeof(struct bnx2i_nop_out_request));
 551
 552         nopout_wqe->op_code = nopout_hdr->opcode;
 553         nopout_wqe->op_attr = ISCSI_FLAG_CMD_FINAL;
 554         memcpy(nopout_wqe->lun, &nopout_hdr->lun, 8);
 555
 556         if (test_bit(BNX2I_NX2_DEV_57710, &ep->hba->cnic_dev_type)) {
 557                 u32 tmp = nopout_wqe->lun[0];
 558                 /* 57710 requires LUN field to be swapped */
 559                 nopout_wqe->lun[0] = nopout_wqe->lun[1];
 560                 nopout_wqe->lun[1] = tmp;
 561         }
 562
 563         nopout_wqe->itt = ((u16)task->itt |
 564                            (ISCSI_TASK_TYPE_MPATH <<
 565                             ISCSI_TMF_REQUEST_TYPE_SHIFT));
 566         nopout_wqe->ttt = be32_to_cpu(nopout_hdr->ttt);
 567         nopout_wqe->flags = 0;
 568         if (!unsol)
 569                 nopout_wqe->flags = ISCSI_NOP_OUT_REQUEST_LOCAL_COMPLETION;
 570         else if (nopout_hdr->itt == RESERVED_ITT)
 571                 nopout_wqe->flags = ISCSI_NOP_OUT_REQUEST_LOCAL_COMPLETION;
 572
 573         nopout_wqe->cmd_sn = be32_to_cpu(nopout_hdr->cmdsn);
 574         nopout_wqe->data_length = data_len;
 575         if (data_len) {
 576                 /* handle payload data, not required in first release */
 577                 printk(KERN_ALERT "NOPOUT: WARNING!! payload len != 0\n");
 578         } else {
 579                 nopout_wqe->bd_list_addr_lo = (u32)
 580                                         bnx2i_conn->hba->mp_bd_dma;
 581                 nopout_wqe->bd_list_addr_hi =
 582                         (u32) ((u64) bnx2i_conn->hba->mp_bd_dma >> 32);
 583                 nopout_wqe->num_bds = 1;
 584         }
 585         nopout_wqe->cq_index = 0; /* CQ# used for completion, 5771x only */
 586
 587         bnx2i_ring_dbell_update_sq_params(bnx2i_conn, 1);
 588         return 0;
 589 }
 590
 591
 592 /**
 593  * bnx2i_send_iscsi_logout - post iSCSI logout request WQE to hardware
 594  * @conn:       iscsi connection
 595  * @cmd:        driver command structure which is requesting
 596  *              a WQE to sent to chip for further processing
 597  *
 598  * prepare and post logout request WQE to CNIC firmware
 599  */
 600 int bnx2i_send_iscsi_logout(struct bnx2i_conn *bnx2i_conn,
 601                             struct iscsi_task *task)
 602 {
 603         struct bnx2i_cmd *bnx2i_cmd;
 604         struct bnx2i_logout_request *logout_wqe;
 605         struct iscsi_logout *logout_hdr;
 606
 607         bnx2i_cmd = (struct bnx2i_cmd *)task->dd_data;
 608         logout_hdr = (struct iscsi_logout *)task->hdr;
 609
 610         logout_wqe = (struct bnx2i_logout_request *)
 611                                                 bnx2i_conn->ep->qp.sq_prod_qe;
 612         memset(logout_wqe, 0x00, sizeof(struct bnx2i_logout_request));
 613
 614         logout_wqe->op_code = logout_hdr->opcode;
 615         logout_wqe->cmd_sn = be32_to_cpu(logout_hdr->cmdsn);
 616         logout_wqe->op_attr =
 617                         logout_hdr->flags | ISCSI_LOGOUT_REQUEST_ALWAYS_ONE;
 618         logout_wqe->itt = ((u16)task->itt |
 619                            (ISCSI_TASK_TYPE_MPATH <<
 620                             ISCSI_LOGOUT_REQUEST_TYPE_SHIFT));
 621         logout_wqe->data_length = 0;
 622         logout_wqe->cid = 0;
 623
 624         logout_wqe->bd_list_addr_lo = (u32) bnx2i_conn->hba->mp_bd_dma;
 625         logout_wqe->bd_list_addr_hi = (u32)
 626                                 ((u64) bnx2i_conn->hba->mp_bd_dma >> 32);
 627         logout_wqe->num_bds = 1;
 628         logout_wqe->cq_index = 0; /* CQ# used for completion, 5771x only */
 629
 630         bnx2i_conn->ep->state = EP_STATE_LOGOUT_SENT;
 631
 632         bnx2i_ring_dbell_update_sq_params(bnx2i_conn, 1);
 633         return 0;
 634 }
 635
 636
 637 /**
 638  * bnx2i_update_iscsi_conn - post iSCSI logout request WQE to hardware
 639  * @conn:       iscsi connection which requires iscsi parameter update
 640  *
 641  * sends down iSCSI Conn Update request to move iSCSI conn to FFP
 642  */
 643 void bnx2i_update_iscsi_conn(struct iscsi_conn *conn)
 644 {
 645         struct bnx2i_conn *bnx2i_conn = conn->dd_data;
 646         struct bnx2i_hba *hba = bnx2i_conn->hba;
 647         struct kwqe *kwqe_arr[2];
 648         struct iscsi_kwqe_conn_update *update_wqe;
 649         struct iscsi_kwqe_conn_update conn_update_kwqe;
 650
 651         update_wqe = &conn_update_kwqe;
 652
 653         update_wqe->hdr.op_code = ISCSI_KWQE_OPCODE_UPDATE_CONN;
 654         update_wqe->hdr.flags =
 655                 (ISCSI_KWQE_LAYER_CODE << ISCSI_KWQE_HEADER_LAYER_CODE_SHIFT);
 656
 657         /* 5771x requires conn context id to be passed as is */
 658         if (test_bit(BNX2I_NX2_DEV_57710, &bnx2i_conn->ep->hba->cnic_dev_type))
 659                 update_wqe->context_id = bnx2i_conn->ep->ep_cid;
 660         else
 661                 update_wqe->context_id = (bnx2i_conn->ep->ep_cid >> 7);
 662         update_wqe->conn_flags = 0;
 663         if (conn->hdrdgst_en)
 664                 update_wqe->conn_flags |= ISCSI_KWQE_CONN_UPDATE_HEADER_DIGEST;
 665         if (conn->datadgst_en)
 666                 update_wqe->conn_flags |= ISCSI_KWQE_CONN_UPDATE_DATA_DIGEST;
 667         if (conn->session->initial_r2t_en)
 668                 update_wqe->conn_flags |= ISCSI_KWQE_CONN_UPDATE_INITIAL_R2T;
 669         if (conn->session->imm_data_en)
 670                 update_wqe->conn_flags |= ISCSI_KWQE_CONN_UPDATE_IMMEDIATE_DATA;
 671
 672         update_wqe->max_send_pdu_length = conn->max_xmit_dlength;
 673         update_wqe->max_recv_pdu_length = conn->max_recv_dlength;
 674         update_wqe->first_burst_length = conn->session->first_burst;
 675         update_wqe->max_burst_length = conn->session->max_burst;
 676         update_wqe->exp_stat_sn = conn->exp_statsn;
 677         update_wqe->max_outstanding_r2ts = conn->session->max_r2t;
 678         update_wqe->session_error_recovery_level = conn->session->erl;
 679         iscsi_conn_printk(KERN_ALERT, conn,
 680                           "bnx2i: conn update - MBL 0x%x FBL 0x%x"
 681                           "MRDSL_I 0x%x MRDSL_T 0x%x \n",
 682                           update_wqe->max_burst_length,
 683                           update_wqe->first_burst_length,
 684                           update_wqe->max_recv_pdu_length,
 685                           update_wqe->max_send_pdu_length);
 686
 687         kwqe_arr[0] = (struct kwqe *) update_wqe;
 688         if (hba->cnic && hba->cnic->submit_kwqes)
 689                 hba->cnic->submit_kwqes(hba->cnic, kwqe_arr, 1);
 690 }
 691
 692
 693 /**
 694  * bnx2i_ep_ofld_timer - post iSCSI logout request WQE to hardware
 695  * @data:       endpoint (transport handle) structure pointer
 696  *
 697  * routine to handle connection offload/destroy request timeout
 698  */
 699 void bnx2i_ep_ofld_timer(unsigned long data)
 700 {
 701         struct bnx2i_endpoint *ep = (struct bnx2i_endpoint *) data;
 702
 703         if (ep->state == EP_STATE_OFLD_START) {
 704                 printk(KERN_ALERT "ofld_timer: CONN_OFLD timeout\n");
 705                 ep->state = EP_STATE_OFLD_FAILED;
 706         } else if (ep->state == EP_STATE_DISCONN_START) {
 707                 printk(KERN_ALERT "ofld_timer: CONN_DISCON timeout\n");
 708                 ep->state = EP_STATE_DISCONN_TIMEDOUT;
 709         } else if (ep->state == EP_STATE_CLEANUP_START) {
 710                 printk(KERN_ALERT "ofld_timer: CONN_CLEANUP timeout\n");
 711                 ep->state = EP_STATE_CLEANUP_FAILED;
 712         }
 713
 714         wake_up_interruptible(&ep->ofld_wait);
 715 }
 716
 717
 718 static int bnx2i_power_of2(u32 val)
 719 {
 720         u32 power = 0;
 721         if (val & (val - 1))
 722                 return power;
 723         val--;
 724         while (val) {
 725                 val = val >> 1;
 726                 power++;
 727         }
 728         return power;
 729 }
 730
 731
 732 /**
 733  * bnx2i_send_cmd_cleanup_req - send iscsi cmd context clean-up request
 734  * @hba:        adapter structure pointer
 735  * @cmd:        driver command structure which is requesting
 736  *              a WQE to sent to chip for further processing
 737  *
 738  * prepares and posts CONN_OFLD_REQ1/2 KWQE
 739  */
 740 void bnx2i_send_cmd_cleanup_req(struct bnx2i_hba *hba, struct bnx2i_cmd *cmd)
 741 {
 742         struct bnx2i_cleanup_request *cmd_cleanup;
 743
 744         cmd_cleanup =
 745                 (struct bnx2i_cleanup_request *)cmd->conn->ep->qp.sq_prod_qe;
 746         memset(cmd_cleanup, 0x00, sizeof(struct bnx2i_cleanup_request));
 747
 748         cmd_cleanup->op_code = ISCSI_OPCODE_CLEANUP_REQUEST;
 749         cmd_cleanup->itt = cmd->req.itt;
 750         cmd_cleanup->cq_index = 0; /* CQ# used for completion, 5771x only */
 751
 752         bnx2i_ring_dbell_update_sq_params(cmd->conn, 1);
 753 }
 754
 755
 756 /**
 757  * bnx2i_send_conn_destroy - initiates iscsi connection teardown process
 758  * @hba:        adapter structure pointer
 759  * @ep:         endpoint (transport identifier) structure
 760  *
 761  * this routine prepares and posts CONN_OFLD_REQ1/2 KWQE to initiate
 762  *      iscsi connection context clean-up process
 763  */
 764 int bnx2i_send_conn_destroy(struct bnx2i_hba *hba, struct bnx2i_endpoint *ep)
 765 {
 766         struct kwqe *kwqe_arr[2];
 767         struct iscsi_kwqe_conn_destroy conn_cleanup;
 768         int rc = -EINVAL;
 769
 770         memset(&conn_cleanup, 0x00, sizeof(struct iscsi_kwqe_conn_destroy));
 771
 772         conn_cleanup.hdr.op_code = ISCSI_KWQE_OPCODE_DESTROY_CONN;
 773         conn_cleanup.hdr.flags =
 774                 (ISCSI_KWQE_LAYER_CODE << ISCSI_KWQE_HEADER_LAYER_CODE_SHIFT);
 775         /* 5771x requires conn context id to be passed as is */
 776         if (test_bit(BNX2I_NX2_DEV_57710, &ep->hba->cnic_dev_type))
 777                 conn_cleanup.context_id = ep->ep_cid;
 778         else
 779                 conn_cleanup.context_id = (ep->ep_cid >> 7);
 780
 781         conn_cleanup.reserved0 = (u16)ep->ep_iscsi_cid;
 782
 783         kwqe_arr[0] = (struct kwqe *) &conn_cleanup;
 784         if (hba->cnic && hba->cnic->submit_kwqes)
 785                 rc = hba->cnic->submit_kwqes(hba->cnic, kwqe_arr, 1);
 786
 787         return rc;
 788 }
 789
 790
 791 /**
 792  * bnx2i_570x_send_conn_ofld_req - initiates iscsi conn context setup process
 793  * @hba:                adapter structure pointer
 794  * @ep:                 endpoint (transport identifier) structure
 795  *
 796  * 5706/5708/5709 specific - prepares and posts CONN_OFLD_REQ1/2 KWQE
 797  */
 798 static int bnx2i_570x_send_conn_ofld_req(struct bnx2i_hba *hba,
 799                                          struct bnx2i_endpoint *ep)
 800 {
 801         struct kwqe *kwqe_arr[2];
 802         struct iscsi_kwqe_conn_offload1 ofld_req1;
 803         struct iscsi_kwqe_conn_offload2 ofld_req2;
 804         dma_addr_t dma_addr;
 805         int num_kwqes = 2;
 806         u32 *ptbl;
 807         int rc = -EINVAL;
 808
 809         ofld_req1.hdr.op_code = ISCSI_KWQE_OPCODE_OFFLOAD_CONN1;
 810         ofld_req1.hdr.flags =
 811                 (ISCSI_KWQE_LAYER_CODE << ISCSI_KWQE_HEADER_LAYER_CODE_SHIFT);
 812
 813         ofld_req1.iscsi_conn_id = (u16) ep->ep_iscsi_cid;
 814
 815         dma_addr = ep->qp.sq_pgtbl_phys;
 816         ofld_req1.sq_page_table_addr_lo = (u32) dma_addr;
 817         ofld_req1.sq_page_table_addr_hi = (u32) ((u64) dma_addr >> 32);
 818
 819         dma_addr = ep->qp.cq_pgtbl_phys;
 820         ofld_req1.cq_page_table_addr_lo = (u32) dma_addr;
 821         ofld_req1.cq_page_table_addr_hi = (u32) ((u64) dma_addr >> 32);
 822
 823         ofld_req2.hdr.op_code = ISCSI_KWQE_OPCODE_OFFLOAD_CONN2;
 824         ofld_req2.hdr.flags =
 825                 (ISCSI_KWQE_LAYER_CODE << ISCSI_KWQE_HEADER_LAYER_CODE_SHIFT);
 826
 827         dma_addr = ep->qp.rq_pgtbl_phys;
 828         ofld_req2.rq_page_table_addr_lo = (u32) dma_addr;
 829         ofld_req2.rq_page_table_addr_hi = (u32) ((u64) dma_addr >> 32);
 830
 831         ptbl = (u32 *) ep->qp.sq_pgtbl_virt;
 832
 833         ofld_req2.sq_first_pte.hi = *ptbl++;
 834         ofld_req2.sq_first_pte.lo = *ptbl;
 835
 836         ptbl = (u32 *) ep->qp.cq_pgtbl_virt;
 837         ofld_req2.cq_first_pte.hi = *ptbl++;
 838         ofld_req2.cq_first_pte.lo = *ptbl;
 839
 840         kwqe_arr[0] = (struct kwqe *) &ofld_req1;
 841         kwqe_arr[1] = (struct kwqe *) &ofld_req2;
 842         ofld_req2.num_additional_wqes = 0;
 843
 844         if (hba->cnic && hba->cnic->submit_kwqes)
 845                 rc = hba->cnic->submit_kwqes(hba->cnic, kwqe_arr, num_kwqes);
 846
 847         return rc;
 848 }
 849
 850
 851 /**
 852  * bnx2i_5771x_send_conn_ofld_req - initiates iscsi connection context creation
 853  * @hba:                adapter structure pointer
 854  * @ep:                 endpoint (transport identifier) structure
 855  *
 856  * 57710 specific - prepares and posts CONN_OFLD_REQ1/2 KWQE
 857  */
 858 static int bnx2i_5771x_send_conn_ofld_req(struct bnx2i_hba *hba,
 859                                           struct bnx2i_endpoint *ep)
 860 {
 861         struct kwqe *kwqe_arr[5];
 862         struct iscsi_kwqe_conn_offload1 ofld_req1;
 863         struct iscsi_kwqe_conn_offload2 ofld_req2;
 864         struct iscsi_kwqe_conn_offload3 ofld_req3[1];
 865         dma_addr_t dma_addr;
 866         int num_kwqes = 2;
 867         u32 *ptbl;
 868         int rc = -EINVAL;
 869
 870         ofld_req1.hdr.op_code = ISCSI_KWQE_OPCODE_OFFLOAD_CONN1;
 871         ofld_req1.hdr.flags =
 872                 (ISCSI_KWQE_LAYER_CODE << ISCSI_KWQE_HEADER_LAYER_CODE_SHIFT);
 873
 874         ofld_req1.iscsi_conn_id = (u16) ep->ep_iscsi_cid;
 875
 876         dma_addr = ep->qp.sq_pgtbl_phys + ISCSI_SQ_DB_SIZE;
 877         ofld_req1.sq_page_table_addr_lo = (u32) dma_addr;
 878         ofld_req1.sq_page_table_addr_hi = (u32) ((u64) dma_addr >> 32);
 879
 880         dma_addr = ep->qp.cq_pgtbl_phys + ISCSI_CQ_DB_SIZE;
 881         ofld_req1.cq_page_table_addr_lo = (u32) dma_addr;
 882         ofld_req1.cq_page_table_addr_hi = (u32) ((u64) dma_addr >> 32);
 883
 884         ofld_req2.hdr.op_code = ISCSI_KWQE_OPCODE_OFFLOAD_CONN2;
 885         ofld_req2.hdr.flags =
 886                 (ISCSI_KWQE_LAYER_CODE << ISCSI_KWQE_HEADER_LAYER_CODE_SHIFT);
 887
 888         dma_addr = ep->qp.rq_pgtbl_phys + ISCSI_RQ_DB_SIZE;
 889         ofld_req2.rq_page_table_addr_lo = (u32) dma_addr;
 890         ofld_req2.rq_page_table_addr_hi = (u32) ((u64) dma_addr >> 32);
 891
 892         ptbl = (u32 *)((u8 *)ep->qp.sq_pgtbl_virt + ISCSI_SQ_DB_SIZE);
 893         ofld_req2.sq_first_pte.hi = *ptbl++;
 894         ofld_req2.sq_first_pte.lo = *ptbl;
 895
 896         ptbl = (u32 *)((u8 *)ep->qp.cq_pgtbl_virt + ISCSI_CQ_DB_SIZE);
 897         ofld_req2.cq_first_pte.hi = *ptbl++;
 898         ofld_req2.cq_first_pte.lo = *ptbl;
 899
 900         kwqe_arr[0] = (struct kwqe *) &ofld_req1;
 901         kwqe_arr[1] = (struct kwqe *) &ofld_req2;
 902
 903         ofld_req2.num_additional_wqes = 1;
 904         memset(ofld_req3, 0x00, sizeof(ofld_req3[0]));
 905         ptbl = (u32 *)((u8 *)ep->qp.rq_pgtbl_virt + ISCSI_RQ_DB_SIZE);
 906         ofld_req3[0].qp_first_pte[0].hi = *ptbl++;
 907         ofld_req3[0].qp_first_pte[0].lo = *ptbl;
 908
 909         kwqe_arr[2] = (struct kwqe *) ofld_req3;
 910         /* need if we decide to go with multiple KCQE's per conn */
 911         num_kwqes += 1;
 912
 913         if (hba->cnic && hba->cnic->submit_kwqes)
 914                 rc = hba->cnic->submit_kwqes(hba->cnic, kwqe_arr, num_kwqes);
 915
 916         return rc;
 917 }
 918
 919 /**
 920  * bnx2i_send_conn_ofld_req - initiates iscsi connection context setup process
 921  *
 922  * @hba:                adapter structure pointer
 923  * @ep:                 endpoint (transport identifier) structure
 924  *
 925  * this routine prepares and posts CONN_OFLD_REQ1/2 KWQE
 926  */
 927 int bnx2i_send_conn_ofld_req(struct bnx2i_hba *hba, struct bnx2i_endpoint *ep)
 928 {
 929         int rc;
 930
 931         if (test_bit(BNX2I_NX2_DEV_57710, &hba->cnic_dev_type))
 932                 rc = bnx2i_5771x_send_conn_ofld_req(hba, ep);
 933         else
 934                 rc = bnx2i_570x_send_conn_ofld_req(hba, ep);
 935
 936         return rc;
 937 }
 938
 939
 940 /**
 941  * setup_qp_page_tables - iscsi QP page table setup function
 942  * @ep:         endpoint (transport identifier) structure
 943  *
 944  * Sets up page tables for SQ/RQ/CQ, 1G/sec (5706/5708/5709) devices requires
 945  *      64-bit address in big endian format. Whereas 10G/sec (57710) requires
 946  *      PT in little endian format
 947  */
 948 static void setup_qp_page_tables(struct bnx2i_endpoint *ep)
 949 {
 950         int num_pages;
 951         u32 *ptbl;
 952         dma_addr_t page;
 953         int cnic_dev_10g;
 954
 955         if (test_bit(BNX2I_NX2_DEV_57710, &ep->hba->cnic_dev_type))
 956                 cnic_dev_10g = 1;
 957         else
 958                 cnic_dev_10g = 0;
 959
 960         /* SQ page table */
 961         memset(ep->qp.sq_pgtbl_virt, 0, ep->qp.sq_pgtbl_size);
 962         num_pages = ep->qp.sq_mem_size / PAGE_SIZE;
 963         page = ep->qp.sq_phys;
 964
 965         if (cnic_dev_10g)
 966                 ptbl = (u32 *)((u8 *)ep->qp.sq_pgtbl_virt + ISCSI_SQ_DB_SIZE);
 967         else
 968                 ptbl = (u32 *) ep->qp.sq_pgtbl_virt;
 969         while (num_pages--) {
 970                 if (cnic_dev_10g) {
 971                         /* PTE is written in little endian format for 57710 */
 972                         *ptbl = (u32) page;
 973                         ptbl++;
 974                         *ptbl = (u32) ((u64) page >> 32);
 975                         ptbl++;
 976                         page += PAGE_SIZE;
 977                 } else {
 978                         /* PTE is written in big endian format for
 979                          * 5706/5708/5709 devices */
 980                         *ptbl = (u32) ((u64) page >> 32);
 981                         ptbl++;
 982                         *ptbl = (u32) page;
 983                         ptbl++;
 984                         page += PAGE_SIZE;
 985                 }
 986         }
 987
 988         /* RQ page table */
 989         memset(ep->qp.rq_pgtbl_virt, 0, ep->qp.rq_pgtbl_size);
 990         num_pages = ep->qp.rq_mem_size / PAGE_SIZE;
 991         page = ep->qp.rq_phys;
 992
 993         if (cnic_dev_10g)
 994                 ptbl = (u32 *)((u8 *)ep->qp.rq_pgtbl_virt + ISCSI_RQ_DB_SIZE);
 995         else
 996                 ptbl = (u32 *) ep->qp.rq_pgtbl_virt;
 997         while (num_pages--) {
 998                 if (cnic_dev_10g) {
 999                         /* PTE is written in little endian format for 57710 */
1000                         *ptbl = (u32) page;
1001                         ptbl++;
1002                         *ptbl = (u32) ((u64) page >> 32);
1003                         ptbl++;
1004                         page += PAGE_SIZE;
1005                 } else {
1006                         /* PTE is written in big endian format for
1007                          * 5706/5708/5709 devices */
1008                         *ptbl = (u32) ((u64) page >> 32);
1009                         ptbl++;
1010                         *ptbl = (u32) page;
1011                         ptbl++;
1012                         page += PAGE_SIZE;
1013                 }
1014         }
1015
1016         /* CQ page table */
1017         memset(ep->qp.cq_pgtbl_virt, 0, ep->qp.cq_pgtbl_size);
1018         num_pages = ep->qp.cq_mem_size / PAGE_SIZE;
1019         page = ep->qp.cq_phys;
1020
1021         if (cnic_dev_10g)
1022                 ptbl = (u32 *)((u8 *)ep->qp.cq_pgtbl_virt + ISCSI_CQ_DB_SIZE);
1023         else
1024                 ptbl = (u32 *) ep->qp.cq_pgtbl_virt;
1025         while (num_pages--) {
1026                 if (cnic_dev_10g) {
1027                         /* PTE is written in little endian format for 57710 */
1028                         *ptbl = (u32) page;
1029                         ptbl++;
1030                         *ptbl = (u32) ((u64) page >> 32);
1031                         ptbl++;
1032                         page += PAGE_SIZE;
1033                 } else {
1034                         /* PTE is written in big endian format for
1035                          * 5706/5708/5709 devices */
1036                         *ptbl = (u32) ((u64) page >> 32);
1037                         ptbl++;
1038                         *ptbl = (u32) page;
1039                         ptbl++;
1040                         page += PAGE_SIZE;
1041                 }
1042         }
1043 }
1044
1045
1046 /**
1047  * bnx2i_alloc_qp_resc - allocates required resources for QP.
1048  * @hba:        adapter structure pointer
1049  * @ep:         endpoint (transport identifier) structure
1050  *
1051  * Allocate QP (transport layer for iSCSI connection) resources, DMA'able
1052  *      memory for SQ/RQ/CQ and page tables. EP structure elements such
1053  *      as producer/consumer indexes/pointers, queue sizes and page table
1054  *      contents are setup
1055  */
1056 int bnx2i_alloc_qp_resc(struct bnx2i_hba *hba, struct bnx2i_endpoint *ep)
1057 {
1058         struct bnx2i_5771x_cq_db *cq_db;
1059
1060         ep->hba = hba;
1061         ep->conn = NULL;
1062         ep->ep_cid = ep->ep_iscsi_cid = ep->ep_pg_cid = 0;
1063
1064         /* Allocate page table memory for SQ which is page aligned */
1065         ep->qp.sq_mem_size = hba->max_sqes * BNX2I_SQ_WQE_SIZE;
1066         ep->qp.sq_mem_size =
1067                 (ep->qp.sq_mem_size + (PAGE_SIZE - 1)) & PAGE_MASK;
1068         ep->qp.sq_pgtbl_size =
1069                 (ep->qp.sq_mem_size / PAGE_SIZE) * sizeof(void *);
1070         ep->qp.sq_pgtbl_size =
1071                 (ep->qp.sq_pgtbl_size + (PAGE_SIZE - 1)) & PAGE_MASK;
1072
1073         ep->qp.sq_pgtbl_virt =
1074                 dma_alloc_coherent(&hba->pcidev->dev, ep->qp.sq_pgtbl_size,
1075                                    &ep->qp.sq_pgtbl_phys, GFP_KERNEL);
1076         if (!ep->qp.sq_pgtbl_virt) {
1077                 printk(KERN_ALERT "bnx2i: unable to alloc SQ PT mem (%d)\n",
1078                                   ep->qp.sq_pgtbl_size);
1079                 goto mem_alloc_err;
1080         }
1081
1082         /* Allocate memory area for actual SQ element */
1083         ep->qp.sq_virt =
1084                 dma_alloc_coherent(&hba->pcidev->dev, ep->qp.sq_mem_size,
1085                                    &ep->qp.sq_phys, GFP_KERNEL);
1086         if (!ep->qp.sq_virt) {
1087                 printk(KERN_ALERT "bnx2i: unable to alloc SQ BD memory %d\n",
1088                                   ep->qp.sq_mem_size);
1089                 goto mem_alloc_err;
1090         }
1091
1092         memset(ep->qp.sq_virt, 0x00, ep->qp.sq_mem_size);
1093         ep->qp.sq_first_qe = ep->qp.sq_virt;
1094         ep->qp.sq_prod_qe = ep->qp.sq_first_qe;
1095         ep->qp.sq_cons_qe = ep->qp.sq_first_qe;
1096         ep->qp.sq_last_qe = &ep->qp.sq_first_qe[hba->max_sqes - 1];
1097         ep->qp.sq_prod_idx = 0;
1098         ep->qp.sq_cons_idx = 0;
1099         ep->qp.sqe_left = hba->max_sqes;
1100
1101         /* Allocate page table memory for CQ which is page aligned */
1102         ep->qp.cq_mem_size = hba->max_cqes * BNX2I_CQE_SIZE;
1103         ep->qp.cq_mem_size =
1104                 (ep->qp.cq_mem_size + (PAGE_SIZE - 1)) & PAGE_MASK;
1105         ep->qp.cq_pgtbl_size =
1106                 (ep->qp.cq_mem_size / PAGE_SIZE) * sizeof(void *);
1107         ep->qp.cq_pgtbl_size =
1108                 (ep->qp.cq_pgtbl_size + (PAGE_SIZE - 1)) & PAGE_MASK;
1109
1110         ep->qp.cq_pgtbl_virt =
1111                 dma_alloc_coherent(&hba->pcidev->dev, ep->qp.cq_pgtbl_size,
1112                                    &ep->qp.cq_pgtbl_phys, GFP_KERNEL);
1113         if (!ep->qp.cq_pgtbl_virt) {
1114                 printk(KERN_ALERT "bnx2i: unable to alloc CQ PT memory %d\n",
1115                                   ep->qp.cq_pgtbl_size);
1116                 goto mem_alloc_err;
1117         }
1118
1119         /* Allocate memory area for actual CQ element */
1120         ep->qp.cq_virt =
1121                 dma_alloc_coherent(&hba->pcidev->dev, ep->qp.cq_mem_size,
1122                                    &ep->qp.cq_phys, GFP_KERNEL);
1123         if (!ep->qp.cq_virt) {
1124                 printk(KERN_ALERT "bnx2i: unable to alloc CQ BD memory %d\n",
1125                                   ep->qp.cq_mem_size);
1126                 goto mem_alloc_err;
1127         }
1128         memset(ep->qp.cq_virt, 0x00, ep->qp.cq_mem_size);
1129
1130         ep->qp.cq_first_qe = ep->qp.cq_virt;
1131         ep->qp.cq_prod_qe = ep->qp.cq_first_qe;
1132         ep->qp.cq_cons_qe = ep->qp.cq_first_qe;
1133         ep->qp.cq_last_qe = &ep->qp.cq_first_qe[hba->max_cqes - 1];
1134         ep->qp.cq_prod_idx = 0;
1135         ep->qp.cq_cons_idx = 0;
1136         ep->qp.cqe_left = hba->max_cqes;
1137         ep->qp.cqe_exp_seq_sn = ISCSI_INITIAL_SN;
1138         ep->qp.cqe_size = hba->max_cqes;
1139
1140         /* Invalidate all EQ CQE index, req only for 57710 */
1141         cq_db = (struct bnx2i_5771x_cq_db *) ep->qp.cq_pgtbl_virt;
1142         memset(cq_db->sqn, 0xFF, sizeof(cq_db->sqn[0]) * BNX2X_MAX_CQS);
1143
1144         /* Allocate page table memory for RQ which is page aligned */
1145         ep->qp.rq_mem_size = hba->max_rqes * BNX2I_RQ_WQE_SIZE;
1146         ep->qp.rq_mem_size =
1147                 (ep->qp.rq_mem_size + (PAGE_SIZE - 1)) & PAGE_MASK;
1148         ep->qp.rq_pgtbl_size =
1149                 (ep->qp.rq_mem_size / PAGE_SIZE) * sizeof(void *);
1150         ep->qp.rq_pgtbl_size =
1151                 (ep->qp.rq_pgtbl_size + (PAGE_SIZE - 1)) & PAGE_MASK;
1152
1153         ep->qp.rq_pgtbl_virt =
1154                 dma_alloc_coherent(&hba->pcidev->dev, ep->qp.rq_pgtbl_size,
1155                                    &ep->qp.rq_pgtbl_phys, GFP_KERNEL);
1156         if (!ep->qp.rq_pgtbl_virt) {
1157                 printk(KERN_ALERT "bnx2i: unable to alloc RQ PT mem %d\n",
1158                                   ep->qp.rq_pgtbl_size);
1159                 goto mem_alloc_err;
1160         }
1161
1162         /* Allocate memory area for actual RQ element */
1163         ep->qp.rq_virt =
1164                 dma_alloc_coherent(&hba->pcidev->dev, ep->qp.rq_mem_size,
1165                                    &ep->qp.rq_phys, GFP_KERNEL);
1166         if (!ep->qp.rq_virt) {
1167                 printk(KERN_ALERT "bnx2i: unable to alloc RQ BD memory %d\n",
1168                                   ep->qp.rq_mem_size);
1169                 goto mem_alloc_err;
1170         }
1171
1172         ep->qp.rq_first_qe = ep->qp.rq_virt;
1173         ep->qp.rq_prod_qe = ep->qp.rq_first_qe;
1174         ep->qp.rq_cons_qe = ep->qp.rq_first_qe;
1175         ep->qp.rq_last_qe = &ep->qp.rq_first_qe[hba->max_rqes - 1];
1176         ep->qp.rq_prod_idx = 0x8000;
1177         ep->qp.rq_cons_idx = 0;
1178         ep->qp.rqe_left = hba->max_rqes;
1179
1180         setup_qp_page_tables(ep);
1181
1182         return 0;
1183
1184 mem_alloc_err:
1185         bnx2i_free_qp_resc(hba, ep);
1186         return -ENOMEM;
1187 }
1188
1189
1190
1191 /**
1192  * bnx2i_free_qp_resc - free memory resources held by QP
1193  * @hba:        adapter structure pointer
1194  * @ep: endpoint (transport identifier) structure
1195  *
1196  * Free QP resources - SQ/RQ/CQ memory and page tables.
1197  */
1198 void bnx2i_free_qp_resc(struct bnx2i_hba *hba, struct bnx2i_endpoint *ep)
1199 {
1200         if (ep->qp.ctx_base) {
1201                 iounmap(ep->qp.ctx_base);
1202                 ep->qp.ctx_base = NULL;
1203         }
1204         /* Free SQ mem */
1205         if (ep->qp.sq_pgtbl_virt) {
1206                 dma_free_coherent(&hba->pcidev->dev, ep->qp.sq_pgtbl_size,
1207                                   ep->qp.sq_pgtbl_virt, ep->qp.sq_pgtbl_phys);
1208                 ep->qp.sq_pgtbl_virt = NULL;
1209                 ep->qp.sq_pgtbl_phys = 0;
1210         }
1211         if (ep->qp.sq_virt) {
1212                 dma_free_coherent(&hba->pcidev->dev, ep->qp.sq_mem_size,
1213                                   ep->qp.sq_virt, ep->qp.sq_phys);
1214                 ep->qp.sq_virt = NULL;
1215                 ep->qp.sq_phys = 0;
1216         }
1217
1218         /* Free RQ mem */
1219         if (ep->qp.rq_pgtbl_virt) {
1220                 dma_free_coherent(&hba->pcidev->dev, ep->qp.rq_pgtbl_size,
1221                                   ep->qp.rq_pgtbl_virt, ep->qp.rq_pgtbl_phys);
1222                 ep->qp.rq_pgtbl_virt = NULL;
1223                 ep->qp.rq_pgtbl_phys = 0;
1224         }
1225         if (ep->qp.rq_virt) {
1226                 dma_free_coherent(&hba->pcidev->dev, ep->qp.rq_mem_size,
1227                                   ep->qp.rq_virt, ep->qp.rq_phys);
1228                 ep->qp.rq_virt = NULL;
1229                 ep->qp.rq_phys = 0;
1230         }
1231
1232         /* Free CQ mem */
1233         if (ep->qp.cq_pgtbl_virt) {
1234                 dma_free_coherent(&hba->pcidev->dev, ep->qp.cq_pgtbl_size,
1235                                   ep->qp.cq_pgtbl_virt, ep->qp.cq_pgtbl_phys);
1236                 ep->qp.cq_pgtbl_virt = NULL;
1237                 ep->qp.cq_pgtbl_phys = 0;
1238         }
1239         if (ep->qp.cq_virt) {
1240                 dma_free_coherent(&hba->pcidev->dev, ep->qp.cq_mem_size,
1241                                   ep->qp.cq_virt, ep->qp.cq_phys);
1242                 ep->qp.cq_virt = NULL;
1243                 ep->qp.cq_phys = 0;
1244         }
1245 }
1246
1247
1248 /**
1249  * bnx2i_send_fw_iscsi_init_msg - initiates initial handshake with iscsi f/w
1250  * @hba:        adapter structure pointer
1251  *
1252  * Send down iscsi_init KWQEs which initiates the initial handshake with the f/w
1253  *      This results in iSCSi support validation and on-chip context manager
1254  *      initialization.  Firmware completes this handshake with a CQE carrying
1255  *      the result of iscsi support validation. Parameter carried by
1256  *      iscsi init request determines the number of offloaded connection and
1257  *      tolerance level for iscsi protocol violation this hba/chip can support
1258  */
1259 int bnx2i_send_fw_iscsi_init_msg(struct bnx2i_hba *hba)
1260 {
1261         struct kwqe *kwqe_arr[3];
1262         struct iscsi_kwqe_init1 iscsi_init;
1263         struct iscsi_kwqe_init2 iscsi_init2;
1264         int rc = 0;
1265         u64 mask64;
1266
1267         memset(&iscsi_init, 0x00, sizeof(struct iscsi_kwqe_init1));
1268         memset(&iscsi_init2, 0x00, sizeof(struct iscsi_kwqe_init2));
1269
1270         bnx2i_adjust_qp_size(hba);
1271
1272         iscsi_init.flags =
1273                 ISCSI_PAGE_SIZE_4K << ISCSI_KWQE_INIT1_PAGE_SIZE_SHIFT;
1274         if (en_tcp_dack)
1275                 iscsi_init.flags |= ISCSI_KWQE_INIT1_DELAYED_ACK_ENABLE;
1276         iscsi_init.reserved0 = 0;
1277         iscsi_init.num_cqs = 1;
1278         iscsi_init.hdr.op_code = ISCSI_KWQE_OPCODE_INIT1;
1279         iscsi_init.hdr.flags =
1280                 (ISCSI_KWQE_LAYER_CODE << ISCSI_KWQE_HEADER_LAYER_CODE_SHIFT);
1281
1282         iscsi_init.dummy_buffer_addr_lo = (u32) hba->dummy_buf_dma;
1283         iscsi_init.dummy_buffer_addr_hi =
1284                 (u32) ((u64) hba->dummy_buf_dma >> 32);
1285
1286         hba->num_ccell = hba->max_sqes >> 1;
1287         hba->ctx_ccell_tasks =
1288                         ((hba->num_ccell & 0xFFFF) | (hba->max_sqes << 16));
1289         iscsi_init.num_ccells_per_conn = hba->num_ccell;
1290         iscsi_init.num_tasks_per_conn = hba->max_sqes;
1291         iscsi_init.sq_wqes_per_page = PAGE_SIZE / BNX2I_SQ_WQE_SIZE;
1292         iscsi_init.sq_num_wqes = hba->max_sqes;
1293         iscsi_init.cq_log_wqes_per_page =
1294                 (u8) bnx2i_power_of2(PAGE_SIZE / BNX2I_CQE_SIZE);
1295         iscsi_init.cq_num_wqes = hba->max_cqes;
1296         iscsi_init.cq_num_pages = (hba->max_cqes * BNX2I_CQE_SIZE +
1297                                    (PAGE_SIZE - 1)) / PAGE_SIZE;
1298         iscsi_init.sq_num_pages = (hba->max_sqes * BNX2I_SQ_WQE_SIZE +
1299                                    (PAGE_SIZE - 1)) / PAGE_SIZE;
1300         iscsi_init.rq_buffer_size = BNX2I_RQ_WQE_SIZE;
1301         iscsi_init.rq_num_wqes = hba->max_rqes;
1302
1303
1304         iscsi_init2.hdr.op_code = ISCSI_KWQE_OPCODE_INIT2;
1305         iscsi_init2.hdr.flags =
1306                 (ISCSI_KWQE_LAYER_CODE << ISCSI_KWQE_HEADER_LAYER_CODE_SHIFT);
1307         iscsi_init2.max_cq_sqn = hba->max_cqes * 2 + 1;
1308         mask64 = 0x0ULL;
1309         mask64 |= (
1310                 /* CISCO MDS */
1311                 (1UL <<
1312                   ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_TTT_NOT_RSRV) |
1313                 /* HP MSA1510i */
1314                 (1UL <<
1315                   ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_EXP_DATASN) |
1316                 /* EMC */
1317                 (1ULL << ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_LUN));
1318         if (error_mask1) {
1319                 iscsi_init2.error_bit_map[0] = error_mask1;
1320                 mask64 ^= (u32)(mask64);
1321                 mask64 |= error_mask1;
1322         } else
1323                 iscsi_init2.error_bit_map[0] = (u32) mask64;
1324
1325         if (error_mask2) {
1326                 iscsi_init2.error_bit_map[1] = error_mask2;
1327                 mask64 &= 0xffffffff;
1328                 mask64 |= ((u64)error_mask2 << 32);
1329         } else
1330                 iscsi_init2.error_bit_map[1] = (u32) (mask64 >> 32);
1331
1332         iscsi_error_mask = mask64;
1333
1334         kwqe_arr[0] = (struct kwqe *) &iscsi_init;
1335         kwqe_arr[1] = (struct kwqe *) &iscsi_init2;
1336
1337         if (hba->cnic && hba->cnic->submit_kwqes)
1338                 rc = hba->cnic->submit_kwqes(hba->cnic, kwqe_arr, 2);
1339         return rc;
1340 }
1341
1342
1343 /**
1344  * bnx2i_process_scsi_cmd_resp - this function handles scsi cmd completion.
1345  * @session:    iscsi session
1346  * @bnx2i_conn: bnx2i connection
1347  * @cqe:        pointer to newly DMA'ed CQE entry for processing
1348  *
1349  * process SCSI CMD Response CQE & complete the request to SCSI-ML
1350  */
1351 int bnx2i_process_scsi_cmd_resp(struct iscsi_session *session,
1352                                 struct bnx2i_conn *bnx2i_conn,
1353                                 struct cqe *cqe)
1354 {
1355         struct iscsi_conn *conn = bnx2i_conn->cls_conn->dd_data;
1356         struct bnx2i_hba *hba = bnx2i_conn->hba;
1357         struct bnx2i_cmd_response *resp_cqe;
1358         struct bnx2i_cmd *bnx2i_cmd;
1359         struct iscsi_task *task;
1360         struct iscsi_scsi_rsp *hdr;
1361         u32 datalen = 0;
1362
1363         resp_cqe = (struct bnx2i_cmd_response *)cqe;
1364         spin_lock_bh(&session->lock);
1365         task = iscsi_itt_to_task(conn,
1366                                  resp_cqe->itt & ISCSI_CMD_RESPONSE_INDEX);
1367         if (!task)
1368                 goto fail;
1369
1370         bnx2i_cmd = task->dd_data;
1371
1372         if (bnx2i_cmd->req.op_attr & ISCSI_CMD_REQUEST_READ) {
1373                 conn->datain_pdus_cnt +=
1374                         resp_cqe->task_stat.read_stat.num_data_ins;
1375                 conn->rxdata_octets +=
1376                         bnx2i_cmd->req.total_data_transfer_length;
1377                 ADD_STATS_64(hba, rx_pdus,
1378                              resp_cqe->task_stat.read_stat.num_data_ins);
1379                 ADD_STATS_64(hba, rx_bytes,
1380                              bnx2i_cmd->req.total_data_transfer_length);
1381         } else {
1382                 conn->dataout_pdus_cnt +=
1383                         resp_cqe->task_stat.write_stat.num_data_outs;
1384                 conn->r2t_pdus_cnt +=
1385                         resp_cqe->task_stat.write_stat.num_r2ts;
1386                 conn->txdata_octets +=
1387                         bnx2i_cmd->req.total_data_transfer_length;
1388                 ADD_STATS_64(hba, tx_pdus,
1389                              resp_cqe->task_stat.write_stat.num_data_outs);
1390                 ADD_STATS_64(hba, tx_bytes,
1391                              bnx2i_cmd->req.total_data_transfer_length);
1392                 ADD_STATS_64(hba, rx_pdus,
1393                              resp_cqe->task_stat.write_stat.num_r2ts);
1394         }
1395         bnx2i_iscsi_unmap_sg_list(bnx2i_cmd);
1396
1397         hdr = (struct iscsi_scsi_rsp *)task->hdr;
1398         resp_cqe = (struct bnx2i_cmd_response *)cqe;
1399         hdr->opcode = resp_cqe->op_code;
1400         hdr->max_cmdsn = cpu_to_be32(resp_cqe->max_cmd_sn);
1401         hdr->exp_cmdsn = cpu_to_be32(resp_cqe->exp_cmd_sn);
1402         hdr->response = resp_cqe->response;
1403         hdr->cmd_status = resp_cqe->status;
1404         hdr->flags = resp_cqe->response_flags;
1405         hdr->residual_count = cpu_to_be32(resp_cqe->residual_count);
1406
1407         if (resp_cqe->op_code == ISCSI_OP_SCSI_DATA_IN)
1408                 goto done;
1409
1410         if (resp_cqe->status == SAM_STAT_CHECK_CONDITION) {
1411                 datalen = resp_cqe->data_length;
1412                 if (datalen < 2)
1413                         goto done;
1414
1415                 if (datalen > BNX2I_RQ_WQE_SIZE) {
1416                         iscsi_conn_printk(KERN_ERR, conn,
1417                                           "sense data len %d > RQ sz\n",
1418                                           datalen);
1419                         datalen = BNX2I_RQ_WQE_SIZE;
1420                 } else if (datalen > ISCSI_DEF_MAX_RECV_SEG_LEN) {
1421                         iscsi_conn_printk(KERN_ERR, conn,
1422                                           "sense data len %d > conn data\n",
1423                                           datalen);
1424                         datalen = ISCSI_DEF_MAX_RECV_SEG_LEN;
1425                 }
1426
1427                 bnx2i_get_rq_buf(bnx2i_cmd->conn, conn->data, datalen);
1428                 bnx2i_put_rq_buf(bnx2i_cmd->conn, 1);
1429         }
1430
1431 done:
1432         __iscsi_complete_pdu(conn, (struct iscsi_hdr *)hdr,
1433                              conn->data, datalen);
1434 fail:
1435         spin_unlock_bh(&session->lock);
1436         return 0;
1437 }
1438
1439
1440 /**
1441  * bnx2i_process_login_resp - this function handles iscsi login response
1442  * @session:            iscsi session pointer
1443  * @bnx2i_conn:         iscsi connection pointer
1444  * @cqe:                pointer to newly DMA'ed CQE entry for processing
1445  *
1446  * process Login Response CQE & complete it to open-iscsi user daemon
1447  */
1448 static int bnx2i_process_login_resp(struct iscsi_session *session,
1449                                     struct bnx2i_conn *bnx2i_conn,
1450                                     struct cqe *cqe)
1451 {
1452         struct iscsi_conn *conn = bnx2i_conn->cls_conn->dd_data;
1453         struct iscsi_task *task;
1454         struct bnx2i_login_response *login;
1455         struct iscsi_login_rsp *resp_hdr;
1456         int pld_len;
1457         int pad_len;
1458
1459         login = (struct bnx2i_login_response *) cqe;
1460         spin_lock(&session->lock);
1461         task = iscsi_itt_to_task(conn,
1462                                  login->itt & ISCSI_LOGIN_RESPONSE_INDEX);
1463         if (!task)
1464                 goto done;
1465
1466         resp_hdr = (struct iscsi_login_rsp *) &bnx2i_conn->gen_pdu.resp_hdr;
1467         memset(resp_hdr, 0, sizeof(struct iscsi_hdr));
1468         resp_hdr->opcode = login->op_code;
1469         resp_hdr->flags = login->response_flags;
1470         resp_hdr->max_version = login->version_max;
1471         resp_hdr->active_version = login->version_active;
1472         resp_hdr->hlength = 0;
1473
1474         hton24(resp_hdr->dlength, login->data_length);
1475         memcpy(resp_hdr->isid, &login->isid_lo, 6);
1476         resp_hdr->tsih = cpu_to_be16(login->tsih);
1477         resp_hdr->itt = task->hdr->itt;
1478         resp_hdr->statsn = cpu_to_be32(login->stat_sn);
1479         resp_hdr->exp_cmdsn = cpu_to_be32(login->exp_cmd_sn);
1480         resp_hdr->max_cmdsn = cpu_to_be32(login->max_cmd_sn);
1481         resp_hdr->status_class = login->status_class;
1482         resp_hdr->status_detail = login->status_detail;
1483         pld_len = login->data_length;
1484         bnx2i_conn->gen_pdu.resp_wr_ptr =
1485                                         bnx2i_conn->gen_pdu.resp_buf + pld_len;
1486
1487         pad_len = 0;
1488         if (pld_len & 0x3)
1489                 pad_len = 4 - (pld_len % 4);
1490
1491         if (pad_len) {
1492                 int i = 0;
1493                 for (i = 0; i < pad_len; i++) {
1494                         bnx2i_conn->gen_pdu.resp_wr_ptr[0] = 0;
1495                         bnx2i_conn->gen_pdu.resp_wr_ptr++;
1496                 }
1497         }
1498
1499         __iscsi_complete_pdu(conn, (struct iscsi_hdr *)resp_hdr,
1500                 bnx2i_conn->gen_pdu.resp_buf,
1501                 bnx2i_conn->gen_pdu.resp_wr_ptr - bnx2i_conn->gen_pdu.resp_buf);
1502 done:
1503         spin_unlock(&session->lock);
1504         return 0;
1505 }
1506
1507
1508 /**
1509  * bnx2i_process_text_resp - this function handles iscsi text response
1510  * @session:    iscsi session pointer
1511  * @bnx2i_conn: iscsi connection pointer
1512  * @cqe:        pointer to newly DMA'ed CQE entry for processing
1513  *
1514  * process iSCSI Text Response CQE&  complete it to open-iscsi user daemon
1515  */
1516 static int bnx2i_process_text_resp(struct iscsi_session *session,
1517                                    struct bnx2i_conn *bnx2i_conn,
1518                                    struct cqe *cqe)
1519 {
1520         struct iscsi_conn *conn = bnx2i_conn->cls_conn->dd_data;
1521         struct iscsi_task *task;
1522         struct bnx2i_text_response *text;
1523         struct iscsi_text_rsp *resp_hdr;
1524         int pld_len;
1525         int pad_len;
1526
1527         text = (struct bnx2i_text_response *) cqe;
1528         spin_lock(&session->lock);
1529         task = iscsi_itt_to_task(conn, text->itt & ISCSI_LOGIN_RESPONSE_INDEX);
1530         if (!task)
1531                 goto done;
1532
1533         resp_hdr = (struct iscsi_text_rsp *)&bnx2i_conn->gen_pdu.resp_hdr;
1534         memset(resp_hdr, 0, sizeof(struct iscsi_hdr));
1535         resp_hdr->opcode = text->op_code;
1536         resp_hdr->flags = text->response_flags;
1537         resp_hdr->hlength = 0;
1538
1539         hton24(resp_hdr->dlength, text->data_length);
1540         resp_hdr->itt = task->hdr->itt;
1541         resp_hdr->ttt = cpu_to_be32(text->ttt);
1542         resp_hdr->statsn = task->hdr->exp_statsn;
1543         resp_hdr->exp_cmdsn = cpu_to_be32(text->exp_cmd_sn);
1544         resp_hdr->max_cmdsn = cpu_to_be32(text->max_cmd_sn);
1545         pld_len = text->data_length;
1546         bnx2i_conn->gen_pdu.resp_wr_ptr = bnx2i_conn->gen_pdu.resp_buf +
1547                                           pld_len;
1548         pad_len = 0;
1549         if (pld_len & 0x3)
1550                 pad_len = 4 - (pld_len % 4);
1551
1552         if (pad_len) {
1553                 int i = 0;
1554                 for (i = 0; i < pad_len; i++) {
1555                         bnx2i_conn->gen_pdu.resp_wr_ptr[0] = 0;
1556                         bnx2i_conn->gen_pdu.resp_wr_ptr++;
1557                 }
1558         }
1559         __iscsi_complete_pdu(conn, (struct iscsi_hdr *)resp_hdr,
1560                              bnx2i_conn->gen_pdu.resp_buf,
1561                              bnx2i_conn->gen_pdu.resp_wr_ptr -
1562                              bnx2i_conn->gen_pdu.resp_buf);
1563 done:
1564         spin_unlock(&session->lock);
1565         return 0;
1566 }
1567
1568
1569 /**
1570  * bnx2i_process_tmf_resp - this function handles iscsi TMF response
1571  * @session:            iscsi session pointer
1572  * @bnx2i_conn:         iscsi connection pointer
1573  * @cqe:                pointer to newly DMA'ed CQE entry for processing
1574  *
1575  * process iSCSI TMF Response CQE and wake up the driver eh thread.
1576  */
1577 static int bnx2i_process_tmf_resp(struct iscsi_session *session,
1578                                   struct bnx2i_conn *bnx2i_conn,
1579                                   struct cqe *cqe)
1580 {
1581         struct iscsi_conn *conn = bnx2i_conn->cls_conn->dd_data;
1582         struct iscsi_task *task;
1583         struct bnx2i_tmf_response *tmf_cqe;
1584         struct iscsi_tm_rsp *resp_hdr;
1585
1586         tmf_cqe = (struct bnx2i_tmf_response *)cqe;
1587         spin_lock(&session->lock);
1588         task = iscsi_itt_to_task(conn,
1589                                  tmf_cqe->itt & ISCSI_TMF_RESPONSE_INDEX);
1590         if (!task)
1591                 goto done;
1592
1593         resp_hdr = (struct iscsi_tm_rsp *) &bnx2i_conn->gen_pdu.resp_hdr;
1594         memset(resp_hdr, 0, sizeof(struct iscsi_hdr));
1595         resp_hdr->opcode = tmf_cqe->op_code;
1596         resp_hdr->max_cmdsn = cpu_to_be32(tmf_cqe->max_cmd_sn);
1597         resp_hdr->exp_cmdsn = cpu_to_be32(tmf_cqe->exp_cmd_sn);
1598         resp_hdr->itt = task->hdr->itt;
1599         resp_hdr->response = tmf_cqe->response;
1600
1601         __iscsi_complete_pdu(conn, (struct iscsi_hdr *)resp_hdr, NULL, 0);
1602 done:
1603         spin_unlock(&session->lock);
1604         return 0;
1605 }
1606
1607 /**
1608  * bnx2i_process_logout_resp - this function handles iscsi logout response
1609  * @session:            iscsi session pointer
1610  * @bnx2i_conn:         iscsi connection pointer
1611  * @cqe:                pointer to newly DMA'ed CQE entry for processing
1612  *
1613  * process iSCSI Logout Response CQE & make function call to
1614  * notify the user daemon.
1615  */
1616 static int bnx2i_process_logout_resp(struct iscsi_session *session,
1617                                      struct bnx2i_conn *bnx2i_conn,
1618                                      struct cqe *cqe)
1619 {
1620         struct iscsi_conn *conn = bnx2i_conn->cls_conn->dd_data;
1621         struct iscsi_task *task;
1622         struct bnx2i_logout_response *logout;
1623         struct iscsi_logout_rsp *resp_hdr;
1624
1625         logout = (struct bnx2i_logout_response *) cqe;
1626         spin_lock(&session->lock);
1627         task = iscsi_itt_to_task(conn,
1628                                  logout->itt & ISCSI_LOGOUT_RESPONSE_INDEX);
1629         if (!task)
1630                 goto done;
1631
1632         resp_hdr = (struct iscsi_logout_rsp *) &bnx2i_conn->gen_pdu.resp_hdr;
1633         memset(resp_hdr, 0, sizeof(struct iscsi_hdr));
1634         resp_hdr->opcode = logout->op_code;
1635         resp_hdr->flags = logout->response;
1636         resp_hdr->hlength = 0;
1637
1638         resp_hdr->itt = task->hdr->itt;
1639         resp_hdr->statsn = task->hdr->exp_statsn;
1640         resp_hdr->exp_cmdsn = cpu_to_be32(logout->exp_cmd_sn);
1641         resp_hdr->max_cmdsn = cpu_to_be32(logout->max_cmd_sn);
1642
1643         resp_hdr->t2wait = cpu_to_be32(logout->time_to_wait);
1644         resp_hdr->t2retain = cpu_to_be32(logout->time_to_retain);
1645
1646         __iscsi_complete_pdu(conn, (struct iscsi_hdr *)resp_hdr, NULL, 0);
1647
1648         bnx2i_conn->ep->state = EP_STATE_LOGOUT_RESP_RCVD;
1649 done:
1650         spin_unlock(&session->lock);
1651         return 0;
1652 }
1653
1654 /**
1655  * bnx2i_process_nopin_local_cmpl - this function handles iscsi nopin CQE
1656  * @session:            iscsi session pointer
1657  * @bnx2i_conn:         iscsi connection pointer
1658  * @cqe:                pointer to newly DMA'ed CQE entry for processing
1659  *
1660  * process iSCSI NOPIN local completion CQE, frees IIT and command structures
1661  */
1662 static void bnx2i_process_nopin_local_cmpl(struct iscsi_session *session,
1663                                            struct bnx2i_conn *bnx2i_conn,
1664                                            struct cqe *cqe)
1665 {
1666         struct iscsi_conn *conn = bnx2i_conn->cls_conn->dd_data;
1667         struct bnx2i_nop_in_msg *nop_in;
1668         struct iscsi_task *task;
1669
1670         nop_in = (struct bnx2i_nop_in_msg *)cqe;
1671         spin_lock(&session->lock);
1672         task = iscsi_itt_to_task(conn,
1673                                  nop_in->itt & ISCSI_NOP_IN_MSG_INDEX);
1674         if (task)
1675                 __iscsi_put_task(task);
1676         spin_unlock(&session->lock);
1677 }
1678
1679 /**
1680  * bnx2i_unsol_pdu_adjust_rq - makes adjustments to RQ after unsol pdu is recvd
1681  * @conn:       iscsi connection
1682  *
1683  * Firmware advances RQ producer index for every unsolicited PDU even if
1684  *      payload data length is '0'. This function makes corresponding
1685  *      adjustments on the driver side to match this f/w behavior
1686  */
1687 static void bnx2i_unsol_pdu_adjust_rq(struct bnx2i_conn *bnx2i_conn)
1688 {
1689         char dummy_rq_data[2];
1690         bnx2i_get_rq_buf(bnx2i_conn, dummy_rq_data, 1);
1691         bnx2i_put_rq_buf(bnx2i_conn, 1);
1692 }
1693
1694
1695 /**
1696  * bnx2i_process_nopin_mesg - this function handles iscsi nopin CQE
1697  * @session:            iscsi session pointer
1698  * @bnx2i_conn:         iscsi connection pointer
1699  * @cqe:                pointer to newly DMA'ed CQE entry for processing
1700  *
1701  * process iSCSI target's proactive iSCSI NOPIN request
1702  */
1703 static int bnx2i_process_nopin_mesg(struct iscsi_session *session,
1704                                      struct bnx2i_conn *bnx2i_conn,
1705                                      struct cqe *cqe)
1706 {
1707         struct iscsi_conn *conn = bnx2i_conn->cls_conn->dd_data;
1708         struct iscsi_task *task;
1709         struct bnx2i_nop_in_msg *nop_in;
1710         struct iscsi_nopin *hdr;
1711         int tgt_async_nop = 0;
1712
1713         nop_in = (struct bnx2i_nop_in_msg *)cqe;
1714
1715         spin_lock(&session->lock);
1716         hdr = (struct iscsi_nopin *)&bnx2i_conn->gen_pdu.resp_hdr;
1717         memset(hdr, 0, sizeof(struct iscsi_hdr));
1718         hdr->opcode = nop_in->op_code;
1719         hdr->max_cmdsn = cpu_to_be32(nop_in->max_cmd_sn);
1720         hdr->exp_cmdsn = cpu_to_be32(nop_in->exp_cmd_sn);
1721         hdr->ttt = cpu_to_be32(nop_in->ttt);
1722
1723         if (nop_in->itt == (u16) RESERVED_ITT) {
1724                 bnx2i_unsol_pdu_adjust_rq(bnx2i_conn);
1725                 hdr->itt = RESERVED_ITT;
1726                 tgt_async_nop = 1;
1727                 goto done;
1728         }
1729
1730         /* this is a response to one of our nop-outs */
1731         task = iscsi_itt_to_task(conn,
1732                          (itt_t) (nop_in->itt & ISCSI_NOP_IN_MSG_INDEX));
1733         if (task) {
1734                 hdr->flags = ISCSI_FLAG_CMD_FINAL;
1735                 hdr->itt = task->hdr->itt;
1736                 hdr->ttt = cpu_to_be32(nop_in->ttt);
1737                 memcpy(&hdr->lun, nop_in->lun, 8);
1738         }
1739 done:
1740         __iscsi_complete_pdu(conn, (struct iscsi_hdr *)hdr, NULL, 0);
1741         spin_unlock(&session->lock);
1742
1743         return tgt_async_nop;
1744 }
1745
1746
1747 /**
1748  * bnx2i_process_async_mesg - this function handles iscsi async message
1749  * @session:            iscsi session pointer
1750  * @bnx2i_conn:         iscsi connection pointer
1751  * @cqe:                pointer to newly DMA'ed CQE entry for processing
1752  *
1753  * process iSCSI ASYNC Message
1754  */
1755 static void bnx2i_process_async_mesg(struct iscsi_session *session,
1756                                      struct bnx2i_conn *bnx2i_conn,
1757                                      struct cqe *cqe)
1758 {
1759         struct bnx2i_async_msg *async_cqe;
1760         struct iscsi_async *resp_hdr;
1761         u8 async_event;
1762
1763         bnx2i_unsol_pdu_adjust_rq(bnx2i_conn);
1764
1765         async_cqe = (struct bnx2i_async_msg *)cqe;
1766         async_event = async_cqe->async_event;
1767
1768         if (async_event == ISCSI_ASYNC_MSG_SCSI_EVENT) {
1769                 iscsi_conn_printk(KERN_ALERT, bnx2i_conn->cls_conn->dd_data,
1770                                   "async: scsi events not supported\n");
1771                 return;
1772         }
1773
1774         spin_lock(&session->lock);
1775         resp_hdr = (struct iscsi_async *) &bnx2i_conn->gen_pdu.resp_hdr;
1776         memset(resp_hdr, 0, sizeof(struct iscsi_hdr));
1777         resp_hdr->opcode = async_cqe->op_code;
1778         resp_hdr->flags = 0x80;
1779
1780         memcpy(&resp_hdr->lun, async_cqe->lun, 8);
1781         resp_hdr->exp_cmdsn = cpu_to_be32(async_cqe->exp_cmd_sn);
1782         resp_hdr->max_cmdsn = cpu_to_be32(async_cqe->max_cmd_sn);
1783
1784         resp_hdr->async_event = async_cqe->async_event;
1785         resp_hdr->async_vcode = async_cqe->async_vcode;
1786
1787         resp_hdr->param1 = cpu_to_be16(async_cqe->param1);
1788         resp_hdr->param2 = cpu_to_be16(async_cqe->param2);
1789         resp_hdr->param3 = cpu_to_be16(async_cqe->param3);
1790
1791         __iscsi_complete_pdu(bnx2i_conn->cls_conn->dd_data,
1792                              (struct iscsi_hdr *)resp_hdr, NULL, 0);
1793         spin_unlock(&session->lock);
1794 }
1795
1796
1797 /**
1798  * bnx2i_process_reject_mesg - process iscsi reject pdu
1799  * @session:            iscsi session pointer
1800  * @bnx2i_conn:         iscsi connection pointer
1801  * @cqe:                pointer to newly DMA'ed CQE entry for processing
1802  *
1803  * process iSCSI REJECT message
1804  */
1805 static void bnx2i_process_reject_mesg(struct iscsi_session *session,
1806                                       struct bnx2i_conn *bnx2i_conn,
1807                                       struct cqe *cqe)
1808 {
1809         struct iscsi_conn *conn = bnx2i_conn->cls_conn->dd_data;
1810         struct bnx2i_reject_msg *reject;
1811         struct iscsi_reject *hdr;
1812
1813         reject = (struct bnx2i_reject_msg *) cqe;
1814         if (reject->data_length) {
1815                 bnx2i_get_rq_buf(bnx2i_conn, conn->data, reject->data_length);
1816                 bnx2i_put_rq_buf(bnx2i_conn, 1);
1817         } else
1818                 bnx2i_unsol_pdu_adjust_rq(bnx2i_conn);
1819
1820         spin_lock(&session->lock);
1821         hdr = (struct iscsi_reject *) &bnx2i_conn->gen_pdu.resp_hdr;
1822         memset(hdr, 0, sizeof(struct iscsi_hdr));
1823         hdr->opcode = reject->op_code;
1824         hdr->reason = reject->reason;
1825         hton24(hdr->dlength, reject->data_length);
1826         hdr->max_cmdsn = cpu_to_be32(reject->max_cmd_sn);
1827         hdr->exp_cmdsn = cpu_to_be32(reject->exp_cmd_sn);
1828         hdr->ffffffff = cpu_to_be32(RESERVED_ITT);
1829         __iscsi_complete_pdu(conn, (struct iscsi_hdr *)hdr, conn->data,
1830                              reject->data_length);
1831         spin_unlock(&session->lock);
1832 }
1833
1834 /**
1835  * bnx2i_process_cmd_cleanup_resp - process scsi command clean-up completion
1836  * @session:            iscsi session pointer
1837  * @bnx2i_conn:         iscsi connection pointer
1838  * @cqe:                pointer to newly DMA'ed CQE entry for processing
1839  *
1840  * process command cleanup response CQE during conn shutdown or error recovery
1841  */
1842 static void bnx2i_process_cmd_cleanup_resp(struct iscsi_session *session,
1843                                            struct bnx2i_conn *bnx2i_conn,
1844                                            struct cqe *cqe)
1845 {
1846         struct bnx2i_cleanup_response *cmd_clean_rsp;
1847         struct iscsi_conn *conn = bnx2i_conn->cls_conn->dd_data;
1848         struct iscsi_task *task;
1849
1850         cmd_clean_rsp = (struct bnx2i_cleanup_response *)cqe;
1851         spin_lock(&session->lock);
1852         task = iscsi_itt_to_task(conn,
1853                         cmd_clean_rsp->itt & ISCSI_CLEANUP_RESPONSE_INDEX);
1854         if (!task)
1855                 printk(KERN_ALERT "bnx2i: cmd clean ITT %x not active\n",
1856                         cmd_clean_rsp->itt & ISCSI_CLEANUP_RESPONSE_INDEX);
1857         spin_unlock(&session->lock);
1858         complete(&bnx2i_conn->cmd_cleanup_cmpl);
1859 }
1860
1861
1862 /**
1863  * bnx2i_percpu_io_thread - thread per cpu for ios
1864  *
1865  * @arg:        ptr to bnx2i_percpu_info structure
1866  */
1867 int bnx2i_percpu_io_thread(void *arg)
1868 {
1869         struct bnx2i_percpu_s *p = arg;
1870         struct bnx2i_work *work, *tmp;
1871         LIST_HEAD(work_list);
1872
1873         set_user_nice(current, -20);
1874
1875         while (!kthread_should_stop()) {
1876                 spin_lock_bh(&p->p_work_lock);
1877                 while (!list_empty(&p->work_list)) {
1878                         list_splice_init(&p->work_list, &work_list);
1879                         spin_unlock_bh(&p->p_work_lock);
1880
1881                         list_for_each_entry_safe(work, tmp, &work_list, list) {
1882                                 list_del_init(&work->list);
1883                                 /* work allocated in the bh, freed here */
1884                                 bnx2i_process_scsi_cmd_resp(work->session,
1885                                                             work->bnx2i_conn,
1886                                                             &work->cqe);
1887                                 atomic_dec(&work->bnx2i_conn->work_cnt);
1888                                 kfree(work);
1889                         }
1890                         spin_lock_bh(&p->p_work_lock);
1891                 }
1892                 set_current_state(TASK_INTERRUPTIBLE);
1893                 spin_unlock_bh(&p->p_work_lock);
1894                 schedule();
1895         }
1896         __set_current_state(TASK_RUNNING);
1897
1898         return 0;
1899 }
1900
1901
1902 /**
1903  * bnx2i_queue_scsi_cmd_resp - queue cmd completion to the percpu thread
1904  * @bnx2i_conn:         bnx2i connection
1905  *
1906  * this function is called by generic KCQ handler to queue all pending cmd
1907  * completion CQEs
1908  *
1909  * The implementation is to queue the cmd response based on the
1910  * last recorded command for the given connection.  The
1911  * cpu_id gets recorded upon task_xmit.  No out-of-order completion!
1912  */
1913 static int bnx2i_queue_scsi_cmd_resp(struct iscsi_session *session,
1914                                      struct bnx2i_conn *bnx2i_conn,
1915                                      struct bnx2i_nop_in_msg *cqe)
1916 {
1917         struct bnx2i_work *bnx2i_work = NULL;
1918         struct bnx2i_percpu_s *p = NULL;
1919         struct iscsi_task *task;
1920         struct scsi_cmnd *sc;
1921         int rc = 0;
1922         int cpu;
1923
1924         spin_lock(&session->lock);
1925         task = iscsi_itt_to_task(bnx2i_conn->cls_conn->dd_data,
1926                                  cqe->itt & ISCSI_CMD_RESPONSE_INDEX);
1927         if (!task || !task->sc) {
1928                 spin_unlock(&session->lock);
1929                 return -EINVAL;
1930         }
1931         sc = task->sc;
1932
1933         if (!blk_rq_cpu_valid(sc->request))
1934                 cpu = smp_processor_id();
1935         else
1936                 cpu = sc->request->cpu;
1937
1938         spin_unlock(&session->lock);
1939
1940         p = &per_cpu(bnx2i_percpu, cpu);
1941         spin_lock(&p->p_work_lock);
1942         if (unlikely(!p->iothread)) {
1943                 rc = -EINVAL;
1944                 goto err;
1945         }
1946         /* Alloc and copy to the cqe */
1947         bnx2i_work = kzalloc(sizeof(struct bnx2i_work), GFP_ATOMIC);
1948         if (bnx2i_work) {
1949                 INIT_LIST_HEAD(&bnx2i_work->list);
1950                 bnx2i_work->session = session;
1951                 bnx2i_work->bnx2i_conn = bnx2i_conn;
1952                 memcpy(&bnx2i_work->cqe, cqe, sizeof(struct cqe));
1953                 list_add_tail(&bnx2i_work->list, &p->work_list);
1954                 atomic_inc(&bnx2i_conn->work_cnt);
1955                 wake_up_process(p->iothread);
1956                 spin_unlock(&p->p_work_lock);
1957                 goto done;
1958         } else
1959                 rc = -ENOMEM;
1960 err:
1961         spin_unlock(&p->p_work_lock);
1962         bnx2i_process_scsi_cmd_resp(session, bnx2i_conn, (struct cqe *)cqe);
1963 done:
1964         return rc;
1965 }
1966
1967
1968 /**
1969  * bnx2i_process_new_cqes - process newly DMA'ed CQE's
1970  * @bnx2i_conn:         bnx2i connection
1971  *
1972  * this function is called by generic KCQ handler to process all pending CQE's
1973  */
1974 static int bnx2i_process_new_cqes(struct bnx2i_conn *bnx2i_conn)
1975 {
1976         struct iscsi_conn *conn = bnx2i_conn->cls_conn->dd_data;
1977         struct iscsi_session *session = conn->session;
1978         struct bnx2i_hba *hba = bnx2i_conn->hba;
1979         struct qp_info *qp;
1980         struct bnx2i_nop_in_msg *nopin;
1981         int tgt_async_msg;
1982         int cqe_cnt = 0;
1983
1984         if (bnx2i_conn->ep == NULL)
1985                 return 0;
1986
1987         qp = &bnx2i_conn->ep->qp;
1988
1989         if (!qp->cq_virt) {
1990                 printk(KERN_ALERT "bnx2i (%s): cq resr freed in bh execution!",
1991                        hba->netdev->name);
1992                 goto out;
1993         }
1994         while (1) {
1995                 nopin = (struct bnx2i_nop_in_msg *) qp->cq_cons_qe;
1996                 if (nopin->cq_req_sn != qp->cqe_exp_seq_sn)
1997                         break;
1998
1999                 if (unlikely(test_bit(ISCSI_SUSPEND_BIT, &conn->suspend_rx))) {
2000                         if (nopin->op_code == ISCSI_OP_NOOP_IN &&
2001                             nopin->itt == (u16) RESERVED_ITT) {
2002                                 printk(KERN_ALERT "bnx2i: Unsolicited "
2003                                        "NOP-In detected for suspended "
2004                                        "connection dev=%s!\n",
2005                                        hba->netdev->name);
2006                                 bnx2i_unsol_pdu_adjust_rq(bnx2i_conn);
2007                                 goto cqe_out;
2008                         }
2009                         break;
2010                 }
2011                 tgt_async_msg = 0;
2012
2013                 switch (nopin->op_code) {
2014                 case ISCSI_OP_SCSI_CMD_RSP:
2015                 case ISCSI_OP_SCSI_DATA_IN:
2016                         /* Run the kthread engine only for data cmds
2017                            All other cmds will be completed in this bh! */
2018                         bnx2i_queue_scsi_cmd_resp(session, bnx2i_conn, nopin);
2019                         goto done;
2020                 case ISCSI_OP_LOGIN_RSP:
2021                         bnx2i_process_login_resp(session, bnx2i_conn,
2022                                                  qp->cq_cons_qe);
2023                         break;
2024                 case ISCSI_OP_SCSI_TMFUNC_RSP:
2025                         bnx2i_process_tmf_resp(session, bnx2i_conn,
2026                                                qp->cq_cons_qe);
2027                         break;
2028                 case ISCSI_OP_TEXT_RSP:
2029                         bnx2i_process_text_resp(session, bnx2i_conn,
2030                                                 qp->cq_cons_qe);
2031                         break;
2032                 case ISCSI_OP_LOGOUT_RSP:
2033                         bnx2i_process_logout_resp(session, bnx2i_conn,
2034                                                   qp->cq_cons_qe);
2035                         break;
2036                 case ISCSI_OP_NOOP_IN:
2037                         if (bnx2i_process_nopin_mesg(session, bnx2i_conn,
2038                                                      qp->cq_cons_qe))
2039                                 tgt_async_msg = 1;
2040                         break;
2041                 case ISCSI_OPCODE_NOPOUT_LOCAL_COMPLETION:
2042                         bnx2i_process_nopin_local_cmpl(session, bnx2i_conn,
2043                                                        qp->cq_cons_qe);
2044                         break;
2045                 case ISCSI_OP_ASYNC_EVENT:
2046                         bnx2i_process_async_mesg(session, bnx2i_conn,
2047                                                  qp->cq_cons_qe);
2048                         tgt_async_msg = 1;
2049                         break;
2050                 case ISCSI_OP_REJECT:
2051                         bnx2i_process_reject_mesg(session, bnx2i_conn,
2052                                                   qp->cq_cons_qe);
2053                         break;
2054                 case ISCSI_OPCODE_CLEANUP_RESPONSE:
2055                         bnx2i_process_cmd_cleanup_resp(session, bnx2i_conn,
2056                                                        qp->cq_cons_qe);
2057                         break;
2058                 default:
2059                         printk(KERN_ALERT "bnx2i: unknown opcode 0x%x\n",
2060                                           nopin->op_code);
2061                 }
2062
2063                 ADD_STATS_64(hba, rx_pdus, 1);
2064                 ADD_STATS_64(hba, rx_bytes, nopin->data_length);
2065 done:
2066                 if (!tgt_async_msg) {
2067                         if (!atomic_read(&bnx2i_conn->ep->num_active_cmds))
2068                                 printk(KERN_ALERT "bnx2i (%s): no active cmd! "
2069                                        "op 0x%x\n",
2070                                        hba->netdev->name,
2071                                        nopin->op_code);
2072                         else
2073                                 atomic_dec(&bnx2i_conn->ep->num_active_cmds);
2074                 }
2075 cqe_out:
2076                 /* clear out in production version only, till beta keep opcode
2077                  * field intact, will be helpful in debugging (context dump)
2078                  * nopin->op_code = 0;
2079                  */
2080                 cqe_cnt++;
2081                 qp->cqe_exp_seq_sn++;
2082                 if (qp->cqe_exp_seq_sn == (qp->cqe_size * 2 + 1))
2083                         qp->cqe_exp_seq_sn = ISCSI_INITIAL_SN;
2084
2085                 if (qp->cq_cons_qe == qp->cq_last_qe) {
2086                         qp->cq_cons_qe = qp->cq_first_qe;
2087                         qp->cq_cons_idx = 0;
2088                 } else {
2089                         qp->cq_cons_qe++;
2090                         qp->cq_cons_idx++;
2091                 }
2092         }
2093 out:
2094         return cqe_cnt;
2095 }
2096
2097 /**
2098  * bnx2i_fastpath_notification - process global event queue (KCQ)
2099  * @hba:                adapter structure pointer
2100  * @new_cqe_kcqe:       pointer to newly DMA'ed KCQE entry
2101  *
2102  * Fast path event notification handler, KCQ entry carries context id
2103  *      of the connection that has 1 or more pending CQ entries
2104  */
2105 static void bnx2i_fastpath_notification(struct bnx2i_hba *hba,
2106                                         struct iscsi_kcqe *new_cqe_kcqe)
2107 {
2108         struct bnx2i_conn *bnx2i_conn;
2109         u32 iscsi_cid;
2110         int nxt_idx;
2111
2112         iscsi_cid = new_cqe_kcqe->iscsi_conn_id;
2113         bnx2i_conn = bnx2i_get_conn_from_id(hba, iscsi_cid);
2114
2115         if (!bnx2i_conn) {
2116                 printk(KERN_ALERT "cid #%x not valid\n", iscsi_cid);
2117                 return;
2118         }
2119         if (!bnx2i_conn->ep) {
2120                 printk(KERN_ALERT "cid #%x - ep not bound\n", iscsi_cid);
2121                 return;
2122         }
2123
2124         bnx2i_process_new_cqes(bnx2i_conn);
2125         nxt_idx = bnx2i_arm_cq_event_coalescing(bnx2i_conn->ep,
2126                                                 CNIC_ARM_CQE_FP);
2127         if (nxt_idx && nxt_idx == bnx2i_process_new_cqes(bnx2i_conn))
2128                 bnx2i_arm_cq_event_coalescing(bnx2i_conn->ep, CNIC_ARM_CQE_FP);
2129 }
2130
2131
2132 /**
2133  * bnx2i_process_update_conn_cmpl - process iscsi conn update completion KCQE
2134  * @hba:                adapter structure pointer
2135  * @update_kcqe:        kcqe pointer
2136  *
2137  * CONN_UPDATE completion handler, this completes iSCSI connection FFP migration
2138  */
2139 static void bnx2i_process_update_conn_cmpl(struct bnx2i_hba *hba,
2140                                            struct iscsi_kcqe *update_kcqe)
2141 {
2142         struct bnx2i_conn *conn;
2143         u32 iscsi_cid;
2144
2145         iscsi_cid = update_kcqe->iscsi_conn_id;
2146         conn = bnx2i_get_conn_from_id(hba, iscsi_cid);
2147
2148         if (!conn) {
2149                 printk(KERN_ALERT "conn_update: cid %x not valid\n", iscsi_cid);
2150                 return;
2151         }
2152         if (!conn->ep) {
2153                 printk(KERN_ALERT "cid %x does not have ep bound\n", iscsi_cid);
2154                 return;
2155         }
2156
2157         if (update_kcqe->completion_status) {
2158                 printk(KERN_ALERT "request failed cid %x\n", iscsi_cid);
2159                 conn->ep->state = EP_STATE_ULP_UPDATE_FAILED;
2160         } else
2161                 conn->ep->state = EP_STATE_ULP_UPDATE_COMPL;
2162
2163         wake_up_interruptible(&conn->ep->ofld_wait);
2164 }
2165
2166
2167 /**
2168  * bnx2i_recovery_que_add_conn - add connection to recovery queue
2169  * @hba:                adapter structure pointer
2170  * @bnx2i_conn:         iscsi connection
2171  *
2172  * Add connection to recovery queue and schedule adapter eh worker
2173  */
2174 static void bnx2i_recovery_que_add_conn(struct bnx2i_hba *hba,
2175                                         struct bnx2i_conn *bnx2i_conn)
2176 {
2177         iscsi_conn_failure(bnx2i_conn->cls_conn->dd_data,
2178                            ISCSI_ERR_CONN_FAILED);
2179 }
2180
2181
2182 /**
2183  * bnx2i_process_tcp_error - process error notification on a given connection
2184  *
2185  * @hba:                adapter structure pointer
2186  * @tcp_err:            tcp error kcqe pointer
2187  *
2188  * handles tcp level error notifications from FW.
2189  */
2190 static void bnx2i_process_tcp_error(struct bnx2i_hba *hba,
2191                                     struct iscsi_kcqe *tcp_err)
2192 {
2193         struct bnx2i_conn *bnx2i_conn;
2194         u32 iscsi_cid;
2195
2196         iscsi_cid = tcp_err->iscsi_conn_id;
2197         bnx2i_conn = bnx2i_get_conn_from_id(hba, iscsi_cid);
2198
2199         if (!bnx2i_conn) {
2200                 printk(KERN_ALERT "bnx2i - cid 0x%x not valid\n", iscsi_cid);
2201                 return;
2202         }
2203
2204         printk(KERN_ALERT "bnx2i - cid 0x%x had TCP errors, error code 0x%x\n",
2205                           iscsi_cid, tcp_err->completion_status);
2206         bnx2i_recovery_que_add_conn(bnx2i_conn->hba, bnx2i_conn);
2207 }
2208
2209
2210 /**
2211  * bnx2i_process_iscsi_error - process error notification on a given connection
2212  * @hba:                adapter structure pointer
2213  * @iscsi_err:          iscsi error kcqe pointer
2214  *
2215  * handles iscsi error notifications from the FW. Firmware based in initial
2216  *      handshake classifies iscsi protocol / TCP rfc violation into either
2217  *      warning or error indications. If indication is of "Error" type, driver
2218  *      will initiate session recovery for that connection/session. For
2219  *      "Warning" type indication, driver will put out a system log message
2220  *      (there will be only one message for each type for the life of the
2221  *      session, this is to avoid un-necessarily overloading the system)
2222  */
2223 static void bnx2i_process_iscsi_error(struct bnx2i_hba *hba,
2224                                       struct iscsi_kcqe *iscsi_err)
2225 {
2226         struct bnx2i_conn *bnx2i_conn;
2227         u32 iscsi_cid;
2228         char warn_notice[] = "iscsi_warning";
2229         char error_notice[] = "iscsi_error";
2230         char additional_notice[64];
2231         char *message;
2232         int need_recovery;
2233         u64 err_mask64;
2234
2235         iscsi_cid = iscsi_err->iscsi_conn_id;
2236         bnx2i_conn = bnx2i_get_conn_from_id(hba, iscsi_cid);
2237         if (!bnx2i_conn) {
2238                 printk(KERN_ALERT "bnx2i - cid 0x%x not valid\n", iscsi_cid);
2239                 return;
2240         }
2241
2242         err_mask64 = (0x1ULL << iscsi_err->completion_status);
2243
2244         if (err_mask64 & iscsi_error_mask) {
2245                 need_recovery = 0;
2246                 message = warn_notice;
2247         } else {
2248                 need_recovery = 1;
2249                 message = error_notice;
2250         }
2251
2252         switch (iscsi_err->completion_status) {
2253         case ISCSI_KCQE_COMPLETION_STATUS_HDR_DIG_ERR:
2254                 strcpy(additional_notice, "hdr digest err");
2255                 break;
2256         case ISCSI_KCQE_COMPLETION_STATUS_DATA_DIG_ERR:
2257                 strcpy(additional_notice, "data digest err");
2258                 break;
2259         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_OPCODE:
2260                 strcpy(additional_notice, "wrong opcode rcvd");
2261                 break;
2262         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_AHS_LEN:
2263                 strcpy(additional_notice, "AHS len > 0 rcvd");
2264                 break;
2265         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_ITT:
2266                 strcpy(additional_notice, "invalid ITT rcvd");
2267                 break;
2268         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_STATSN:
2269                 strcpy(additional_notice, "wrong StatSN rcvd");
2270                 break;
2271         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_EXP_DATASN:
2272                 strcpy(additional_notice, "wrong DataSN rcvd");
2273                 break;
2274         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_PEND_R2T:
2275                 strcpy(additional_notice, "pend R2T violation");
2276                 break;
2277         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_O_U_0:
2278                 strcpy(additional_notice, "ERL0, UO");
2279                 break;
2280         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_O_U_1:
2281                 strcpy(additional_notice, "ERL0, U1");
2282                 break;
2283         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_O_U_2:
2284                 strcpy(additional_notice, "ERL0, U2");
2285                 break;
2286         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_O_U_3:
2287                 strcpy(additional_notice, "ERL0, U3");
2288                 break;
2289         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_O_U_4:
2290                 strcpy(additional_notice, "ERL0, U4");
2291                 break;
2292         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_O_U_5:
2293                 strcpy(additional_notice, "ERL0, U5");
2294                 break;
2295         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_O_U_6:
2296                 strcpy(additional_notice, "ERL0, U6");
2297                 break;
2298         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_REMAIN_RCV_LEN:
2299                 strcpy(additional_notice, "invalid resi len");
2300                 break;
2301         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_MAX_RCV_PDU_LEN:
2302                 strcpy(additional_notice, "MRDSL violation");
2303                 break;
2304         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_F_BIT_ZERO:
2305                 strcpy(additional_notice, "F-bit not set");
2306                 break;
2307         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_TTT_NOT_RSRV:
2308                 strcpy(additional_notice, "invalid TTT");
2309                 break;
2310         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_DATASN:
2311                 strcpy(additional_notice, "invalid DataSN");
2312                 break;
2313         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_REMAIN_BURST_LEN:
2314                 strcpy(additional_notice, "burst len violation");
2315                 break;
2316         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_BUFFER_OFF:
2317                 strcpy(additional_notice, "buf offset violation");
2318                 break;
2319         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_LUN:
2320                 strcpy(additional_notice, "invalid LUN field");
2321                 break;
2322         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_R2TSN:
2323                 strcpy(additional_notice, "invalid R2TSN field");
2324                 break;
2325 #define BNX2I_ERR_DESIRED_DATA_TRNS_LEN_0       \
2326         ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_DESIRED_DATA_TRNS_LEN_0
2327         case BNX2I_ERR_DESIRED_DATA_TRNS_LEN_0:
2328                 strcpy(additional_notice, "invalid cmd len1");
2329                 break;
2330 #define BNX2I_ERR_DESIRED_DATA_TRNS_LEN_1       \
2331         ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_DESIRED_DATA_TRNS_LEN_1
2332         case BNX2I_ERR_DESIRED_DATA_TRNS_LEN_1:
2333                 strcpy(additional_notice, "invalid cmd len2");
2334                 break;
2335         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_PEND_R2T_EXCEED:
2336                 strcpy(additional_notice,
2337                        "pend r2t exceeds MaxOutstandingR2T value");
2338                 break;
2339         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_TTT_IS_RSRV:
2340                 strcpy(additional_notice, "TTT is rsvd");
2341                 break;
2342         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_MAX_BURST_LEN:
2343                 strcpy(additional_notice, "MBL violation");
2344                 break;
2345 #define BNX2I_ERR_DATA_SEG_LEN_NOT_ZERO         \
2346         ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_DATA_SEG_LEN_NOT_ZERO
2347         case BNX2I_ERR_DATA_SEG_LEN_NOT_ZERO:
2348                 strcpy(additional_notice, "data seg len != 0");
2349                 break;
2350         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_REJECT_PDU_LEN:
2351                 strcpy(additional_notice, "reject pdu len error");
2352                 break;
2353         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_ASYNC_PDU_LEN:
2354                 strcpy(additional_notice, "async pdu len error");
2355                 break;
2356         case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_NOPIN_PDU_LEN:
2357                 strcpy(additional_notice, "nopin pdu len error");
2358                 break;
2359 #define BNX2_ERR_PEND_R2T_IN_CLEANUP                    \
2360         ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_PEND_R2T_IN_CLEANUP
2361         case BNX2_ERR_PEND_R2T_IN_CLEANUP:
2362                 strcpy(additional_notice, "pend r2t in cleanup");
2363                 break;
2364
2365         case ISCI_KCQE_COMPLETION_STATUS_TCP_ERROR_IP_FRAGMENT:
2366                 strcpy(additional_notice, "IP fragments rcvd");
2367                 break;
2368         case ISCI_KCQE_COMPLETION_STATUS_TCP_ERROR_IP_OPTIONS:
2369                 strcpy(additional_notice, "IP options error");
2370                 break;
2371         case ISCI_KCQE_COMPLETION_STATUS_TCP_ERROR_URGENT_FLAG:
2372                 strcpy(additional_notice, "urgent flag error");
2373                 break;
2374         default:
2375                 printk(KERN_ALERT "iscsi_err - unknown err %x\n",
2376                                   iscsi_err->completion_status);
2377         }
2378
2379         if (need_recovery) {
2380                 iscsi_conn_printk(KERN_ALERT,
2381                                   bnx2i_conn->cls_conn->dd_data,
2382                                   "bnx2i: %s - %s\n",
2383                                   message, additional_notice);
2384
2385                 iscsi_conn_printk(KERN_ALERT,
2386                                   bnx2i_conn->cls_conn->dd_data,
2387                                   "conn_err - hostno %d conn %p, "
2388                                   "iscsi_cid %x cid %x\n",
2389                                   bnx2i_conn->hba->shost->host_no,
2390                                   bnx2i_conn, bnx2i_conn->ep->ep_iscsi_cid,
2391                                   bnx2i_conn->ep->ep_cid);
2392                 bnx2i_recovery_que_add_conn(bnx2i_conn->hba, bnx2i_conn);
2393         } else
2394                 if (!test_and_set_bit(iscsi_err->completion_status,
2395                                       (void *) &bnx2i_conn->violation_notified))
2396                         iscsi_conn_printk(KERN_ALERT,
2397                                           bnx2i_conn->cls_conn->dd_data,
2398                                           "bnx2i: %s - %s\n",
2399                                           message, additional_notice);
2400 }
2401
2402
2403 /**
2404  * bnx2i_process_conn_destroy_cmpl - process iscsi conn destroy completion
2405  * @hba:                adapter structure pointer
2406  * @conn_destroy:       conn destroy kcqe pointer
2407  *
2408  * handles connection destroy completion request.
2409  */
2410 static void bnx2i_process_conn_destroy_cmpl(struct bnx2i_hba *hba,
2411                                             struct iscsi_kcqe *conn_destroy)
2412 {
2413         struct bnx2i_endpoint *ep;
2414
2415         ep = bnx2i_find_ep_in_destroy_list(hba, conn_destroy->iscsi_conn_id);
2416         if (!ep) {
2417                 printk(KERN_ALERT "bnx2i_conn_destroy_cmpl: no pending "
2418                                   "offload request, unexpected complection\n");
2419                 return;
2420         }
2421
2422         if (hba != ep->hba) {
2423                 printk(KERN_ALERT "conn destroy- error hba mis-match\n");
2424                 return;
2425         }
2426
2427         if (conn_destroy->completion_status) {
2428                 printk(KERN_ALERT "conn_destroy_cmpl: op failed\n");
2429                 ep->state = EP_STATE_CLEANUP_FAILED;
2430         } else
2431                 ep->state = EP_STATE_CLEANUP_CMPL;
2432         wake_up_interruptible(&ep->ofld_wait);
2433 }
2434
2435
2436 /**
2437  * bnx2i_process_ofld_cmpl - process initial iscsi conn offload completion
2438  * @hba:                adapter structure pointer
2439  * @ofld_kcqe:          conn offload kcqe pointer
2440  *
2441  * handles initial connection offload completion, ep_connect() thread is
2442  *      woken-up to continue with LLP connect process
2443  */
2444 static void bnx2i_process_ofld_cmpl(struct bnx2i_hba *hba,
2445                                     struct iscsi_kcqe *ofld_kcqe)
2446 {
2447         u32 cid_addr;
2448         struct bnx2i_endpoint *ep;
2449         u32 cid_num;
2450
2451         ep = bnx2i_find_ep_in_ofld_list(hba, ofld_kcqe->iscsi_conn_id);
2452         if (!ep) {
2453                 printk(KERN_ALERT "ofld_cmpl: no pend offload request\n");
2454                 return;
2455         }
2456
2457         if (hba != ep->hba) {
2458                 printk(KERN_ALERT "ofld_cmpl: error hba mis-match\n");
2459                 return;
2460         }
2461
2462         if (ofld_kcqe->completion_status) {
2463                 ep->state = EP_STATE_OFLD_FAILED;
2464                 if (ofld_kcqe->completion_status ==
2465                     ISCSI_KCQE_COMPLETION_STATUS_CTX_ALLOC_FAILURE)
2466                         printk(KERN_ALERT "bnx2i (%s): ofld1 cmpl - unable "
2467                                 "to allocate iSCSI context resources\n",
2468                                 hba->netdev->name);
2469                 else if (ofld_kcqe->completion_status ==
2470                          ISCSI_KCQE_COMPLETION_STATUS_INVALID_OPCODE)
2471                         printk(KERN_ALERT "bnx2i (%s): ofld1 cmpl - invalid "
2472                                 "opcode\n", hba->netdev->name);
2473                 else if (ofld_kcqe->completion_status ==
2474                          ISCSI_KCQE_COMPLETION_STATUS_CID_BUSY)
2475                         /* error status code valid only for 5771x chipset */
2476                         ep->state = EP_STATE_OFLD_FAILED_CID_BUSY;
2477                 else
2478                         printk(KERN_ALERT "bnx2i (%s): ofld1 cmpl - invalid "
2479                                 "error code %d\n", hba->netdev->name,
2480                                 ofld_kcqe->completion_status);
2481         } else {
2482                 ep->state = EP_STATE_OFLD_COMPL;
2483                 cid_addr = ofld_kcqe->iscsi_conn_context_id;
2484                 cid_num = bnx2i_get_cid_num(ep);
2485                 ep->ep_cid = cid_addr;
2486                 ep->qp.ctx_base = NULL;
2487         }
2488         wake_up_interruptible(&ep->ofld_wait);
2489 }
2490
2491 /**
2492  * bnx2i_indicate_kcqe - process iscsi conn update completion KCQE
2493  * @hba:                adapter structure pointer
2494  * @update_kcqe:        kcqe pointer
2495  *
2496  * Generic KCQ event handler/dispatcher
2497  */
2498 static void bnx2i_indicate_kcqe(void *context, struct kcqe *kcqe[],
2499                                 u32 num_cqe)
2500 {
2501         struct bnx2i_hba *hba = context;
2502         int i = 0;
2503         struct iscsi_kcqe *ikcqe = NULL;
2504
2505         while (i < num_cqe) {
2506                 ikcqe = (struct iscsi_kcqe *) kcqe[i++];
2507
2508                 if (ikcqe->op_code ==
2509                     ISCSI_KCQE_OPCODE_CQ_EVENT_NOTIFICATION)
2510                         bnx2i_fastpath_notification(hba, ikcqe);
2511                 else if (ikcqe->op_code == ISCSI_KCQE_OPCODE_OFFLOAD_CONN)
2512                         bnx2i_process_ofld_cmpl(hba, ikcqe);
2513                 else if (ikcqe->op_code == ISCSI_KCQE_OPCODE_UPDATE_CONN)
2514                         bnx2i_process_update_conn_cmpl(hba, ikcqe);
2515                 else if (ikcqe->op_code == ISCSI_KCQE_OPCODE_INIT) {
2516                         if (ikcqe->completion_status !=
2517                             ISCSI_KCQE_COMPLETION_STATUS_SUCCESS)
2518                                 bnx2i_iscsi_license_error(hba, ikcqe->\
2519                                                           completion_status);
2520                         else {
2521                                 set_bit(ADAPTER_STATE_UP, &hba->adapter_state);
2522                                 bnx2i_get_link_state(hba);
2523                                 printk(KERN_INFO "bnx2i [%.2x:%.2x.%.2x]: "
2524                                                  "ISCSI_INIT passed\n",
2525                                                  (u8)hba->pcidev->bus->number,
2526                                                  hba->pci_devno,
2527                                                  (u8)hba->pci_func);
2528
2529
2530                         }
2531                 } else if (ikcqe->op_code == ISCSI_KCQE_OPCODE_DESTROY_CONN)
2532                         bnx2i_process_conn_destroy_cmpl(hba, ikcqe);
2533                 else if (ikcqe->op_code == ISCSI_KCQE_OPCODE_ISCSI_ERROR)
2534                         bnx2i_process_iscsi_error(hba, ikcqe);
2535                 else if (ikcqe->op_code == ISCSI_KCQE_OPCODE_TCP_ERROR)
2536                         bnx2i_process_tcp_error(hba, ikcqe);
2537                 else
2538                         printk(KERN_ALERT "bnx2i: unknown opcode 0x%x\n",
2539                                           ikcqe->op_code);
2540         }
2541 }
2542
2543
2544 /**
2545  * bnx2i_indicate_netevent - Generic netdev event handler
2546  * @context:    adapter structure pointer
2547  * @event:      event type
2548  * @vlan_id:    vlans id - associated vlan id with this event
2549  *
2550  * Handles four netdev events, NETDEV_UP, NETDEV_DOWN,
2551  *      NETDEV_GOING_DOWN and NETDEV_CHANGE
2552  */
2553 static void bnx2i_indicate_netevent(void *context, unsigned long event,
2554                                     u16 vlan_id)
2555 {
2556         struct bnx2i_hba *hba = context;
2557
2558         /* Ignore all netevent coming from vlans */
2559         if (vlan_id != 0)
2560                 return;
2561
2562         switch (event) {
2563         case NETDEV_UP:
2564                 if (!test_bit(ADAPTER_STATE_UP, &hba->adapter_state))
2565                         bnx2i_send_fw_iscsi_init_msg(hba);
2566                 break;
2567         case NETDEV_DOWN:
2568                 clear_bit(ADAPTER_STATE_GOING_DOWN, &hba->adapter_state);
2569                 clear_bit(ADAPTER_STATE_UP, &hba->adapter_state);
2570                 break;
2571         case NETDEV_GOING_DOWN:
2572                 set_bit(ADAPTER_STATE_GOING_DOWN, &hba->adapter_state);
2573                 iscsi_host_for_each_session(hba->shost,
2574                                             bnx2i_drop_session);
2575                 break;
2576         case NETDEV_CHANGE:
2577                 bnx2i_get_link_state(hba);
2578                 break;
2579         default:
2580                 ;
2581         }
2582 }
2583
2584
2585 /**
2586  * bnx2i_cm_connect_cmpl - process iscsi conn establishment completion
2587  * @cm_sk:              cnic sock structure pointer
2588  *
2589  * function callback exported via bnx2i - cnic driver interface to
2590  *      indicate completion of option-2 TCP connect request.
2591  */
2592 static void bnx2i_cm_connect_cmpl(struct cnic_sock *cm_sk)
2593 {
2594         struct bnx2i_endpoint *ep = (struct bnx2i_endpoint *) cm_sk->context;
2595
2596         if (test_bit(ADAPTER_STATE_GOING_DOWN, &ep->hba->adapter_state))
2597                 ep->state = EP_STATE_CONNECT_FAILED;
2598         else if (test_bit(SK_F_OFFLD_COMPLETE, &cm_sk->flags))
2599                 ep->state = EP_STATE_CONNECT_COMPL;
2600         else
2601                 ep->state = EP_STATE_CONNECT_FAILED;
2602
2603         wake_up_interruptible(&ep->ofld_wait);
2604 }
2605
2606
2607 /**
2608  * bnx2i_cm_close_cmpl - process tcp conn close completion
2609  * @cm_sk:      cnic sock structure pointer
2610  *
2611  * function callback exported via bnx2i - cnic driver interface to
2612  *      indicate completion of option-2 graceful TCP connect shutdown
2613  */
2614 static void bnx2i_cm_close_cmpl(struct cnic_sock *cm_sk)
2615 {
2616         struct bnx2i_endpoint *ep = (struct bnx2i_endpoint *) cm_sk->context;
2617
2618         ep->state = EP_STATE_DISCONN_COMPL;
2619         wake_up_interruptible(&ep->ofld_wait);
2620 }
2621
2622
2623 /**
2624  * bnx2i_cm_abort_cmpl - process abortive tcp conn teardown completion
2625  * @cm_sk:      cnic sock structure pointer
2626  *
2627  * function callback exported via bnx2i - cnic driver interface to
2628  *      indicate completion of option-2 abortive TCP connect termination
2629  */
2630 static void bnx2i_cm_abort_cmpl(struct cnic_sock *cm_sk)
2631 {
2632         struct bnx2i_endpoint *ep = (struct bnx2i_endpoint *) cm_sk->context;
2633
2634         ep->state = EP_STATE_DISCONN_COMPL;
2635         wake_up_interruptible(&ep->ofld_wait);
2636 }
2637
2638
2639 /**
2640  * bnx2i_cm_remote_close - process received TCP FIN
2641  * @hba:                adapter structure pointer
2642  * @update_kcqe:        kcqe pointer
2643  *
2644  * function callback exported via bnx2i - cnic driver interface to indicate
2645  *      async TCP events such as FIN
2646  */
2647 static void bnx2i_cm_remote_close(struct cnic_sock *cm_sk)
2648 {
2649         struct bnx2i_endpoint *ep = (struct bnx2i_endpoint *) cm_sk->context;
2650
2651         ep->state = EP_STATE_TCP_FIN_RCVD;
2652         if (ep->conn)
2653                 bnx2i_recovery_que_add_conn(ep->hba, ep->conn);
2654 }
2655
2656 /**
2657  * bnx2i_cm_remote_abort - process TCP RST and start conn cleanup
2658  * @hba:                adapter structure pointer
2659  * @update_kcqe:        kcqe pointer
2660  *
2661  * function callback exported via bnx2i - cnic driver interface to
2662  *      indicate async TCP events (RST) sent by the peer.
2663  */
2664 static void bnx2i_cm_remote_abort(struct cnic_sock *cm_sk)
2665 {
2666         struct bnx2i_endpoint *ep = (struct bnx2i_endpoint *) cm_sk->context;
2667         u32 old_state = ep->state;
2668
2669         ep->state = EP_STATE_TCP_RST_RCVD;
2670         if (old_state == EP_STATE_DISCONN_START)
2671                 wake_up_interruptible(&ep->ofld_wait);
2672         else
2673                 if (ep->conn)
2674                         bnx2i_recovery_que_add_conn(ep->hba, ep->conn);
2675 }
2676
2677
2678 static int bnx2i_send_nl_mesg(void *context, u32 msg_type,
2679                               char *buf, u16 buflen)
2680 {
2681         struct bnx2i_hba *hba = context;
2682         int rc;
2683
2684         if (!hba)
2685                 return -ENODEV;
2686
2687         rc = iscsi_offload_mesg(hba->shost, &bnx2i_iscsi_transport,
2688                                 msg_type, buf, buflen);
2689         if (rc)
2690                 printk(KERN_ALERT "bnx2i: private nl message send error\n");
2691
2692         return rc;
2693 }
2694
2695
2696 /**
2697  * bnx2i_cnic_cb - global template of bnx2i - cnic driver interface structure
2698  *                      carrying callback function pointers
2699  *
2700  */
2701 struct cnic_ulp_ops bnx2i_cnic_cb = {
2702         .cnic_init = bnx2i_ulp_init,
2703         .cnic_exit = bnx2i_ulp_exit,
2704         .cnic_start = bnx2i_start,
2705         .cnic_stop = bnx2i_stop,
2706         .indicate_kcqes = bnx2i_indicate_kcqe,
2707         .indicate_netevent = bnx2i_indicate_netevent,
2708         .cm_connect_complete = bnx2i_cm_connect_cmpl,
2709         .cm_close_complete = bnx2i_cm_close_cmpl,
2710         .cm_abort_complete = bnx2i_cm_abort_cmpl,
2711         .cm_remote_close = bnx2i_cm_remote_close,
2712         .cm_remote_abort = bnx2i_cm_remote_abort,
2713         .iscsi_nl_send_msg = bnx2i_send_nl_mesg,
2714         .cnic_get_stats = bnx2i_get_stats,
2715         .owner = THIS_MODULE
2716 };
2717
2718
2719 /**
2720  * bnx2i_map_ep_dbell_regs - map connection doorbell registers
2721  * @ep: bnx2i endpoint
2722  *
2723  * maps connection's SQ and RQ doorbell registers, 5706/5708/5709 hosts these
2724  *      register in BAR #0. Whereas in 57710 these register are accessed by
2725  *      mapping BAR #1
2726  */
2727 int bnx2i_map_ep_dbell_regs(struct bnx2i_endpoint *ep)
2728 {
2729         u32 cid_num;
2730         u32 reg_off;
2731         u32 first_l4l5;
2732         u32 ctx_sz;
2733         u32 config2;
2734         resource_size_t reg_base;
2735
2736         cid_num = bnx2i_get_cid_num(ep);
2737
2738         if (test_bit(BNX2I_NX2_DEV_57710, &ep->hba->cnic_dev_type)) {
2739                 reg_base = pci_resource_start(ep->hba->pcidev,
2740                                               BNX2X_DOORBELL_PCI_BAR);
2741                 reg_off = (1 << BNX2X_DB_SHIFT) * (cid_num & 0x1FFFF);
2742                 ep->qp.ctx_base = ioremap_nocache(reg_base + reg_off, 4);
2743                 goto arm_cq;
2744         }
2745
2746         if ((test_bit(BNX2I_NX2_DEV_5709, &ep->hba->cnic_dev_type)) &&
2747             (ep->hba->mail_queue_access == BNX2I_MQ_BIN_MODE)) {
2748                 config2 = REG_RD(ep->hba, BNX2_MQ_CONFIG2);
2749                 first_l4l5 = config2 & BNX2_MQ_CONFIG2_FIRST_L4L5;
2750                 ctx_sz = (config2 & BNX2_MQ_CONFIG2_CONT_SZ) >> 3;
2751                 if (ctx_sz)
2752                         reg_off = CTX_OFFSET + MAX_CID_CNT * MB_KERNEL_CTX_SIZE
2753                                   + BNX2I_570X_PAGE_SIZE_DEFAULT *
2754                                   (((cid_num - first_l4l5) / ctx_sz) + 256);
2755                 else
2756                         reg_off = CTX_OFFSET + (MB_KERNEL_CTX_SIZE * cid_num);
2757         } else
2758                 /* 5709 device in normal node and 5706/5708 devices */
2759                 reg_off = CTX_OFFSET + (MB_KERNEL_CTX_SIZE * cid_num);
2760
2761         ep->qp.ctx_base = ioremap_nocache(ep->hba->reg_base + reg_off,
2762                                           MB_KERNEL_CTX_SIZE);
2763         if (!ep->qp.ctx_base)
2764                 return -ENOMEM;
2765
2766 arm_cq:
2767         bnx2i_arm_cq_event_coalescing(ep, CNIC_ARM_CQE);
2768         return 0;
2769 }