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