USB: usb-storage: unusual_devs update for Super TOP SATA bridge
[linux/fpc-iii.git] / drivers / scsi / bnx2i / bnx2i_hwi.c
blob72de3ba51657f6eb16df69714225db7fe05e576b
1 /* bnx2i_hwi.c: Broadcom NetXtreme II iSCSI driver.
3 * Copyright (c) 2006 - 2011 Broadcom Corporation
4 * Copyright (c) 2007, 2008 Red Hat, Inc. All rights reserved.
5 * Copyright (c) 2007, 2008 Mike Christie
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.
11 * Written by: Anil Veerabhadrappa (anilgv@broadcom.com)
12 * Maintained by: Eddie Wai (eddie.wai@broadcom.com)
15 #include <linux/gfp.h>
16 #include <scsi/scsi_tcq.h>
17 #include <scsi/libiscsi.h>
18 #include "bnx2i.h"
20 DECLARE_PER_CPU(struct bnx2i_percpu_s, bnx2i_percpu);
22 /**
23 * bnx2i_get_cid_num - get cid from ep
24 * @ep: endpoint pointer
26 * Only applicable to 57710 family of devices
28 static u32 bnx2i_get_cid_num(struct bnx2i_endpoint *ep)
30 u32 cid;
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;
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
44 * Only applicable to 57710 family of devices
46 static void bnx2i_adjust_qp_size(struct bnx2i_hba *hba)
48 u32 num_elements_per_pg;
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);
56 if (!is_power_of_2(hba->max_rqes))
57 hba->max_rqes = rounddown_pow_of_two(hba->max_rqes);
60 /* Adjust each queue size if the user selection does not
61 * yield integral num of page buffers
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);
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);
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);
89 /**
90 * bnx2i_get_link_state - get network interface link state
91 * @hba: adapter instance pointer
93 * updates adapter structure flag based on netdev state
95 static void bnx2i_get_link_state(struct bnx2i_hba *hba)
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);
105 * bnx2i_iscsi_license_error - displays iscsi license related error message
106 * @hba: adapter instance pointer
107 * @error_code: error classification
109 * Puts out an error log when driver is unable to offload iscsi connection
110 * due to license restrictions
112 static void bnx2i_iscsi_license_error(struct bnx2i_hba *hba, u32 error_code)
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);
128 * bnx2i_arm_cq_event_coalescing - arms CQ to enable EQ notification
129 * @ep: endpoint (transport indentifier) structure
130 * @action: action, ARM or DISARM. For now only ARM_CQE is used
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
136 int bnx2i_arm_cq_event_coalescing(struct bnx2i_endpoint *ep, u8 action)
138 struct bnx2i_5771x_cq_db *cq_db;
139 u16 cq_index;
140 u16 next_index = 0;
141 u32 num_active_cmds;
143 /* Coalesce CQ entries only on 10G devices */
144 if (!test_bit(BNX2I_NX2_DEV_57710, &ep->hba->cnic_dev_type))
145 return 0;
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
151 cq_db = (struct bnx2i_5771x_cq_db *) ep->qp.cq_pgtbl_virt;
153 if (action != CNIC_ARM_CQE_FP)
154 if (cq_db->sqn[0] && cq_db->sqn[0] != 0xFFFF)
155 return 0;
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;
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;
174 cq_db->sqn[0] = cq_index;
176 return next_index;
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
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
191 void bnx2i_get_rq_buf(struct bnx2i_conn *bnx2i_conn, char *ptr, int len)
193 if (!bnx2i_conn->ep->qp.rqe_left)
194 return;
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++;
208 static void bnx2i_ring_577xx_doorbell(struct bnx2i_conn *conn)
210 struct bnx2i_5771x_dbell dbell;
211 u32 msg;
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);
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
227 * No need to ring hardware doorbell for 57710 family of devices
229 void bnx2i_put_rq_buf(struct bnx2i_conn *bnx2i_conn, int count)
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;
235 ep->qp.rqe_left += count;
236 ep->qp.rq_prod_idx &= 0x7FFF;
237 ep->qp.rq_prod_idx += count;
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;
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);
254 mmiowb();
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
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
267 static void bnx2i_ring_sq_dbell(struct bnx2i_conn *bnx2i_conn, int count)
269 struct bnx2i_5771x_sq_rq_db *sq_db;
270 struct bnx2i_endpoint *ep = bnx2i_conn->ep;
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);
281 mmiowb(); /* flush posted PCI writes */
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
290 * this routine will update SQ driver parameters and ring the doorbell
292 static void bnx2i_ring_dbell_update_sq_params(struct bnx2i_conn *bnx2i_conn,
293 int count)
295 int tmp_cnt;
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)];
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);
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
328 * prepare and post an iSCSI Login request WQE to CNIC firmware
330 int bnx2i_send_iscsi_login(struct bnx2i_conn *bnx2i_conn,
331 struct iscsi_task *task)
333 struct bnx2i_cmd *bnx2i_cmd;
334 struct bnx2i_login_request *login_wqe;
335 struct iscsi_login_req *login_hdr;
336 u32 dword;
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;
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;
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;
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);
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 */
373 bnx2i_ring_dbell_update_sq_params(bnx2i_conn, 1);
374 return 0;
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
383 * prepare and post an iSCSI Login request WQE to CNIC firmware
385 int bnx2i_send_iscsi_tmf(struct bnx2i_conn *bnx2i_conn,
386 struct iscsi_task *mtask)
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];
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;
402 tmfabort_wqe->op_code = tmfabort_hdr->opcode;
403 tmfabort_wqe->op_attr = tmfabort_hdr->flags;
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);
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)
415 * the iscsi layer must have completed the cmd while
416 * was starting up.
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
422 return 0;
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;
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]);
441 tmfabort_wqe->ref_cmd_sn = be32_to_cpu(tmfabort_hdr->refcmdsn);
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 */
449 bnx2i_ring_dbell_update_sq_params(bnx2i_conn, 1);
450 return 0;
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
459 * prepare and post an iSCSI Text request WQE to CNIC firmware
461 int bnx2i_send_iscsi_text(struct bnx2i_conn *bnx2i_conn,
462 struct iscsi_task *mtask)
464 struct bnx2i_cmd *bnx2i_cmd;
465 struct bnx2i_text_request *text_wqe;
466 struct iscsi_text *text_hdr;
467 u32 dword;
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;
473 memset(text_wqe, 0, sizeof(struct bnx2i_text_request));
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);
482 text_wqe->cmd_sn = be32_to_cpu(text_hdr->cmdsn);
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);
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 */
498 bnx2i_ring_dbell_update_sq_params(bnx2i_conn, 1);
499 return 0;
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
509 * prepare and post an iSCSI SCSI-CMD request WQE to CNIC firmware
511 int bnx2i_send_iscsi_scsicmd(struct bnx2i_conn *bnx2i_conn,
512 struct bnx2i_cmd *cmd)
514 struct bnx2i_cmd_request *scsi_cmd_wqe;
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 */
521 bnx2i_ring_dbell_update_sq_params(bnx2i_conn, 1);
522 return 0;
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
535 * prepare and post a nopout request WQE to CNIC firmware
537 int bnx2i_send_iscsi_nopout(struct bnx2i_conn *bnx2i_conn,
538 struct iscsi_task *task,
539 char *datap, int data_len, int unsol)
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;
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;
550 memset(nopout_wqe, 0x00, sizeof(struct bnx2i_nop_out_request));
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);
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;
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;
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;
585 nopout_wqe->cq_index = 0; /* CQ# used for completion, 5771x only */
587 bnx2i_ring_dbell_update_sq_params(bnx2i_conn, 1);
588 return 0;
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
598 * prepare and post logout request WQE to CNIC firmware
600 int bnx2i_send_iscsi_logout(struct bnx2i_conn *bnx2i_conn,
601 struct iscsi_task *task)
603 struct bnx2i_cmd *bnx2i_cmd;
604 struct bnx2i_logout_request *logout_wqe;
605 struct iscsi_logout *logout_hdr;
607 bnx2i_cmd = (struct bnx2i_cmd *)task->dd_data;
608 logout_hdr = (struct iscsi_logout *)task->hdr;
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));
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;
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 */
630 bnx2i_conn->ep->state = EP_STATE_LOGOUT_SENT;
632 bnx2i_ring_dbell_update_sq_params(bnx2i_conn, 1);
633 return 0;
638 * bnx2i_update_iscsi_conn - post iSCSI logout request WQE to hardware
639 * @conn: iscsi connection which requires iscsi parameter update
641 * sends down iSCSI Conn Update request to move iSCSI conn to FFP
643 void bnx2i_update_iscsi_conn(struct iscsi_conn *conn)
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;
651 update_wqe = &conn_update_kwqe;
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);
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;
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);
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);
694 * bnx2i_ep_ofld_timer - post iSCSI logout request WQE to hardware
695 * @data: endpoint (transport handle) structure pointer
697 * routine to handle connection offload/destroy request timeout
699 void bnx2i_ep_ofld_timer(unsigned long data)
701 struct bnx2i_endpoint *ep = (struct bnx2i_endpoint *) data;
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;
714 wake_up_interruptible(&ep->ofld_wait);
718 static int bnx2i_power_of2(u32 val)
720 u32 power = 0;
721 if (val & (val - 1))
722 return power;
723 val--;
724 while (val) {
725 val = val >> 1;
726 power++;
728 return power;
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
738 * prepares and posts CONN_OFLD_REQ1/2 KWQE
740 void bnx2i_send_cmd_cleanup_req(struct bnx2i_hba *hba, struct bnx2i_cmd *cmd)
742 struct bnx2i_cleanup_request *cmd_cleanup;
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));
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 */
752 bnx2i_ring_dbell_update_sq_params(cmd->conn, 1);
757 * bnx2i_send_conn_destroy - initiates iscsi connection teardown process
758 * @hba: adapter structure pointer
759 * @ep: endpoint (transport indentifier) structure
761 * this routine prepares and posts CONN_OFLD_REQ1/2 KWQE to initiate
762 * iscsi connection context clean-up process
764 int bnx2i_send_conn_destroy(struct bnx2i_hba *hba, struct bnx2i_endpoint *ep)
766 struct kwqe *kwqe_arr[2];
767 struct iscsi_kwqe_conn_destroy conn_cleanup;
768 int rc = -EINVAL;
770 memset(&conn_cleanup, 0x00, sizeof(struct iscsi_kwqe_conn_destroy));
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);
781 conn_cleanup.reserved0 = (u16)ep->ep_iscsi_cid;
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);
787 return rc;
792 * bnx2i_570x_send_conn_ofld_req - initiates iscsi conn context setup process
793 * @hba: adapter structure pointer
794 * @ep: endpoint (transport indentifier) structure
796 * 5706/5708/5709 specific - prepares and posts CONN_OFLD_REQ1/2 KWQE
798 static int bnx2i_570x_send_conn_ofld_req(struct bnx2i_hba *hba,
799 struct bnx2i_endpoint *ep)
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;
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);
813 ofld_req1.iscsi_conn_id = (u16) ep->ep_iscsi_cid;
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);
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);
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);
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);
831 ptbl = (u32 *) ep->qp.sq_pgtbl_virt;
833 ofld_req2.sq_first_pte.hi = *ptbl++;
834 ofld_req2.sq_first_pte.lo = *ptbl;
836 ptbl = (u32 *) ep->qp.cq_pgtbl_virt;
837 ofld_req2.cq_first_pte.hi = *ptbl++;
838 ofld_req2.cq_first_pte.lo = *ptbl;
840 kwqe_arr[0] = (struct kwqe *) &ofld_req1;
841 kwqe_arr[1] = (struct kwqe *) &ofld_req2;
842 ofld_req2.num_additional_wqes = 0;
844 if (hba->cnic && hba->cnic->submit_kwqes)
845 rc = hba->cnic->submit_kwqes(hba->cnic, kwqe_arr, num_kwqes);
847 return rc;
852 * bnx2i_5771x_send_conn_ofld_req - initiates iscsi connection context creation
853 * @hba: adapter structure pointer
854 * @ep: endpoint (transport indentifier) structure
856 * 57710 specific - prepares and posts CONN_OFLD_REQ1/2 KWQE
858 static int bnx2i_5771x_send_conn_ofld_req(struct bnx2i_hba *hba,
859 struct bnx2i_endpoint *ep)
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;
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);
874 ofld_req1.iscsi_conn_id = (u16) ep->ep_iscsi_cid;
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);
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);
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);
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);
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;
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;
900 kwqe_arr[0] = (struct kwqe *) &ofld_req1;
901 kwqe_arr[1] = (struct kwqe *) &ofld_req2;
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;
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;
913 if (hba->cnic && hba->cnic->submit_kwqes)
914 rc = hba->cnic->submit_kwqes(hba->cnic, kwqe_arr, num_kwqes);
916 return rc;
920 * bnx2i_send_conn_ofld_req - initiates iscsi connection context setup process
922 * @hba: adapter structure pointer
923 * @ep: endpoint (transport indentifier) structure
925 * this routine prepares and posts CONN_OFLD_REQ1/2 KWQE
927 int bnx2i_send_conn_ofld_req(struct bnx2i_hba *hba, struct bnx2i_endpoint *ep)
929 int rc;
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);
936 return rc;
941 * setup_qp_page_tables - iscsi QP page table setup function
942 * @ep: endpoint (transport indentifier) structure
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
948 static void setup_qp_page_tables(struct bnx2i_endpoint *ep)
950 int num_pages;
951 u32 *ptbl;
952 dma_addr_t page;
953 int cnic_dev_10g;
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;
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;
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;
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;
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;
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;
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;
1047 * bnx2i_alloc_qp_resc - allocates required resources for QP.
1048 * @hba: adapter structure pointer
1049 * @ep: endpoint (transport indentifier) structure
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
1056 int bnx2i_alloc_qp_resc(struct bnx2i_hba *hba, struct bnx2i_endpoint *ep)
1058 struct bnx2i_5771x_cq_db *cq_db;
1060 ep->hba = hba;
1061 ep->conn = NULL;
1062 ep->ep_cid = ep->ep_iscsi_cid = ep->ep_pg_cid = 0;
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;
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;
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;
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;
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;
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;
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;
1128 memset(ep->qp.cq_virt, 0x00, ep->qp.cq_mem_size);
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;
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);
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;
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;
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;
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;
1180 setup_qp_page_tables(ep);
1182 return 0;
1184 mem_alloc_err:
1185 bnx2i_free_qp_resc(hba, ep);
1186 return -ENOMEM;
1192 * bnx2i_free_qp_resc - free memory resources held by QP
1193 * @hba: adapter structure pointer
1194 * @ep: endpoint (transport indentifier) structure
1196 * Free QP resources - SQ/RQ/CQ memory and page tables.
1198 void bnx2i_free_qp_resc(struct bnx2i_hba *hba, struct bnx2i_endpoint *ep)
1200 if (ep->qp.ctx_base) {
1201 iounmap(ep->qp.ctx_base);
1202 ep->qp.ctx_base = NULL;
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;
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;
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;
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;
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;
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;
1249 * bnx2i_send_fw_iscsi_init_msg - initiates initial handshake with iscsi f/w
1250 * @hba: adapter structure pointer
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
1259 int bnx2i_send_fw_iscsi_init_msg(struct bnx2i_hba *hba)
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;
1267 memset(&iscsi_init, 0x00, sizeof(struct iscsi_kwqe_init1));
1268 memset(&iscsi_init2, 0x00, sizeof(struct iscsi_kwqe_init2));
1270 bnx2i_adjust_qp_size(hba);
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);
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);
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;
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;
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);
1332 iscsi_error_mask = mask64;
1334 kwqe_arr[0] = (struct kwqe *) &iscsi_init;
1335 kwqe_arr[1] = (struct kwqe *) &iscsi_init2;
1337 if (hba->cnic && hba->cnic->submit_kwqes)
1338 rc = hba->cnic->submit_kwqes(hba->cnic, kwqe_arr, 2);
1339 return rc;
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
1349 * process SCSI CMD Response CQE & complete the request to SCSI-ML
1351 int bnx2i_process_scsi_cmd_resp(struct iscsi_session *session,
1352 struct bnx2i_conn *bnx2i_conn,
1353 struct cqe *cqe)
1355 struct iscsi_conn *conn = bnx2i_conn->cls_conn->dd_data;
1356 struct bnx2i_cmd_response *resp_cqe;
1357 struct bnx2i_cmd *bnx2i_cmd;
1358 struct iscsi_task *task;
1359 struct iscsi_scsi_rsp *hdr;
1360 u32 datalen = 0;
1362 resp_cqe = (struct bnx2i_cmd_response *)cqe;
1363 spin_lock_bh(&session->lock);
1364 task = iscsi_itt_to_task(conn,
1365 resp_cqe->itt & ISCSI_CMD_RESPONSE_INDEX);
1366 if (!task)
1367 goto fail;
1369 bnx2i_cmd = task->dd_data;
1371 if (bnx2i_cmd->req.op_attr & ISCSI_CMD_REQUEST_READ) {
1372 conn->datain_pdus_cnt +=
1373 resp_cqe->task_stat.read_stat.num_data_outs;
1374 conn->rxdata_octets +=
1375 bnx2i_cmd->req.total_data_transfer_length;
1376 } else {
1377 conn->dataout_pdus_cnt +=
1378 resp_cqe->task_stat.read_stat.num_data_outs;
1379 conn->r2t_pdus_cnt +=
1380 resp_cqe->task_stat.read_stat.num_r2ts;
1381 conn->txdata_octets +=
1382 bnx2i_cmd->req.total_data_transfer_length;
1384 bnx2i_iscsi_unmap_sg_list(bnx2i_cmd);
1386 hdr = (struct iscsi_scsi_rsp *)task->hdr;
1387 resp_cqe = (struct bnx2i_cmd_response *)cqe;
1388 hdr->opcode = resp_cqe->op_code;
1389 hdr->max_cmdsn = cpu_to_be32(resp_cqe->max_cmd_sn);
1390 hdr->exp_cmdsn = cpu_to_be32(resp_cqe->exp_cmd_sn);
1391 hdr->response = resp_cqe->response;
1392 hdr->cmd_status = resp_cqe->status;
1393 hdr->flags = resp_cqe->response_flags;
1394 hdr->residual_count = cpu_to_be32(resp_cqe->residual_count);
1396 if (resp_cqe->op_code == ISCSI_OP_SCSI_DATA_IN)
1397 goto done;
1399 if (resp_cqe->status == SAM_STAT_CHECK_CONDITION) {
1400 datalen = resp_cqe->data_length;
1401 if (datalen < 2)
1402 goto done;
1404 if (datalen > BNX2I_RQ_WQE_SIZE) {
1405 iscsi_conn_printk(KERN_ERR, conn,
1406 "sense data len %d > RQ sz\n",
1407 datalen);
1408 datalen = BNX2I_RQ_WQE_SIZE;
1409 } else if (datalen > ISCSI_DEF_MAX_RECV_SEG_LEN) {
1410 iscsi_conn_printk(KERN_ERR, conn,
1411 "sense data len %d > conn data\n",
1412 datalen);
1413 datalen = ISCSI_DEF_MAX_RECV_SEG_LEN;
1416 bnx2i_get_rq_buf(bnx2i_cmd->conn, conn->data, datalen);
1417 bnx2i_put_rq_buf(bnx2i_cmd->conn, 1);
1420 done:
1421 __iscsi_complete_pdu(conn, (struct iscsi_hdr *)hdr,
1422 conn->data, datalen);
1423 fail:
1424 spin_unlock_bh(&session->lock);
1425 return 0;
1430 * bnx2i_process_login_resp - this function handles iscsi login response
1431 * @session: iscsi session pointer
1432 * @bnx2i_conn: iscsi connection pointer
1433 * @cqe: pointer to newly DMA'ed CQE entry for processing
1435 * process Login Response CQE & complete it to open-iscsi user daemon
1437 static int bnx2i_process_login_resp(struct iscsi_session *session,
1438 struct bnx2i_conn *bnx2i_conn,
1439 struct cqe *cqe)
1441 struct iscsi_conn *conn = bnx2i_conn->cls_conn->dd_data;
1442 struct iscsi_task *task;
1443 struct bnx2i_login_response *login;
1444 struct iscsi_login_rsp *resp_hdr;
1445 int pld_len;
1446 int pad_len;
1448 login = (struct bnx2i_login_response *) cqe;
1449 spin_lock(&session->lock);
1450 task = iscsi_itt_to_task(conn,
1451 login->itt & ISCSI_LOGIN_RESPONSE_INDEX);
1452 if (!task)
1453 goto done;
1455 resp_hdr = (struct iscsi_login_rsp *) &bnx2i_conn->gen_pdu.resp_hdr;
1456 memset(resp_hdr, 0, sizeof(struct iscsi_hdr));
1457 resp_hdr->opcode = login->op_code;
1458 resp_hdr->flags = login->response_flags;
1459 resp_hdr->max_version = login->version_max;
1460 resp_hdr->active_version = login->version_active;
1461 resp_hdr->hlength = 0;
1463 hton24(resp_hdr->dlength, login->data_length);
1464 memcpy(resp_hdr->isid, &login->isid_lo, 6);
1465 resp_hdr->tsih = cpu_to_be16(login->tsih);
1466 resp_hdr->itt = task->hdr->itt;
1467 resp_hdr->statsn = cpu_to_be32(login->stat_sn);
1468 resp_hdr->exp_cmdsn = cpu_to_be32(login->exp_cmd_sn);
1469 resp_hdr->max_cmdsn = cpu_to_be32(login->max_cmd_sn);
1470 resp_hdr->status_class = login->status_class;
1471 resp_hdr->status_detail = login->status_detail;
1472 pld_len = login->data_length;
1473 bnx2i_conn->gen_pdu.resp_wr_ptr =
1474 bnx2i_conn->gen_pdu.resp_buf + pld_len;
1476 pad_len = 0;
1477 if (pld_len & 0x3)
1478 pad_len = 4 - (pld_len % 4);
1480 if (pad_len) {
1481 int i = 0;
1482 for (i = 0; i < pad_len; i++) {
1483 bnx2i_conn->gen_pdu.resp_wr_ptr[0] = 0;
1484 bnx2i_conn->gen_pdu.resp_wr_ptr++;
1488 __iscsi_complete_pdu(conn, (struct iscsi_hdr *)resp_hdr,
1489 bnx2i_conn->gen_pdu.resp_buf,
1490 bnx2i_conn->gen_pdu.resp_wr_ptr - bnx2i_conn->gen_pdu.resp_buf);
1491 done:
1492 spin_unlock(&session->lock);
1493 return 0;
1498 * bnx2i_process_text_resp - this function handles iscsi text response
1499 * @session: iscsi session pointer
1500 * @bnx2i_conn: iscsi connection pointer
1501 * @cqe: pointer to newly DMA'ed CQE entry for processing
1503 * process iSCSI Text Response CQE& complete it to open-iscsi user daemon
1505 static int bnx2i_process_text_resp(struct iscsi_session *session,
1506 struct bnx2i_conn *bnx2i_conn,
1507 struct cqe *cqe)
1509 struct iscsi_conn *conn = bnx2i_conn->cls_conn->dd_data;
1510 struct iscsi_task *task;
1511 struct bnx2i_text_response *text;
1512 struct iscsi_text_rsp *resp_hdr;
1513 int pld_len;
1514 int pad_len;
1516 text = (struct bnx2i_text_response *) cqe;
1517 spin_lock(&session->lock);
1518 task = iscsi_itt_to_task(conn, text->itt & ISCSI_LOGIN_RESPONSE_INDEX);
1519 if (!task)
1520 goto done;
1522 resp_hdr = (struct iscsi_text_rsp *)&bnx2i_conn->gen_pdu.resp_hdr;
1523 memset(resp_hdr, 0, sizeof(struct iscsi_hdr));
1524 resp_hdr->opcode = text->op_code;
1525 resp_hdr->flags = text->response_flags;
1526 resp_hdr->hlength = 0;
1528 hton24(resp_hdr->dlength, text->data_length);
1529 resp_hdr->itt = task->hdr->itt;
1530 resp_hdr->ttt = cpu_to_be32(text->ttt);
1531 resp_hdr->statsn = task->hdr->exp_statsn;
1532 resp_hdr->exp_cmdsn = cpu_to_be32(text->exp_cmd_sn);
1533 resp_hdr->max_cmdsn = cpu_to_be32(text->max_cmd_sn);
1534 pld_len = text->data_length;
1535 bnx2i_conn->gen_pdu.resp_wr_ptr = bnx2i_conn->gen_pdu.resp_buf +
1536 pld_len;
1537 pad_len = 0;
1538 if (pld_len & 0x3)
1539 pad_len = 4 - (pld_len % 4);
1541 if (pad_len) {
1542 int i = 0;
1543 for (i = 0; i < pad_len; i++) {
1544 bnx2i_conn->gen_pdu.resp_wr_ptr[0] = 0;
1545 bnx2i_conn->gen_pdu.resp_wr_ptr++;
1548 __iscsi_complete_pdu(conn, (struct iscsi_hdr *)resp_hdr,
1549 bnx2i_conn->gen_pdu.resp_buf,
1550 bnx2i_conn->gen_pdu.resp_wr_ptr -
1551 bnx2i_conn->gen_pdu.resp_buf);
1552 done:
1553 spin_unlock(&session->lock);
1554 return 0;
1559 * bnx2i_process_tmf_resp - this function handles iscsi TMF response
1560 * @session: iscsi session pointer
1561 * @bnx2i_conn: iscsi connection pointer
1562 * @cqe: pointer to newly DMA'ed CQE entry for processing
1564 * process iSCSI TMF Response CQE and wake up the driver eh thread.
1566 static int bnx2i_process_tmf_resp(struct iscsi_session *session,
1567 struct bnx2i_conn *bnx2i_conn,
1568 struct cqe *cqe)
1570 struct iscsi_conn *conn = bnx2i_conn->cls_conn->dd_data;
1571 struct iscsi_task *task;
1572 struct bnx2i_tmf_response *tmf_cqe;
1573 struct iscsi_tm_rsp *resp_hdr;
1575 tmf_cqe = (struct bnx2i_tmf_response *)cqe;
1576 spin_lock(&session->lock);
1577 task = iscsi_itt_to_task(conn,
1578 tmf_cqe->itt & ISCSI_TMF_RESPONSE_INDEX);
1579 if (!task)
1580 goto done;
1582 resp_hdr = (struct iscsi_tm_rsp *) &bnx2i_conn->gen_pdu.resp_hdr;
1583 memset(resp_hdr, 0, sizeof(struct iscsi_hdr));
1584 resp_hdr->opcode = tmf_cqe->op_code;
1585 resp_hdr->max_cmdsn = cpu_to_be32(tmf_cqe->max_cmd_sn);
1586 resp_hdr->exp_cmdsn = cpu_to_be32(tmf_cqe->exp_cmd_sn);
1587 resp_hdr->itt = task->hdr->itt;
1588 resp_hdr->response = tmf_cqe->response;
1590 __iscsi_complete_pdu(conn, (struct iscsi_hdr *)resp_hdr, NULL, 0);
1591 done:
1592 spin_unlock(&session->lock);
1593 return 0;
1597 * bnx2i_process_logout_resp - this function handles iscsi logout response
1598 * @session: iscsi session pointer
1599 * @bnx2i_conn: iscsi connection pointer
1600 * @cqe: pointer to newly DMA'ed CQE entry for processing
1602 * process iSCSI Logout Response CQE & make function call to
1603 * notify the user daemon.
1605 static int bnx2i_process_logout_resp(struct iscsi_session *session,
1606 struct bnx2i_conn *bnx2i_conn,
1607 struct cqe *cqe)
1609 struct iscsi_conn *conn = bnx2i_conn->cls_conn->dd_data;
1610 struct iscsi_task *task;
1611 struct bnx2i_logout_response *logout;
1612 struct iscsi_logout_rsp *resp_hdr;
1614 logout = (struct bnx2i_logout_response *) cqe;
1615 spin_lock(&session->lock);
1616 task = iscsi_itt_to_task(conn,
1617 logout->itt & ISCSI_LOGOUT_RESPONSE_INDEX);
1618 if (!task)
1619 goto done;
1621 resp_hdr = (struct iscsi_logout_rsp *) &bnx2i_conn->gen_pdu.resp_hdr;
1622 memset(resp_hdr, 0, sizeof(struct iscsi_hdr));
1623 resp_hdr->opcode = logout->op_code;
1624 resp_hdr->flags = logout->response;
1625 resp_hdr->hlength = 0;
1627 resp_hdr->itt = task->hdr->itt;
1628 resp_hdr->statsn = task->hdr->exp_statsn;
1629 resp_hdr->exp_cmdsn = cpu_to_be32(logout->exp_cmd_sn);
1630 resp_hdr->max_cmdsn = cpu_to_be32(logout->max_cmd_sn);
1632 resp_hdr->t2wait = cpu_to_be32(logout->time_to_wait);
1633 resp_hdr->t2retain = cpu_to_be32(logout->time_to_retain);
1635 __iscsi_complete_pdu(conn, (struct iscsi_hdr *)resp_hdr, NULL, 0);
1637 bnx2i_conn->ep->state = EP_STATE_LOGOUT_RESP_RCVD;
1638 done:
1639 spin_unlock(&session->lock);
1640 return 0;
1644 * bnx2i_process_nopin_local_cmpl - this function handles iscsi nopin CQE
1645 * @session: iscsi session pointer
1646 * @bnx2i_conn: iscsi connection pointer
1647 * @cqe: pointer to newly DMA'ed CQE entry for processing
1649 * process iSCSI NOPIN local completion CQE, frees IIT and command structures
1651 static void bnx2i_process_nopin_local_cmpl(struct iscsi_session *session,
1652 struct bnx2i_conn *bnx2i_conn,
1653 struct cqe *cqe)
1655 struct iscsi_conn *conn = bnx2i_conn->cls_conn->dd_data;
1656 struct bnx2i_nop_in_msg *nop_in;
1657 struct iscsi_task *task;
1659 nop_in = (struct bnx2i_nop_in_msg *)cqe;
1660 spin_lock(&session->lock);
1661 task = iscsi_itt_to_task(conn,
1662 nop_in->itt & ISCSI_NOP_IN_MSG_INDEX);
1663 if (task)
1664 __iscsi_put_task(task);
1665 spin_unlock(&session->lock);
1669 * bnx2i_unsol_pdu_adjust_rq - makes adjustments to RQ after unsol pdu is recvd
1670 * @conn: iscsi connection
1672 * Firmware advances RQ producer index for every unsolicited PDU even if
1673 * payload data length is '0'. This function makes corresponding
1674 * adjustments on the driver side to match this f/w behavior
1676 static void bnx2i_unsol_pdu_adjust_rq(struct bnx2i_conn *bnx2i_conn)
1678 char dummy_rq_data[2];
1679 bnx2i_get_rq_buf(bnx2i_conn, dummy_rq_data, 1);
1680 bnx2i_put_rq_buf(bnx2i_conn, 1);
1685 * bnx2i_process_nopin_mesg - this function handles iscsi nopin CQE
1686 * @session: iscsi session pointer
1687 * @bnx2i_conn: iscsi connection pointer
1688 * @cqe: pointer to newly DMA'ed CQE entry for processing
1690 * process iSCSI target's proactive iSCSI NOPIN request
1692 static int bnx2i_process_nopin_mesg(struct iscsi_session *session,
1693 struct bnx2i_conn *bnx2i_conn,
1694 struct cqe *cqe)
1696 struct iscsi_conn *conn = bnx2i_conn->cls_conn->dd_data;
1697 struct iscsi_task *task;
1698 struct bnx2i_nop_in_msg *nop_in;
1699 struct iscsi_nopin *hdr;
1700 int tgt_async_nop = 0;
1702 nop_in = (struct bnx2i_nop_in_msg *)cqe;
1704 spin_lock(&session->lock);
1705 hdr = (struct iscsi_nopin *)&bnx2i_conn->gen_pdu.resp_hdr;
1706 memset(hdr, 0, sizeof(struct iscsi_hdr));
1707 hdr->opcode = nop_in->op_code;
1708 hdr->max_cmdsn = cpu_to_be32(nop_in->max_cmd_sn);
1709 hdr->exp_cmdsn = cpu_to_be32(nop_in->exp_cmd_sn);
1710 hdr->ttt = cpu_to_be32(nop_in->ttt);
1712 if (nop_in->itt == (u16) RESERVED_ITT) {
1713 bnx2i_unsol_pdu_adjust_rq(bnx2i_conn);
1714 hdr->itt = RESERVED_ITT;
1715 tgt_async_nop = 1;
1716 goto done;
1719 /* this is a response to one of our nop-outs */
1720 task = iscsi_itt_to_task(conn,
1721 (itt_t) (nop_in->itt & ISCSI_NOP_IN_MSG_INDEX));
1722 if (task) {
1723 hdr->flags = ISCSI_FLAG_CMD_FINAL;
1724 hdr->itt = task->hdr->itt;
1725 hdr->ttt = cpu_to_be32(nop_in->ttt);
1726 memcpy(&hdr->lun, nop_in->lun, 8);
1728 done:
1729 __iscsi_complete_pdu(conn, (struct iscsi_hdr *)hdr, NULL, 0);
1730 spin_unlock(&session->lock);
1732 return tgt_async_nop;
1737 * bnx2i_process_async_mesg - this function handles iscsi async message
1738 * @session: iscsi session pointer
1739 * @bnx2i_conn: iscsi connection pointer
1740 * @cqe: pointer to newly DMA'ed CQE entry for processing
1742 * process iSCSI ASYNC Message
1744 static void bnx2i_process_async_mesg(struct iscsi_session *session,
1745 struct bnx2i_conn *bnx2i_conn,
1746 struct cqe *cqe)
1748 struct bnx2i_async_msg *async_cqe;
1749 struct iscsi_async *resp_hdr;
1750 u8 async_event;
1752 bnx2i_unsol_pdu_adjust_rq(bnx2i_conn);
1754 async_cqe = (struct bnx2i_async_msg *)cqe;
1755 async_event = async_cqe->async_event;
1757 if (async_event == ISCSI_ASYNC_MSG_SCSI_EVENT) {
1758 iscsi_conn_printk(KERN_ALERT, bnx2i_conn->cls_conn->dd_data,
1759 "async: scsi events not supported\n");
1760 return;
1763 spin_lock(&session->lock);
1764 resp_hdr = (struct iscsi_async *) &bnx2i_conn->gen_pdu.resp_hdr;
1765 memset(resp_hdr, 0, sizeof(struct iscsi_hdr));
1766 resp_hdr->opcode = async_cqe->op_code;
1767 resp_hdr->flags = 0x80;
1769 memcpy(&resp_hdr->lun, async_cqe->lun, 8);
1770 resp_hdr->exp_cmdsn = cpu_to_be32(async_cqe->exp_cmd_sn);
1771 resp_hdr->max_cmdsn = cpu_to_be32(async_cqe->max_cmd_sn);
1773 resp_hdr->async_event = async_cqe->async_event;
1774 resp_hdr->async_vcode = async_cqe->async_vcode;
1776 resp_hdr->param1 = cpu_to_be16(async_cqe->param1);
1777 resp_hdr->param2 = cpu_to_be16(async_cqe->param2);
1778 resp_hdr->param3 = cpu_to_be16(async_cqe->param3);
1780 __iscsi_complete_pdu(bnx2i_conn->cls_conn->dd_data,
1781 (struct iscsi_hdr *)resp_hdr, NULL, 0);
1782 spin_unlock(&session->lock);
1787 * bnx2i_process_reject_mesg - process iscsi reject pdu
1788 * @session: iscsi session pointer
1789 * @bnx2i_conn: iscsi connection pointer
1790 * @cqe: pointer to newly DMA'ed CQE entry for processing
1792 * process iSCSI REJECT message
1794 static void bnx2i_process_reject_mesg(struct iscsi_session *session,
1795 struct bnx2i_conn *bnx2i_conn,
1796 struct cqe *cqe)
1798 struct iscsi_conn *conn = bnx2i_conn->cls_conn->dd_data;
1799 struct bnx2i_reject_msg *reject;
1800 struct iscsi_reject *hdr;
1802 reject = (struct bnx2i_reject_msg *) cqe;
1803 if (reject->data_length) {
1804 bnx2i_get_rq_buf(bnx2i_conn, conn->data, reject->data_length);
1805 bnx2i_put_rq_buf(bnx2i_conn, 1);
1806 } else
1807 bnx2i_unsol_pdu_adjust_rq(bnx2i_conn);
1809 spin_lock(&session->lock);
1810 hdr = (struct iscsi_reject *) &bnx2i_conn->gen_pdu.resp_hdr;
1811 memset(hdr, 0, sizeof(struct iscsi_hdr));
1812 hdr->opcode = reject->op_code;
1813 hdr->reason = reject->reason;
1814 hton24(hdr->dlength, reject->data_length);
1815 hdr->max_cmdsn = cpu_to_be32(reject->max_cmd_sn);
1816 hdr->exp_cmdsn = cpu_to_be32(reject->exp_cmd_sn);
1817 hdr->ffffffff = cpu_to_be32(RESERVED_ITT);
1818 __iscsi_complete_pdu(conn, (struct iscsi_hdr *)hdr, conn->data,
1819 reject->data_length);
1820 spin_unlock(&session->lock);
1824 * bnx2i_process_cmd_cleanup_resp - process scsi command clean-up completion
1825 * @session: iscsi session pointer
1826 * @bnx2i_conn: iscsi connection pointer
1827 * @cqe: pointer to newly DMA'ed CQE entry for processing
1829 * process command cleanup response CQE during conn shutdown or error recovery
1831 static void bnx2i_process_cmd_cleanup_resp(struct iscsi_session *session,
1832 struct bnx2i_conn *bnx2i_conn,
1833 struct cqe *cqe)
1835 struct bnx2i_cleanup_response *cmd_clean_rsp;
1836 struct iscsi_conn *conn = bnx2i_conn->cls_conn->dd_data;
1837 struct iscsi_task *task;
1839 cmd_clean_rsp = (struct bnx2i_cleanup_response *)cqe;
1840 spin_lock(&session->lock);
1841 task = iscsi_itt_to_task(conn,
1842 cmd_clean_rsp->itt & ISCSI_CLEANUP_RESPONSE_INDEX);
1843 if (!task)
1844 printk(KERN_ALERT "bnx2i: cmd clean ITT %x not active\n",
1845 cmd_clean_rsp->itt & ISCSI_CLEANUP_RESPONSE_INDEX);
1846 spin_unlock(&session->lock);
1847 complete(&bnx2i_conn->cmd_cleanup_cmpl);
1852 * bnx2i_percpu_io_thread - thread per cpu for ios
1854 * @arg: ptr to bnx2i_percpu_info structure
1856 int bnx2i_percpu_io_thread(void *arg)
1858 struct bnx2i_percpu_s *p = arg;
1859 struct bnx2i_work *work, *tmp;
1860 LIST_HEAD(work_list);
1862 set_user_nice(current, -20);
1864 while (!kthread_should_stop()) {
1865 spin_lock_bh(&p->p_work_lock);
1866 while (!list_empty(&p->work_list)) {
1867 list_splice_init(&p->work_list, &work_list);
1868 spin_unlock_bh(&p->p_work_lock);
1870 list_for_each_entry_safe(work, tmp, &work_list, list) {
1871 list_del_init(&work->list);
1872 /* work allocated in the bh, freed here */
1873 bnx2i_process_scsi_cmd_resp(work->session,
1874 work->bnx2i_conn,
1875 &work->cqe);
1876 atomic_dec(&work->bnx2i_conn->work_cnt);
1877 kfree(work);
1879 spin_lock_bh(&p->p_work_lock);
1881 set_current_state(TASK_INTERRUPTIBLE);
1882 spin_unlock_bh(&p->p_work_lock);
1883 schedule();
1885 __set_current_state(TASK_RUNNING);
1887 return 0;
1892 * bnx2i_queue_scsi_cmd_resp - queue cmd completion to the percpu thread
1893 * @bnx2i_conn: bnx2i connection
1895 * this function is called by generic KCQ handler to queue all pending cmd
1896 * completion CQEs
1898 * The implementation is to queue the cmd response based on the
1899 * last recorded command for the given connection. The
1900 * cpu_id gets recorded upon task_xmit. No out-of-order completion!
1902 static int bnx2i_queue_scsi_cmd_resp(struct iscsi_session *session,
1903 struct bnx2i_conn *bnx2i_conn,
1904 struct bnx2i_nop_in_msg *cqe)
1906 struct bnx2i_work *bnx2i_work = NULL;
1907 struct bnx2i_percpu_s *p = NULL;
1908 struct iscsi_task *task;
1909 struct scsi_cmnd *sc;
1910 int rc = 0;
1911 int cpu;
1913 spin_lock(&session->lock);
1914 task = iscsi_itt_to_task(bnx2i_conn->cls_conn->dd_data,
1915 cqe->itt & ISCSI_CMD_RESPONSE_INDEX);
1916 if (!task || !task->sc) {
1917 spin_unlock(&session->lock);
1918 return -EINVAL;
1920 sc = task->sc;
1922 if (!blk_rq_cpu_valid(sc->request))
1923 cpu = smp_processor_id();
1924 else
1925 cpu = sc->request->cpu;
1927 spin_unlock(&session->lock);
1929 p = &per_cpu(bnx2i_percpu, cpu);
1930 spin_lock(&p->p_work_lock);
1931 if (unlikely(!p->iothread)) {
1932 rc = -EINVAL;
1933 goto err;
1935 /* Alloc and copy to the cqe */
1936 bnx2i_work = kzalloc(sizeof(struct bnx2i_work), GFP_ATOMIC);
1937 if (bnx2i_work) {
1938 INIT_LIST_HEAD(&bnx2i_work->list);
1939 bnx2i_work->session = session;
1940 bnx2i_work->bnx2i_conn = bnx2i_conn;
1941 memcpy(&bnx2i_work->cqe, cqe, sizeof(struct cqe));
1942 list_add_tail(&bnx2i_work->list, &p->work_list);
1943 atomic_inc(&bnx2i_conn->work_cnt);
1944 wake_up_process(p->iothread);
1945 spin_unlock(&p->p_work_lock);
1946 goto done;
1947 } else
1948 rc = -ENOMEM;
1949 err:
1950 spin_unlock(&p->p_work_lock);
1951 bnx2i_process_scsi_cmd_resp(session, bnx2i_conn, (struct cqe *)cqe);
1952 done:
1953 return rc;
1958 * bnx2i_process_new_cqes - process newly DMA'ed CQE's
1959 * @bnx2i_conn: bnx2i connection
1961 * this function is called by generic KCQ handler to process all pending CQE's
1963 static int bnx2i_process_new_cqes(struct bnx2i_conn *bnx2i_conn)
1965 struct iscsi_conn *conn = bnx2i_conn->cls_conn->dd_data;
1966 struct iscsi_session *session = conn->session;
1967 struct qp_info *qp;
1968 struct bnx2i_nop_in_msg *nopin;
1969 int tgt_async_msg;
1970 int cqe_cnt = 0;
1972 if (bnx2i_conn->ep == NULL)
1973 return 0;
1975 qp = &bnx2i_conn->ep->qp;
1977 if (!qp->cq_virt) {
1978 printk(KERN_ALERT "bnx2i (%s): cq resr freed in bh execution!",
1979 bnx2i_conn->hba->netdev->name);
1980 goto out;
1982 while (1) {
1983 nopin = (struct bnx2i_nop_in_msg *) qp->cq_cons_qe;
1984 if (nopin->cq_req_sn != qp->cqe_exp_seq_sn)
1985 break;
1987 if (unlikely(test_bit(ISCSI_SUSPEND_BIT, &conn->suspend_rx))) {
1988 if (nopin->op_code == ISCSI_OP_NOOP_IN &&
1989 nopin->itt == (u16) RESERVED_ITT) {
1990 printk(KERN_ALERT "bnx2i: Unsolicited "
1991 "NOP-In detected for suspended "
1992 "connection dev=%s!\n",
1993 bnx2i_conn->hba->netdev->name);
1994 bnx2i_unsol_pdu_adjust_rq(bnx2i_conn);
1995 goto cqe_out;
1997 break;
1999 tgt_async_msg = 0;
2001 switch (nopin->op_code) {
2002 case ISCSI_OP_SCSI_CMD_RSP:
2003 case ISCSI_OP_SCSI_DATA_IN:
2004 /* Run the kthread engine only for data cmds
2005 All other cmds will be completed in this bh! */
2006 bnx2i_queue_scsi_cmd_resp(session, bnx2i_conn, nopin);
2007 break;
2008 case ISCSI_OP_LOGIN_RSP:
2009 bnx2i_process_login_resp(session, bnx2i_conn,
2010 qp->cq_cons_qe);
2011 break;
2012 case ISCSI_OP_SCSI_TMFUNC_RSP:
2013 bnx2i_process_tmf_resp(session, bnx2i_conn,
2014 qp->cq_cons_qe);
2015 break;
2016 case ISCSI_OP_TEXT_RSP:
2017 bnx2i_process_text_resp(session, bnx2i_conn,
2018 qp->cq_cons_qe);
2019 break;
2020 case ISCSI_OP_LOGOUT_RSP:
2021 bnx2i_process_logout_resp(session, bnx2i_conn,
2022 qp->cq_cons_qe);
2023 break;
2024 case ISCSI_OP_NOOP_IN:
2025 if (bnx2i_process_nopin_mesg(session, bnx2i_conn,
2026 qp->cq_cons_qe))
2027 tgt_async_msg = 1;
2028 break;
2029 case ISCSI_OPCODE_NOPOUT_LOCAL_COMPLETION:
2030 bnx2i_process_nopin_local_cmpl(session, bnx2i_conn,
2031 qp->cq_cons_qe);
2032 break;
2033 case ISCSI_OP_ASYNC_EVENT:
2034 bnx2i_process_async_mesg(session, bnx2i_conn,
2035 qp->cq_cons_qe);
2036 tgt_async_msg = 1;
2037 break;
2038 case ISCSI_OP_REJECT:
2039 bnx2i_process_reject_mesg(session, bnx2i_conn,
2040 qp->cq_cons_qe);
2041 break;
2042 case ISCSI_OPCODE_CLEANUP_RESPONSE:
2043 bnx2i_process_cmd_cleanup_resp(session, bnx2i_conn,
2044 qp->cq_cons_qe);
2045 break;
2046 default:
2047 printk(KERN_ALERT "bnx2i: unknown opcode 0x%x\n",
2048 nopin->op_code);
2050 if (!tgt_async_msg) {
2051 if (!atomic_read(&bnx2i_conn->ep->num_active_cmds))
2052 printk(KERN_ALERT "bnx2i (%s): no active cmd! "
2053 "op 0x%x\n",
2054 bnx2i_conn->hba->netdev->name,
2055 nopin->op_code);
2056 else
2057 atomic_dec(&bnx2i_conn->ep->num_active_cmds);
2059 cqe_out:
2060 /* clear out in production version only, till beta keep opcode
2061 * field intact, will be helpful in debugging (context dump)
2062 * nopin->op_code = 0;
2064 cqe_cnt++;
2065 qp->cqe_exp_seq_sn++;
2066 if (qp->cqe_exp_seq_sn == (qp->cqe_size * 2 + 1))
2067 qp->cqe_exp_seq_sn = ISCSI_INITIAL_SN;
2069 if (qp->cq_cons_qe == qp->cq_last_qe) {
2070 qp->cq_cons_qe = qp->cq_first_qe;
2071 qp->cq_cons_idx = 0;
2072 } else {
2073 qp->cq_cons_qe++;
2074 qp->cq_cons_idx++;
2077 out:
2078 return cqe_cnt;
2082 * bnx2i_fastpath_notification - process global event queue (KCQ)
2083 * @hba: adapter structure pointer
2084 * @new_cqe_kcqe: pointer to newly DMA'ed KCQE entry
2086 * Fast path event notification handler, KCQ entry carries context id
2087 * of the connection that has 1 or more pending CQ entries
2089 static void bnx2i_fastpath_notification(struct bnx2i_hba *hba,
2090 struct iscsi_kcqe *new_cqe_kcqe)
2092 struct bnx2i_conn *bnx2i_conn;
2093 u32 iscsi_cid;
2094 int nxt_idx;
2096 iscsi_cid = new_cqe_kcqe->iscsi_conn_id;
2097 bnx2i_conn = bnx2i_get_conn_from_id(hba, iscsi_cid);
2099 if (!bnx2i_conn) {
2100 printk(KERN_ALERT "cid #%x not valid\n", iscsi_cid);
2101 return;
2103 if (!bnx2i_conn->ep) {
2104 printk(KERN_ALERT "cid #%x - ep not bound\n", iscsi_cid);
2105 return;
2108 bnx2i_process_new_cqes(bnx2i_conn);
2109 nxt_idx = bnx2i_arm_cq_event_coalescing(bnx2i_conn->ep,
2110 CNIC_ARM_CQE_FP);
2111 if (nxt_idx && nxt_idx == bnx2i_process_new_cqes(bnx2i_conn))
2112 bnx2i_arm_cq_event_coalescing(bnx2i_conn->ep, CNIC_ARM_CQE_FP);
2117 * bnx2i_process_update_conn_cmpl - process iscsi conn update completion KCQE
2118 * @hba: adapter structure pointer
2119 * @update_kcqe: kcqe pointer
2121 * CONN_UPDATE completion handler, this completes iSCSI connection FFP migration
2123 static void bnx2i_process_update_conn_cmpl(struct bnx2i_hba *hba,
2124 struct iscsi_kcqe *update_kcqe)
2126 struct bnx2i_conn *conn;
2127 u32 iscsi_cid;
2129 iscsi_cid = update_kcqe->iscsi_conn_id;
2130 conn = bnx2i_get_conn_from_id(hba, iscsi_cid);
2132 if (!conn) {
2133 printk(KERN_ALERT "conn_update: cid %x not valid\n", iscsi_cid);
2134 return;
2136 if (!conn->ep) {
2137 printk(KERN_ALERT "cid %x does not have ep bound\n", iscsi_cid);
2138 return;
2141 if (update_kcqe->completion_status) {
2142 printk(KERN_ALERT "request failed cid %x\n", iscsi_cid);
2143 conn->ep->state = EP_STATE_ULP_UPDATE_FAILED;
2144 } else
2145 conn->ep->state = EP_STATE_ULP_UPDATE_COMPL;
2147 wake_up_interruptible(&conn->ep->ofld_wait);
2152 * bnx2i_recovery_que_add_conn - add connection to recovery queue
2153 * @hba: adapter structure pointer
2154 * @bnx2i_conn: iscsi connection
2156 * Add connection to recovery queue and schedule adapter eh worker
2158 static void bnx2i_recovery_que_add_conn(struct bnx2i_hba *hba,
2159 struct bnx2i_conn *bnx2i_conn)
2161 iscsi_conn_failure(bnx2i_conn->cls_conn->dd_data,
2162 ISCSI_ERR_CONN_FAILED);
2167 * bnx2i_process_tcp_error - process error notification on a given connection
2169 * @hba: adapter structure pointer
2170 * @tcp_err: tcp error kcqe pointer
2172 * handles tcp level error notifications from FW.
2174 static void bnx2i_process_tcp_error(struct bnx2i_hba *hba,
2175 struct iscsi_kcqe *tcp_err)
2177 struct bnx2i_conn *bnx2i_conn;
2178 u32 iscsi_cid;
2180 iscsi_cid = tcp_err->iscsi_conn_id;
2181 bnx2i_conn = bnx2i_get_conn_from_id(hba, iscsi_cid);
2183 if (!bnx2i_conn) {
2184 printk(KERN_ALERT "bnx2i - cid 0x%x not valid\n", iscsi_cid);
2185 return;
2188 printk(KERN_ALERT "bnx2i - cid 0x%x had TCP errors, error code 0x%x\n",
2189 iscsi_cid, tcp_err->completion_status);
2190 bnx2i_recovery_que_add_conn(bnx2i_conn->hba, bnx2i_conn);
2195 * bnx2i_process_iscsi_error - process error notification on a given connection
2196 * @hba: adapter structure pointer
2197 * @iscsi_err: iscsi error kcqe pointer
2199 * handles iscsi error notifications from the FW. Firmware based in initial
2200 * handshake classifies iscsi protocol / TCP rfc violation into either
2201 * warning or error indications. If indication is of "Error" type, driver
2202 * will initiate session recovery for that connection/session. For
2203 * "Warning" type indication, driver will put out a system log message
2204 * (there will be only one message for each type for the life of the
2205 * session, this is to avoid un-necessarily overloading the system)
2207 static void bnx2i_process_iscsi_error(struct bnx2i_hba *hba,
2208 struct iscsi_kcqe *iscsi_err)
2210 struct bnx2i_conn *bnx2i_conn;
2211 u32 iscsi_cid;
2212 char warn_notice[] = "iscsi_warning";
2213 char error_notice[] = "iscsi_error";
2214 char additional_notice[64];
2215 char *message;
2216 int need_recovery;
2217 u64 err_mask64;
2219 iscsi_cid = iscsi_err->iscsi_conn_id;
2220 bnx2i_conn = bnx2i_get_conn_from_id(hba, iscsi_cid);
2221 if (!bnx2i_conn) {
2222 printk(KERN_ALERT "bnx2i - cid 0x%x not valid\n", iscsi_cid);
2223 return;
2226 err_mask64 = (0x1ULL << iscsi_err->completion_status);
2228 if (err_mask64 & iscsi_error_mask) {
2229 need_recovery = 0;
2230 message = warn_notice;
2231 } else {
2232 need_recovery = 1;
2233 message = error_notice;
2236 switch (iscsi_err->completion_status) {
2237 case ISCSI_KCQE_COMPLETION_STATUS_HDR_DIG_ERR:
2238 strcpy(additional_notice, "hdr digest err");
2239 break;
2240 case ISCSI_KCQE_COMPLETION_STATUS_DATA_DIG_ERR:
2241 strcpy(additional_notice, "data digest err");
2242 break;
2243 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_OPCODE:
2244 strcpy(additional_notice, "wrong opcode rcvd");
2245 break;
2246 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_AHS_LEN:
2247 strcpy(additional_notice, "AHS len > 0 rcvd");
2248 break;
2249 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_ITT:
2250 strcpy(additional_notice, "invalid ITT rcvd");
2251 break;
2252 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_STATSN:
2253 strcpy(additional_notice, "wrong StatSN rcvd");
2254 break;
2255 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_EXP_DATASN:
2256 strcpy(additional_notice, "wrong DataSN rcvd");
2257 break;
2258 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_PEND_R2T:
2259 strcpy(additional_notice, "pend R2T violation");
2260 break;
2261 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_O_U_0:
2262 strcpy(additional_notice, "ERL0, UO");
2263 break;
2264 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_O_U_1:
2265 strcpy(additional_notice, "ERL0, U1");
2266 break;
2267 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_O_U_2:
2268 strcpy(additional_notice, "ERL0, U2");
2269 break;
2270 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_O_U_3:
2271 strcpy(additional_notice, "ERL0, U3");
2272 break;
2273 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_O_U_4:
2274 strcpy(additional_notice, "ERL0, U4");
2275 break;
2276 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_O_U_5:
2277 strcpy(additional_notice, "ERL0, U5");
2278 break;
2279 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_O_U_6:
2280 strcpy(additional_notice, "ERL0, U6");
2281 break;
2282 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_REMAIN_RCV_LEN:
2283 strcpy(additional_notice, "invalid resi len");
2284 break;
2285 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_MAX_RCV_PDU_LEN:
2286 strcpy(additional_notice, "MRDSL violation");
2287 break;
2288 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_F_BIT_ZERO:
2289 strcpy(additional_notice, "F-bit not set");
2290 break;
2291 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_TTT_NOT_RSRV:
2292 strcpy(additional_notice, "invalid TTT");
2293 break;
2294 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_DATASN:
2295 strcpy(additional_notice, "invalid DataSN");
2296 break;
2297 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_REMAIN_BURST_LEN:
2298 strcpy(additional_notice, "burst len violation");
2299 break;
2300 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_BUFFER_OFF:
2301 strcpy(additional_notice, "buf offset violation");
2302 break;
2303 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_LUN:
2304 strcpy(additional_notice, "invalid LUN field");
2305 break;
2306 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_R2TSN:
2307 strcpy(additional_notice, "invalid R2TSN field");
2308 break;
2309 #define BNX2I_ERR_DESIRED_DATA_TRNS_LEN_0 \
2310 ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_DESIRED_DATA_TRNS_LEN_0
2311 case BNX2I_ERR_DESIRED_DATA_TRNS_LEN_0:
2312 strcpy(additional_notice, "invalid cmd len1");
2313 break;
2314 #define BNX2I_ERR_DESIRED_DATA_TRNS_LEN_1 \
2315 ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_DESIRED_DATA_TRNS_LEN_1
2316 case BNX2I_ERR_DESIRED_DATA_TRNS_LEN_1:
2317 strcpy(additional_notice, "invalid cmd len2");
2318 break;
2319 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_PEND_R2T_EXCEED:
2320 strcpy(additional_notice,
2321 "pend r2t exceeds MaxOutstandingR2T value");
2322 break;
2323 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_TTT_IS_RSRV:
2324 strcpy(additional_notice, "TTT is rsvd");
2325 break;
2326 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_MAX_BURST_LEN:
2327 strcpy(additional_notice, "MBL violation");
2328 break;
2329 #define BNX2I_ERR_DATA_SEG_LEN_NOT_ZERO \
2330 ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_DATA_SEG_LEN_NOT_ZERO
2331 case BNX2I_ERR_DATA_SEG_LEN_NOT_ZERO:
2332 strcpy(additional_notice, "data seg len != 0");
2333 break;
2334 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_REJECT_PDU_LEN:
2335 strcpy(additional_notice, "reject pdu len error");
2336 break;
2337 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_ASYNC_PDU_LEN:
2338 strcpy(additional_notice, "async pdu len error");
2339 break;
2340 case ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_NOPIN_PDU_LEN:
2341 strcpy(additional_notice, "nopin pdu len error");
2342 break;
2343 #define BNX2_ERR_PEND_R2T_IN_CLEANUP \
2344 ISCSI_KCQE_COMPLETION_STATUS_PROTOCOL_ERR_PEND_R2T_IN_CLEANUP
2345 case BNX2_ERR_PEND_R2T_IN_CLEANUP:
2346 strcpy(additional_notice, "pend r2t in cleanup");
2347 break;
2349 case ISCI_KCQE_COMPLETION_STATUS_TCP_ERROR_IP_FRAGMENT:
2350 strcpy(additional_notice, "IP fragments rcvd");
2351 break;
2352 case ISCI_KCQE_COMPLETION_STATUS_TCP_ERROR_IP_OPTIONS:
2353 strcpy(additional_notice, "IP options error");
2354 break;
2355 case ISCI_KCQE_COMPLETION_STATUS_TCP_ERROR_URGENT_FLAG:
2356 strcpy(additional_notice, "urgent flag error");
2357 break;
2358 default:
2359 printk(KERN_ALERT "iscsi_err - unknown err %x\n",
2360 iscsi_err->completion_status);
2363 if (need_recovery) {
2364 iscsi_conn_printk(KERN_ALERT,
2365 bnx2i_conn->cls_conn->dd_data,
2366 "bnx2i: %s - %s\n",
2367 message, additional_notice);
2369 iscsi_conn_printk(KERN_ALERT,
2370 bnx2i_conn->cls_conn->dd_data,
2371 "conn_err - hostno %d conn %p, "
2372 "iscsi_cid %x cid %x\n",
2373 bnx2i_conn->hba->shost->host_no,
2374 bnx2i_conn, bnx2i_conn->ep->ep_iscsi_cid,
2375 bnx2i_conn->ep->ep_cid);
2376 bnx2i_recovery_que_add_conn(bnx2i_conn->hba, bnx2i_conn);
2377 } else
2378 if (!test_and_set_bit(iscsi_err->completion_status,
2379 (void *) &bnx2i_conn->violation_notified))
2380 iscsi_conn_printk(KERN_ALERT,
2381 bnx2i_conn->cls_conn->dd_data,
2382 "bnx2i: %s - %s\n",
2383 message, additional_notice);
2388 * bnx2i_process_conn_destroy_cmpl - process iscsi conn destroy completion
2389 * @hba: adapter structure pointer
2390 * @conn_destroy: conn destroy kcqe pointer
2392 * handles connection destroy completion request.
2394 static void bnx2i_process_conn_destroy_cmpl(struct bnx2i_hba *hba,
2395 struct iscsi_kcqe *conn_destroy)
2397 struct bnx2i_endpoint *ep;
2399 ep = bnx2i_find_ep_in_destroy_list(hba, conn_destroy->iscsi_conn_id);
2400 if (!ep) {
2401 printk(KERN_ALERT "bnx2i_conn_destroy_cmpl: no pending "
2402 "offload request, unexpected complection\n");
2403 return;
2406 if (hba != ep->hba) {
2407 printk(KERN_ALERT "conn destroy- error hba mis-match\n");
2408 return;
2411 if (conn_destroy->completion_status) {
2412 printk(KERN_ALERT "conn_destroy_cmpl: op failed\n");
2413 ep->state = EP_STATE_CLEANUP_FAILED;
2414 } else
2415 ep->state = EP_STATE_CLEANUP_CMPL;
2416 wake_up_interruptible(&ep->ofld_wait);
2421 * bnx2i_process_ofld_cmpl - process initial iscsi conn offload completion
2422 * @hba: adapter structure pointer
2423 * @ofld_kcqe: conn offload kcqe pointer
2425 * handles initial connection offload completion, ep_connect() thread is
2426 * woken-up to continue with LLP connect process
2428 static void bnx2i_process_ofld_cmpl(struct bnx2i_hba *hba,
2429 struct iscsi_kcqe *ofld_kcqe)
2431 u32 cid_addr;
2432 struct bnx2i_endpoint *ep;
2433 u32 cid_num;
2435 ep = bnx2i_find_ep_in_ofld_list(hba, ofld_kcqe->iscsi_conn_id);
2436 if (!ep) {
2437 printk(KERN_ALERT "ofld_cmpl: no pend offload request\n");
2438 return;
2441 if (hba != ep->hba) {
2442 printk(KERN_ALERT "ofld_cmpl: error hba mis-match\n");
2443 return;
2446 if (ofld_kcqe->completion_status) {
2447 ep->state = EP_STATE_OFLD_FAILED;
2448 if (ofld_kcqe->completion_status ==
2449 ISCSI_KCQE_COMPLETION_STATUS_CTX_ALLOC_FAILURE)
2450 printk(KERN_ALERT "bnx2i (%s): ofld1 cmpl - unable "
2451 "to allocate iSCSI context resources\n",
2452 hba->netdev->name);
2453 else if (ofld_kcqe->completion_status ==
2454 ISCSI_KCQE_COMPLETION_STATUS_INVALID_OPCODE)
2455 printk(KERN_ALERT "bnx2i (%s): ofld1 cmpl - invalid "
2456 "opcode\n", hba->netdev->name);
2457 else if (ofld_kcqe->completion_status ==
2458 ISCSI_KCQE_COMPLETION_STATUS_CID_BUSY)
2459 /* error status code valid only for 5771x chipset */
2460 ep->state = EP_STATE_OFLD_FAILED_CID_BUSY;
2461 else
2462 printk(KERN_ALERT "bnx2i (%s): ofld1 cmpl - invalid "
2463 "error code %d\n", hba->netdev->name,
2464 ofld_kcqe->completion_status);
2465 } else {
2466 ep->state = EP_STATE_OFLD_COMPL;
2467 cid_addr = ofld_kcqe->iscsi_conn_context_id;
2468 cid_num = bnx2i_get_cid_num(ep);
2469 ep->ep_cid = cid_addr;
2470 ep->qp.ctx_base = NULL;
2472 wake_up_interruptible(&ep->ofld_wait);
2476 * bnx2i_indicate_kcqe - process iscsi conn update completion KCQE
2477 * @hba: adapter structure pointer
2478 * @update_kcqe: kcqe pointer
2480 * Generic KCQ event handler/dispatcher
2482 static void bnx2i_indicate_kcqe(void *context, struct kcqe *kcqe[],
2483 u32 num_cqe)
2485 struct bnx2i_hba *hba = context;
2486 int i = 0;
2487 struct iscsi_kcqe *ikcqe = NULL;
2489 while (i < num_cqe) {
2490 ikcqe = (struct iscsi_kcqe *) kcqe[i++];
2492 if (ikcqe->op_code ==
2493 ISCSI_KCQE_OPCODE_CQ_EVENT_NOTIFICATION)
2494 bnx2i_fastpath_notification(hba, ikcqe);
2495 else if (ikcqe->op_code == ISCSI_KCQE_OPCODE_OFFLOAD_CONN)
2496 bnx2i_process_ofld_cmpl(hba, ikcqe);
2497 else if (ikcqe->op_code == ISCSI_KCQE_OPCODE_UPDATE_CONN)
2498 bnx2i_process_update_conn_cmpl(hba, ikcqe);
2499 else if (ikcqe->op_code == ISCSI_KCQE_OPCODE_INIT) {
2500 if (ikcqe->completion_status !=
2501 ISCSI_KCQE_COMPLETION_STATUS_SUCCESS)
2502 bnx2i_iscsi_license_error(hba, ikcqe->\
2503 completion_status);
2504 else {
2505 set_bit(ADAPTER_STATE_UP, &hba->adapter_state);
2506 bnx2i_get_link_state(hba);
2507 printk(KERN_INFO "bnx2i [%.2x:%.2x.%.2x]: "
2508 "ISCSI_INIT passed\n",
2509 (u8)hba->pcidev->bus->number,
2510 hba->pci_devno,
2511 (u8)hba->pci_func);
2515 } else if (ikcqe->op_code == ISCSI_KCQE_OPCODE_DESTROY_CONN)
2516 bnx2i_process_conn_destroy_cmpl(hba, ikcqe);
2517 else if (ikcqe->op_code == ISCSI_KCQE_OPCODE_ISCSI_ERROR)
2518 bnx2i_process_iscsi_error(hba, ikcqe);
2519 else if (ikcqe->op_code == ISCSI_KCQE_OPCODE_TCP_ERROR)
2520 bnx2i_process_tcp_error(hba, ikcqe);
2521 else
2522 printk(KERN_ALERT "bnx2i: unknown opcode 0x%x\n",
2523 ikcqe->op_code);
2529 * bnx2i_indicate_netevent - Generic netdev event handler
2530 * @context: adapter structure pointer
2531 * @event: event type
2532 * @vlan_id: vlans id - associated vlan id with this event
2534 * Handles four netdev events, NETDEV_UP, NETDEV_DOWN,
2535 * NETDEV_GOING_DOWN and NETDEV_CHANGE
2537 static void bnx2i_indicate_netevent(void *context, unsigned long event,
2538 u16 vlan_id)
2540 struct bnx2i_hba *hba = context;
2542 /* Ignore all netevent coming from vlans */
2543 if (vlan_id != 0)
2544 return;
2546 switch (event) {
2547 case NETDEV_UP:
2548 if (!test_bit(ADAPTER_STATE_UP, &hba->adapter_state))
2549 bnx2i_send_fw_iscsi_init_msg(hba);
2550 break;
2551 case NETDEV_DOWN:
2552 clear_bit(ADAPTER_STATE_GOING_DOWN, &hba->adapter_state);
2553 clear_bit(ADAPTER_STATE_UP, &hba->adapter_state);
2554 break;
2555 case NETDEV_GOING_DOWN:
2556 set_bit(ADAPTER_STATE_GOING_DOWN, &hba->adapter_state);
2557 iscsi_host_for_each_session(hba->shost,
2558 bnx2i_drop_session);
2559 break;
2560 case NETDEV_CHANGE:
2561 bnx2i_get_link_state(hba);
2562 break;
2563 default:
2570 * bnx2i_cm_connect_cmpl - process iscsi conn establishment completion
2571 * @cm_sk: cnic sock structure pointer
2573 * function callback exported via bnx2i - cnic driver interface to
2574 * indicate completion of option-2 TCP connect request.
2576 static void bnx2i_cm_connect_cmpl(struct cnic_sock *cm_sk)
2578 struct bnx2i_endpoint *ep = (struct bnx2i_endpoint *) cm_sk->context;
2580 if (test_bit(ADAPTER_STATE_GOING_DOWN, &ep->hba->adapter_state))
2581 ep->state = EP_STATE_CONNECT_FAILED;
2582 else if (test_bit(SK_F_OFFLD_COMPLETE, &cm_sk->flags))
2583 ep->state = EP_STATE_CONNECT_COMPL;
2584 else
2585 ep->state = EP_STATE_CONNECT_FAILED;
2587 wake_up_interruptible(&ep->ofld_wait);
2592 * bnx2i_cm_close_cmpl - process tcp conn close completion
2593 * @cm_sk: cnic sock structure pointer
2595 * function callback exported via bnx2i - cnic driver interface to
2596 * indicate completion of option-2 graceful TCP connect shutdown
2598 static void bnx2i_cm_close_cmpl(struct cnic_sock *cm_sk)
2600 struct bnx2i_endpoint *ep = (struct bnx2i_endpoint *) cm_sk->context;
2602 ep->state = EP_STATE_DISCONN_COMPL;
2603 wake_up_interruptible(&ep->ofld_wait);
2608 * bnx2i_cm_abort_cmpl - process abortive tcp conn teardown completion
2609 * @cm_sk: cnic sock structure pointer
2611 * function callback exported via bnx2i - cnic driver interface to
2612 * indicate completion of option-2 abortive TCP connect termination
2614 static void bnx2i_cm_abort_cmpl(struct cnic_sock *cm_sk)
2616 struct bnx2i_endpoint *ep = (struct bnx2i_endpoint *) cm_sk->context;
2618 ep->state = EP_STATE_DISCONN_COMPL;
2619 wake_up_interruptible(&ep->ofld_wait);
2624 * bnx2i_cm_remote_close - process received TCP FIN
2625 * @hba: adapter structure pointer
2626 * @update_kcqe: kcqe pointer
2628 * function callback exported via bnx2i - cnic driver interface to indicate
2629 * async TCP events such as FIN
2631 static void bnx2i_cm_remote_close(struct cnic_sock *cm_sk)
2633 struct bnx2i_endpoint *ep = (struct bnx2i_endpoint *) cm_sk->context;
2635 ep->state = EP_STATE_TCP_FIN_RCVD;
2636 if (ep->conn)
2637 bnx2i_recovery_que_add_conn(ep->hba, ep->conn);
2641 * bnx2i_cm_remote_abort - process TCP RST and start conn cleanup
2642 * @hba: adapter structure pointer
2643 * @update_kcqe: kcqe pointer
2645 * function callback exported via bnx2i - cnic driver interface to
2646 * indicate async TCP events (RST) sent by the peer.
2648 static void bnx2i_cm_remote_abort(struct cnic_sock *cm_sk)
2650 struct bnx2i_endpoint *ep = (struct bnx2i_endpoint *) cm_sk->context;
2651 u32 old_state = ep->state;
2653 ep->state = EP_STATE_TCP_RST_RCVD;
2654 if (old_state == EP_STATE_DISCONN_START)
2655 wake_up_interruptible(&ep->ofld_wait);
2656 else
2657 if (ep->conn)
2658 bnx2i_recovery_que_add_conn(ep->hba, ep->conn);
2662 static int bnx2i_send_nl_mesg(void *context, u32 msg_type,
2663 char *buf, u16 buflen)
2665 struct bnx2i_hba *hba = context;
2666 int rc;
2668 if (!hba)
2669 return -ENODEV;
2671 rc = iscsi_offload_mesg(hba->shost, &bnx2i_iscsi_transport,
2672 msg_type, buf, buflen);
2673 if (rc)
2674 printk(KERN_ALERT "bnx2i: private nl message send error\n");
2676 return rc;
2681 * bnx2i_cnic_cb - global template of bnx2i - cnic driver interface structure
2682 * carrying callback function pointers
2685 struct cnic_ulp_ops bnx2i_cnic_cb = {
2686 .cnic_init = bnx2i_ulp_init,
2687 .cnic_exit = bnx2i_ulp_exit,
2688 .cnic_start = bnx2i_start,
2689 .cnic_stop = bnx2i_stop,
2690 .indicate_kcqes = bnx2i_indicate_kcqe,
2691 .indicate_netevent = bnx2i_indicate_netevent,
2692 .cm_connect_complete = bnx2i_cm_connect_cmpl,
2693 .cm_close_complete = bnx2i_cm_close_cmpl,
2694 .cm_abort_complete = bnx2i_cm_abort_cmpl,
2695 .cm_remote_close = bnx2i_cm_remote_close,
2696 .cm_remote_abort = bnx2i_cm_remote_abort,
2697 .iscsi_nl_send_msg = bnx2i_send_nl_mesg,
2698 .owner = THIS_MODULE
2703 * bnx2i_map_ep_dbell_regs - map connection doorbell registers
2704 * @ep: bnx2i endpoint
2706 * maps connection's SQ and RQ doorbell registers, 5706/5708/5709 hosts these
2707 * register in BAR #0. Whereas in 57710 these register are accessed by
2708 * mapping BAR #1
2710 int bnx2i_map_ep_dbell_regs(struct bnx2i_endpoint *ep)
2712 u32 cid_num;
2713 u32 reg_off;
2714 u32 first_l4l5;
2715 u32 ctx_sz;
2716 u32 config2;
2717 resource_size_t reg_base;
2719 cid_num = bnx2i_get_cid_num(ep);
2721 if (test_bit(BNX2I_NX2_DEV_57710, &ep->hba->cnic_dev_type)) {
2722 reg_base = pci_resource_start(ep->hba->pcidev,
2723 BNX2X_DOORBELL_PCI_BAR);
2724 reg_off = BNX2I_5771X_DBELL_PAGE_SIZE * (cid_num & 0x1FFFF) +
2725 DPM_TRIGER_TYPE;
2726 ep->qp.ctx_base = ioremap_nocache(reg_base + reg_off, 4);
2727 goto arm_cq;
2730 reg_base = ep->hba->netdev->base_addr;
2731 if ((test_bit(BNX2I_NX2_DEV_5709, &ep->hba->cnic_dev_type)) &&
2732 (ep->hba->mail_queue_access == BNX2I_MQ_BIN_MODE)) {
2733 config2 = REG_RD(ep->hba, BNX2_MQ_CONFIG2);
2734 first_l4l5 = config2 & BNX2_MQ_CONFIG2_FIRST_L4L5;
2735 ctx_sz = (config2 & BNX2_MQ_CONFIG2_CONT_SZ) >> 3;
2736 if (ctx_sz)
2737 reg_off = CTX_OFFSET + MAX_CID_CNT * MB_KERNEL_CTX_SIZE
2738 + BNX2I_570X_PAGE_SIZE_DEFAULT *
2739 (((cid_num - first_l4l5) / ctx_sz) + 256);
2740 else
2741 reg_off = CTX_OFFSET + (MB_KERNEL_CTX_SIZE * cid_num);
2742 } else
2743 /* 5709 device in normal node and 5706/5708 devices */
2744 reg_off = CTX_OFFSET + (MB_KERNEL_CTX_SIZE * cid_num);
2746 ep->qp.ctx_base = ioremap_nocache(reg_base + reg_off,
2747 MB_KERNEL_CTX_SIZE);
2748 if (!ep->qp.ctx_base)
2749 return -ENOMEM;
2751 arm_cq:
2752 bnx2i_arm_cq_event_coalescing(ep, CNIC_ARM_CQE);
2753 return 0;