]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blame - drivers/scsi/be2iscsi/be_main.c
projects / mirror_ubuntu-bionic-kernel.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
[SCSI] be2iscsi: check boot_kset is created before destroying it
[mirror_ubuntu-bionic-kernel.git] / drivers / scsi / be2iscsi / be_main.c
CommitLineData
6733b39a 1/**
255fa9a3 2 * Copyright (C) 2005 - 2011 Emulex
6733b39a
JK		 3 * All rights reserved.
4 *
5 * This program is free software; you can redistribute it and/or
6 * modify it under the terms of the GNU General Public License version 2
7 * as published by the Free Software Foundation. The full GNU General
8 * Public License is included in this distribution in the file called COPYING.
9 *
255fa9a3 10 * Written by: Jayamohan Kallickal (jayamohan.kallickal@emulex.com)
6733b39a
JK		 11 *
12 * Contact Information:
255fa9a3 13 * linux-drivers@emulex.com
6733b39a 14 *
255fa9a3
JK		 15 * Emulex
16 * 3333 Susan Street
17 * Costa Mesa, CA 92626
6733b39a 18 */
255fa9a3 19
6733b39a
JK		 20#include <linux/reboot.h>
21#include <linux/delay.h>
5a0e3ad6 22#include <linux/slab.h>
6733b39a
JK		 23#include <linux/interrupt.h>
24#include <linux/blkdev.h>
25#include <linux/pci.h>
26#include <linux/string.h>
27#include <linux/kernel.h>
28#include <linux/semaphore.h>
c7acc5b8 29#include <linux/iscsi_boot_sysfs.h>
6733b39a
JK		 30
31#include <scsi/libiscsi.h>
32#include <scsi/scsi_transport_iscsi.h>
33#include <scsi/scsi_transport.h>
34#include <scsi/scsi_cmnd.h>
35#include <scsi/scsi_device.h>
36#include <scsi/scsi_host.h>
37#include <scsi/scsi.h>
38#include "be_main.h"
39#include "be_iscsi.h"
40#include "be_mgmt.h"
41
42static unsigned int be_iopoll_budget = 10;
43static unsigned int be_max_phys_size = 64;
bfead3b2 44static unsigned int enable_msix = 1;
e9b91193
JK		 45static unsigned int gcrashmode = 0;
46static unsigned int num_hba = 0;
6733b39a
JK		 47
48MODULE_DEVICE_TABLE(pci, beiscsi_pci_id_table);
49MODULE_DESCRIPTION(DRV_DESC " " BUILD_STR);
50MODULE_AUTHOR("ServerEngines Corporation");
51MODULE_LICENSE("GPL");
52module_param(be_iopoll_budget, int, 0);
53module_param(enable_msix, int, 0);
54module_param(be_max_phys_size, uint, S_IRUGO);
55MODULE_PARM_DESC(be_max_phys_size, "Maximum Size (In Kilobytes) of physically"
56 "contiguous memory that can be allocated."
57 "Range is 16 - 128");
58
59static int beiscsi_slave_configure(struct scsi_device *sdev)
60{
61 blk_queue_max_segment_size(sdev->request_queue, 65536);
62 return 0;
63}
64
4183122d
JK		 65static int beiscsi_eh_abort(struct scsi_cmnd *sc)
66{
67 struct iscsi_cls_session *cls_session;
68 struct iscsi_task *aborted_task = (struct iscsi_task *)sc->SCp.ptr;
69 struct beiscsi_io_task *aborted_io_task;
70 struct iscsi_conn *conn;
71 struct beiscsi_conn *beiscsi_conn;
72 struct beiscsi_hba *phba;
73 struct iscsi_session *session;
74 struct invalidate_command_table *inv_tbl;
3cbb7a74 75 struct be_dma_mem nonemb_cmd;
4183122d
JK		 76 unsigned int cid, tag, num_invalidate;
77
78 cls_session = starget_to_session(scsi_target(sc->device));
79 session = cls_session->dd_data;
80
81 spin_lock_bh(&session->lock);
82 if (!aborted_task || !aborted_task->sc) {
83 /* we raced */
84 spin_unlock_bh(&session->lock);
85 return SUCCESS;
86 }
87
88 aborted_io_task = aborted_task->dd_data;
89 if (!aborted_io_task->scsi_cmnd) {
90 /* raced or invalid command */
91 spin_unlock_bh(&session->lock);
92 return SUCCESS;
93 }
94 spin_unlock_bh(&session->lock);
95 conn = aborted_task->conn;
96 beiscsi_conn = conn->dd_data;
97 phba = beiscsi_conn->phba;
98
99 /* invalidate iocb */
100 cid = beiscsi_conn->beiscsi_conn_cid;
101 inv_tbl = phba->inv_tbl;
102 memset(inv_tbl, 0x0, sizeof(*inv_tbl));
103 inv_tbl->cid = cid;
104 inv_tbl->icd = aborted_io_task->psgl_handle->sgl_index;
105 num_invalidate = 1;
3cbb7a74
JK		 106 nonemb_cmd.va = pci_alloc_consistent(phba->ctrl.pdev,
107 sizeof(struct invalidate_commands_params_in),
108 &nonemb_cmd.dma);
109 if (nonemb_cmd.va == NULL) {
110 SE_DEBUG(DBG_LVL_1,
111 "Failed to allocate memory for"
112 "mgmt_invalidate_icds\n");
113 return FAILED;
114 }
115 nonemb_cmd.size = sizeof(struct invalidate_commands_params_in);
116
117 tag = mgmt_invalidate_icds(phba, inv_tbl, num_invalidate,
118 cid, &nonemb_cmd);
4183122d
JK		 119 if (!tag) {
120 shost_printk(KERN_WARNING, phba->shost,
121 "mgmt_invalidate_icds could not be"
122 " submitted\n");
3cbb7a74
JK		 123 pci_free_consistent(phba->ctrl.pdev, nonemb_cmd.size,
124 nonemb_cmd.va, nonemb_cmd.dma);
125
4183122d
JK		 126 return FAILED;
127 } else {
128 wait_event_interruptible(phba->ctrl.mcc_wait[tag],
129 phba->ctrl.mcc_numtag[tag]);
130 free_mcc_tag(&phba->ctrl, tag);
131 }
3cbb7a74
JK		 132 pci_free_consistent(phba->ctrl.pdev, nonemb_cmd.size,
133 nonemb_cmd.va, nonemb_cmd.dma);
4183122d
JK		 134 return iscsi_eh_abort(sc);
135}
136
137static int beiscsi_eh_device_reset(struct scsi_cmnd *sc)
138{
139 struct iscsi_task *abrt_task;
140 struct beiscsi_io_task *abrt_io_task;
141 struct iscsi_conn *conn;
142 struct beiscsi_conn *beiscsi_conn;
143 struct beiscsi_hba *phba;
144 struct iscsi_session *session;
145 struct iscsi_cls_session *cls_session;
146 struct invalidate_command_table *inv_tbl;
3cbb7a74 147 struct be_dma_mem nonemb_cmd;
4183122d
JK		 148 unsigned int cid, tag, i, num_invalidate;
149 int rc = FAILED;
150
151 /* invalidate iocbs */
152 cls_session = starget_to_session(scsi_target(sc->device));
153 session = cls_session->dd_data;
154 spin_lock_bh(&session->lock);
155 if (!session->leadconn || session->state != ISCSI_STATE_LOGGED_IN)
156 goto unlock;
157
158 conn = session->leadconn;
159 beiscsi_conn = conn->dd_data;
160 phba = beiscsi_conn->phba;
161 cid = beiscsi_conn->beiscsi_conn_cid;
162 inv_tbl = phba->inv_tbl;
163 memset(inv_tbl, 0x0, sizeof(*inv_tbl) * BE2_CMDS_PER_CXN);
164 num_invalidate = 0;
165 for (i = 0; i < conn->session->cmds_max; i++) {
166 abrt_task = conn->session->cmds[i];
167 abrt_io_task = abrt_task->dd_data;
168 if (!abrt_task->sc || abrt_task->state == ISCSI_TASK_FREE)
169 continue;
170
171 if (abrt_task->sc->device->lun != abrt_task->sc->device->lun)
172 continue;
173
174 inv_tbl->cid = cid;
175 inv_tbl->icd = abrt_io_task->psgl_handle->sgl_index;
176 num_invalidate++;
177 inv_tbl++;
178 }
179 spin_unlock_bh(&session->lock);
180 inv_tbl = phba->inv_tbl;
181
3cbb7a74
JK		 182 nonemb_cmd.va = pci_alloc_consistent(phba->ctrl.pdev,
183 sizeof(struct invalidate_commands_params_in),
184 &nonemb_cmd.dma);
185 if (nonemb_cmd.va == NULL) {
186 SE_DEBUG(DBG_LVL_1,
187 "Failed to allocate memory for"
188 "mgmt_invalidate_icds\n");
189 return FAILED;
190 }
191 nonemb_cmd.size = sizeof(struct invalidate_commands_params_in);
192 memset(nonemb_cmd.va, 0, nonemb_cmd.size);
193 tag = mgmt_invalidate_icds(phba, inv_tbl, num_invalidate,
194 cid, &nonemb_cmd);
4183122d
JK		 195 if (!tag) {
196 shost_printk(KERN_WARNING, phba->shost,
197 "mgmt_invalidate_icds could not be"
198 " submitted\n");
3cbb7a74
JK		 199 pci_free_consistent(phba->ctrl.pdev, nonemb_cmd.size,
200 nonemb_cmd.va, nonemb_cmd.dma);
4183122d
JK		 201 return FAILED;
202 } else {
203 wait_event_interruptible(phba->ctrl.mcc_wait[tag],
204 phba->ctrl.mcc_numtag[tag]);
205 free_mcc_tag(&phba->ctrl, tag);
206 }
3cbb7a74
JK		 207 pci_free_consistent(phba->ctrl.pdev, nonemb_cmd.size,
208 nonemb_cmd.va, nonemb_cmd.dma);
4183122d
JK		 209 return iscsi_eh_device_reset(sc);
210unlock:
211 spin_unlock_bh(&session->lock);
212 return rc;
213}
214
c7acc5b8
JK		 215static ssize_t beiscsi_show_boot_tgt_info(void *data, int type, char *buf)
216{
217 struct beiscsi_hba *phba = data;
218 char *str = buf;
219 int rc;
220
221 switch (type) {
222 case ISCSI_BOOT_TGT_NAME:
223 rc = sprintf(buf, "%.*s\n",
224 (int)strlen(phba->boot_sess.target_name),
225 (char *)&phba->boot_sess.target_name);
226 break;
227 case ISCSI_BOOT_TGT_IP_ADDR:
228 if (phba->boot_sess.conn_list[0].dest_ipaddr.ip_type == 0x1)
229 rc = sprintf(buf, "%pI4\n",
230 (char *)&phba->boot_sess.conn_list[0].
231 dest_ipaddr.ip_address);
232 else
233 rc = sprintf(str, "%pI6\n",
234 (char *)&phba->boot_sess.conn_list[0].
235 dest_ipaddr.ip_address);
236 break;
237 case ISCSI_BOOT_TGT_PORT:
238 rc = sprintf(str, "%d\n", phba->boot_sess.conn_list[0].
239 dest_port);
240 break;
241
242 case ISCSI_BOOT_TGT_CHAP_NAME:
243 rc = sprintf(str, "%.*s\n",
244 phba->boot_sess.conn_list[0].
245 negotiated_login_options.auth_data.chap.
246 target_chap_name_length,
247 (char *)&phba->boot_sess.conn_list[0].
248 negotiated_login_options.auth_data.chap.
249 target_chap_name);
250 break;
251 case ISCSI_BOOT_TGT_CHAP_SECRET:
252 rc = sprintf(str, "%.*s\n",
253 phba->boot_sess.conn_list[0].
254 negotiated_login_options.auth_data.chap.
255 target_secret_length,
256 (char *)&phba->boot_sess.conn_list[0].
257 negotiated_login_options.auth_data.chap.
258 target_secret);
259
260 break;
261 case ISCSI_BOOT_TGT_REV_CHAP_NAME:
262 rc = sprintf(str, "%.*s\n",
263 phba->boot_sess.conn_list[0].
264 negotiated_login_options.auth_data.chap.
265 intr_chap_name_length,
266 (char *)&phba->boot_sess.conn_list[0].
267 negotiated_login_options.auth_data.chap.
268 intr_chap_name);
269
270 break;
271 case ISCSI_BOOT_TGT_REV_CHAP_SECRET:
272 rc = sprintf(str, "%.*s\n",
273 phba->boot_sess.conn_list[0].
274 negotiated_login_options.auth_data.chap.
275 intr_secret_length,
276 (char *)&phba->boot_sess.conn_list[0].
277 negotiated_login_options.auth_data.chap.
278 intr_secret);
279 break;
280 case ISCSI_BOOT_TGT_FLAGS:
281 rc = sprintf(str, "2\n");
282 break;
283 case ISCSI_BOOT_TGT_NIC_ASSOC:
284 rc = sprintf(str, "0\n");
285 break;
286 default:
287 rc = -ENOSYS;
288 break;
289 }
290 return rc;
291}
292
293static ssize_t beiscsi_show_boot_ini_info(void *data, int type, char *buf)
294{
295 struct beiscsi_hba *phba = data;
296 char *str = buf;
297 int rc;
298
299 switch (type) {
300 case ISCSI_BOOT_INI_INITIATOR_NAME:
301 rc = sprintf(str, "%s\n", phba->boot_sess.initiator_iscsiname);
302 break;
303 default:
304 rc = -ENOSYS;
305 break;
306 }
307 return rc;
308}
309
310static ssize_t beiscsi_show_boot_eth_info(void *data, int type, char *buf)
311{
312 struct beiscsi_hba *phba = data;
313 char *str = buf;
314 int rc;
315
316 switch (type) {
317 case ISCSI_BOOT_ETH_FLAGS:
318 rc = sprintf(str, "2\n");
319 break;
320 case ISCSI_BOOT_ETH_INDEX:
321 rc = sprintf(str, "0\n");
322 break;
323 case ISCSI_BOOT_ETH_MAC:
324 rc = beiscsi_get_macaddr(buf, phba);
325 if (rc < 0) {
326 SE_DEBUG(DBG_LVL_1, "beiscsi_get_macaddr Failed\n");
327 return rc;
328 }
329 break;
330 default:
331 rc = -ENOSYS;
332 break;
333 }
334 return rc;
335}
336
337
338static mode_t beiscsi_tgt_get_attr_visibility(void *data, int type)
339{
340 int rc;
341
342 switch (type) {
343 case ISCSI_BOOT_TGT_NAME:
344 case ISCSI_BOOT_TGT_IP_ADDR:
345 case ISCSI_BOOT_TGT_PORT:
346 case ISCSI_BOOT_TGT_CHAP_NAME:
347 case ISCSI_BOOT_TGT_CHAP_SECRET:
348 case ISCSI_BOOT_TGT_REV_CHAP_NAME:
349 case ISCSI_BOOT_TGT_REV_CHAP_SECRET:
350 case ISCSI_BOOT_TGT_NIC_ASSOC:
351 case ISCSI_BOOT_TGT_FLAGS:
352 rc = S_IRUGO;
353 break;
354 default:
355 rc = 0;
356 break;
357 }
358 return rc;
359}
360
361static mode_t beiscsi_ini_get_attr_visibility(void *data, int type)
362{
363 int rc;
364
365 switch (type) {
366 case ISCSI_BOOT_INI_INITIATOR_NAME:
367 rc = S_IRUGO;
368 break;
369 default:
370 rc = 0;
371 break;
372 }
373 return rc;
374}
375
376
377static mode_t beiscsi_eth_get_attr_visibility(void *data, int type)
378{
379 int rc;
380
381 switch (type) {
382 case ISCSI_BOOT_ETH_FLAGS:
383 case ISCSI_BOOT_ETH_MAC:
384 case ISCSI_BOOT_ETH_INDEX:
385 rc = S_IRUGO;
386 break;
387 default:
388 rc = 0;
389 break;
390 }
391 return rc;
392}
393
394static int beiscsi_setup_boot_info(struct beiscsi_hba *phba)
395{
396 struct iscsi_boot_kobj *boot_kobj;
397
398 phba->boot_kset = iscsi_boot_create_host_kset(phba->shost->host_no);
399 if (!phba->boot_kset)
400 return -ENOMEM;
401
402 /* get boot info using mgmt cmd */
403 boot_kobj = iscsi_boot_create_target(phba->boot_kset, 0, phba,
404 beiscsi_show_boot_tgt_info,
405 beiscsi_tgt_get_attr_visibility);
406 if (!boot_kobj)
407 goto free_kset;
408
409 boot_kobj = iscsi_boot_create_initiator(phba->boot_kset, 0, phba,
410 beiscsi_show_boot_ini_info,
411 beiscsi_ini_get_attr_visibility);
412 if (!boot_kobj)
413 goto free_kset;
414
415 boot_kobj = iscsi_boot_create_ethernet(phba->boot_kset, 0, phba,
416 beiscsi_show_boot_eth_info,
417 beiscsi_eth_get_attr_visibility);
418 if (!boot_kobj)
419 goto free_kset;
420 return 0;
421
422free_kset:
0b1d3cbf
JK		 423 if (phba->boot_kset)
424 iscsi_boot_destroy_kset(phba->boot_kset);
c7acc5b8
JK		 425 return -ENOMEM;
426}
427
bfead3b2
JK		 428/*------------------- PCI Driver operations and data ----------------- */
429static DEFINE_PCI_DEVICE_TABLE(beiscsi_pci_id_table) = {
430 { PCI_DEVICE(BE_VENDOR_ID, BE_DEVICE_ID1) },
f98c96b0 431 { PCI_DEVICE(BE_VENDOR_ID, BE_DEVICE_ID2) },
bfead3b2
JK		 432 { PCI_DEVICE(BE_VENDOR_ID, OC_DEVICE_ID1) },
433 { PCI_DEVICE(BE_VENDOR_ID, OC_DEVICE_ID2) },
434 { PCI_DEVICE(BE_VENDOR_ID, OC_DEVICE_ID3) },
bfead3b2
JK		 435 { 0 }
436};
437MODULE_DEVICE_TABLE(pci, beiscsi_pci_id_table);
438
6733b39a
JK		 439static struct scsi_host_template beiscsi_sht = {
440 .module = THIS_MODULE,
441 .name = "ServerEngines 10Gbe open-iscsi Initiator Driver",
442 .proc_name = DRV_NAME,
443 .queuecommand = iscsi_queuecommand,
6733b39a
JK		 444 .change_queue_depth = iscsi_change_queue_depth,
445 .slave_configure = beiscsi_slave_configure,
446 .target_alloc = iscsi_target_alloc,
4183122d
JK		 447 .eh_abort_handler = beiscsi_eh_abort,
448 .eh_device_reset_handler = beiscsi_eh_device_reset,
309ce156 449 .eh_target_reset_handler = iscsi_eh_session_reset,
6733b39a
JK		 450 .sg_tablesize = BEISCSI_SGLIST_ELEMENTS,
451 .can_queue = BE2_IO_DEPTH,
452 .this_id = -1,
453 .max_sectors = BEISCSI_MAX_SECTORS,
454 .cmd_per_lun = BEISCSI_CMD_PER_LUN,
455 .use_clustering = ENABLE_CLUSTERING,
456};
6733b39a 457
bfead3b2 458static struct scsi_transport_template *beiscsi_scsi_transport;
6733b39a
JK		 459
460static struct beiscsi_hba *beiscsi_hba_alloc(struct pci_dev *pcidev)
461{
462 struct beiscsi_hba *phba;
463 struct Scsi_Host *shost;
464
465 shost = iscsi_host_alloc(&beiscsi_sht, sizeof(*phba), 0);
466 if (!shost) {
467 dev_err(&pcidev->dev, "beiscsi_hba_alloc -"
457ff3b7 468 "iscsi_host_alloc failed\n");
6733b39a
JK		 469 return NULL;
470 }
471 shost->dma_boundary = pcidev->dma_mask;
472 shost->max_id = BE2_MAX_SESSIONS;
473 shost->max_channel = 0;
474 shost->max_cmd_len = BEISCSI_MAX_CMD_LEN;
475 shost->max_lun = BEISCSI_NUM_MAX_LUN;
476 shost->transportt = beiscsi_scsi_transport;
6733b39a
JK		 477 phba = iscsi_host_priv(shost);
478 memset(phba, 0, sizeof(*phba));
479 phba->shost = shost;
480 phba->pcidev = pci_dev_get(pcidev);
2807afb7 481 pci_set_drvdata(pcidev, phba);
6733b39a
JK		 482
483 if (iscsi_host_add(shost, &phba->pcidev->dev))
484 goto free_devices;
c7acc5b8
JK		 485
486 if (beiscsi_setup_boot_info(phba))
487 /*
488 * log error but continue, because we may not be using
489 * iscsi boot.
490 */
491 shost_printk(KERN_ERR, phba->shost, "Could not set up "
492 "iSCSI boot info.");
493
6733b39a
JK		 494 return phba;
495
496free_devices:
497 pci_dev_put(phba->pcidev);
498 iscsi_host_free(phba->shost);
499 return NULL;
500}
501
502static void beiscsi_unmap_pci_function(struct beiscsi_hba *phba)
503{
504 if (phba->csr_va) {
505 iounmap(phba->csr_va);
506 phba->csr_va = NULL;
507 }
508 if (phba->db_va) {
509 iounmap(phba->db_va);
510 phba->db_va = NULL;
511 }
512 if (phba->pci_va) {
513 iounmap(phba->pci_va);
514 phba->pci_va = NULL;
515 }
516}
517
518static int beiscsi_map_pci_bars(struct beiscsi_hba *phba,
519 struct pci_dev *pcidev)
520{
521 u8 __iomem *addr;
f98c96b0 522 int pcicfg_reg;
6733b39a
JK		 523
524 addr = ioremap_nocache(pci_resource_start(pcidev, 2),
525 pci_resource_len(pcidev, 2));
526 if (addr == NULL)
527 return -ENOMEM;
528 phba->ctrl.csr = addr;
529 phba->csr_va = addr;
530 phba->csr_pa.u.a64.address = pci_resource_start(pcidev, 2);
531
532 addr = ioremap_nocache(pci_resource_start(pcidev, 4), 128 * 1024);
533 if (addr == NULL)
534 goto pci_map_err;
535 phba->ctrl.db = addr;
536 phba->db_va = addr;
537 phba->db_pa.u.a64.address = pci_resource_start(pcidev, 4);
538
f98c96b0
JK		 539 if (phba->generation == BE_GEN2)
540 pcicfg_reg = 1;
541 else
542 pcicfg_reg = 0;
543
544 addr = ioremap_nocache(pci_resource_start(pcidev, pcicfg_reg),
545 pci_resource_len(pcidev, pcicfg_reg));
546
6733b39a
JK		 547 if (addr == NULL)
548 goto pci_map_err;
549 phba->ctrl.pcicfg = addr;
550 phba->pci_va = addr;
f98c96b0 551 phba->pci_pa.u.a64.address = pci_resource_start(pcidev, pcicfg_reg);
6733b39a
JK		 552 return 0;
553
554pci_map_err:
555 beiscsi_unmap_pci_function(phba);
556 return -ENOMEM;
557}
558
559static int beiscsi_enable_pci(struct pci_dev *pcidev)
560{
561 int ret;
562
563 ret = pci_enable_device(pcidev);
564 if (ret) {
565 dev_err(&pcidev->dev, "beiscsi_enable_pci - enable device "
566 "failed. Returning -ENODEV\n");
567 return ret;
568 }
569
bfead3b2 570 pci_set_master(pcidev);
6733b39a
JK		 571 if (pci_set_consistent_dma_mask(pcidev, DMA_BIT_MASK(64))) {
572 ret = pci_set_consistent_dma_mask(pcidev, DMA_BIT_MASK(32));
573 if (ret) {
574 dev_err(&pcidev->dev, "Could not set PCI DMA Mask\n");
575 pci_disable_device(pcidev);
576 return ret;
577 }
578 }
579 return 0;
580}
581
582static int be_ctrl_init(struct beiscsi_hba *phba, struct pci_dev *pdev)
583{
584 struct be_ctrl_info *ctrl = &phba->ctrl;
585 struct be_dma_mem *mbox_mem_alloc = &ctrl->mbox_mem_alloced;
586 struct be_dma_mem *mbox_mem_align = &ctrl->mbox_mem;
587 int status = 0;
588
589 ctrl->pdev = pdev;
590 status = beiscsi_map_pci_bars(phba, pdev);
591 if (status)
592 return status;
6733b39a
JK		 593 mbox_mem_alloc->size = sizeof(struct be_mcc_mailbox) + 16;
594 mbox_mem_alloc->va = pci_alloc_consistent(pdev,
595 mbox_mem_alloc->size,
596 &mbox_mem_alloc->dma);
597 if (!mbox_mem_alloc->va) {
598 beiscsi_unmap_pci_function(phba);
599 status = -ENOMEM;
600 return status;
601 }
602
603 mbox_mem_align->size = sizeof(struct be_mcc_mailbox);
604 mbox_mem_align->va = PTR_ALIGN(mbox_mem_alloc->va, 16);
605 mbox_mem_align->dma = PTR_ALIGN(mbox_mem_alloc->dma, 16);
606 memset(mbox_mem_align->va, 0, sizeof(struct be_mcc_mailbox));
607 spin_lock_init(&ctrl->mbox_lock);
bfead3b2
JK		 608 spin_lock_init(&phba->ctrl.mcc_lock);
609 spin_lock_init(&phba->ctrl.mcc_cq_lock);
610
6733b39a
JK		 611 return status;
612}
613
614static void beiscsi_get_params(struct beiscsi_hba *phba)
615{
7da50879
JK		 616 phba->params.ios_per_ctrl = (phba->fw_config.iscsi_icd_count
617 - (phba->fw_config.iscsi_cid_count
618 + BE2_TMFS
619 + BE2_NOPOUT_REQ));
620 phba->params.cxns_per_ctrl = phba->fw_config.iscsi_cid_count;
ed58ea2a 621 phba->params.asyncpdus_per_ctrl = phba->fw_config.iscsi_cid_count * 2;
7da50879 622 phba->params.icds_per_ctrl = phba->fw_config.iscsi_icd_count;;
6733b39a
JK		 623 phba->params.num_sge_per_io = BE2_SGE;
624 phba->params.defpdu_hdr_sz = BE2_DEFPDU_HDR_SZ;
625 phba->params.defpdu_data_sz = BE2_DEFPDU_DATA_SZ;
626 phba->params.eq_timer = 64;
627 phba->params.num_eq_entries =
7da50879
JK		 628 (((BE2_CMDS_PER_CXN * 2 + phba->fw_config.iscsi_cid_count * 2
629 + BE2_TMFS) / 512) + 1) * 512;
6733b39a
JK		 630 phba->params.num_eq_entries = (phba->params.num_eq_entries < 1024)
631 ? 1024 : phba->params.num_eq_entries;
457ff3b7 632 SE_DEBUG(DBG_LVL_8, "phba->params.num_eq_entries=%d\n",
7da50879 633 phba->params.num_eq_entries);
6733b39a 634 phba->params.num_cq_entries =
7da50879
JK		 635 (((BE2_CMDS_PER_CXN * 2 + phba->fw_config.iscsi_cid_count * 2
636 + BE2_TMFS) / 512) + 1) * 512;
6733b39a
JK		 637 phba->params.wrbs_per_cxn = 256;
638}
639
640static void hwi_ring_eq_db(struct beiscsi_hba *phba,
641 unsigned int id, unsigned int clr_interrupt,
642 unsigned int num_processed,
643 unsigned char rearm, unsigned char event)
644{
645 u32 val = 0;
646 val |= id & DB_EQ_RING_ID_MASK;
647 if (rearm)
648 val |= 1 << DB_EQ_REARM_SHIFT;
649 if (clr_interrupt)
650 val |= 1 << DB_EQ_CLR_SHIFT;
651 if (event)
652 val |= 1 << DB_EQ_EVNT_SHIFT;
653 val |= num_processed << DB_EQ_NUM_POPPED_SHIFT;
654 iowrite32(val, phba->db_va + DB_EQ_OFFSET);
655}
656
bfead3b2
JK		 657/**
658 * be_isr_mcc - The isr routine of the driver.
659 * @irq: Not used
660 * @dev_id: Pointer to host adapter structure
661 */
662static irqreturn_t be_isr_mcc(int irq, void *dev_id)
663{
664 struct beiscsi_hba *phba;
665 struct be_eq_entry *eqe = NULL;
666 struct be_queue_info *eq;
667 struct be_queue_info *mcc;
668 unsigned int num_eq_processed;
669 struct be_eq_obj *pbe_eq;
670 unsigned long flags;
671
672 pbe_eq = dev_id;
673 eq = &pbe_eq->q;
674 phba = pbe_eq->phba;
675 mcc = &phba->ctrl.mcc_obj.cq;
676 eqe = queue_tail_node(eq);
677 if (!eqe)
678 SE_DEBUG(DBG_LVL_1, "eqe is NULL\n");
679
680 num_eq_processed = 0;
681
682 while (eqe->dw[offsetof(struct amap_eq_entry, valid) / 32]
683 & EQE_VALID_MASK) {
684 if (((eqe->dw[offsetof(struct amap_eq_entry,
685 resource_id) / 32] &
686 EQE_RESID_MASK) >> 16) == mcc->id) {
687 spin_lock_irqsave(&phba->isr_lock, flags);
688 phba->todo_mcc_cq = 1;
689 spin_unlock_irqrestore(&phba->isr_lock, flags);
690 }
691 AMAP_SET_BITS(struct amap_eq_entry, valid, eqe, 0);
692 queue_tail_inc(eq);
693 eqe = queue_tail_node(eq);
694 num_eq_processed++;
695 }
696 if (phba->todo_mcc_cq)
697 queue_work(phba->wq, &phba->work_cqs);
698 if (num_eq_processed)
699 hwi_ring_eq_db(phba, eq->id, 1, num_eq_processed, 1, 1);
700
701 return IRQ_HANDLED;
702}
703
704/**
705 * be_isr_msix - The isr routine of the driver.
706 * @irq: Not used
707 * @dev_id: Pointer to host adapter structure
708 */
709static irqreturn_t be_isr_msix(int irq, void *dev_id)
710{
711 struct beiscsi_hba *phba;
712 struct be_eq_entry *eqe = NULL;
713 struct be_queue_info *eq;
714 struct be_queue_info *cq;
715 unsigned int num_eq_processed;
716 struct be_eq_obj *pbe_eq;
717 unsigned long flags;
718
719 pbe_eq = dev_id;
720 eq = &pbe_eq->q;
721 cq = pbe_eq->cq;
722 eqe = queue_tail_node(eq);
723 if (!eqe)
724 SE_DEBUG(DBG_LVL_1, "eqe is NULL\n");
725
726 phba = pbe_eq->phba;
727 num_eq_processed = 0;
728 if (blk_iopoll_enabled) {
729 while (eqe->dw[offsetof(struct amap_eq_entry, valid) / 32]
730 & EQE_VALID_MASK) {
731 if (!blk_iopoll_sched_prep(&pbe_eq->iopoll))
732 blk_iopoll_sched(&pbe_eq->iopoll);
733
734 AMAP_SET_BITS(struct amap_eq_entry, valid, eqe, 0);
735 queue_tail_inc(eq);
736 eqe = queue_tail_node(eq);
737 num_eq_processed++;
738 }
739 if (num_eq_processed)
740 hwi_ring_eq_db(phba, eq->id, 1, num_eq_processed, 0, 1);
741
742 return IRQ_HANDLED;
743 } else {
744 while (eqe->dw[offsetof(struct amap_eq_entry, valid) / 32]
745 & EQE_VALID_MASK) {
746 spin_lock_irqsave(&phba->isr_lock, flags);
747 phba->todo_cq = 1;
748 spin_unlock_irqrestore(&phba->isr_lock, flags);
749 AMAP_SET_BITS(struct amap_eq_entry, valid, eqe, 0);
750 queue_tail_inc(eq);
751 eqe = queue_tail_node(eq);
752 num_eq_processed++;
753 }
754 if (phba->todo_cq)
755 queue_work(phba->wq, &phba->work_cqs);
756
757 if (num_eq_processed)
758 hwi_ring_eq_db(phba, eq->id, 1, num_eq_processed, 1, 1);
759
760 return IRQ_HANDLED;
761 }
762}
763
6733b39a
JK		 764/**
765 * be_isr - The isr routine of the driver.
766 * @irq: Not used
767 * @dev_id: Pointer to host adapter structure
768 */
769static irqreturn_t be_isr(int irq, void *dev_id)
770{
771 struct beiscsi_hba *phba;
772 struct hwi_controller *phwi_ctrlr;
773 struct hwi_context_memory *phwi_context;
774 struct be_eq_entry *eqe = NULL;
775 struct be_queue_info *eq;
776 struct be_queue_info *cq;
bfead3b2 777 struct be_queue_info *mcc;
6733b39a 778 unsigned long flags, index;
bfead3b2 779 unsigned int num_mcceq_processed, num_ioeq_processed;
6733b39a 780 struct be_ctrl_info *ctrl;
bfead3b2 781 struct be_eq_obj *pbe_eq;
6733b39a
JK		 782 int isr;
783
784 phba = dev_id;
bfead3b2
JK		 785 ctrl = &phba->ctrl;;
786 isr = ioread32(ctrl->csr + CEV_ISR0_OFFSET +
787 (PCI_FUNC(ctrl->pdev->devfn) * CEV_ISR_SIZE));
788 if (!isr)
789 return IRQ_NONE;
6733b39a
JK		 790
791 phwi_ctrlr = phba->phwi_ctrlr;
792 phwi_context = phwi_ctrlr->phwi_ctxt;
bfead3b2
JK		 793 pbe_eq = &phwi_context->be_eq[0];
794
795 eq = &phwi_context->be_eq[0].q;
796 mcc = &phba->ctrl.mcc_obj.cq;
6733b39a
JK		 797 index = 0;
798 eqe = queue_tail_node(eq);
799 if (!eqe)
800 SE_DEBUG(DBG_LVL_1, "eqe is NULL\n");
801
bfead3b2
JK		 802 num_ioeq_processed = 0;
803 num_mcceq_processed = 0;
6733b39a
JK		 804 if (blk_iopoll_enabled) {
805 while (eqe->dw[offsetof(struct amap_eq_entry, valid) / 32]
806 & EQE_VALID_MASK) {
bfead3b2
JK		 807 if (((eqe->dw[offsetof(struct amap_eq_entry,
808 resource_id) / 32] &
809 EQE_RESID_MASK) >> 16) == mcc->id) {
810 spin_lock_irqsave(&phba->isr_lock, flags);
811 phba->todo_mcc_cq = 1;
812 spin_unlock_irqrestore(&phba->isr_lock, flags);
813 num_mcceq_processed++;
814 } else {
815 if (!blk_iopoll_sched_prep(&pbe_eq->iopoll))
816 blk_iopoll_sched(&pbe_eq->iopoll);
817 num_ioeq_processed++;
818 }
6733b39a
JK		 819 AMAP_SET_BITS(struct amap_eq_entry, valid, eqe, 0);
820 queue_tail_inc(eq);
821 eqe = queue_tail_node(eq);
6733b39a 822 }
bfead3b2
JK		 823 if (num_ioeq_processed || num_mcceq_processed) {
824 if (phba->todo_mcc_cq)
825 queue_work(phba->wq, &phba->work_cqs);
826
756d29c8 827 if ((num_mcceq_processed) && (!num_ioeq_processed))
bfead3b2
JK		 828 hwi_ring_eq_db(phba, eq->id, 0,
829 (num_ioeq_processed +
830 num_mcceq_processed) , 1, 1);
831 else
832 hwi_ring_eq_db(phba, eq->id, 0,
833 (num_ioeq_processed +
834 num_mcceq_processed), 0, 1);
835
6733b39a
JK		 836 return IRQ_HANDLED;
837 } else
838 return IRQ_NONE;
839 } else {
bfead3b2 840 cq = &phwi_context->be_cq[0];
6733b39a
JK		 841 while (eqe->dw[offsetof(struct amap_eq_entry, valid) / 32]
842 & EQE_VALID_MASK) {
843
844 if (((eqe->dw[offsetof(struct amap_eq_entry,
845 resource_id) / 32] &
846 EQE_RESID_MASK) >> 16) != cq->id) {
847 spin_lock_irqsave(&phba->isr_lock, flags);
848 phba->todo_mcc_cq = 1;
849 spin_unlock_irqrestore(&phba->isr_lock, flags);
850 } else {
851 spin_lock_irqsave(&phba->isr_lock, flags);
852 phba->todo_cq = 1;
853 spin_unlock_irqrestore(&phba->isr_lock, flags);
854 }
855 AMAP_SET_BITS(struct amap_eq_entry, valid, eqe, 0);
856 queue_tail_inc(eq);
857 eqe = queue_tail_node(eq);
bfead3b2 858 num_ioeq_processed++;
6733b39a
JK		 859 }
860 if (phba->todo_cq || phba->todo_mcc_cq)
861 queue_work(phba->wq, &phba->work_cqs);
862
bfead3b2
JK		 863 if (num_ioeq_processed) {
864 hwi_ring_eq_db(phba, eq->id, 0,
865 num_ioeq_processed, 1, 1);
6733b39a
JK		 866 return IRQ_HANDLED;
867 } else
868 return IRQ_NONE;
869 }
870}
871
872static int beiscsi_init_irqs(struct beiscsi_hba *phba)
873{
874 struct pci_dev *pcidev = phba->pcidev;
bfead3b2
JK		 875 struct hwi_controller *phwi_ctrlr;
876 struct hwi_context_memory *phwi_context;
4f5af07e 877 int ret, msix_vec, i, j;
bfead3b2 878 char desc[32];
6733b39a 879
bfead3b2
JK		 880 phwi_ctrlr = phba->phwi_ctrlr;
881 phwi_context = phwi_ctrlr->phwi_ctxt;
882
883 if (phba->msix_enabled) {
884 for (i = 0; i < phba->num_cpus; i++) {
885 sprintf(desc, "beiscsi_msix_%04x", i);
886 msix_vec = phba->msix_entries[i].vector;
887 ret = request_irq(msix_vec, be_isr_msix, 0, desc,
888 &phwi_context->be_eq[i]);
4f5af07e
JK		 889 if (ret) {
890 shost_printk(KERN_ERR, phba->shost,
891 "beiscsi_init_irqs-Failed to"
892 "register msix for i = %d\n", i);
893 if (!i)
894 return ret;
895 goto free_msix_irqs;
896 }
bfead3b2
JK		 897 }
898 msix_vec = phba->msix_entries[i].vector;
899 ret = request_irq(msix_vec, be_isr_mcc, 0, "beiscsi_msix_mcc",
900 &phwi_context->be_eq[i]);
4f5af07e
JK		 901 if (ret) {
902 shost_printk(KERN_ERR, phba->shost, "beiscsi_init_irqs-"
903 "Failed to register beiscsi_msix_mcc\n");
904 i++;
905 goto free_msix_irqs;
906 }
907
bfead3b2
JK		 908 } else {
909 ret = request_irq(pcidev->irq, be_isr, IRQF_SHARED,
910 "beiscsi", phba);
911 if (ret) {
912 shost_printk(KERN_ERR, phba->shost, "beiscsi_init_irqs-"
913 "Failed to register irq\\n");
914 return ret;
915 }
6733b39a
JK		 916 }
917 return 0;
4f5af07e
JK		 918free_msix_irqs:
919 for (j = i - 1; j == 0; j++)
920 free_irq(msix_vec, &phwi_context->be_eq[j]);
921 return ret;
6733b39a
JK		 922}
923
924static void hwi_ring_cq_db(struct beiscsi_hba *phba,
925 unsigned int id, unsigned int num_processed,
926 unsigned char rearm, unsigned char event)
927{
928 u32 val = 0;
929 val |= id & DB_CQ_RING_ID_MASK;
930 if (rearm)
931 val |= 1 << DB_CQ_REARM_SHIFT;
932 val |= num_processed << DB_CQ_NUM_POPPED_SHIFT;
933 iowrite32(val, phba->db_va + DB_CQ_OFFSET);
934}
935
6733b39a
JK		 936static unsigned int
937beiscsi_process_async_pdu(struct beiscsi_conn *beiscsi_conn,
938 struct beiscsi_hba *phba,
939 unsigned short cid,
940 struct pdu_base *ppdu,
941 unsigned long pdu_len,
942 void *pbuffer, unsigned long buf_len)
943{
944 struct iscsi_conn *conn = beiscsi_conn->conn;
945 struct iscsi_session *session = conn->session;
bfead3b2
JK		 946 struct iscsi_task *task;
947 struct beiscsi_io_task *io_task;
948 struct iscsi_hdr *login_hdr;
6733b39a
JK		 949
950 switch (ppdu->dw[offsetof(struct amap_pdu_base, opcode) / 32] &
951 PDUBASE_OPCODE_MASK) {
952 case ISCSI_OP_NOOP_IN:
953 pbuffer = NULL;
954 buf_len = 0;
955 break;
956 case ISCSI_OP_ASYNC_EVENT:
957 break;
958 case ISCSI_OP_REJECT:
959 WARN_ON(!pbuffer);
960 WARN_ON(!(buf_len == 48));
961 SE_DEBUG(DBG_LVL_1, "In ISCSI_OP_REJECT\n");
962 break;
963 case ISCSI_OP_LOGIN_RSP:
7bd6e25c 964 case ISCSI_OP_TEXT_RSP:
bfead3b2
JK		 965 task = conn->login_task;
966 io_task = task->dd_data;
967 login_hdr = (struct iscsi_hdr *)ppdu;
968 login_hdr->itt = io_task->libiscsi_itt;
6733b39a
JK		 969 break;
970 default:
971 shost_printk(KERN_WARNING, phba->shost,
457ff3b7 972 "Unrecognized opcode 0x%x in async msg\n",
6733b39a
JK		 973 (ppdu->
974 dw[offsetof(struct amap_pdu_base, opcode) / 32]
975 & PDUBASE_OPCODE_MASK));
976 return 1;
977 }
978
979 spin_lock_bh(&session->lock);
980 __iscsi_complete_pdu(conn, (struct iscsi_hdr *)ppdu, pbuffer, buf_len);
981 spin_unlock_bh(&session->lock);
982 return 0;
983}
984
985static struct sgl_handle *alloc_io_sgl_handle(struct beiscsi_hba *phba)
986{
987 struct sgl_handle *psgl_handle;
988
989 if (phba->io_sgl_hndl_avbl) {
990 SE_DEBUG(DBG_LVL_8,
457ff3b7 991 "In alloc_io_sgl_handle,io_sgl_alloc_index=%d\n",
6733b39a
JK		 992 phba->io_sgl_alloc_index);
993 psgl_handle = phba->io_sgl_hndl_base[phba->
994 io_sgl_alloc_index];
995 phba->io_sgl_hndl_base[phba->io_sgl_alloc_index] = NULL;
996 phba->io_sgl_hndl_avbl--;
bfead3b2
JK		 997 if (phba->io_sgl_alloc_index == (phba->params.
998 ios_per_ctrl - 1))
6733b39a
JK		 999 phba->io_sgl_alloc_index = 0;
1000 else
1001 phba->io_sgl_alloc_index++;
1002 } else
1003 psgl_handle = NULL;
1004 return psgl_handle;
1005}
1006
1007static void
1008free_io_sgl_handle(struct beiscsi_hba *phba, struct sgl_handle *psgl_handle)
1009{
457ff3b7 1010 SE_DEBUG(DBG_LVL_8, "In free_,io_sgl_free_index=%d\n",
6733b39a
JK		 1011 phba->io_sgl_free_index);
1012 if (phba->io_sgl_hndl_base[phba->io_sgl_free_index]) {
1013 /*
1014 * this can happen if clean_task is called on a task that
1015 * failed in xmit_task or alloc_pdu.
1016 */
1017 SE_DEBUG(DBG_LVL_8,
1018 "Double Free in IO SGL io_sgl_free_index=%d,"
457ff3b7 1019 "value there=%p\n", phba->io_sgl_free_index,
6733b39a
JK		 1020 phba->io_sgl_hndl_base[phba->io_sgl_free_index]);
1021 return;
1022 }
1023 phba->io_sgl_hndl_base[phba->io_sgl_free_index] = psgl_handle;
1024 phba->io_sgl_hndl_avbl++;
1025 if (phba->io_sgl_free_index == (phba->params.ios_per_ctrl - 1))
1026 phba->io_sgl_free_index = 0;
1027 else
1028 phba->io_sgl_free_index++;
1029}
1030
1031/**
1032 * alloc_wrb_handle - To allocate a wrb handle
1033 * @phba: The hba pointer
1034 * @cid: The cid to use for allocation
6733b39a
JK		 1035 *
1036 * This happens under session_lock until submission to chip
1037 */
d5431488 1038struct wrb_handle *alloc_wrb_handle(struct beiscsi_hba *phba, unsigned int cid)
6733b39a
JK		 1039{
1040 struct hwi_wrb_context *pwrb_context;
1041 struct hwi_controller *phwi_ctrlr;
d5431488 1042 struct wrb_handle *pwrb_handle, *pwrb_handle_tmp;
6733b39a
JK		 1043
1044 phwi_ctrlr = phba->phwi_ctrlr;
1045 pwrb_context = &phwi_ctrlr->wrb_context[cid];
d5431488 1046 if (pwrb_context->wrb_handles_available >= 2) {
bfead3b2
JK		 1047 pwrb_handle = pwrb_context->pwrb_handle_base[
1048 pwrb_context->alloc_index];
1049 pwrb_context->wrb_handles_available--;
bfead3b2
JK		 1050 if (pwrb_context->alloc_index ==
1051 (phba->params.wrbs_per_cxn - 1))
1052 pwrb_context->alloc_index = 0;
1053 else
1054 pwrb_context->alloc_index++;
d5431488
JK		 1055 pwrb_handle_tmp = pwrb_context->pwrb_handle_base[
1056 pwrb_context->alloc_index];
1057 pwrb_handle->nxt_wrb_index = pwrb_handle_tmp->wrb_index;
bfead3b2
JK		 1058 } else
1059 pwrb_handle = NULL;
6733b39a
JK		 1060 return pwrb_handle;
1061}
1062
1063/**
1064 * free_wrb_handle - To free the wrb handle back to pool
1065 * @phba: The hba pointer
1066 * @pwrb_context: The context to free from
1067 * @pwrb_handle: The wrb_handle to free
1068 *
1069 * This happens under session_lock until submission to chip
1070 */
1071static void
1072free_wrb_handle(struct beiscsi_hba *phba, struct hwi_wrb_context *pwrb_context,
1073 struct wrb_handle *pwrb_handle)
1074{
32951dd8 1075 pwrb_context->pwrb_handle_base[pwrb_context->free_index] = pwrb_handle;
bfead3b2
JK		 1076 pwrb_context->wrb_handles_available++;
1077 if (pwrb_context->free_index == (phba->params.wrbs_per_cxn - 1))
1078 pwrb_context->free_index = 0;
1079 else
1080 pwrb_context->free_index++;
1081
6733b39a 1082 SE_DEBUG(DBG_LVL_8,
bfead3b2 1083 "FREE WRB: pwrb_handle=%p free_index=0x%x"
457ff3b7 1084 "wrb_handles_available=%d\n",
6733b39a 1085 pwrb_handle, pwrb_context->free_index,
bfead3b2 1086 pwrb_context->wrb_handles_available);
6733b39a
JK		 1087}
1088
1089static struct sgl_handle *alloc_mgmt_sgl_handle(struct beiscsi_hba *phba)
1090{
1091 struct sgl_handle *psgl_handle;
1092
1093 if (phba->eh_sgl_hndl_avbl) {
1094 psgl_handle = phba->eh_sgl_hndl_base[phba->eh_sgl_alloc_index];
1095 phba->eh_sgl_hndl_base[phba->eh_sgl_alloc_index] = NULL;
457ff3b7 1096 SE_DEBUG(DBG_LVL_8, "mgmt_sgl_alloc_index=%d=0x%x\n",
6733b39a
JK		 1097 phba->eh_sgl_alloc_index, phba->eh_sgl_alloc_index);
1098 phba->eh_sgl_hndl_avbl--;
1099 if (phba->eh_sgl_alloc_index ==
1100 (phba->params.icds_per_ctrl - phba->params.ios_per_ctrl -
1101 1))
1102 phba->eh_sgl_alloc_index = 0;
1103 else
1104 phba->eh_sgl_alloc_index++;
1105 } else
1106 psgl_handle = NULL;
1107 return psgl_handle;
1108}
1109
1110void
1111free_mgmt_sgl_handle(struct beiscsi_hba *phba, struct sgl_handle *psgl_handle)
1112{
1113
457ff3b7 1114 SE_DEBUG(DBG_LVL_8, "In free_mgmt_sgl_handle,eh_sgl_free_index=%d\n",
bfead3b2 1115 phba->eh_sgl_free_index);
6733b39a
JK		 1116 if (phba->eh_sgl_hndl_base[phba->eh_sgl_free_index]) {
1117 /*
1118 * this can happen if clean_task is called on a task that
1119 * failed in xmit_task or alloc_pdu.
1120 */
1121 SE_DEBUG(DBG_LVL_8,
457ff3b7 1122 "Double Free in eh SGL ,eh_sgl_free_index=%d\n",
6733b39a
JK		 1123 phba->eh_sgl_free_index);
1124 return;
1125 }
1126 phba->eh_sgl_hndl_base[phba->eh_sgl_free_index] = psgl_handle;
1127 phba->eh_sgl_hndl_avbl++;
1128 if (phba->eh_sgl_free_index ==
1129 (phba->params.icds_per_ctrl - phba->params.ios_per_ctrl - 1))
1130 phba->eh_sgl_free_index = 0;
1131 else
1132 phba->eh_sgl_free_index++;
1133}
1134
1135static void
1136be_complete_io(struct beiscsi_conn *beiscsi_conn,
1137 struct iscsi_task *task, struct sol_cqe *psol)
1138{
1139 struct beiscsi_io_task *io_task = task->dd_data;
1140 struct be_status_bhs *sts_bhs =
1141 (struct be_status_bhs *)io_task->cmd_bhs;
1142 struct iscsi_conn *conn = beiscsi_conn->conn;
1143 unsigned int sense_len;
1144 unsigned char *sense;
1145 u32 resid = 0, exp_cmdsn, max_cmdsn;
1146 u8 rsp, status, flags;
1147
bfead3b2 1148 exp_cmdsn = (psol->
6733b39a
JK		 1149 dw[offsetof(struct amap_sol_cqe, i_exp_cmd_sn) / 32]
1150 & SOL_EXP_CMD_SN_MASK);
bfead3b2 1151 max_cmdsn = ((psol->
6733b39a
JK		 1152 dw[offsetof(struct amap_sol_cqe, i_exp_cmd_sn) / 32]
1153 & SOL_EXP_CMD_SN_MASK) +
1154 ((psol->dw[offsetof(struct amap_sol_cqe, i_cmd_wnd)
1155 / 32] & SOL_CMD_WND_MASK) >> 24) - 1);
1156 rsp = ((psol->dw[offsetof(struct amap_sol_cqe, i_resp) / 32]
1157 & SOL_RESP_MASK) >> 16);
1158 status = ((psol->dw[offsetof(struct amap_sol_cqe, i_sts) / 32]
1159 & SOL_STS_MASK) >> 8);
1160 flags = ((psol->dw[offsetof(struct amap_sol_cqe, i_flags) / 32]
1161 & SOL_FLAGS_MASK) >> 24) | 0x80;
1162
1163 task->sc->result = (DID_OK << 16) | status;
1164 if (rsp != ISCSI_STATUS_CMD_COMPLETED) {
1165 task->sc->result = DID_ERROR << 16;
1166 goto unmap;
1167 }
1168
1169 /* bidi not initially supported */
1170 if (flags & (ISCSI_FLAG_CMD_UNDERFLOW | ISCSI_FLAG_CMD_OVERFLOW)) {
1171 resid = (psol->dw[offsetof(struct amap_sol_cqe, i_res_cnt) /
1172 32] & SOL_RES_CNT_MASK);
1173
1174 if (!status && (flags & ISCSI_FLAG_CMD_OVERFLOW))
1175 task->sc->result = DID_ERROR << 16;
1176
1177 if (flags & ISCSI_FLAG_CMD_UNDERFLOW) {
1178 scsi_set_resid(task->sc, resid);
1179 if (!status && (scsi_bufflen(task->sc) - resid <
1180 task->sc->underflow))
1181 task->sc->result = DID_ERROR << 16;
1182 }
1183 }
1184
1185 if (status == SAM_STAT_CHECK_CONDITION) {
bfead3b2 1186 unsigned short *slen = (unsigned short *)sts_bhs->sense_info;
6733b39a 1187 sense = sts_bhs->sense_info + sizeof(unsigned short);
bfead3b2 1188 sense_len = cpu_to_be16(*slen);
6733b39a
JK		 1189 memcpy(task->sc->sense_buffer, sense,
1190 min_t(u16, sense_len, SCSI_SENSE_BUFFERSIZE));
1191 }
756d29c8 1192
6733b39a
JK		 1193 if (io_task->cmd_bhs->iscsi_hdr.flags & ISCSI_FLAG_CMD_READ) {
1194 if (psol->dw[offsetof(struct amap_sol_cqe, i_res_cnt) / 32]
1195 & SOL_RES_CNT_MASK)
1196 conn->rxdata_octets += (psol->
bfead3b2
JK		 1197 dw[offsetof(struct amap_sol_cqe, i_res_cnt) / 32]
1198 & SOL_RES_CNT_MASK);
6733b39a
JK		 1199 }
1200unmap:
1201 scsi_dma_unmap(io_task->scsi_cmnd);
1202 iscsi_complete_scsi_task(task, exp_cmdsn, max_cmdsn);
1203}
1204
1205static void
1206be_complete_logout(struct beiscsi_conn *beiscsi_conn,
1207 struct iscsi_task *task, struct sol_cqe *psol)
1208{
1209 struct iscsi_logout_rsp *hdr;
bfead3b2 1210 struct beiscsi_io_task *io_task = task->dd_data;
6733b39a
JK		 1211 struct iscsi_conn *conn = beiscsi_conn->conn;
1212
1213 hdr = (struct iscsi_logout_rsp *)task->hdr;
7bd6e25c 1214 hdr->opcode = ISCSI_OP_LOGOUT_RSP;
6733b39a
JK		 1215 hdr->t2wait = 5;
1216 hdr->t2retain = 0;
1217 hdr->flags = ((psol->dw[offsetof(struct amap_sol_cqe, i_flags) / 32]
1218 & SOL_FLAGS_MASK) >> 24) | 0x80;
1219 hdr->response = (psol->dw[offsetof(struct amap_sol_cqe, i_resp) /
1220 32] & SOL_RESP_MASK);
1221 hdr->exp_cmdsn = cpu_to_be32(psol->
1222 dw[offsetof(struct amap_sol_cqe, i_exp_cmd_sn) / 32]
1223 & SOL_EXP_CMD_SN_MASK);
1224 hdr->max_cmdsn = be32_to_cpu((psol->
1225 dw[offsetof(struct amap_sol_cqe, i_exp_cmd_sn) / 32]
1226 & SOL_EXP_CMD_SN_MASK) +
1227 ((psol->dw[offsetof(struct amap_sol_cqe, i_cmd_wnd)
1228 / 32] & SOL_CMD_WND_MASK) >> 24) - 1);
7bd6e25c
JK		 1229 hdr->dlength[0] = 0;
1230 hdr->dlength[1] = 0;
1231 hdr->dlength[2] = 0;
6733b39a 1232 hdr->hlength = 0;
bfead3b2 1233 hdr->itt = io_task->libiscsi_itt;
6733b39a
JK		 1234 __iscsi_complete_pdu(conn, (struct iscsi_hdr *)hdr, NULL, 0);
1235}
1236
1237static void
1238be_complete_tmf(struct beiscsi_conn *beiscsi_conn,
1239 struct iscsi_task *task, struct sol_cqe *psol)
1240{
1241 struct iscsi_tm_rsp *hdr;
1242 struct iscsi_conn *conn = beiscsi_conn->conn;
bfead3b2 1243 struct beiscsi_io_task *io_task = task->dd_data;
6733b39a
JK		 1244
1245 hdr = (struct iscsi_tm_rsp *)task->hdr;
7bd6e25c 1246 hdr->opcode = ISCSI_OP_SCSI_TMFUNC_RSP;
6733b39a
JK		 1247 hdr->flags = ((psol->dw[offsetof(struct amap_sol_cqe, i_flags) / 32]
1248 & SOL_FLAGS_MASK) >> 24) | 0x80;
1249 hdr->response = (psol->dw[offsetof(struct amap_sol_cqe, i_resp) /
1250 32] & SOL_RESP_MASK);
1251 hdr->exp_cmdsn = cpu_to_be32(psol->dw[offsetof(struct amap_sol_cqe,
bfead3b2 1252 i_exp_cmd_sn) / 32] & SOL_EXP_CMD_SN_MASK);
6733b39a
JK		 1253 hdr->max_cmdsn = be32_to_cpu((psol->dw[offsetof(struct amap_sol_cqe,
1254 i_exp_cmd_sn) / 32] & SOL_EXP_CMD_SN_MASK) +
1255 ((psol->dw[offsetof(struct amap_sol_cqe, i_cmd_wnd)
1256 / 32] & SOL_CMD_WND_MASK) >> 24) - 1);
bfead3b2 1257 hdr->itt = io_task->libiscsi_itt;
6733b39a
JK		 1258 __iscsi_complete_pdu(conn, (struct iscsi_hdr *)hdr, NULL, 0);
1259}
1260
1261static void
1262hwi_complete_drvr_msgs(struct beiscsi_conn *beiscsi_conn,
1263 struct beiscsi_hba *phba, struct sol_cqe *psol)
1264{
1265 struct hwi_wrb_context *pwrb_context;
bfead3b2 1266 struct wrb_handle *pwrb_handle = NULL;
6733b39a 1267 struct hwi_controller *phwi_ctrlr;
bfead3b2
JK		 1268 struct iscsi_task *task;
1269 struct beiscsi_io_task *io_task;
6733b39a
JK		 1270 struct iscsi_conn *conn = beiscsi_conn->conn;
1271 struct iscsi_session *session = conn->session;
1272
1273 phwi_ctrlr = phba->phwi_ctrlr;
32951dd8 1274 pwrb_context = &phwi_ctrlr->wrb_context[((psol->
35e66019 1275 dw[offsetof(struct amap_sol_cqe, cid) / 32] &
7da50879
JK		 1276 SOL_CID_MASK) >> 6) -
1277 phba->fw_config.iscsi_cid_start];
32951dd8 1278 pwrb_handle = pwrb_context->pwrb_handle_basestd[((psol->
35e66019
JK		 1279 dw[offsetof(struct amap_sol_cqe, wrb_index) /
1280 32] & SOL_WRB_INDEX_MASK) >> 16)];
32951dd8 1281 task = pwrb_handle->pio_handle;
35e66019 1282
bfead3b2
JK		 1283 io_task = task->dd_data;
1284 spin_lock(&phba->mgmt_sgl_lock);
1285 free_mgmt_sgl_handle(phba, io_task->psgl_handle);
1286 spin_unlock(&phba->mgmt_sgl_lock);
6733b39a
JK		 1287 spin_lock_bh(&session->lock);
1288 free_wrb_handle(phba, pwrb_context, pwrb_handle);
1289 spin_unlock_bh(&session->lock);
1290}
1291
1292static void
1293be_complete_nopin_resp(struct beiscsi_conn *beiscsi_conn,
1294 struct iscsi_task *task, struct sol_cqe *psol)
1295{
1296 struct iscsi_nopin *hdr;
1297 struct iscsi_conn *conn = beiscsi_conn->conn;
bfead3b2 1298 struct beiscsi_io_task *io_task = task->dd_data;
6733b39a
JK		 1299
1300 hdr = (struct iscsi_nopin *)task->hdr;
1301 hdr->flags = ((psol->dw[offsetof(struct amap_sol_cqe, i_flags) / 32]
1302 & SOL_FLAGS_MASK) >> 24) | 0x80;
1303 hdr->exp_cmdsn = cpu_to_be32(psol->dw[offsetof(struct amap_sol_cqe,
1304 i_exp_cmd_sn) / 32] & SOL_EXP_CMD_SN_MASK);
1305 hdr->max_cmdsn = be32_to_cpu((psol->dw[offsetof(struct amap_sol_cqe,
1306 i_exp_cmd_sn) / 32] & SOL_EXP_CMD_SN_MASK) +
1307 ((psol->dw[offsetof(struct amap_sol_cqe, i_cmd_wnd)
1308 / 32] & SOL_CMD_WND_MASK) >> 24) - 1);
1309 hdr->opcode = ISCSI_OP_NOOP_IN;
bfead3b2 1310 hdr->itt = io_task->libiscsi_itt;
6733b39a
JK		 1311 __iscsi_complete_pdu(conn, (struct iscsi_hdr *)hdr, NULL, 0);
1312}
1313
1314static void hwi_complete_cmd(struct beiscsi_conn *beiscsi_conn,
1315 struct beiscsi_hba *phba, struct sol_cqe *psol)
1316{
1317 struct hwi_wrb_context *pwrb_context;
1318 struct wrb_handle *pwrb_handle;
1319 struct iscsi_wrb *pwrb = NULL;
1320 struct hwi_controller *phwi_ctrlr;
1321 struct iscsi_task *task;
bfead3b2 1322 unsigned int type;
6733b39a
JK		 1323 struct iscsi_conn *conn = beiscsi_conn->conn;
1324 struct iscsi_session *session = conn->session;
1325
1326 phwi_ctrlr = phba->phwi_ctrlr;
32951dd8 1327 pwrb_context = &phwi_ctrlr->wrb_context[((psol->dw[offsetof
35e66019 1328 (struct amap_sol_cqe, cid) / 32]
7da50879
JK		 1329 & SOL_CID_MASK) >> 6) -
1330 phba->fw_config.iscsi_cid_start];
32951dd8 1331 pwrb_handle = pwrb_context->pwrb_handle_basestd[((psol->
35e66019
JK		 1332 dw[offsetof(struct amap_sol_cqe, wrb_index) /
1333 32] & SOL_WRB_INDEX_MASK) >> 16)];
32951dd8
JK		 1334 task = pwrb_handle->pio_handle;
1335 pwrb = pwrb_handle->pwrb;
1336 type = (pwrb->dw[offsetof(struct amap_iscsi_wrb, type) / 32] &
1337 WRB_TYPE_MASK) >> 28;
1338
bfead3b2
JK		 1339 spin_lock_bh(&session->lock);
1340 switch (type) {
6733b39a
JK		 1341 case HWH_TYPE_IO:
1342 case HWH_TYPE_IO_RD:
1343 if ((task->hdr->opcode & ISCSI_OPCODE_MASK) ==
dafab8e0 1344 ISCSI_OP_NOOP_OUT)
6733b39a 1345 be_complete_nopin_resp(beiscsi_conn, task, psol);
dafab8e0 1346 else
6733b39a
JK		 1347 be_complete_io(beiscsi_conn, task, psol);
1348 break;
1349
1350 case HWH_TYPE_LOGOUT:
dafab8e0
JK		 1351 if ((task->hdr->opcode & ISCSI_OPCODE_MASK) == ISCSI_OP_LOGOUT)
1352 be_complete_logout(beiscsi_conn, task, psol);
1353 else
1354 be_complete_tmf(beiscsi_conn, task, psol);
1355
6733b39a
JK		 1356 break;
1357
1358 case HWH_TYPE_LOGIN:
1359 SE_DEBUG(DBG_LVL_1,
1360 "\t\t No HWH_TYPE_LOGIN Expected in hwi_complete_cmd"
457ff3b7 1361 "- Solicited path\n");
6733b39a
JK		 1362 break;
1363
6733b39a
JK		 1364 case HWH_TYPE_NOP:
1365 be_complete_nopin_resp(beiscsi_conn, task, psol);
1366 break;
1367
1368 default:
32951dd8 1369 shost_printk(KERN_WARNING, phba->shost,
35e66019
JK		 1370 "In hwi_complete_cmd, unknown type = %d"
1371 "wrb_index 0x%x CID 0x%x\n", type,
1372 ((psol->dw[offsetof(struct amap_iscsi_wrb,
1373 type) / 32] & SOL_WRB_INDEX_MASK) >> 16),
1374 ((psol->dw[offsetof(struct amap_sol_cqe,
1375 cid) / 32] & SOL_CID_MASK) >> 6));
6733b39a
JK		 1376 break;
1377 }
35e66019 1378
6733b39a
JK		 1379 spin_unlock_bh(&session->lock);
1380}
1381
1382static struct list_head *hwi_get_async_busy_list(struct hwi_async_pdu_context
1383 *pasync_ctx, unsigned int is_header,
1384 unsigned int host_write_ptr)
1385{
1386 if (is_header)
1387 return &pasync_ctx->async_entry[host_write_ptr].
1388 header_busy_list;
1389 else
1390 return &pasync_ctx->async_entry[host_write_ptr].data_busy_list;
1391}
1392
1393static struct async_pdu_handle *
1394hwi_get_async_handle(struct beiscsi_hba *phba,
1395 struct beiscsi_conn *beiscsi_conn,
1396 struct hwi_async_pdu_context *pasync_ctx,
1397 struct i_t_dpdu_cqe *pdpdu_cqe, unsigned int *pcq_index)
1398{
1399 struct be_bus_address phys_addr;
1400 struct list_head *pbusy_list;
1401 struct async_pdu_handle *pasync_handle = NULL;
1402 int buffer_len = 0;
1403 unsigned char buffer_index = -1;
1404 unsigned char is_header = 0;
1405
1406 phys_addr.u.a32.address_lo =
1407 pdpdu_cqe->dw[offsetof(struct amap_i_t_dpdu_cqe, db_addr_lo) / 32] -
1408 ((pdpdu_cqe->dw[offsetof(struct amap_i_t_dpdu_cqe, dpl) / 32]
1409 & PDUCQE_DPL_MASK) >> 16);
1410 phys_addr.u.a32.address_hi =
1411 pdpdu_cqe->dw[offsetof(struct amap_i_t_dpdu_cqe, db_addr_hi) / 32];
1412
1413 phys_addr.u.a64.address =
1414 *((unsigned long long *)(&phys_addr.u.a64.address));
1415
1416 switch (pdpdu_cqe->dw[offsetof(struct amap_i_t_dpdu_cqe, code) / 32]
1417 & PDUCQE_CODE_MASK) {
1418 case UNSOL_HDR_NOTIFY:
1419 is_header = 1;
1420
1421 pbusy_list = hwi_get_async_busy_list(pasync_ctx, 1,
1422 (pdpdu_cqe->dw[offsetof(struct amap_i_t_dpdu_cqe,
1423 index) / 32] & PDUCQE_INDEX_MASK));
1424
1425 buffer_len = (unsigned int)(phys_addr.u.a64.address -
1426 pasync_ctx->async_header.pa_base.u.a64.address);
1427
1428 buffer_index = buffer_len /
1429 pasync_ctx->async_header.buffer_size;
1430
1431 break;
1432 case UNSOL_DATA_NOTIFY:
1433 pbusy_list = hwi_get_async_busy_list(pasync_ctx, 0, (pdpdu_cqe->
1434 dw[offsetof(struct amap_i_t_dpdu_cqe,
1435 index) / 32] & PDUCQE_INDEX_MASK));
1436 buffer_len = (unsigned long)(phys_addr.u.a64.address -
1437 pasync_ctx->async_data.pa_base.u.
1438 a64.address);
1439 buffer_index = buffer_len / pasync_ctx->async_data.buffer_size;
1440 break;
1441 default:
1442 pbusy_list = NULL;
1443 shost_printk(KERN_WARNING, phba->shost,
457ff3b7 1444 "Unexpected code=%d\n",
6733b39a
JK		 1445 pdpdu_cqe->dw[offsetof(struct amap_i_t_dpdu_cqe,
1446 code) / 32] & PDUCQE_CODE_MASK);
1447 return NULL;
1448 }
1449
1450 WARN_ON(!(buffer_index <= pasync_ctx->async_data.num_entries));
1451 WARN_ON(list_empty(pbusy_list));
1452 list_for_each_entry(pasync_handle, pbusy_list, link) {
1453 WARN_ON(pasync_handle->consumed);
1454 if (pasync_handle->index == buffer_index)
1455 break;
1456 }
1457
1458 WARN_ON(!pasync_handle);
1459
7da50879
JK		 1460 pasync_handle->cri = (unsigned short)beiscsi_conn->beiscsi_conn_cid -
1461 phba->fw_config.iscsi_cid_start;
6733b39a
JK		 1462 pasync_handle->is_header = is_header;
1463 pasync_handle->buffer_len = ((pdpdu_cqe->
1464 dw[offsetof(struct amap_i_t_dpdu_cqe, dpl) / 32]
1465 & PDUCQE_DPL_MASK) >> 16);
1466
1467 *pcq_index = (pdpdu_cqe->dw[offsetof(struct amap_i_t_dpdu_cqe,
1468 index) / 32] & PDUCQE_INDEX_MASK);
1469 return pasync_handle;
1470}
1471
1472static unsigned int
1473hwi_update_async_writables(struct hwi_async_pdu_context *pasync_ctx,
1474 unsigned int is_header, unsigned int cq_index)
1475{
1476 struct list_head *pbusy_list;
1477 struct async_pdu_handle *pasync_handle;
1478 unsigned int num_entries, writables = 0;
1479 unsigned int *pep_read_ptr, *pwritables;
1480
1481
1482 if (is_header) {
1483 pep_read_ptr = &pasync_ctx->async_header.ep_read_ptr;
1484 pwritables = &pasync_ctx->async_header.writables;
1485 num_entries = pasync_ctx->async_header.num_entries;
1486 } else {
1487 pep_read_ptr = &pasync_ctx->async_data.ep_read_ptr;
1488 pwritables = &pasync_ctx->async_data.writables;
1489 num_entries = pasync_ctx->async_data.num_entries;
1490 }
1491
1492 while ((*pep_read_ptr) != cq_index) {
1493 (*pep_read_ptr)++;
1494 *pep_read_ptr = (*pep_read_ptr) % num_entries;
1495
1496 pbusy_list = hwi_get_async_busy_list(pasync_ctx, is_header,
1497 *pep_read_ptr);
1498 if (writables == 0)
1499 WARN_ON(list_empty(pbusy_list));
1500
1501 if (!list_empty(pbusy_list)) {
1502 pasync_handle = list_entry(pbusy_list->next,
1503 struct async_pdu_handle,
1504 link);
1505 WARN_ON(!pasync_handle);
1506 pasync_handle->consumed = 1;
1507 }
1508
1509 writables++;
1510 }
1511
1512 if (!writables) {
1513 SE_DEBUG(DBG_LVL_1,
1514 "Duplicate notification received - index 0x%x!!\n",
1515 cq_index);
1516 WARN_ON(1);
1517 }
1518
1519 *pwritables = *pwritables + writables;
1520 return 0;
1521}
1522
1523static unsigned int hwi_free_async_msg(struct beiscsi_hba *phba,
1524 unsigned int cri)
1525{
1526 struct hwi_controller *phwi_ctrlr;
1527 struct hwi_async_pdu_context *pasync_ctx;
1528 struct async_pdu_handle *pasync_handle, *tmp_handle;
1529 struct list_head *plist;
1530 unsigned int i = 0;
1531
1532 phwi_ctrlr = phba->phwi_ctrlr;
1533 pasync_ctx = HWI_GET_ASYNC_PDU_CTX(phwi_ctrlr);
1534
1535 plist = &pasync_ctx->async_entry[cri].wait_queue.list;
1536
1537 list_for_each_entry_safe(pasync_handle, tmp_handle, plist, link) {
1538 list_del(&pasync_handle->link);
1539
1540 if (i == 0) {
1541 list_add_tail(&pasync_handle->link,
1542 &pasync_ctx->async_header.free_list);
1543 pasync_ctx->async_header.free_entries++;
1544 i++;
1545 } else {
1546 list_add_tail(&pasync_handle->link,
1547 &pasync_ctx->async_data.free_list);
1548 pasync_ctx->async_data.free_entries++;
1549 i++;
1550 }
1551 }
1552
1553 INIT_LIST_HEAD(&pasync_ctx->async_entry[cri].wait_queue.list);
1554 pasync_ctx->async_entry[cri].wait_queue.hdr_received = 0;
1555 pasync_ctx->async_entry[cri].wait_queue.bytes_received = 0;
1556 return 0;
1557}
1558
1559static struct phys_addr *
1560hwi_get_ring_address(struct hwi_async_pdu_context *pasync_ctx,
1561 unsigned int is_header, unsigned int host_write_ptr)
1562{
1563 struct phys_addr *pasync_sge = NULL;
1564
1565 if (is_header)
1566 pasync_sge = pasync_ctx->async_header.ring_base;
1567 else
1568 pasync_sge = pasync_ctx->async_data.ring_base;
1569
1570 return pasync_sge + host_write_ptr;
1571}
1572
1573static void hwi_post_async_buffers(struct beiscsi_hba *phba,
1574 unsigned int is_header)
1575{
1576 struct hwi_controller *phwi_ctrlr;
1577 struct hwi_async_pdu_context *pasync_ctx;
1578 struct async_pdu_handle *pasync_handle;
1579 struct list_head *pfree_link, *pbusy_list;
1580 struct phys_addr *pasync_sge;
1581 unsigned int ring_id, num_entries;
1582 unsigned int host_write_num;
1583 unsigned int writables;
1584 unsigned int i = 0;
1585 u32 doorbell = 0;
1586
1587 phwi_ctrlr = phba->phwi_ctrlr;
1588 pasync_ctx = HWI_GET_ASYNC_PDU_CTX(phwi_ctrlr);
1589
1590 if (is_header) {
1591 num_entries = pasync_ctx->async_header.num_entries;
1592 writables = min(pasync_ctx->async_header.writables,
1593 pasync_ctx->async_header.free_entries);
1594 pfree_link = pasync_ctx->async_header.free_list.next;
1595 host_write_num = pasync_ctx->async_header.host_write_ptr;
1596 ring_id = phwi_ctrlr->default_pdu_hdr.id;
1597 } else {
1598 num_entries = pasync_ctx->async_data.num_entries;
1599 writables = min(pasync_ctx->async_data.writables,
1600 pasync_ctx->async_data.free_entries);
1601 pfree_link = pasync_ctx->async_data.free_list.next;
1602 host_write_num = pasync_ctx->async_data.host_write_ptr;
1603 ring_id = phwi_ctrlr->default_pdu_data.id;
1604 }
1605
1606 writables = (writables / 8) * 8;
1607 if (writables) {
1608 for (i = 0; i < writables; i++) {
1609 pbusy_list =
1610 hwi_get_async_busy_list(pasync_ctx, is_header,
1611 host_write_num);
1612 pasync_handle =
1613 list_entry(pfree_link, struct async_pdu_handle,
1614 link);
1615 WARN_ON(!pasync_handle);
1616 pasync_handle->consumed = 0;
1617
1618 pfree_link = pfree_link->next;
1619
1620 pasync_sge = hwi_get_ring_address(pasync_ctx,
1621 is_header, host_write_num);
1622
1623 pasync_sge->hi = pasync_handle->pa.u.a32.address_lo;
1624 pasync_sge->lo = pasync_handle->pa.u.a32.address_hi;
1625
1626 list_move(&pasync_handle->link, pbusy_list);
1627
1628 host_write_num++;
1629 host_write_num = host_write_num % num_entries;
1630 }
1631
1632 if (is_header) {
1633 pasync_ctx->async_header.host_write_ptr =
1634 host_write_num;
1635 pasync_ctx->async_header.free_entries -= writables;
1636 pasync_ctx->async_header.writables -= writables;
1637 pasync_ctx->async_header.busy_entries += writables;
1638 } else {
1639 pasync_ctx->async_data.host_write_ptr = host_write_num;
1640 pasync_ctx->async_data.free_entries -= writables;
1641 pasync_ctx->async_data.writables -= writables;
1642 pasync_ctx->async_data.busy_entries += writables;
1643 }
1644
1645 doorbell |= ring_id & DB_DEF_PDU_RING_ID_MASK;
1646 doorbell |= 1 << DB_DEF_PDU_REARM_SHIFT;
1647 doorbell |= 0 << DB_DEF_PDU_EVENT_SHIFT;
1648 doorbell |= (writables & DB_DEF_PDU_CQPROC_MASK)
1649 << DB_DEF_PDU_CQPROC_SHIFT;
1650
1651 iowrite32(doorbell, phba->db_va + DB_RXULP0_OFFSET);
1652 }
1653}
1654
1655static void hwi_flush_default_pdu_buffer(struct beiscsi_hba *phba,
1656 struct beiscsi_conn *beiscsi_conn,
1657 struct i_t_dpdu_cqe *pdpdu_cqe)
1658{
1659 struct hwi_controller *phwi_ctrlr;
1660 struct hwi_async_pdu_context *pasync_ctx;
1661 struct async_pdu_handle *pasync_handle = NULL;
1662 unsigned int cq_index = -1;
1663
1664 phwi_ctrlr = phba->phwi_ctrlr;
1665 pasync_ctx = HWI_GET_ASYNC_PDU_CTX(phwi_ctrlr);
1666
1667 pasync_handle = hwi_get_async_handle(phba, beiscsi_conn, pasync_ctx,
1668 pdpdu_cqe, &cq_index);
1669 BUG_ON(pasync_handle->is_header != 0);
1670 if (pasync_handle->consumed == 0)
1671 hwi_update_async_writables(pasync_ctx, pasync_handle->is_header,
1672 cq_index);
1673
1674 hwi_free_async_msg(phba, pasync_handle->cri);
1675 hwi_post_async_buffers(phba, pasync_handle->is_header);
1676}
1677
1678static unsigned int
1679hwi_fwd_async_msg(struct beiscsi_conn *beiscsi_conn,
1680 struct beiscsi_hba *phba,
1681 struct hwi_async_pdu_context *pasync_ctx, unsigned short cri)
1682{
1683 struct list_head *plist;
1684 struct async_pdu_handle *pasync_handle;
1685 void *phdr = NULL;
1686 unsigned int hdr_len = 0, buf_len = 0;
1687 unsigned int status, index = 0, offset = 0;
1688 void *pfirst_buffer = NULL;
1689 unsigned int num_buf = 0;
1690
1691 plist = &pasync_ctx->async_entry[cri].wait_queue.list;
1692
1693 list_for_each_entry(pasync_handle, plist, link) {
1694 if (index == 0) {
1695 phdr = pasync_handle->pbuffer;
1696 hdr_len = pasync_handle->buffer_len;
1697 } else {
1698 buf_len = pasync_handle->buffer_len;
1699 if (!num_buf) {
1700 pfirst_buffer = pasync_handle->pbuffer;
1701 num_buf++;
1702 }
1703 memcpy(pfirst_buffer + offset,
1704 pasync_handle->pbuffer, buf_len);
1705 offset = buf_len;
1706 }
1707 index++;
1708 }
1709
1710 status = beiscsi_process_async_pdu(beiscsi_conn, phba,
7da50879
JK		 1711 (beiscsi_conn->beiscsi_conn_cid -
1712 phba->fw_config.iscsi_cid_start),
1713 phdr, hdr_len, pfirst_buffer,
1714 buf_len);
6733b39a
JK		 1715
1716 if (status == 0)
1717 hwi_free_async_msg(phba, cri);
1718 return 0;
1719}
1720
1721static unsigned int
1722hwi_gather_async_pdu(struct beiscsi_conn *beiscsi_conn,
1723 struct beiscsi_hba *phba,
1724 struct async_pdu_handle *pasync_handle)
1725{
1726 struct hwi_async_pdu_context *pasync_ctx;
1727 struct hwi_controller *phwi_ctrlr;
1728 unsigned int bytes_needed = 0, status = 0;
1729 unsigned short cri = pasync_handle->cri;
1730 struct pdu_base *ppdu;
1731
1732 phwi_ctrlr = phba->phwi_ctrlr;
1733 pasync_ctx = HWI_GET_ASYNC_PDU_CTX(phwi_ctrlr);
1734
1735 list_del(&pasync_handle->link);
1736 if (pasync_handle->is_header) {
1737 pasync_ctx->async_header.busy_entries--;
1738 if (pasync_ctx->async_entry[cri].wait_queue.hdr_received) {
1739 hwi_free_async_msg(phba, cri);
1740 BUG();
1741 }
1742
1743 pasync_ctx->async_entry[cri].wait_queue.bytes_received = 0;
1744 pasync_ctx->async_entry[cri].wait_queue.hdr_received = 1;
1745 pasync_ctx->async_entry[cri].wait_queue.hdr_len =
1746 (unsigned short)pasync_handle->buffer_len;
1747 list_add_tail(&pasync_handle->link,
1748 &pasync_ctx->async_entry[cri].wait_queue.list);
1749
1750 ppdu = pasync_handle->pbuffer;
1751 bytes_needed = ((((ppdu->dw[offsetof(struct amap_pdu_base,
1752 data_len_hi) / 32] & PDUBASE_DATALENHI_MASK) << 8) &
1753 0xFFFF0000) | ((be16_to_cpu((ppdu->
1754 dw[offsetof(struct amap_pdu_base, data_len_lo) / 32]
1755 & PDUBASE_DATALENLO_MASK) >> 16)) & 0x0000FFFF));
1756
1757 if (status == 0) {
1758 pasync_ctx->async_entry[cri].wait_queue.bytes_needed =
1759 bytes_needed;
1760
1761 if (bytes_needed == 0)
1762 status = hwi_fwd_async_msg(beiscsi_conn, phba,
1763 pasync_ctx, cri);
1764 }
1765 } else {
1766 pasync_ctx->async_data.busy_entries--;
1767 if (pasync_ctx->async_entry[cri].wait_queue.hdr_received) {
1768 list_add_tail(&pasync_handle->link,
1769 &pasync_ctx->async_entry[cri].wait_queue.
1770 list);
1771 pasync_ctx->async_entry[cri].wait_queue.
1772 bytes_received +=
1773 (unsigned short)pasync_handle->buffer_len;
1774
1775 if (pasync_ctx->async_entry[cri].wait_queue.
1776 bytes_received >=
1777 pasync_ctx->async_entry[cri].wait_queue.
1778 bytes_needed)
1779 status = hwi_fwd_async_msg(beiscsi_conn, phba,
1780 pasync_ctx, cri);
1781 }
1782 }
1783 return status;
1784}
1785
1786static void hwi_process_default_pdu_ring(struct beiscsi_conn *beiscsi_conn,
1787 struct beiscsi_hba *phba,
1788 struct i_t_dpdu_cqe *pdpdu_cqe)
1789{
1790 struct hwi_controller *phwi_ctrlr;
1791 struct hwi_async_pdu_context *pasync_ctx;
1792 struct async_pdu_handle *pasync_handle = NULL;
1793 unsigned int cq_index = -1;
1794
1795 phwi_ctrlr = phba->phwi_ctrlr;
1796 pasync_ctx = HWI_GET_ASYNC_PDU_CTX(phwi_ctrlr);
1797 pasync_handle = hwi_get_async_handle(phba, beiscsi_conn, pasync_ctx,
1798 pdpdu_cqe, &cq_index);
1799
1800 if (pasync_handle->consumed == 0)
1801 hwi_update_async_writables(pasync_ctx, pasync_handle->is_header,
1802 cq_index);
1803 hwi_gather_async_pdu(beiscsi_conn, phba, pasync_handle);
1804 hwi_post_async_buffers(phba, pasync_handle->is_header);
1805}
1806
756d29c8
JK		 1807static void beiscsi_process_mcc_isr(struct beiscsi_hba *phba)
1808{
1809 struct be_queue_info *mcc_cq;
1810 struct be_mcc_compl *mcc_compl;
1811 unsigned int num_processed = 0;
1812
1813 mcc_cq = &phba->ctrl.mcc_obj.cq;
1814 mcc_compl = queue_tail_node(mcc_cq);
1815 mcc_compl->flags = le32_to_cpu(mcc_compl->flags);
1816 while (mcc_compl->flags & CQE_FLAGS_VALID_MASK) {
1817
1818 if (num_processed >= 32) {
1819 hwi_ring_cq_db(phba, mcc_cq->id,
1820 num_processed, 0, 0);
1821 num_processed = 0;
1822 }
1823 if (mcc_compl->flags & CQE_FLAGS_ASYNC_MASK) {
1824 /* Interpret flags as an async trailer */
1825 if (is_link_state_evt(mcc_compl->flags))
1826 /* Interpret compl as a async link evt */
1827 beiscsi_async_link_state_process(phba,
1828 (struct be_async_event_link_state *) mcc_compl);
1829 else
1830 SE_DEBUG(DBG_LVL_1,
1831 " Unsupported Async Event, flags"
457ff3b7 1832 " = 0x%08x\n", mcc_compl->flags);
756d29c8
JK		 1833 } else if (mcc_compl->flags & CQE_FLAGS_COMPLETED_MASK) {
1834 be_mcc_compl_process_isr(&phba->ctrl, mcc_compl);
1835 atomic_dec(&phba->ctrl.mcc_obj.q.used);
1836 }
1837
1838 mcc_compl->flags = 0;
1839 queue_tail_inc(mcc_cq);
1840 mcc_compl = queue_tail_node(mcc_cq);
1841 mcc_compl->flags = le32_to_cpu(mcc_compl->flags);
1842 num_processed++;
1843 }
1844
1845 if (num_processed > 0)
1846 hwi_ring_cq_db(phba, mcc_cq->id, num_processed, 1, 0);
1847
1848}
bfead3b2
JK		 1849
1850static unsigned int beiscsi_process_cq(struct be_eq_obj *pbe_eq)
6733b39a 1851{
6733b39a
JK		 1852 struct be_queue_info *cq;
1853 struct sol_cqe *sol;
1854 struct dmsg_cqe *dmsg;
1855 unsigned int num_processed = 0;
1856 unsigned int tot_nump = 0;
1857 struct beiscsi_conn *beiscsi_conn;
c2462288
JK		 1858 struct beiscsi_endpoint *beiscsi_ep;
1859 struct iscsi_endpoint *ep;
bfead3b2 1860 struct beiscsi_hba *phba;
6733b39a 1861
bfead3b2 1862 cq = pbe_eq->cq;
6733b39a 1863 sol = queue_tail_node(cq);
bfead3b2 1864 phba = pbe_eq->phba;
6733b39a
JK		 1865
1866 while (sol->dw[offsetof(struct amap_sol_cqe, valid) / 32] &
1867 CQE_VALID_MASK) {
1868 be_dws_le_to_cpu(sol, sizeof(struct sol_cqe));
1869
32951dd8 1870 ep = phba->ep_array[(u32) ((sol->
c2462288
JK		 1871 dw[offsetof(struct amap_sol_cqe, cid) / 32] &
1872 SOL_CID_MASK) >> 6) -
7da50879 1873 phba->fw_config.iscsi_cid_start];
32951dd8 1874
c2462288
JK		 1875 beiscsi_ep = ep->dd_data;
1876 beiscsi_conn = beiscsi_ep->conn;
756d29c8 1877
6733b39a 1878 if (num_processed >= 32) {
bfead3b2 1879 hwi_ring_cq_db(phba, cq->id,
6733b39a
JK		 1880 num_processed, 0, 0);
1881 tot_nump += num_processed;
1882 num_processed = 0;
1883 }
1884
1885 switch ((u32) sol->dw[offsetof(struct amap_sol_cqe, code) /
1886 32] & CQE_CODE_MASK) {
1887 case SOL_CMD_COMPLETE:
1888 hwi_complete_cmd(beiscsi_conn, phba, sol);
1889 break;
1890 case DRIVERMSG_NOTIFY:
457ff3b7 1891 SE_DEBUG(DBG_LVL_8, "Received DRIVERMSG_NOTIFY\n");
6733b39a
JK		 1892 dmsg = (struct dmsg_cqe *)sol;
1893 hwi_complete_drvr_msgs(beiscsi_conn, phba, sol);
1894 break;
1895 case UNSOL_HDR_NOTIFY:
bfead3b2
JK		 1896 SE_DEBUG(DBG_LVL_8, "Received UNSOL_HDR_ NOTIFY\n");
1897 hwi_process_default_pdu_ring(beiscsi_conn, phba,
1898 (struct i_t_dpdu_cqe *)sol);
1899 break;
6733b39a 1900 case UNSOL_DATA_NOTIFY:
bfead3b2 1901 SE_DEBUG(DBG_LVL_8, "Received UNSOL_DATA_NOTIFY\n");
6733b39a
JK		 1902 hwi_process_default_pdu_ring(beiscsi_conn, phba,
1903 (struct i_t_dpdu_cqe *)sol);
1904 break;
1905 case CXN_INVALIDATE_INDEX_NOTIFY:
1906 case CMD_INVALIDATED_NOTIFY:
1907 case CXN_INVALIDATE_NOTIFY:
1908 SE_DEBUG(DBG_LVL_1,
1909 "Ignoring CQ Error notification for cmd/cxn"
1910 "invalidate\n");
1911 break;
1912 case SOL_CMD_KILLED_DATA_DIGEST_ERR:
1913 case CMD_KILLED_INVALID_STATSN_RCVD:
1914 case CMD_KILLED_INVALID_R2T_RCVD:
1915 case CMD_CXN_KILLED_LUN_INVALID:
1916 case CMD_CXN_KILLED_ICD_INVALID:
1917 case CMD_CXN_KILLED_ITT_INVALID:
1918 case CMD_CXN_KILLED_SEQ_OUTOFORDER:
1919 case CMD_CXN_KILLED_INVALID_DATASN_RCVD:
32951dd8 1920 SE_DEBUG(DBG_LVL_1,
6733b39a
JK		 1921 "CQ Error notification for cmd.. "
1922 "code %d cid 0x%x\n",
1923 sol->dw[offsetof(struct amap_sol_cqe, code) /
1924 32] & CQE_CODE_MASK,
1925 (sol->dw[offsetof(struct amap_sol_cqe, cid) /
1926 32] & SOL_CID_MASK));
1927 break;
1928 case UNSOL_DATA_DIGEST_ERROR_NOTIFY:
1929 SE_DEBUG(DBG_LVL_1,
1930 "Digest error on def pdu ring, dropping..\n");
1931 hwi_flush_default_pdu_buffer(phba, beiscsi_conn,
1932 (struct i_t_dpdu_cqe *) sol);
1933 break;
1934 case CXN_KILLED_PDU_SIZE_EXCEEDS_DSL:
1935 case CXN_KILLED_BURST_LEN_MISMATCH:
1936 case CXN_KILLED_AHS_RCVD:
1937 case CXN_KILLED_HDR_DIGEST_ERR:
1938 case CXN_KILLED_UNKNOWN_HDR:
1939 case CXN_KILLED_STALE_ITT_TTT_RCVD:
1940 case CXN_KILLED_INVALID_ITT_TTT_RCVD:
1941 case CXN_KILLED_TIMED_OUT:
1942 case CXN_KILLED_FIN_RCVD:
1943 case CXN_KILLED_BAD_UNSOL_PDU_RCVD:
1944 case CXN_KILLED_BAD_WRB_INDEX_ERROR:
1945 case CXN_KILLED_OVER_RUN_RESIDUAL:
1946 case CXN_KILLED_UNDER_RUN_RESIDUAL:
1947 case CXN_KILLED_CMND_DATA_NOT_ON_SAME_CONN:
32951dd8 1948 SE_DEBUG(DBG_LVL_1, "CQ Error %d, reset CID "
6733b39a
JK		 1949 "0x%x...\n",
1950 sol->dw[offsetof(struct amap_sol_cqe, code) /
1951 32] & CQE_CODE_MASK,
7da50879
JK		 1952 (sol->dw[offsetof(struct amap_sol_cqe, cid) /
1953 32] & CQE_CID_MASK));
6733b39a
JK		 1954 iscsi_conn_failure(beiscsi_conn->conn,
1955 ISCSI_ERR_CONN_FAILED);
1956 break;
1957 case CXN_KILLED_RST_SENT:
1958 case CXN_KILLED_RST_RCVD:
32951dd8 1959 SE_DEBUG(DBG_LVL_1, "CQ Error %d, reset"
bfead3b2 1960 "received/sent on CID 0x%x...\n",
6733b39a
JK		 1961 sol->dw[offsetof(struct amap_sol_cqe, code) /
1962 32] & CQE_CODE_MASK,
7da50879
JK		 1963 (sol->dw[offsetof(struct amap_sol_cqe, cid) /
1964 32] & CQE_CID_MASK));
6733b39a
JK		 1965 iscsi_conn_failure(beiscsi_conn->conn,
1966 ISCSI_ERR_CONN_FAILED);
1967 break;
1968 default:
1969 SE_DEBUG(DBG_LVL_1, "CQ Error Invalid code= %d "
1970 "received on CID 0x%x...\n",
1971 sol->dw[offsetof(struct amap_sol_cqe, code) /
1972 32] & CQE_CODE_MASK,
7da50879
JK		 1973 (sol->dw[offsetof(struct amap_sol_cqe, cid) /
1974 32] & CQE_CID_MASK));
6733b39a
JK		 1975 break;
1976 }
1977
1978 AMAP_SET_BITS(struct amap_sol_cqe, valid, sol, 0);
1979 queue_tail_inc(cq);
1980 sol = queue_tail_node(cq);
1981 num_processed++;
1982 }
1983
1984 if (num_processed > 0) {
1985 tot_nump += num_processed;
bfead3b2 1986 hwi_ring_cq_db(phba, cq->id, num_processed, 1, 0);
6733b39a
JK		 1987 }
1988 return tot_nump;
1989}
1990
756d29c8 1991void beiscsi_process_all_cqs(struct work_struct *work)
6733b39a
JK		 1992{
1993 unsigned long flags;
bfead3b2
JK		 1994 struct hwi_controller *phwi_ctrlr;
1995 struct hwi_context_memory *phwi_context;
1996 struct be_eq_obj *pbe_eq;
6733b39a
JK		 1997 struct beiscsi_hba *phba =
1998 container_of(work, struct beiscsi_hba, work_cqs);
1999
bfead3b2
JK		 2000 phwi_ctrlr = phba->phwi_ctrlr;
2001 phwi_context = phwi_ctrlr->phwi_ctxt;
2002 if (phba->msix_enabled)
2003 pbe_eq = &phwi_context->be_eq[phba->num_cpus];
2004 else
2005 pbe_eq = &phwi_context->be_eq[0];
2006
6733b39a
JK		 2007 if (phba->todo_mcc_cq) {
2008 spin_lock_irqsave(&phba->isr_lock, flags);
2009 phba->todo_mcc_cq = 0;
2010 spin_unlock_irqrestore(&phba->isr_lock, flags);
756d29c8 2011 beiscsi_process_mcc_isr(phba);
6733b39a
JK		 2012 }
2013
2014 if (phba->todo_cq) {
2015 spin_lock_irqsave(&phba->isr_lock, flags);
2016 phba->todo_cq = 0;
2017 spin_unlock_irqrestore(&phba->isr_lock, flags);
bfead3b2 2018 beiscsi_process_cq(pbe_eq);
6733b39a
JK		 2019 }
2020}
2021
2022static int be_iopoll(struct blk_iopoll *iop, int budget)
2023{
2024 static unsigned int ret;
2025 struct beiscsi_hba *phba;
bfead3b2 2026 struct be_eq_obj *pbe_eq;
6733b39a 2027
bfead3b2
JK		 2028 pbe_eq = container_of(iop, struct be_eq_obj, iopoll);
2029 ret = beiscsi_process_cq(pbe_eq);
6733b39a 2030 if (ret < budget) {
bfead3b2 2031 phba = pbe_eq->phba;
6733b39a 2032 blk_iopoll_complete(iop);
bfead3b2
JK		 2033 SE_DEBUG(DBG_LVL_8, "rearm pbe_eq->q.id =%d\n", pbe_eq->q.id);
2034 hwi_ring_eq_db(phba, pbe_eq->q.id, 0, 0, 1, 1);
6733b39a
JK		 2035 }
2036 return ret;
2037}
2038
2039static void
2040hwi_write_sgl(struct iscsi_wrb *pwrb, struct scatterlist *sg,
2041 unsigned int num_sg, struct beiscsi_io_task *io_task)
2042{
2043 struct iscsi_sge *psgl;
58ff4bd0 2044 unsigned int sg_len, index;
6733b39a
JK		 2045 unsigned int sge_len = 0;
2046 unsigned long long addr;
2047 struct scatterlist *l_sg;
2048 unsigned int offset;
2049
2050 AMAP_SET_BITS(struct amap_iscsi_wrb, iscsi_bhs_addr_lo, pwrb,
2051 io_task->bhs_pa.u.a32.address_lo);
2052 AMAP_SET_BITS(struct amap_iscsi_wrb, iscsi_bhs_addr_hi, pwrb,
2053 io_task->bhs_pa.u.a32.address_hi);
2054
2055 l_sg = sg;
48bd86cf
JK		 2056 for (index = 0; (index < num_sg) && (index < 2); index++,
2057 sg = sg_next(sg)) {
6733b39a
JK		 2058 if (index == 0) {
2059 sg_len = sg_dma_len(sg);
2060 addr = (u64) sg_dma_address(sg);
2061 AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_addr_lo, pwrb,
457ff3b7 2062 ((u32)(addr & 0xFFFFFFFF)));
6733b39a 2063 AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_addr_hi, pwrb,
457ff3b7 2064 ((u32)(addr >> 32)));
6733b39a
JK		 2065 AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_len, pwrb,
2066 sg_len);
2067 sge_len = sg_len;
6733b39a 2068 } else {
6733b39a
JK		 2069 AMAP_SET_BITS(struct amap_iscsi_wrb, sge1_r2t_offset,
2070 pwrb, sge_len);
2071 sg_len = sg_dma_len(sg);
2072 addr = (u64) sg_dma_address(sg);
2073 AMAP_SET_BITS(struct amap_iscsi_wrb, sge1_addr_lo, pwrb,
457ff3b7 2074 ((u32)(addr & 0xFFFFFFFF)));
6733b39a 2075 AMAP_SET_BITS(struct amap_iscsi_wrb, sge1_addr_hi, pwrb,
457ff3b7 2076 ((u32)(addr >> 32)));
6733b39a
JK		 2077 AMAP_SET_BITS(struct amap_iscsi_wrb, sge1_len, pwrb,
2078 sg_len);
2079 }
2080 }
2081 psgl = (struct iscsi_sge *)io_task->psgl_handle->pfrag;
2082 memset(psgl, 0, sizeof(*psgl) * BE2_SGE);
2083
2084 AMAP_SET_BITS(struct amap_iscsi_sge, len, psgl, io_task->bhs_len - 2);
2085
2086 AMAP_SET_BITS(struct amap_iscsi_sge, addr_hi, psgl,
2087 io_task->bhs_pa.u.a32.address_hi);
2088 AMAP_SET_BITS(struct amap_iscsi_sge, addr_lo, psgl,
2089 io_task->bhs_pa.u.a32.address_lo);
2090
caf818f1
JK		 2091 if (num_sg == 1) {
2092 AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_last, pwrb,
2093 1);
2094 AMAP_SET_BITS(struct amap_iscsi_wrb, sge1_last, pwrb,
2095 0);
2096 } else if (num_sg == 2) {
2097 AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_last, pwrb,
2098 0);
2099 AMAP_SET_BITS(struct amap_iscsi_wrb, sge1_last, pwrb,
2100 1);
2101 } else {
2102 AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_last, pwrb,
2103 0);
2104 AMAP_SET_BITS(struct amap_iscsi_wrb, sge1_last, pwrb,
2105 0);
2106 }
6733b39a
JK		 2107 sg = l_sg;
2108 psgl++;
2109 psgl++;
2110 offset = 0;
48bd86cf 2111 for (index = 0; index < num_sg; index++, sg = sg_next(sg), psgl++) {
6733b39a
JK		 2112 sg_len = sg_dma_len(sg);
2113 addr = (u64) sg_dma_address(sg);
2114 AMAP_SET_BITS(struct amap_iscsi_sge, addr_lo, psgl,
2115 (addr & 0xFFFFFFFF));
2116 AMAP_SET_BITS(struct amap_iscsi_sge, addr_hi, psgl,
2117 (addr >> 32));
2118 AMAP_SET_BITS(struct amap_iscsi_sge, len, psgl, sg_len);
2119 AMAP_SET_BITS(struct amap_iscsi_sge, sge_offset, psgl, offset);
2120 AMAP_SET_BITS(struct amap_iscsi_sge, last_sge, psgl, 0);
2121 offset += sg_len;
2122 }
2123 psgl--;
2124 AMAP_SET_BITS(struct amap_iscsi_sge, last_sge, psgl, 1);
2125}
2126
2127static void hwi_write_buffer(struct iscsi_wrb *pwrb, struct iscsi_task *task)
2128{
2129 struct iscsi_sge *psgl;
2130 unsigned long long addr;
2131 struct beiscsi_io_task *io_task = task->dd_data;
2132 struct beiscsi_conn *beiscsi_conn = io_task->conn;
2133 struct beiscsi_hba *phba = beiscsi_conn->phba;
2134
2135 io_task->bhs_len = sizeof(struct be_nonio_bhs) - 2;
2136 AMAP_SET_BITS(struct amap_iscsi_wrb, iscsi_bhs_addr_lo, pwrb,
2137 io_task->bhs_pa.u.a32.address_lo);
2138 AMAP_SET_BITS(struct amap_iscsi_wrb, iscsi_bhs_addr_hi, pwrb,
2139 io_task->bhs_pa.u.a32.address_hi);
2140
2141 if (task->data) {
2142 if (task->data_count) {
2143 AMAP_SET_BITS(struct amap_iscsi_wrb, dsp, pwrb, 1);
2144 addr = (u64) pci_map_single(phba->pcidev,
2145 task->data,
2146 task->data_count, 1);
2147 } else {
2148 AMAP_SET_BITS(struct amap_iscsi_wrb, dsp, pwrb, 0);
2149 addr = 0;
2150 }
2151 AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_addr_lo, pwrb,
457ff3b7 2152 ((u32)(addr & 0xFFFFFFFF)));
6733b39a 2153 AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_addr_hi, pwrb,
457ff3b7 2154 ((u32)(addr >> 32)));
6733b39a
JK		 2155 AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_len, pwrb,
2156 task->data_count);
2157
2158 AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_last, pwrb, 1);
2159 } else {
2160 AMAP_SET_BITS(struct amap_iscsi_wrb, dsp, pwrb, 0);
2161 addr = 0;
2162 }
2163
2164 psgl = (struct iscsi_sge *)io_task->psgl_handle->pfrag;
2165
2166 AMAP_SET_BITS(struct amap_iscsi_sge, len, psgl, io_task->bhs_len);
2167
2168 AMAP_SET_BITS(struct amap_iscsi_sge, addr_hi, psgl,
2169 io_task->bhs_pa.u.a32.address_hi);
2170 AMAP_SET_BITS(struct amap_iscsi_sge, addr_lo, psgl,
2171 io_task->bhs_pa.u.a32.address_lo);
2172 if (task->data) {
2173 psgl++;
2174 AMAP_SET_BITS(struct amap_iscsi_sge, addr_hi, psgl, 0);
2175 AMAP_SET_BITS(struct amap_iscsi_sge, addr_lo, psgl, 0);
2176 AMAP_SET_BITS(struct amap_iscsi_sge, len, psgl, 0);
2177 AMAP_SET_BITS(struct amap_iscsi_sge, sge_offset, psgl, 0);
2178 AMAP_SET_BITS(struct amap_iscsi_sge, rsvd0, psgl, 0);
2179 AMAP_SET_BITS(struct amap_iscsi_sge, last_sge, psgl, 0);
2180
2181 psgl++;
2182 if (task->data) {
2183 AMAP_SET_BITS(struct amap_iscsi_sge, addr_lo, psgl,
457ff3b7 2184 ((u32)(addr & 0xFFFFFFFF)));
6733b39a 2185 AMAP_SET_BITS(struct amap_iscsi_sge, addr_hi, psgl,
457ff3b7 2186 ((u32)(addr >> 32)));
6733b39a
JK		 2187 }
2188 AMAP_SET_BITS(struct amap_iscsi_sge, len, psgl, 0x106);
2189 }
2190 AMAP_SET_BITS(struct amap_iscsi_sge, last_sge, psgl, 1);
2191}
2192
2193static void beiscsi_find_mem_req(struct beiscsi_hba *phba)
2194{
bfead3b2 2195 unsigned int num_cq_pages, num_async_pdu_buf_pages;
6733b39a
JK		 2196 unsigned int num_async_pdu_data_pages, wrb_sz_per_cxn;
2197 unsigned int num_async_pdu_buf_sgl_pages, num_async_pdu_data_sgl_pages;
2198
2199 num_cq_pages = PAGES_REQUIRED(phba->params.num_cq_entries * \
2200 sizeof(struct sol_cqe));
6733b39a
JK		 2201 num_async_pdu_buf_pages =
2202 PAGES_REQUIRED(phba->params.asyncpdus_per_ctrl * \
2203 phba->params.defpdu_hdr_sz);
2204 num_async_pdu_buf_sgl_pages =
2205 PAGES_REQUIRED(phba->params.asyncpdus_per_ctrl * \
2206 sizeof(struct phys_addr));
2207 num_async_pdu_data_pages =
2208 PAGES_REQUIRED(phba->params.asyncpdus_per_ctrl * \
2209 phba->params.defpdu_data_sz);
2210 num_async_pdu_data_sgl_pages =
2211 PAGES_REQUIRED(phba->params.asyncpdus_per_ctrl * \
2212 sizeof(struct phys_addr));
2213
2214 phba->params.hwi_ws_sz = sizeof(struct hwi_controller);
2215
2216 phba->mem_req[ISCSI_MEM_GLOBAL_HEADER] = 2 *
2217 BE_ISCSI_PDU_HEADER_SIZE;
2218 phba->mem_req[HWI_MEM_ADDN_CONTEXT] =
2219 sizeof(struct hwi_context_memory);
2220
6733b39a
JK		 2221
2222 phba->mem_req[HWI_MEM_WRB] = sizeof(struct iscsi_wrb)
2223 * (phba->params.wrbs_per_cxn)
2224 * phba->params.cxns_per_ctrl;
2225 wrb_sz_per_cxn = sizeof(struct wrb_handle) *
2226 (phba->params.wrbs_per_cxn);
2227 phba->mem_req[HWI_MEM_WRBH] = roundup_pow_of_two((wrb_sz_per_cxn) *
2228 phba->params.cxns_per_ctrl);
2229
2230 phba->mem_req[HWI_MEM_SGLH] = sizeof(struct sgl_handle) *
2231 phba->params.icds_per_ctrl;
2232 phba->mem_req[HWI_MEM_SGE] = sizeof(struct iscsi_sge) *
2233 phba->params.num_sge_per_io * phba->params.icds_per_ctrl;
2234
2235 phba->mem_req[HWI_MEM_ASYNC_HEADER_BUF] =
2236 num_async_pdu_buf_pages * PAGE_SIZE;
2237 phba->mem_req[HWI_MEM_ASYNC_DATA_BUF] =
2238 num_async_pdu_data_pages * PAGE_SIZE;
2239 phba->mem_req[HWI_MEM_ASYNC_HEADER_RING] =
2240 num_async_pdu_buf_sgl_pages * PAGE_SIZE;
2241 phba->mem_req[HWI_MEM_ASYNC_DATA_RING] =
2242 num_async_pdu_data_sgl_pages * PAGE_SIZE;
2243 phba->mem_req[HWI_MEM_ASYNC_HEADER_HANDLE] =
2244 phba->params.asyncpdus_per_ctrl *
2245 sizeof(struct async_pdu_handle);
2246 phba->mem_req[HWI_MEM_ASYNC_DATA_HANDLE] =
2247 phba->params.asyncpdus_per_ctrl *
2248 sizeof(struct async_pdu_handle);
2249 phba->mem_req[HWI_MEM_ASYNC_PDU_CONTEXT] =
2250 sizeof(struct hwi_async_pdu_context) +
2251 (phba->params.cxns_per_ctrl * sizeof(struct hwi_async_entry));
2252}
2253
2254static int beiscsi_alloc_mem(struct beiscsi_hba *phba)
2255{
2256 struct be_mem_descriptor *mem_descr;
2257 dma_addr_t bus_add;
2258 struct mem_array *mem_arr, *mem_arr_orig;
2259 unsigned int i, j, alloc_size, curr_alloc_size;
2260
2261 phba->phwi_ctrlr = kmalloc(phba->params.hwi_ws_sz, GFP_KERNEL);
2262 if (!phba->phwi_ctrlr)
2263 return -ENOMEM;
2264
2265 phba->init_mem = kcalloc(SE_MEM_MAX, sizeof(*mem_descr),
2266 GFP_KERNEL);
2267 if (!phba->init_mem) {
2268 kfree(phba->phwi_ctrlr);
2269 return -ENOMEM;
2270 }
2271
2272 mem_arr_orig = kmalloc(sizeof(*mem_arr_orig) * BEISCSI_MAX_FRAGS_INIT,
2273 GFP_KERNEL);
2274 if (!mem_arr_orig) {
2275 kfree(phba->init_mem);
2276 kfree(phba->phwi_ctrlr);
2277 return -ENOMEM;
2278 }
2279
2280 mem_descr = phba->init_mem;
2281 for (i = 0; i < SE_MEM_MAX; i++) {
2282 j = 0;
2283 mem_arr = mem_arr_orig;
2284 alloc_size = phba->mem_req[i];
2285 memset(mem_arr, 0, sizeof(struct mem_array) *
2286 BEISCSI_MAX_FRAGS_INIT);
2287 curr_alloc_size = min(be_max_phys_size * 1024, alloc_size);
2288 do {
2289 mem_arr->virtual_address = pci_alloc_consistent(
2290 phba->pcidev,
2291 curr_alloc_size,
2292 &bus_add);
2293 if (!mem_arr->virtual_address) {
2294 if (curr_alloc_size <= BE_MIN_MEM_SIZE)
2295 goto free_mem;
2296 if (curr_alloc_size -
2297 rounddown_pow_of_two(curr_alloc_size))
2298 curr_alloc_size = rounddown_pow_of_two
2299 (curr_alloc_size);
2300 else
2301 curr_alloc_size = curr_alloc_size / 2;
2302 } else {
2303 mem_arr->bus_address.u.
2304 a64.address = (__u64) bus_add;
2305 mem_arr->size = curr_alloc_size;
2306 alloc_size -= curr_alloc_size;
2307 curr_alloc_size = min(be_max_phys_size *
2308 1024, alloc_size);
2309 j++;
2310 mem_arr++;
2311 }
2312 } while (alloc_size);
2313 mem_descr->num_elements = j;
2314 mem_descr->size_in_bytes = phba->mem_req[i];
2315 mem_descr->mem_array = kmalloc(sizeof(*mem_arr) * j,
2316 GFP_KERNEL);
2317 if (!mem_descr->mem_array)
2318 goto free_mem;
2319
2320 memcpy(mem_descr->mem_array, mem_arr_orig,
2321 sizeof(struct mem_array) * j);
2322 mem_descr++;
2323 }
2324 kfree(mem_arr_orig);
2325 return 0;
2326free_mem:
2327 mem_descr->num_elements = j;
2328 while ((i) || (j)) {
2329 for (j = mem_descr->num_elements; j > 0; j--) {
2330 pci_free_consistent(phba->pcidev,
2331 mem_descr->mem_array[j - 1].size,
2332 mem_descr->mem_array[j - 1].
2333 virtual_address,
457ff3b7
JK		 2334 (unsigned long)mem_descr->
2335 mem_array[j - 1].
6733b39a
JK		 2336 bus_address.u.a64.address);
2337 }
2338 if (i) {
2339 i--;
2340 kfree(mem_descr->mem_array);
2341 mem_descr--;
2342 }
2343 }
2344 kfree(mem_arr_orig);
2345 kfree(phba->init_mem);
2346 kfree(phba->phwi_ctrlr);
2347 return -ENOMEM;
2348}
2349
2350static int beiscsi_get_memory(struct beiscsi_hba *phba)
2351{
2352 beiscsi_find_mem_req(phba);
2353 return beiscsi_alloc_mem(phba);
2354}
2355
2356static void iscsi_init_global_templates(struct beiscsi_hba *phba)
2357{
2358 struct pdu_data_out *pdata_out;
2359 struct pdu_nop_out *pnop_out;
2360 struct be_mem_descriptor *mem_descr;
2361
2362 mem_descr = phba->init_mem;
2363 mem_descr += ISCSI_MEM_GLOBAL_HEADER;
2364 pdata_out =
2365 (struct pdu_data_out *)mem_descr->mem_array[0].virtual_address;
2366 memset(pdata_out, 0, BE_ISCSI_PDU_HEADER_SIZE);
2367
2368 AMAP_SET_BITS(struct amap_pdu_data_out, opcode, pdata_out,
2369 IIOC_SCSI_DATA);
2370
2371 pnop_out =
2372 (struct pdu_nop_out *)((unsigned char *)mem_descr->mem_array[0].
2373 virtual_address + BE_ISCSI_PDU_HEADER_SIZE);
2374
2375 memset(pnop_out, 0, BE_ISCSI_PDU_HEADER_SIZE);
2376 AMAP_SET_BITS(struct amap_pdu_nop_out, ttt, pnop_out, 0xFFFFFFFF);
2377 AMAP_SET_BITS(struct amap_pdu_nop_out, f_bit, pnop_out, 1);
2378 AMAP_SET_BITS(struct amap_pdu_nop_out, i_bit, pnop_out, 0);
2379}
2380
2381static void beiscsi_init_wrb_handle(struct beiscsi_hba *phba)
2382{
2383 struct be_mem_descriptor *mem_descr_wrbh, *mem_descr_wrb;
2384 struct wrb_handle *pwrb_handle;
2385 struct hwi_controller *phwi_ctrlr;
2386 struct hwi_wrb_context *pwrb_context;
2387 struct iscsi_wrb *pwrb;
2388 unsigned int num_cxn_wrbh;
2389 unsigned int num_cxn_wrb, j, idx, index;
2390
2391 mem_descr_wrbh = phba->init_mem;
2392 mem_descr_wrbh += HWI_MEM_WRBH;
2393
2394 mem_descr_wrb = phba->init_mem;
2395 mem_descr_wrb += HWI_MEM_WRB;
2396
2397 idx = 0;
2398 pwrb_handle = mem_descr_wrbh->mem_array[idx].virtual_address;
2399 num_cxn_wrbh = ((mem_descr_wrbh->mem_array[idx].size) /
2400 ((sizeof(struct wrb_handle)) *
2401 phba->params.wrbs_per_cxn));
2402 phwi_ctrlr = phba->phwi_ctrlr;
2403
2404 for (index = 0; index < phba->params.cxns_per_ctrl * 2; index += 2) {
2405 pwrb_context = &phwi_ctrlr->wrb_context[index];
6733b39a
JK		 2406 pwrb_context->pwrb_handle_base =
2407 kzalloc(sizeof(struct wrb_handle *) *
2408 phba->params.wrbs_per_cxn, GFP_KERNEL);
2409 pwrb_context->pwrb_handle_basestd =
2410 kzalloc(sizeof(struct wrb_handle *) *
2411 phba->params.wrbs_per_cxn, GFP_KERNEL);
2412 if (num_cxn_wrbh) {
2413 pwrb_context->alloc_index = 0;
2414 pwrb_context->wrb_handles_available = 0;
2415 for (j = 0; j < phba->params.wrbs_per_cxn; j++) {
2416 pwrb_context->pwrb_handle_base[j] = pwrb_handle;
2417 pwrb_context->pwrb_handle_basestd[j] =
2418 pwrb_handle;
2419 pwrb_context->wrb_handles_available++;
bfead3b2 2420 pwrb_handle->wrb_index = j;
6733b39a
JK		 2421 pwrb_handle++;
2422 }
2423 pwrb_context->free_index = 0;
2424 num_cxn_wrbh--;
2425 } else {
2426 idx++;
2427 pwrb_handle =
2428 mem_descr_wrbh->mem_array[idx].virtual_address;
2429 num_cxn_wrbh =
2430 ((mem_descr_wrbh->mem_array[idx].size) /
2431 ((sizeof(struct wrb_handle)) *
2432 phba->params.wrbs_per_cxn));
2433 pwrb_context->alloc_index = 0;
2434 for (j = 0; j < phba->params.wrbs_per_cxn; j++) {
2435 pwrb_context->pwrb_handle_base[j] = pwrb_handle;
2436 pwrb_context->pwrb_handle_basestd[j] =
2437 pwrb_handle;
2438 pwrb_context->wrb_handles_available++;
bfead3b2 2439 pwrb_handle->wrb_index = j;
6733b39a
JK		 2440 pwrb_handle++;
2441 }
2442 pwrb_context->free_index = 0;
2443 num_cxn_wrbh--;
2444 }
2445 }
2446 idx = 0;
2447 pwrb = mem_descr_wrb->mem_array[idx].virtual_address;
7c56533c
JK		 2448 num_cxn_wrb = (mem_descr_wrb->mem_array[idx].size) /
2449 ((sizeof(struct iscsi_wrb) *
2450 phba->params.wrbs_per_cxn));
ed58ea2a 2451 for (index = 0; index < phba->params.cxns_per_ctrl * 2; index += 2) {
6733b39a
JK		 2452 pwrb_context = &phwi_ctrlr->wrb_context[index];
2453 if (num_cxn_wrb) {
2454 for (j = 0; j < phba->params.wrbs_per_cxn; j++) {
2455 pwrb_handle = pwrb_context->pwrb_handle_base[j];
2456 pwrb_handle->pwrb = pwrb;
2457 pwrb++;
2458 }
2459 num_cxn_wrb--;
2460 } else {
2461 idx++;
2462 pwrb = mem_descr_wrb->mem_array[idx].virtual_address;
7c56533c
JK		 2463 num_cxn_wrb = (mem_descr_wrb->mem_array[idx].size) /
2464 ((sizeof(struct iscsi_wrb) *
2465 phba->params.wrbs_per_cxn));
6733b39a
JK		 2466 for (j = 0; j < phba->params.wrbs_per_cxn; j++) {
2467 pwrb_handle = pwrb_context->pwrb_handle_base[j];
2468 pwrb_handle->pwrb = pwrb;
2469 pwrb++;
2470 }
2471 num_cxn_wrb--;
2472 }
2473 }
2474}
2475
2476static void hwi_init_async_pdu_ctx(struct beiscsi_hba *phba)
2477{
2478 struct hwi_controller *phwi_ctrlr;
2479 struct hba_parameters *p = &phba->params;
2480 struct hwi_async_pdu_context *pasync_ctx;
2481 struct async_pdu_handle *pasync_header_h, *pasync_data_h;
2482 unsigned int index;
2483 struct be_mem_descriptor *mem_descr;
2484
2485 mem_descr = (struct be_mem_descriptor *)phba->init_mem;
2486 mem_descr += HWI_MEM_ASYNC_PDU_CONTEXT;
2487
2488 phwi_ctrlr = phba->phwi_ctrlr;
2489 phwi_ctrlr->phwi_ctxt->pasync_ctx = (struct hwi_async_pdu_context *)
2490 mem_descr->mem_array[0].virtual_address;
2491 pasync_ctx = phwi_ctrlr->phwi_ctxt->pasync_ctx;
2492 memset(pasync_ctx, 0, sizeof(*pasync_ctx));
2493
2494 pasync_ctx->async_header.num_entries = p->asyncpdus_per_ctrl;
2495 pasync_ctx->async_header.buffer_size = p->defpdu_hdr_sz;
2496 pasync_ctx->async_data.buffer_size = p->defpdu_data_sz;
2497 pasync_ctx->async_data.num_entries = p->asyncpdus_per_ctrl;
2498
2499 mem_descr = (struct be_mem_descriptor *)phba->init_mem;
2500 mem_descr += HWI_MEM_ASYNC_HEADER_BUF;
2501 if (mem_descr->mem_array[0].virtual_address) {
2502 SE_DEBUG(DBG_LVL_8,
2503 "hwi_init_async_pdu_ctx HWI_MEM_ASYNC_HEADER_BUF"
457ff3b7 2504 "va=%p\n", mem_descr->mem_array[0].virtual_address);
6733b39a
JK		 2505 } else
2506 shost_printk(KERN_WARNING, phba->shost,
457ff3b7 2507 "No Virtual address\n");
6733b39a
JK		 2508
2509 pasync_ctx->async_header.va_base =
2510 mem_descr->mem_array[0].virtual_address;
2511
2512 pasync_ctx->async_header.pa_base.u.a64.address =
2513 mem_descr->mem_array[0].bus_address.u.a64.address;
2514
2515 mem_descr = (struct be_mem_descriptor *)phba->init_mem;
2516 mem_descr += HWI_MEM_ASYNC_HEADER_RING;
2517 if (mem_descr->mem_array[0].virtual_address) {
2518 SE_DEBUG(DBG_LVL_8,
2519 "hwi_init_async_pdu_ctx HWI_MEM_ASYNC_HEADER_RING"
457ff3b7 2520 "va=%p\n", mem_descr->mem_array[0].virtual_address);
6733b39a
JK		 2521 } else
2522 shost_printk(KERN_WARNING, phba->shost,
457ff3b7 2523 "No Virtual address\n");
6733b39a
JK		 2524 pasync_ctx->async_header.ring_base =
2525 mem_descr->mem_array[0].virtual_address;
2526
2527 mem_descr = (struct be_mem_descriptor *)phba->init_mem;
2528 mem_descr += HWI_MEM_ASYNC_HEADER_HANDLE;
2529 if (mem_descr->mem_array[0].virtual_address) {
2530 SE_DEBUG(DBG_LVL_8,
2531 "hwi_init_async_pdu_ctx HWI_MEM_ASYNC_HEADER_HANDLE"
457ff3b7 2532 "va=%p\n", mem_descr->mem_array[0].virtual_address);
6733b39a
JK		 2533 } else
2534 shost_printk(KERN_WARNING, phba->shost,
457ff3b7 2535 "No Virtual address\n");
6733b39a
JK		 2536
2537 pasync_ctx->async_header.handle_base =
2538 mem_descr->mem_array[0].virtual_address;
2539 pasync_ctx->async_header.writables = 0;
2540 INIT_LIST_HEAD(&pasync_ctx->async_header.free_list);
2541
2542 mem_descr = (struct be_mem_descriptor *)phba->init_mem;
2543 mem_descr += HWI_MEM_ASYNC_DATA_BUF;
2544 if (mem_descr->mem_array[0].virtual_address) {
2545 SE_DEBUG(DBG_LVL_8,
2546 "hwi_init_async_pdu_ctx HWI_MEM_ASYNC_DATA_BUF"
457ff3b7 2547 "va=%p\n", mem_descr->mem_array[0].virtual_address);
6733b39a
JK		 2548 } else
2549 shost_printk(KERN_WARNING, phba->shost,
457ff3b7 2550 "No Virtual address\n");
6733b39a
JK		 2551 pasync_ctx->async_data.va_base =
2552 mem_descr->mem_array[0].virtual_address;
2553 pasync_ctx->async_data.pa_base.u.a64.address =
2554 mem_descr->mem_array[0].bus_address.u.a64.address;
2555
2556 mem_descr = (struct be_mem_descriptor *)phba->init_mem;
2557 mem_descr += HWI_MEM_ASYNC_DATA_RING;
2558 if (mem_descr->mem_array[0].virtual_address) {
2559 SE_DEBUG(DBG_LVL_8,
2560 "hwi_init_async_pdu_ctx HWI_MEM_ASYNC_DATA_RING"
457ff3b7 2561 "va=%p\n", mem_descr->mem_array[0].virtual_address);
6733b39a
JK		 2562 } else
2563 shost_printk(KERN_WARNING, phba->shost,
457ff3b7 2564 "No Virtual address\n");
6733b39a
JK		 2565
2566 pasync_ctx->async_data.ring_base =
2567 mem_descr->mem_array[0].virtual_address;
2568
2569 mem_descr = (struct be_mem_descriptor *)phba->init_mem;
2570 mem_descr += HWI_MEM_ASYNC_DATA_HANDLE;
2571 if (!mem_descr->mem_array[0].virtual_address)
2572 shost_printk(KERN_WARNING, phba->shost,
457ff3b7 2573 "No Virtual address\n");
6733b39a
JK		 2574
2575 pasync_ctx->async_data.handle_base =
2576 mem_descr->mem_array[0].virtual_address;
2577 pasync_ctx->async_data.writables = 0;
2578 INIT_LIST_HEAD(&pasync_ctx->async_data.free_list);
2579
2580 pasync_header_h =
2581 (struct async_pdu_handle *)pasync_ctx->async_header.handle_base;
2582 pasync_data_h =
2583 (struct async_pdu_handle *)pasync_ctx->async_data.handle_base;
2584
2585 for (index = 0; index < p->asyncpdus_per_ctrl; index++) {
2586 pasync_header_h->cri = -1;
2587 pasync_header_h->index = (char)index;
2588 INIT_LIST_HEAD(&pasync_header_h->link);
2589 pasync_header_h->pbuffer =
2590 (void *)((unsigned long)
2591 (pasync_ctx->async_header.va_base) +
2592 (p->defpdu_hdr_sz * index));
2593
2594 pasync_header_h->pa.u.a64.address =
2595 pasync_ctx->async_header.pa_base.u.a64.address +
2596 (p->defpdu_hdr_sz * index);
2597
2598 list_add_tail(&pasync_header_h->link,
2599 &pasync_ctx->async_header.free_list);
2600 pasync_header_h++;
2601 pasync_ctx->async_header.free_entries++;
2602 pasync_ctx->async_header.writables++;
2603
2604 INIT_LIST_HEAD(&pasync_ctx->async_entry[index].wait_queue.list);
2605 INIT_LIST_HEAD(&pasync_ctx->async_entry[index].
2606 header_busy_list);
2607 pasync_data_h->cri = -1;
2608 pasync_data_h->index = (char)index;
2609 INIT_LIST_HEAD(&pasync_data_h->link);
2610 pasync_data_h->pbuffer =
2611 (void *)((unsigned long)
2612 (pasync_ctx->async_data.va_base) +
2613 (p->defpdu_data_sz * index));
2614
2615 pasync_data_h->pa.u.a64.address =
2616 pasync_ctx->async_data.pa_base.u.a64.address +
2617 (p->defpdu_data_sz * index);
2618
2619 list_add_tail(&pasync_data_h->link,
2620 &pasync_ctx->async_data.free_list);
2621 pasync_data_h++;
2622 pasync_ctx->async_data.free_entries++;
2623 pasync_ctx->async_data.writables++;
2624
2625 INIT_LIST_HEAD(&pasync_ctx->async_entry[index].data_busy_list);
2626 }
2627
2628 pasync_ctx->async_header.host_write_ptr = 0;
2629 pasync_ctx->async_header.ep_read_ptr = -1;
2630 pasync_ctx->async_data.host_write_ptr = 0;
2631 pasync_ctx->async_data.ep_read_ptr = -1;
2632}
2633
2634static int
2635be_sgl_create_contiguous(void *virtual_address,
2636 u64 physical_address, u32 length,
2637 struct be_dma_mem *sgl)
2638{
2639 WARN_ON(!virtual_address);
2640 WARN_ON(!physical_address);
2641 WARN_ON(!length > 0);
2642 WARN_ON(!sgl);
2643
2644 sgl->va = virtual_address;
457ff3b7 2645 sgl->dma = (unsigned long)physical_address;
6733b39a
JK		 2646 sgl->size = length;
2647
2648 return 0;
2649}
2650
2651static void be_sgl_destroy_contiguous(struct be_dma_mem *sgl)
2652{
2653 memset(sgl, 0, sizeof(*sgl));
2654}
2655
2656static void
2657hwi_build_be_sgl_arr(struct beiscsi_hba *phba,
2658 struct mem_array *pmem, struct be_dma_mem *sgl)
2659{
2660 if (sgl->va)
2661 be_sgl_destroy_contiguous(sgl);
2662
2663 be_sgl_create_contiguous(pmem->virtual_address,
2664 pmem->bus_address.u.a64.address,
2665 pmem->size, sgl);
2666}
2667
2668static void
2669hwi_build_be_sgl_by_offset(struct beiscsi_hba *phba,
2670 struct mem_array *pmem, struct be_dma_mem *sgl)
2671{
2672 if (sgl->va)
2673 be_sgl_destroy_contiguous(sgl);
2674
2675 be_sgl_create_contiguous((unsigned char *)pmem->virtual_address,
2676 pmem->bus_address.u.a64.address,
2677 pmem->size, sgl);
2678}
2679
2680static int be_fill_queue(struct be_queue_info *q,
2681 u16 len, u16 entry_size, void *vaddress)
2682{
2683 struct be_dma_mem *mem = &q->dma_mem;
2684
2685 memset(q, 0, sizeof(*q));
2686 q->len = len;
2687 q->entry_size = entry_size;
2688 mem->size = len * entry_size;
2689 mem->va = vaddress;
2690 if (!mem->va)
2691 return -ENOMEM;
2692 memset(mem->va, 0, mem->size);
2693 return 0;
2694}
2695
bfead3b2 2696static int beiscsi_create_eqs(struct beiscsi_hba *phba,
6733b39a
JK		 2697 struct hwi_context_memory *phwi_context)
2698{
bfead3b2
JK		 2699 unsigned int i, num_eq_pages;
2700 int ret, eq_for_mcc;
6733b39a
JK		 2701 struct be_queue_info *eq;
2702 struct be_dma_mem *mem;
6733b39a 2703 void *eq_vaddress;
bfead3b2 2704 dma_addr_t paddr;
6733b39a 2705
bfead3b2
JK		 2706 num_eq_pages = PAGES_REQUIRED(phba->params.num_eq_entries * \
2707 sizeof(struct be_eq_entry));
6733b39a 2708
bfead3b2
JK		 2709 if (phba->msix_enabled)
2710 eq_for_mcc = 1;
2711 else
2712 eq_for_mcc = 0;
2713 for (i = 0; i < (phba->num_cpus + eq_for_mcc); i++) {
2714 eq = &phwi_context->be_eq[i].q;
2715 mem = &eq->dma_mem;
2716 phwi_context->be_eq[i].phba = phba;
2717 eq_vaddress = pci_alloc_consistent(phba->pcidev,
2718 num_eq_pages * PAGE_SIZE,
2719 &paddr);
2720 if (!eq_vaddress)
2721 goto create_eq_error;
2722
2723 mem->va = eq_vaddress;
2724 ret = be_fill_queue(eq, phba->params.num_eq_entries,
2725 sizeof(struct be_eq_entry), eq_vaddress);
2726 if (ret) {
2727 shost_printk(KERN_ERR, phba->shost,
457ff3b7 2728 "be_fill_queue Failed for EQ\n");
bfead3b2
JK		 2729 goto create_eq_error;
2730 }
6733b39a 2731
bfead3b2
JK		 2732 mem->dma = paddr;
2733 ret = beiscsi_cmd_eq_create(&phba->ctrl, eq,
2734 phwi_context->cur_eqd);
2735 if (ret) {
2736 shost_printk(KERN_ERR, phba->shost,
2737 "beiscsi_cmd_eq_create"
457ff3b7 2738 "Failedfor EQ\n");
bfead3b2
JK		 2739 goto create_eq_error;
2740 }
2741 SE_DEBUG(DBG_LVL_8, "eqid = %d\n", phwi_context->be_eq[i].q.id);
6733b39a 2742 }
6733b39a 2743 return 0;
bfead3b2
JK		 2744create_eq_error:
2745 for (i = 0; i < (phba->num_cpus + 1); i++) {
2746 eq = &phwi_context->be_eq[i].q;
2747 mem = &eq->dma_mem;
2748 if (mem->va)
2749 pci_free_consistent(phba->pcidev, num_eq_pages
2750 * PAGE_SIZE,
2751 mem->va, mem->dma);
2752 }
2753 return ret;
6733b39a
JK		 2754}
2755
bfead3b2 2756static int beiscsi_create_cqs(struct beiscsi_hba *phba,
6733b39a
JK		 2757 struct hwi_context_memory *phwi_context)
2758{
bfead3b2 2759 unsigned int i, num_cq_pages;
6733b39a
JK		 2760 int ret;
2761 struct be_queue_info *cq, *eq;
2762 struct be_dma_mem *mem;
bfead3b2 2763 struct be_eq_obj *pbe_eq;
6733b39a 2764 void *cq_vaddress;
bfead3b2 2765 dma_addr_t paddr;
6733b39a 2766
bfead3b2
JK		 2767 num_cq_pages = PAGES_REQUIRED(phba->params.num_cq_entries * \
2768 sizeof(struct sol_cqe));
6733b39a 2769
bfead3b2
JK		 2770 for (i = 0; i < phba->num_cpus; i++) {
2771 cq = &phwi_context->be_cq[i];
2772 eq = &phwi_context->be_eq[i].q;
2773 pbe_eq = &phwi_context->be_eq[i];
2774 pbe_eq->cq = cq;
2775 pbe_eq->phba = phba;
2776 mem = &cq->dma_mem;
2777 cq_vaddress = pci_alloc_consistent(phba->pcidev,
2778 num_cq_pages * PAGE_SIZE,
2779 &paddr);
2780 if (!cq_vaddress)
2781 goto create_cq_error;
7da50879 2782 ret = be_fill_queue(cq, phba->params.num_cq_entries,
bfead3b2
JK		 2783 sizeof(struct sol_cqe), cq_vaddress);
2784 if (ret) {
2785 shost_printk(KERN_ERR, phba->shost,
457ff3b7 2786 "be_fill_queue Failed for ISCSI CQ\n");
bfead3b2
JK		 2787 goto create_cq_error;
2788 }
2789
2790 mem->dma = paddr;
2791 ret = beiscsi_cmd_cq_create(&phba->ctrl, cq, eq, false,
2792 false, 0);
2793 if (ret) {
2794 shost_printk(KERN_ERR, phba->shost,
2795 "beiscsi_cmd_eq_create"
457ff3b7 2796 "Failed for ISCSI CQ\n");
bfead3b2
JK		 2797 goto create_cq_error;
2798 }
2799 SE_DEBUG(DBG_LVL_8, "iscsi cq_id is %d for eq_id %d\n",
2800 cq->id, eq->id);
2801 SE_DEBUG(DBG_LVL_8, "ISCSI CQ CREATED\n");
6733b39a 2802 }
6733b39a 2803 return 0;
bfead3b2
JK		 2804
2805create_cq_error:
2806 for (i = 0; i < phba->num_cpus; i++) {
2807 cq = &phwi_context->be_cq[i];
2808 mem = &cq->dma_mem;
2809 if (mem->va)
2810 pci_free_consistent(phba->pcidev, num_cq_pages
2811 * PAGE_SIZE,
2812 mem->va, mem->dma);
2813 }
2814 return ret;
2815
6733b39a
JK		 2816}
2817
2818static int
2819beiscsi_create_def_hdr(struct beiscsi_hba *phba,
2820 struct hwi_context_memory *phwi_context,
2821 struct hwi_controller *phwi_ctrlr,
2822 unsigned int def_pdu_ring_sz)
2823{
2824 unsigned int idx;
2825 int ret;
2826 struct be_queue_info *dq, *cq;
2827 struct be_dma_mem *mem;
2828 struct be_mem_descriptor *mem_descr;
2829 void *dq_vaddress;
2830
2831 idx = 0;
2832 dq = &phwi_context->be_def_hdrq;
bfead3b2 2833 cq = &phwi_context->be_cq[0];
6733b39a
JK		 2834 mem = &dq->dma_mem;
2835 mem_descr = phba->init_mem;
2836 mem_descr += HWI_MEM_ASYNC_HEADER_RING;
2837 dq_vaddress = mem_descr->mem_array[idx].virtual_address;
2838 ret = be_fill_queue(dq, mem_descr->mem_array[0].size /
2839 sizeof(struct phys_addr),
2840 sizeof(struct phys_addr), dq_vaddress);
2841 if (ret) {
2842 shost_printk(KERN_ERR, phba->shost,
2843 "be_fill_queue Failed for DEF PDU HDR\n");
2844 return ret;
2845 }
457ff3b7
JK		 2846 mem->dma = (unsigned long)mem_descr->mem_array[idx].
2847 bus_address.u.a64.address;
6733b39a
JK		 2848 ret = be_cmd_create_default_pdu_queue(&phba->ctrl, cq, dq,
2849 def_pdu_ring_sz,
2850 phba->params.defpdu_hdr_sz);
2851 if (ret) {
2852 shost_printk(KERN_ERR, phba->shost,
2853 "be_cmd_create_default_pdu_queue Failed DEFHDR\n");
2854 return ret;
2855 }
2856 phwi_ctrlr->default_pdu_hdr.id = phwi_context->be_def_hdrq.id;
2857 SE_DEBUG(DBG_LVL_8, "iscsi def pdu id is %d\n",
2858 phwi_context->be_def_hdrq.id);
2859 hwi_post_async_buffers(phba, 1);
2860 return 0;
2861}
2862
2863static int
2864beiscsi_create_def_data(struct beiscsi_hba *phba,
2865 struct hwi_context_memory *phwi_context,
2866 struct hwi_controller *phwi_ctrlr,
2867 unsigned int def_pdu_ring_sz)
2868{
2869 unsigned int idx;
2870 int ret;
2871 struct be_queue_info *dataq, *cq;
2872 struct be_dma_mem *mem;
2873 struct be_mem_descriptor *mem_descr;
2874 void *dq_vaddress;
2875
2876 idx = 0;
2877 dataq = &phwi_context->be_def_dataq;
bfead3b2 2878 cq = &phwi_context->be_cq[0];
6733b39a
JK		 2879 mem = &dataq->dma_mem;
2880 mem_descr = phba->init_mem;
2881 mem_descr += HWI_MEM_ASYNC_DATA_RING;
2882 dq_vaddress = mem_descr->mem_array[idx].virtual_address;
2883 ret = be_fill_queue(dataq, mem_descr->mem_array[0].size /
2884 sizeof(struct phys_addr),
2885 sizeof(struct phys_addr), dq_vaddress);
2886 if (ret) {
2887 shost_printk(KERN_ERR, phba->shost,
2888 "be_fill_queue Failed for DEF PDU DATA\n");
2889 return ret;
2890 }
457ff3b7
JK		 2891 mem->dma = (unsigned long)mem_descr->mem_array[idx].
2892 bus_address.u.a64.address;
6733b39a
JK		 2893 ret = be_cmd_create_default_pdu_queue(&phba->ctrl, cq, dataq,
2894 def_pdu_ring_sz,
2895 phba->params.defpdu_data_sz);
2896 if (ret) {
2897 shost_printk(KERN_ERR, phba->shost,
2898 "be_cmd_create_default_pdu_queue Failed"
2899 " for DEF PDU DATA\n");
2900 return ret;
2901 }
2902 phwi_ctrlr->default_pdu_data.id = phwi_context->be_def_dataq.id;
2903 SE_DEBUG(DBG_LVL_8, "iscsi def data id is %d\n",
2904 phwi_context->be_def_dataq.id);
2905 hwi_post_async_buffers(phba, 0);
457ff3b7 2906 SE_DEBUG(DBG_LVL_8, "DEFAULT PDU DATA RING CREATED\n");
6733b39a
JK		 2907 return 0;
2908}
2909
2910static int
2911beiscsi_post_pages(struct beiscsi_hba *phba)
2912{
2913 struct be_mem_descriptor *mem_descr;
2914 struct mem_array *pm_arr;
2915 unsigned int page_offset, i;
2916 struct be_dma_mem sgl;
2917 int status;
2918
2919 mem_descr = phba->init_mem;
2920 mem_descr += HWI_MEM_SGE;
2921 pm_arr = mem_descr->mem_array;
2922
2923 page_offset = (sizeof(struct iscsi_sge) * phba->params.num_sge_per_io *
2924 phba->fw_config.iscsi_icd_start) / PAGE_SIZE;
2925 for (i = 0; i < mem_descr->num_elements; i++) {
2926 hwi_build_be_sgl_arr(phba, pm_arr, &sgl);
2927 status = be_cmd_iscsi_post_sgl_pages(&phba->ctrl, &sgl,
2928 page_offset,
2929 (pm_arr->size / PAGE_SIZE));
2930 page_offset += pm_arr->size / PAGE_SIZE;
2931 if (status != 0) {
2932 shost_printk(KERN_ERR, phba->shost,
2933 "post sgl failed.\n");
2934 return status;
2935 }
2936 pm_arr++;
2937 }
457ff3b7 2938 SE_DEBUG(DBG_LVL_8, "POSTED PAGES\n");
6733b39a
JK		 2939 return 0;
2940}
2941
bfead3b2
JK		 2942static void be_queue_free(struct beiscsi_hba *phba, struct be_queue_info *q)
2943{
2944 struct be_dma_mem *mem = &q->dma_mem;
2945 if (mem->va)
2946 pci_free_consistent(phba->pcidev, mem->size,
2947 mem->va, mem->dma);
2948}
2949
2950static int be_queue_alloc(struct beiscsi_hba *phba, struct be_queue_info *q,
2951 u16 len, u16 entry_size)
2952{
2953 struct be_dma_mem *mem = &q->dma_mem;
2954
2955 memset(q, 0, sizeof(*q));
2956 q->len = len;
2957 q->entry_size = entry_size;
2958 mem->size = len * entry_size;
2959 mem->va = pci_alloc_consistent(phba->pcidev, mem->size, &mem->dma);
2960 if (!mem->va)
d3ad2bb3 2961 return -ENOMEM;
bfead3b2
JK		 2962 memset(mem->va, 0, mem->size);
2963 return 0;
2964}
2965
6733b39a
JK		 2966static int
2967beiscsi_create_wrb_rings(struct beiscsi_hba *phba,
2968 struct hwi_context_memory *phwi_context,
2969 struct hwi_controller *phwi_ctrlr)
2970{
2971 unsigned int wrb_mem_index, offset, size, num_wrb_rings;
2972 u64 pa_addr_lo;
2973 unsigned int idx, num, i;
2974 struct mem_array *pwrb_arr;
2975 void *wrb_vaddr;
2976 struct be_dma_mem sgl;
2977 struct be_mem_descriptor *mem_descr;
2978 int status;
2979
2980 idx = 0;
2981 mem_descr = phba->init_mem;
2982 mem_descr += HWI_MEM_WRB;
2983 pwrb_arr = kmalloc(sizeof(*pwrb_arr) * phba->params.cxns_per_ctrl,
2984 GFP_KERNEL);
2985 if (!pwrb_arr) {
2986 shost_printk(KERN_ERR, phba->shost,
2987 "Memory alloc failed in create wrb ring.\n");
2988 return -ENOMEM;
2989 }
2990 wrb_vaddr = mem_descr->mem_array[idx].virtual_address;
2991 pa_addr_lo = mem_descr->mem_array[idx].bus_address.u.a64.address;
2992 num_wrb_rings = mem_descr->mem_array[idx].size /
2993 (phba->params.wrbs_per_cxn * sizeof(struct iscsi_wrb));
2994
2995 for (num = 0; num < phba->params.cxns_per_ctrl; num++) {
2996 if (num_wrb_rings) {
2997 pwrb_arr[num].virtual_address = wrb_vaddr;
2998 pwrb_arr[num].bus_address.u.a64.address = pa_addr_lo;
2999 pwrb_arr[num].size = phba->params.wrbs_per_cxn *
3000 sizeof(struct iscsi_wrb);
3001 wrb_vaddr += pwrb_arr[num].size;
3002 pa_addr_lo += pwrb_arr[num].size;
3003 num_wrb_rings--;
3004 } else {
3005 idx++;
3006 wrb_vaddr = mem_descr->mem_array[idx].virtual_address;
3007 pa_addr_lo = mem_descr->mem_array[idx].\
3008 bus_address.u.a64.address;
3009 num_wrb_rings = mem_descr->mem_array[idx].size /
3010 (phba->params.wrbs_per_cxn *
3011 sizeof(struct iscsi_wrb));
3012 pwrb_arr[num].virtual_address = wrb_vaddr;
3013 pwrb_arr[num].bus_address.u.a64.address\
3014 = pa_addr_lo;
3015 pwrb_arr[num].size = phba->params.wrbs_per_cxn *
3016 sizeof(struct iscsi_wrb);
3017 wrb_vaddr += pwrb_arr[num].size;
3018 pa_addr_lo += pwrb_arr[num].size;
3019 num_wrb_rings--;
3020 }
3021 }
3022 for (i = 0; i < phba->params.cxns_per_ctrl; i++) {
3023 wrb_mem_index = 0;
3024 offset = 0;
3025 size = 0;
3026
3027 hwi_build_be_sgl_by_offset(phba, &pwrb_arr[i], &sgl);
3028 status = be_cmd_wrbq_create(&phba->ctrl, &sgl,
3029 &phwi_context->be_wrbq[i]);
3030 if (status != 0) {
3031 shost_printk(KERN_ERR, phba->shost,
3032 "wrbq create failed.");
1462b8ff 3033 kfree(pwrb_arr);
6733b39a
JK		 3034 return status;
3035 }
7da50879
JK		 3036 phwi_ctrlr->wrb_context[i * 2].cid = phwi_context->be_wrbq[i].
3037 id;
6733b39a
JK		 3038 }
3039 kfree(pwrb_arr);
3040 return 0;
3041}
3042
3043static void free_wrb_handles(struct beiscsi_hba *phba)
3044{
3045 unsigned int index;
3046 struct hwi_controller *phwi_ctrlr;
3047 struct hwi_wrb_context *pwrb_context;
3048
3049 phwi_ctrlr = phba->phwi_ctrlr;
3050 for (index = 0; index < phba->params.cxns_per_ctrl * 2; index += 2) {
3051 pwrb_context = &phwi_ctrlr->wrb_context[index];
3052 kfree(pwrb_context->pwrb_handle_base);
3053 kfree(pwrb_context->pwrb_handle_basestd);
3054 }
3055}
3056
bfead3b2
JK		 3057static void be_mcc_queues_destroy(struct beiscsi_hba *phba)
3058{
3059 struct be_queue_info *q;
3060 struct be_ctrl_info *ctrl = &phba->ctrl;
3061
3062 q = &phba->ctrl.mcc_obj.q;
3063 if (q->created)
3064 beiscsi_cmd_q_destroy(ctrl, q, QTYPE_MCCQ);
3065 be_queue_free(phba, q);
3066
3067 q = &phba->ctrl.mcc_obj.cq;
3068 if (q->created)
3069 beiscsi_cmd_q_destroy(ctrl, q, QTYPE_CQ);
3070 be_queue_free(phba, q);
3071}
3072
6733b39a
JK		 3073static void hwi_cleanup(struct beiscsi_hba *phba)
3074{
3075 struct be_queue_info *q;
3076 struct be_ctrl_info *ctrl = &phba->ctrl;
3077 struct hwi_controller *phwi_ctrlr;
3078 struct hwi_context_memory *phwi_context;
bfead3b2 3079 int i, eq_num;
6733b39a
JK		 3080
3081 phwi_ctrlr = phba->phwi_ctrlr;
3082 phwi_context = phwi_ctrlr->phwi_ctxt;
3083 for (i = 0; i < phba->params.cxns_per_ctrl; i++) {
3084 q = &phwi_context->be_wrbq[i];
3085 if (q->created)
3086 beiscsi_cmd_q_destroy(ctrl, q, QTYPE_WRBQ);
3087 }
6733b39a
JK		 3088 free_wrb_handles(phba);
3089
3090 q = &phwi_context->be_def_hdrq;
3091 if (q->created)
3092 beiscsi_cmd_q_destroy(ctrl, q, QTYPE_DPDUQ);
3093
3094 q = &phwi_context->be_def_dataq;
3095 if (q->created)
3096 beiscsi_cmd_q_destroy(ctrl, q, QTYPE_DPDUQ);
3097
3098 beiscsi_cmd_q_destroy(ctrl, NULL, QTYPE_SGL);
3099
bfead3b2
JK		 3100 for (i = 0; i < (phba->num_cpus); i++) {
3101 q = &phwi_context->be_cq[i];
3102 if (q->created)
3103 beiscsi_cmd_q_destroy(ctrl, q, QTYPE_CQ);
3104 }
3105 if (phba->msix_enabled)
3106 eq_num = 1;
3107 else
3108 eq_num = 0;
3109 for (i = 0; i < (phba->num_cpus + eq_num); i++) {
3110 q = &phwi_context->be_eq[i].q;
3111 if (q->created)
3112 beiscsi_cmd_q_destroy(ctrl, q, QTYPE_EQ);
3113 }
3114 be_mcc_queues_destroy(phba);
3115}
6733b39a 3116
bfead3b2
JK		 3117static int be_mcc_queues_create(struct beiscsi_hba *phba,
3118 struct hwi_context_memory *phwi_context)
3119{
3120 struct be_queue_info *q, *cq;
3121 struct be_ctrl_info *ctrl = &phba->ctrl;
3122
3123 /* Alloc MCC compl queue */
3124 cq = &phba->ctrl.mcc_obj.cq;
3125 if (be_queue_alloc(phba, cq, MCC_CQ_LEN,
3126 sizeof(struct be_mcc_compl)))
3127 goto err;
3128 /* Ask BE to create MCC compl queue; */
3129 if (phba->msix_enabled) {
3130 if (beiscsi_cmd_cq_create(ctrl, cq, &phwi_context->be_eq
3131 [phba->num_cpus].q, false, true, 0))
3132 goto mcc_cq_free;
3133 } else {
3134 if (beiscsi_cmd_cq_create(ctrl, cq, &phwi_context->be_eq[0].q,
3135 false, true, 0))
3136 goto mcc_cq_free;
3137 }
3138
3139 /* Alloc MCC queue */
3140 q = &phba->ctrl.mcc_obj.q;
3141 if (be_queue_alloc(phba, q, MCC_Q_LEN, sizeof(struct be_mcc_wrb)))
3142 goto mcc_cq_destroy;
3143
3144 /* Ask BE to create MCC queue */
35e66019 3145 if (beiscsi_cmd_mccq_create(phba, q, cq))
bfead3b2
JK		 3146 goto mcc_q_free;
3147
3148 return 0;
3149
3150mcc_q_free:
3151 be_queue_free(phba, q);
3152mcc_cq_destroy:
3153 beiscsi_cmd_q_destroy(ctrl, cq, QTYPE_CQ);
3154mcc_cq_free:
3155 be_queue_free(phba, cq);
3156err:
d3ad2bb3 3157 return -ENOMEM;
bfead3b2
JK		 3158}
3159
3160static int find_num_cpus(void)
3161{
3162 int num_cpus = 0;
3163
3164 num_cpus = num_online_cpus();
3165 if (num_cpus >= MAX_CPUS)
3166 num_cpus = MAX_CPUS - 1;
3167
457ff3b7 3168 SE_DEBUG(DBG_LVL_8, "num_cpus = %d\n", num_cpus);
bfead3b2 3169 return num_cpus;
6733b39a
JK		 3170}
3171
3172static int hwi_init_port(struct beiscsi_hba *phba)
3173{
3174 struct hwi_controller *phwi_ctrlr;
3175 struct hwi_context_memory *phwi_context;
3176 unsigned int def_pdu_ring_sz;
3177 struct be_ctrl_info *ctrl = &phba->ctrl;
3178 int status;
3179
3180 def_pdu_ring_sz =
3181 phba->params.asyncpdus_per_ctrl * sizeof(struct phys_addr);
3182 phwi_ctrlr = phba->phwi_ctrlr;
6733b39a 3183 phwi_context = phwi_ctrlr->phwi_ctxt;
bfead3b2
JK		 3184 phwi_context->max_eqd = 0;
3185 phwi_context->min_eqd = 0;
3186 phwi_context->cur_eqd = 64;
6733b39a 3187 be_cmd_fw_initialize(&phba->ctrl);
bfead3b2
JK		 3188
3189 status = beiscsi_create_eqs(phba, phwi_context);
6733b39a 3190 if (status != 0) {
457ff3b7 3191 shost_printk(KERN_ERR, phba->shost, "EQ not created\n");
6733b39a
JK		 3192 goto error;
3193 }
3194
bfead3b2
JK		 3195 status = be_mcc_queues_create(phba, phwi_context);
3196 if (status != 0)
3197 goto error;
3198
3199 status = mgmt_check_supported_fw(ctrl, phba);
6733b39a
JK		 3200 if (status != 0) {
3201 shost_printk(KERN_ERR, phba->shost,
457ff3b7 3202 "Unsupported fw version\n");
6733b39a
JK		 3203 goto error;
3204 }
3205
bfead3b2 3206 status = beiscsi_create_cqs(phba, phwi_context);
6733b39a
JK		 3207 if (status != 0) {
3208 shost_printk(KERN_ERR, phba->shost, "CQ not created\n");
3209 goto error;
3210 }
3211
3212 status = beiscsi_create_def_hdr(phba, phwi_context, phwi_ctrlr,
3213 def_pdu_ring_sz);
3214 if (status != 0) {
3215 shost_printk(KERN_ERR, phba->shost,
3216 "Default Header not created\n");
3217 goto error;
3218 }
3219
3220 status = beiscsi_create_def_data(phba, phwi_context,
3221 phwi_ctrlr, def_pdu_ring_sz);
3222 if (status != 0) {
3223 shost_printk(KERN_ERR, phba->shost,
3224 "Default Data not created\n");
3225 goto error;
3226 }
3227
3228 status = beiscsi_post_pages(phba);
3229 if (status != 0) {
3230 shost_printk(KERN_ERR, phba->shost, "Post SGL Pages Failed\n");
3231 goto error;
3232 }
3233
3234 status = beiscsi_create_wrb_rings(phba, phwi_context, phwi_ctrlr);
3235 if (status != 0) {
3236 shost_printk(KERN_ERR, phba->shost,
3237 "WRB Rings not created\n");
3238 goto error;
3239 }
3240
3241 SE_DEBUG(DBG_LVL_8, "hwi_init_port success\n");
3242 return 0;
3243
3244error:
3245 shost_printk(KERN_ERR, phba->shost, "hwi_init_port failed");
3246 hwi_cleanup(phba);
3247 return -ENOMEM;
3248}
3249
6733b39a
JK		 3250static int hwi_init_controller(struct beiscsi_hba *phba)
3251{
3252 struct hwi_controller *phwi_ctrlr;
3253
3254 phwi_ctrlr = phba->phwi_ctrlr;
3255 if (1 == phba->init_mem[HWI_MEM_ADDN_CONTEXT].num_elements) {
3256 phwi_ctrlr->phwi_ctxt = (struct hwi_context_memory *)phba->
3257 init_mem[HWI_MEM_ADDN_CONTEXT].mem_array[0].virtual_address;
457ff3b7 3258 SE_DEBUG(DBG_LVL_8, " phwi_ctrlr->phwi_ctxt=%p\n",
6733b39a
JK		 3259 phwi_ctrlr->phwi_ctxt);
3260 } else {
3261 shost_printk(KERN_ERR, phba->shost,
3262 "HWI_MEM_ADDN_CONTEXT is more than one element."
3263 "Failing to load\n");
3264 return -ENOMEM;
3265 }
3266
3267 iscsi_init_global_templates(phba);
3268 beiscsi_init_wrb_handle(phba);
3269 hwi_init_async_pdu_ctx(phba);
3270 if (hwi_init_port(phba) != 0) {
3271 shost_printk(KERN_ERR, phba->shost,
3272 "hwi_init_controller failed\n");
3273 return -ENOMEM;
3274 }
3275 return 0;
3276}
3277
3278static void beiscsi_free_mem(struct beiscsi_hba *phba)
3279{
3280 struct be_mem_descriptor *mem_descr;
3281 int i, j;
3282
3283 mem_descr = phba->init_mem;
3284 i = 0;
3285 j = 0;
3286 for (i = 0; i < SE_MEM_MAX; i++) {
3287 for (j = mem_descr->num_elements; j > 0; j--) {
3288 pci_free_consistent(phba->pcidev,
3289 mem_descr->mem_array[j - 1].size,
3290 mem_descr->mem_array[j - 1].virtual_address,
457ff3b7
JK		 3291 (unsigned long)mem_descr->mem_array[j - 1].
3292 bus_address.u.a64.address);
6733b39a
JK		 3293 }
3294 kfree(mem_descr->mem_array);
3295 mem_descr++;
3296 }
3297 kfree(phba->init_mem);
3298 kfree(phba->phwi_ctrlr);
3299}
3300
3301static int beiscsi_init_controller(struct beiscsi_hba *phba)
3302{
3303 int ret = -ENOMEM;
3304
3305 ret = beiscsi_get_memory(phba);
3306 if (ret < 0) {
3307 shost_printk(KERN_ERR, phba->shost, "beiscsi_dev_probe -"
457ff3b7 3308 "Failed in beiscsi_alloc_memory\n");
6733b39a
JK		 3309 return ret;
3310 }
3311
3312 ret = hwi_init_controller(phba);
3313 if (ret)
3314 goto free_init;
3315 SE_DEBUG(DBG_LVL_8, "Return success from beiscsi_init_controller");
3316 return 0;
3317
3318free_init:
3319 beiscsi_free_mem(phba);
3320 return -ENOMEM;
3321}
3322
3323static int beiscsi_init_sgl_handle(struct beiscsi_hba *phba)
3324{
3325 struct be_mem_descriptor *mem_descr_sglh, *mem_descr_sg;
3326 struct sgl_handle *psgl_handle;
3327 struct iscsi_sge *pfrag;
3328 unsigned int arr_index, i, idx;
3329
3330 phba->io_sgl_hndl_avbl = 0;
3331 phba->eh_sgl_hndl_avbl = 0;
bfead3b2 3332
6733b39a
JK		 3333 mem_descr_sglh = phba->init_mem;
3334 mem_descr_sglh += HWI_MEM_SGLH;
3335 if (1 == mem_descr_sglh->num_elements) {
3336 phba->io_sgl_hndl_base = kzalloc(sizeof(struct sgl_handle *) *
3337 phba->params.ios_per_ctrl,
3338 GFP_KERNEL);
3339 if (!phba->io_sgl_hndl_base) {
3340 shost_printk(KERN_ERR, phba->shost,
3341 "Mem Alloc Failed. Failing to load\n");
3342 return -ENOMEM;
3343 }
3344 phba->eh_sgl_hndl_base = kzalloc(sizeof(struct sgl_handle *) *
3345 (phba->params.icds_per_ctrl -
3346 phba->params.ios_per_ctrl),
3347 GFP_KERNEL);
3348 if (!phba->eh_sgl_hndl_base) {
3349 kfree(phba->io_sgl_hndl_base);
3350 shost_printk(KERN_ERR, phba->shost,
3351 "Mem Alloc Failed. Failing to load\n");
3352 return -ENOMEM;
3353 }
3354 } else {
3355 shost_printk(KERN_ERR, phba->shost,
3356 "HWI_MEM_SGLH is more than one element."
3357 "Failing to load\n");
3358 return -ENOMEM;
3359 }
3360
3361 arr_index = 0;
3362 idx = 0;
3363 while (idx < mem_descr_sglh->num_elements) {
3364 psgl_handle = mem_descr_sglh->mem_array[idx].virtual_address;
3365
3366 for (i = 0; i < (mem_descr_sglh->mem_array[idx].size /
3367 sizeof(struct sgl_handle)); i++) {
3368 if (arr_index < phba->params.ios_per_ctrl) {
3369 phba->io_sgl_hndl_base[arr_index] = psgl_handle;
3370 phba->io_sgl_hndl_avbl++;
3371 arr_index++;
3372 } else {
3373 phba->eh_sgl_hndl_base[arr_index -
3374 phba->params.ios_per_ctrl] =
3375 psgl_handle;
3376 arr_index++;
3377 phba->eh_sgl_hndl_avbl++;
3378 }
3379 psgl_handle++;
3380 }
3381 idx++;
3382 }
3383 SE_DEBUG(DBG_LVL_8,
3384 "phba->io_sgl_hndl_avbl=%d"
457ff3b7 3385 "phba->eh_sgl_hndl_avbl=%d\n",
6733b39a
JK		 3386 phba->io_sgl_hndl_avbl,
3387 phba->eh_sgl_hndl_avbl);
3388 mem_descr_sg = phba->init_mem;
3389 mem_descr_sg += HWI_MEM_SGE;
457ff3b7 3390 SE_DEBUG(DBG_LVL_8, "\n mem_descr_sg->num_elements=%d\n",
6733b39a
JK		 3391 mem_descr_sg->num_elements);
3392 arr_index = 0;
3393 idx = 0;
3394 while (idx < mem_descr_sg->num_elements) {
3395 pfrag = mem_descr_sg->mem_array[idx].virtual_address;
3396
3397 for (i = 0;
3398 i < (mem_descr_sg->mem_array[idx].size) /
3399 (sizeof(struct iscsi_sge) * phba->params.num_sge_per_io);
3400 i++) {
3401 if (arr_index < phba->params.ios_per_ctrl)
3402 psgl_handle = phba->io_sgl_hndl_base[arr_index];
3403 else
3404 psgl_handle = phba->eh_sgl_hndl_base[arr_index -
3405 phba->params.ios_per_ctrl];
3406 psgl_handle->pfrag = pfrag;
3407 AMAP_SET_BITS(struct amap_iscsi_sge, addr_hi, pfrag, 0);
3408 AMAP_SET_BITS(struct amap_iscsi_sge, addr_lo, pfrag, 0);
3409 pfrag += phba->params.num_sge_per_io;
3410 psgl_handle->sgl_index =
7da50879 3411 phba->fw_config.iscsi_icd_start + arr_index++;
6733b39a
JK		 3412 }
3413 idx++;
3414 }
3415 phba->io_sgl_free_index = 0;
3416 phba->io_sgl_alloc_index = 0;
3417 phba->eh_sgl_free_index = 0;
3418 phba->eh_sgl_alloc_index = 0;
3419 return 0;
3420}
3421
3422static int hba_setup_cid_tbls(struct beiscsi_hba *phba)
3423{
3424 int i, new_cid;
3425
c2462288 3426 phba->cid_array = kzalloc(sizeof(void *) * phba->params.cxns_per_ctrl,
6733b39a
JK		 3427 GFP_KERNEL);
3428 if (!phba->cid_array) {
3429 shost_printk(KERN_ERR, phba->shost,
3430 "Failed to allocate memory in "
3431 "hba_setup_cid_tbls\n");
3432 return -ENOMEM;
3433 }
c2462288 3434 phba->ep_array = kzalloc(sizeof(struct iscsi_endpoint *) *
6733b39a
JK		 3435 phba->params.cxns_per_ctrl * 2, GFP_KERNEL);
3436 if (!phba->ep_array) {
3437 shost_printk(KERN_ERR, phba->shost,
3438 "Failed to allocate memory in "
457ff3b7 3439 "hba_setup_cid_tbls\n");
6733b39a
JK		 3440 kfree(phba->cid_array);
3441 return -ENOMEM;
3442 }
7da50879 3443 new_cid = phba->fw_config.iscsi_cid_start;
6733b39a
JK		 3444 for (i = 0; i < phba->params.cxns_per_ctrl; i++) {
3445 phba->cid_array[i] = new_cid;
3446 new_cid += 2;
3447 }
3448 phba->avlbl_cids = phba->params.cxns_per_ctrl;
3449 return 0;
3450}
3451
238f6b72 3452static void hwi_enable_intr(struct beiscsi_hba *phba)
6733b39a
JK		 3453{
3454 struct be_ctrl_info *ctrl = &phba->ctrl;
3455 struct hwi_controller *phwi_ctrlr;
3456 struct hwi_context_memory *phwi_context;
3457 struct be_queue_info *eq;
3458 u8 __iomem *addr;
bfead3b2 3459 u32 reg, i;
6733b39a
JK		 3460 u32 enabled;
3461
3462 phwi_ctrlr = phba->phwi_ctrlr;
3463 phwi_context = phwi_ctrlr->phwi_ctxt;
3464
6733b39a
JK		 3465 addr = (u8 __iomem *) ((u8 __iomem *) ctrl->pcicfg +
3466 PCICFG_MEMBAR_CTRL_INT_CTRL_OFFSET);
3467 reg = ioread32(addr);
457ff3b7 3468 SE_DEBUG(DBG_LVL_8, "reg =x%08x\n", reg);
6733b39a
JK		 3469
3470 enabled = reg & MEMBAR_CTRL_INT_CTRL_HOSTINTR_MASK;
3471 if (!enabled) {
3472 reg |= MEMBAR_CTRL_INT_CTRL_HOSTINTR_MASK;
457ff3b7 3473 SE_DEBUG(DBG_LVL_8, "reg =x%08x addr=%p\n", reg, addr);
6733b39a 3474 iowrite32(reg, addr);
c03af1ae
JK		 3475 if (!phba->msix_enabled) {
3476 eq = &phwi_context->be_eq[0].q;
457ff3b7 3477 SE_DEBUG(DBG_LVL_8, "eq->id=%d\n", eq->id);
bfead3b2 3478 hwi_ring_eq_db(phba, eq->id, 0, 0, 1, 1);
c03af1ae
JK		 3479 } else {
3480 for (i = 0; i <= phba->num_cpus; i++) {
3481 eq = &phwi_context->be_eq[i].q;
457ff3b7 3482 SE_DEBUG(DBG_LVL_8, "eq->id=%d\n", eq->id);
c03af1ae
JK		 3483 hwi_ring_eq_db(phba, eq->id, 0, 0, 1, 1);
3484 }
bfead3b2 3485 }
c03af1ae 3486 }
6733b39a
JK		 3487}
3488
3489static void hwi_disable_intr(struct beiscsi_hba *phba)
3490{
3491 struct be_ctrl_info *ctrl = &phba->ctrl;
3492
3493 u8 __iomem *addr = ctrl->pcicfg + PCICFG_MEMBAR_CTRL_INT_CTRL_OFFSET;
3494 u32 reg = ioread32(addr);
3495
3496 u32 enabled = reg & MEMBAR_CTRL_INT_CTRL_HOSTINTR_MASK;
3497 if (enabled) {
3498 reg &= ~MEMBAR_CTRL_INT_CTRL_HOSTINTR_MASK;
3499 iowrite32(reg, addr);
3500 } else
3501 shost_printk(KERN_WARNING, phba->shost,
457ff3b7 3502 "In hwi_disable_intr, Already Disabled\n");
6733b39a
JK		 3503}
3504
c7acc5b8
JK		 3505static int beiscsi_get_boot_info(struct beiscsi_hba *phba)
3506{
3507 struct be_cmd_resp_get_boot_target *boot_resp;
3508 struct be_cmd_resp_get_session *session_resp;
3509 struct be_mcc_wrb *wrb;
3510 struct be_dma_mem nonemb_cmd;
3511 unsigned int tag, wrb_num;
3512 unsigned short status, extd_status;
3513 struct be_queue_info *mccq = &phba->ctrl.mcc_obj.q;
3514
3515 tag = beiscsi_get_boot_target(phba);
3516 if (!tag) {
3517 SE_DEBUG(DBG_LVL_1, "be_cmd_get_mac_addr Failed\n");
3518 return -EAGAIN;
3519 } else
3520 wait_event_interruptible(phba->ctrl.mcc_wait[tag],
3521 phba->ctrl.mcc_numtag[tag]);
3522
3523 wrb_num = (phba->ctrl.mcc_numtag[tag] & 0x00FF0000) >> 16;
3524 extd_status = (phba->ctrl.mcc_numtag[tag] & 0x0000FF00) >> 8;
3525 status = phba->ctrl.mcc_numtag[tag] & 0x000000FF;
3526 if (status || extd_status) {
3527 SE_DEBUG(DBG_LVL_1, "be_cmd_get_mac_addr Failed"
3528 " status = %d extd_status = %d\n",
3529 status, extd_status);
3530 free_mcc_tag(&phba->ctrl, tag);
3531 return -EBUSY;
3532 }
3533 wrb = queue_get_wrb(mccq, wrb_num);
3534 free_mcc_tag(&phba->ctrl, tag);
3535 boot_resp = embedded_payload(wrb);
3536
3537 if (boot_resp->boot_session_handle < 0) {
3538 printk(KERN_ERR "No Boot Session for this pci_func,"
3539 "session Hndl = %d\n", boot_resp->boot_session_handle);
3540 return -ENXIO;
3541 }
3542
3543 nonemb_cmd.va = pci_alloc_consistent(phba->ctrl.pdev,
3544 sizeof(*session_resp),
3545 &nonemb_cmd.dma);
3546 if (nonemb_cmd.va == NULL) {
3547 SE_DEBUG(DBG_LVL_1,
3548 "Failed to allocate memory for"
3549 "beiscsi_get_session_info\n");
3550 return -ENOMEM;
3551 }
3552
3553 memset(nonemb_cmd.va, 0, sizeof(*session_resp));
3554 tag = beiscsi_get_session_info(phba,
3555 boot_resp->boot_session_handle, &nonemb_cmd);
3556 if (!tag) {
3557 SE_DEBUG(DBG_LVL_1, "beiscsi_get_session_info"
3558 " Failed\n");
3559 goto boot_freemem;
3560 } else
3561 wait_event_interruptible(phba->ctrl.mcc_wait[tag],
3562 phba->ctrl.mcc_numtag[tag]);
3563
3564 wrb_num = (phba->ctrl.mcc_numtag[tag] & 0x00FF0000) >> 16;
3565 extd_status = (phba->ctrl.mcc_numtag[tag] & 0x0000FF00) >> 8;
3566 status = phba->ctrl.mcc_numtag[tag] & 0x000000FF;
3567 if (status || extd_status) {
3568 SE_DEBUG(DBG_LVL_1, "beiscsi_get_session_info Failed"
3569 " status = %d extd_status = %d\n",
3570 status, extd_status);
3571 free_mcc_tag(&phba->ctrl, tag);
3572 goto boot_freemem;
3573 }
3574 wrb = queue_get_wrb(mccq, wrb_num);
3575 free_mcc_tag(&phba->ctrl, tag);
3576 session_resp = nonemb_cmd.va ;
3577 memcpy(&phba->boot_sess, &session_resp->session_info,
3578 sizeof(struct mgmt_session_info));
3579 pci_free_consistent(phba->ctrl.pdev, nonemb_cmd.size,
3580 nonemb_cmd.va, nonemb_cmd.dma);
3581 return 0;
3582boot_freemem:
3583 pci_free_consistent(phba->ctrl.pdev, nonemb_cmd.size,
3584 nonemb_cmd.va, nonemb_cmd.dma);
3585 return -ENOMEM;
3586}
3587
6733b39a
JK		 3588static int beiscsi_init_port(struct beiscsi_hba *phba)
3589{
3590 int ret;
3591
3592 ret = beiscsi_init_controller(phba);
3593 if (ret < 0) {
3594 shost_printk(KERN_ERR, phba->shost,
3595 "beiscsi_dev_probe - Failed in"
457ff3b7 3596 "beiscsi_init_controller\n");
6733b39a
JK		 3597 return ret;
3598 }
3599 ret = beiscsi_init_sgl_handle(phba);
3600 if (ret < 0) {
3601 shost_printk(KERN_ERR, phba->shost,
3602 "beiscsi_dev_probe - Failed in"
457ff3b7 3603 "beiscsi_init_sgl_handle\n");
6733b39a
JK		 3604 goto do_cleanup_ctrlr;
3605 }
3606
3607 if (hba_setup_cid_tbls(phba)) {
3608 shost_printk(KERN_ERR, phba->shost,
3609 "Failed in hba_setup_cid_tbls\n");
3610 kfree(phba->io_sgl_hndl_base);
3611 kfree(phba->eh_sgl_hndl_base);
3612 goto do_cleanup_ctrlr;
3613 }
3614
3615 return ret;
3616
3617do_cleanup_ctrlr:
3618 hwi_cleanup(phba);
3619 return ret;
3620}
3621
3622static void hwi_purge_eq(struct beiscsi_hba *phba)
3623{
3624 struct hwi_controller *phwi_ctrlr;
3625 struct hwi_context_memory *phwi_context;
3626 struct be_queue_info *eq;
3627 struct be_eq_entry *eqe = NULL;
bfead3b2 3628 int i, eq_msix;
756d29c8 3629 unsigned int num_processed;
6733b39a
JK		 3630
3631 phwi_ctrlr = phba->phwi_ctrlr;
3632 phwi_context = phwi_ctrlr->phwi_ctxt;
bfead3b2
JK		 3633 if (phba->msix_enabled)
3634 eq_msix = 1;
3635 else
3636 eq_msix = 0;
6733b39a 3637
bfead3b2
JK		 3638 for (i = 0; i < (phba->num_cpus + eq_msix); i++) {
3639 eq = &phwi_context->be_eq[i].q;
6733b39a 3640 eqe = queue_tail_node(eq);
756d29c8 3641 num_processed = 0;
bfead3b2
JK		 3642 while (eqe->dw[offsetof(struct amap_eq_entry, valid) / 32]
3643 & EQE_VALID_MASK) {
3644 AMAP_SET_BITS(struct amap_eq_entry, valid, eqe, 0);
3645 queue_tail_inc(eq);
3646 eqe = queue_tail_node(eq);
756d29c8 3647 num_processed++;
bfead3b2 3648 }
756d29c8
JK		 3649
3650 if (num_processed)
3651 hwi_ring_eq_db(phba, eq->id, 1, num_processed, 1, 1);
6733b39a
JK		 3652 }
3653}
3654
3655static void beiscsi_clean_port(struct beiscsi_hba *phba)
3656{
03a12310 3657 int mgmt_status;
6733b39a
JK		 3658
3659 mgmt_status = mgmt_epfw_cleanup(phba, CMD_CONNECTION_CHUTE_0);
3660 if (mgmt_status)
3661 shost_printk(KERN_WARNING, phba->shost,
457ff3b7 3662 "mgmt_epfw_cleanup FAILED\n");
756d29c8 3663
6733b39a 3664 hwi_purge_eq(phba);
756d29c8 3665 hwi_cleanup(phba);
6733b39a
JK		 3666 kfree(phba->io_sgl_hndl_base);
3667 kfree(phba->eh_sgl_hndl_base);
3668 kfree(phba->cid_array);
3669 kfree(phba->ep_array);
3670}
3671
3672void
3673beiscsi_offload_connection(struct beiscsi_conn *beiscsi_conn,
3674 struct beiscsi_offload_params *params)
3675{
3676 struct wrb_handle *pwrb_handle;
3677 struct iscsi_target_context_update_wrb *pwrb = NULL;
3678 struct be_mem_descriptor *mem_descr;
3679 struct beiscsi_hba *phba = beiscsi_conn->phba;
3680 u32 doorbell = 0;
3681
3682 /*
3683 * We can always use 0 here because it is reserved by libiscsi for
3684 * login/startup related tasks.
3685 */
7da50879 3686 pwrb_handle = alloc_wrb_handle(phba, (beiscsi_conn->beiscsi_conn_cid -
d5431488 3687 phba->fw_config.iscsi_cid_start));
6733b39a
JK		 3688 pwrb = (struct iscsi_target_context_update_wrb *)pwrb_handle->pwrb;
3689 memset(pwrb, 0, sizeof(*pwrb));
3690 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb,
3691 max_burst_length, pwrb, params->dw[offsetof
3692 (struct amap_beiscsi_offload_params,
3693 max_burst_length) / 32]);
3694 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb,
3695 max_send_data_segment_length, pwrb,
3696 params->dw[offsetof(struct amap_beiscsi_offload_params,
3697 max_send_data_segment_length) / 32]);
3698 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb,
3699 first_burst_length,
3700 pwrb,
3701 params->dw[offsetof(struct amap_beiscsi_offload_params,
3702 first_burst_length) / 32]);
3703
3704 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, erl, pwrb,
3705 (params->dw[offsetof(struct amap_beiscsi_offload_params,
3706 erl) / 32] & OFFLD_PARAMS_ERL));
3707 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, dde, pwrb,
3708 (params->dw[offsetof(struct amap_beiscsi_offload_params,
3709 dde) / 32] & OFFLD_PARAMS_DDE) >> 2);
3710 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, hde, pwrb,
3711 (params->dw[offsetof(struct amap_beiscsi_offload_params,
3712 hde) / 32] & OFFLD_PARAMS_HDE) >> 3);
3713 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, ir2t, pwrb,
3714 (params->dw[offsetof(struct amap_beiscsi_offload_params,
3715 ir2t) / 32] & OFFLD_PARAMS_IR2T) >> 4);
3716 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, imd, pwrb,
3717 (params->dw[offsetof(struct amap_beiscsi_offload_params,
3718 imd) / 32] & OFFLD_PARAMS_IMD) >> 5);
3719 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, stat_sn,
3720 pwrb,
3721 (params->dw[offsetof(struct amap_beiscsi_offload_params,
3722 exp_statsn) / 32] + 1));
3723 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, type, pwrb,
3724 0x7);
3725 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, wrb_idx,
3726 pwrb, pwrb_handle->wrb_index);
3727 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, ptr2nextwrb,
3728 pwrb, pwrb_handle->nxt_wrb_index);
3729 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb,
3730 session_state, pwrb, 0);
3731 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, compltonack,
3732 pwrb, 1);
3733 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, notpredblq,
3734 pwrb, 0);
3735 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, mode, pwrb,
3736 0);
3737
3738 mem_descr = phba->init_mem;
3739 mem_descr += ISCSI_MEM_GLOBAL_HEADER;
3740
3741 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb,
3742 pad_buffer_addr_hi, pwrb,
3743 mem_descr->mem_array[0].bus_address.u.a32.address_hi);
3744 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb,
3745 pad_buffer_addr_lo, pwrb,
3746 mem_descr->mem_array[0].bus_address.u.a32.address_lo);
3747
3748 be_dws_le_to_cpu(pwrb, sizeof(struct iscsi_target_context_update_wrb));
3749
3750 doorbell |= beiscsi_conn->beiscsi_conn_cid & DB_WRB_POST_CID_MASK;
32951dd8 3751 doorbell |= (pwrb_handle->wrb_index & DB_DEF_PDU_WRB_INDEX_MASK)
bfead3b2 3752 << DB_DEF_PDU_WRB_INDEX_SHIFT;
6733b39a
JK		 3753 doorbell |= 1 << DB_DEF_PDU_NUM_POSTED_SHIFT;
3754
3755 iowrite32(doorbell, phba->db_va + DB_TXULP0_OFFSET);
3756}
3757
3758static void beiscsi_parse_pdu(struct iscsi_conn *conn, itt_t itt,
3759 int *index, int *age)
3760{
bfead3b2 3761 *index = (int)itt;
6733b39a
JK		 3762 if (age)
3763 *age = conn->session->age;
3764}
3765
3766/**
3767 * beiscsi_alloc_pdu - allocates pdu and related resources
3768 * @task: libiscsi task
3769 * @opcode: opcode of pdu for task
3770 *
3771 * This is called with the session lock held. It will allocate
3772 * the wrb and sgl if needed for the command. And it will prep
3773 * the pdu's itt. beiscsi_parse_pdu will later translate
3774 * the pdu itt to the libiscsi task itt.
3775 */
3776static int beiscsi_alloc_pdu(struct iscsi_task *task, uint8_t opcode)
3777{
3778 struct beiscsi_io_task *io_task = task->dd_data;
3779 struct iscsi_conn *conn = task->conn;
3780 struct beiscsi_conn *beiscsi_conn = conn->dd_data;
3781 struct beiscsi_hba *phba = beiscsi_conn->phba;
3782 struct hwi_wrb_context *pwrb_context;
3783 struct hwi_controller *phwi_ctrlr;
3784 itt_t itt;
2afc95bf
JK		 3785 struct beiscsi_session *beiscsi_sess = beiscsi_conn->beiscsi_sess;
3786 dma_addr_t paddr;
6733b39a 3787
2afc95bf 3788 io_task->cmd_bhs = pci_pool_alloc(beiscsi_sess->bhs_pool,
bc7accec 3789 GFP_ATOMIC, &paddr);
2afc95bf
JK		 3790 if (!io_task->cmd_bhs)
3791 return -ENOMEM;
2afc95bf 3792 io_task->bhs_pa.u.a64.address = paddr;
bfead3b2 3793 io_task->libiscsi_itt = (itt_t)task->itt;
6733b39a
JK		 3794 io_task->conn = beiscsi_conn;
3795
3796 task->hdr = (struct iscsi_hdr *)&io_task->cmd_bhs->iscsi_hdr;
3797 task->hdr_max = sizeof(struct be_cmd_bhs);
d2cecf0d
JK		 3798 io_task->psgl_handle = NULL;
3799 io_task->psgl_handle = NULL;
6733b39a
JK		 3800
3801 if (task->sc) {
3802 spin_lock(&phba->io_sgl_lock);
3803 io_task->psgl_handle = alloc_io_sgl_handle(phba);
3804 spin_unlock(&phba->io_sgl_lock);
2afc95bf
JK		 3805 if (!io_task->psgl_handle)
3806 goto free_hndls;
d2cecf0d
JK		 3807 io_task->pwrb_handle = alloc_wrb_handle(phba,
3808 beiscsi_conn->beiscsi_conn_cid -
3809 phba->fw_config.iscsi_cid_start);
3810 if (!io_task->pwrb_handle)
3811 goto free_io_hndls;
6733b39a
JK		 3812 } else {
3813 io_task->scsi_cmnd = NULL;
d7aea67b 3814 if ((opcode & ISCSI_OPCODE_MASK) == ISCSI_OP_LOGIN) {
6733b39a
JK		 3815 if (!beiscsi_conn->login_in_progress) {
3816 spin_lock(&phba->mgmt_sgl_lock);
3817 io_task->psgl_handle = (struct sgl_handle *)
3818 alloc_mgmt_sgl_handle(phba);
3819 spin_unlock(&phba->mgmt_sgl_lock);
2afc95bf
JK		 3820 if (!io_task->psgl_handle)
3821 goto free_hndls;
3822
6733b39a
JK		 3823 beiscsi_conn->login_in_progress = 1;
3824 beiscsi_conn->plogin_sgl_handle =
3825 io_task->psgl_handle;
d2cecf0d
JK		 3826 io_task->pwrb_handle =
3827 alloc_wrb_handle(phba,
3828 beiscsi_conn->beiscsi_conn_cid -
3829 phba->fw_config.iscsi_cid_start);
3830 if (!io_task->pwrb_handle)
3831 goto free_io_hndls;
3832 beiscsi_conn->plogin_wrb_handle =
3833 io_task->pwrb_handle;
3834
6733b39a
JK		 3835 } else {
3836 io_task->psgl_handle =
3837 beiscsi_conn->plogin_sgl_handle;
d2cecf0d
JK		 3838 io_task->pwrb_handle =
3839 beiscsi_conn->plogin_wrb_handle;
6733b39a
JK		 3840 }
3841 } else {
3842 spin_lock(&phba->mgmt_sgl_lock);
3843 io_task->psgl_handle = alloc_mgmt_sgl_handle(phba);
3844 spin_unlock(&phba->mgmt_sgl_lock);
2afc95bf
JK		 3845 if (!io_task->psgl_handle)
3846 goto free_hndls;
d2cecf0d
JK		 3847 io_task->pwrb_handle =
3848 alloc_wrb_handle(phba,
3849 beiscsi_conn->beiscsi_conn_cid -
3850 phba->fw_config.iscsi_cid_start);
3851 if (!io_task->pwrb_handle)
3852 goto free_mgmt_hndls;
3853
6733b39a
JK		 3854 }
3855 }
bfead3b2
JK		 3856 itt = (itt_t) cpu_to_be32(((unsigned int)io_task->pwrb_handle->
3857 wrb_index << 16) | (unsigned int)
3858 (io_task->psgl_handle->sgl_index));
32951dd8 3859 io_task->pwrb_handle->pio_handle = task;
bfead3b2 3860
6733b39a
JK		 3861 io_task->cmd_bhs->iscsi_hdr.itt = itt;
3862 return 0;
2afc95bf 3863
d2cecf0d
JK		 3864free_io_hndls:
3865 spin_lock(&phba->io_sgl_lock);
3866 free_io_sgl_handle(phba, io_task->psgl_handle);
3867 spin_unlock(&phba->io_sgl_lock);
3868 goto free_hndls;
3869free_mgmt_hndls:
3870 spin_lock(&phba->mgmt_sgl_lock);
3871 free_mgmt_sgl_handle(phba, io_task->psgl_handle);
3872 spin_unlock(&phba->mgmt_sgl_lock);
2afc95bf
JK		 3873free_hndls:
3874 phwi_ctrlr = phba->phwi_ctrlr;
7da50879
JK		 3875 pwrb_context = &phwi_ctrlr->wrb_context[
3876 beiscsi_conn->beiscsi_conn_cid -
3877 phba->fw_config.iscsi_cid_start];
d2cecf0d
JK		 3878 if (io_task->pwrb_handle)
3879 free_wrb_handle(phba, pwrb_context, io_task->pwrb_handle);
2afc95bf
JK		 3880 io_task->pwrb_handle = NULL;
3881 pci_pool_free(beiscsi_sess->bhs_pool, io_task->cmd_bhs,
3882 io_task->bhs_pa.u.a64.address);
457ff3b7 3883 SE_DEBUG(DBG_LVL_1, "Alloc of SGL_ICD Failed\n");
2afc95bf 3884 return -ENOMEM;
6733b39a
JK		 3885}
3886
3887static void beiscsi_cleanup_task(struct iscsi_task *task)
3888{
3889 struct beiscsi_io_task *io_task = task->dd_data;
3890 struct iscsi_conn *conn = task->conn;
3891 struct beiscsi_conn *beiscsi_conn = conn->dd_data;
3892 struct beiscsi_hba *phba = beiscsi_conn->phba;
2afc95bf 3893 struct beiscsi_session *beiscsi_sess = beiscsi_conn->beiscsi_sess;
6733b39a
JK		 3894 struct hwi_wrb_context *pwrb_context;
3895 struct hwi_controller *phwi_ctrlr;
3896
3897 phwi_ctrlr = phba->phwi_ctrlr;
7da50879
JK		 3898 pwrb_context = &phwi_ctrlr->wrb_context[beiscsi_conn->beiscsi_conn_cid
3899 - phba->fw_config.iscsi_cid_start];
6733b39a
JK		 3900 if (io_task->pwrb_handle) {
3901 free_wrb_handle(phba, pwrb_context, io_task->pwrb_handle);
3902 io_task->pwrb_handle = NULL;
3903 }
3904
2afc95bf
JK		 3905 if (io_task->cmd_bhs) {
3906 pci_pool_free(beiscsi_sess->bhs_pool, io_task->cmd_bhs,
3907 io_task->bhs_pa.u.a64.address);
3908 }
3909
6733b39a
JK		 3910 if (task->sc) {
3911 if (io_task->psgl_handle) {
3912 spin_lock(&phba->io_sgl_lock);
3913 free_io_sgl_handle(phba, io_task->psgl_handle);
3914 spin_unlock(&phba->io_sgl_lock);
3915 io_task->psgl_handle = NULL;
3916 }
3917 } else {
1227633a
MC		 3918 if (task->hdr &&
3919 ((task->hdr->opcode & ISCSI_OPCODE_MASK) == ISCSI_OP_LOGIN))
6733b39a
JK		 3920 return;
3921 if (io_task->psgl_handle) {
3922 spin_lock(&phba->mgmt_sgl_lock);
3923 free_mgmt_sgl_handle(phba, io_task->psgl_handle);
3924 spin_unlock(&phba->mgmt_sgl_lock);
3925 io_task->psgl_handle = NULL;
3926 }
3927 }
3928}
3929
3930static int beiscsi_iotask(struct iscsi_task *task, struct scatterlist *sg,
3931 unsigned int num_sg, unsigned int xferlen,
3932 unsigned int writedir)
3933{
3934
3935 struct beiscsi_io_task *io_task = task->dd_data;
3936 struct iscsi_conn *conn = task->conn;
3937 struct beiscsi_conn *beiscsi_conn = conn->dd_data;
3938 struct beiscsi_hba *phba = beiscsi_conn->phba;
3939 struct iscsi_wrb *pwrb = NULL;
3940 unsigned int doorbell = 0;
3941
3942 pwrb = io_task->pwrb_handle->pwrb;
6733b39a
JK		 3943 io_task->cmd_bhs->iscsi_hdr.exp_statsn = 0;
3944 io_task->bhs_len = sizeof(struct be_cmd_bhs);
3945
3946 if (writedir) {
6733b39a
JK		 3947 memset(&io_task->cmd_bhs->iscsi_data_pdu, 0, 48);
3948 AMAP_SET_BITS(struct amap_pdu_data_out, itt,
3949 &io_task->cmd_bhs->iscsi_data_pdu,
3950 (unsigned int)io_task->cmd_bhs->iscsi_hdr.itt);
3951 AMAP_SET_BITS(struct amap_pdu_data_out, opcode,
3952 &io_task->cmd_bhs->iscsi_data_pdu,
3953 ISCSI_OPCODE_SCSI_DATA_OUT);
3954 AMAP_SET_BITS(struct amap_pdu_data_out, final_bit,
3955 &io_task->cmd_bhs->iscsi_data_pdu, 1);
32951dd8
JK		 3956 AMAP_SET_BITS(struct amap_iscsi_wrb, type, pwrb,
3957 INI_WR_CMD);
6733b39a 3958 AMAP_SET_BITS(struct amap_iscsi_wrb, dsp, pwrb, 1);
6733b39a 3959 } else {
32951dd8
JK		 3960 AMAP_SET_BITS(struct amap_iscsi_wrb, type, pwrb,
3961 INI_RD_CMD);
6733b39a
JK		 3962 AMAP_SET_BITS(struct amap_iscsi_wrb, dsp, pwrb, 0);
3963 }
3964 memcpy(&io_task->cmd_bhs->iscsi_data_pdu.
3965 dw[offsetof(struct amap_pdu_data_out, lun) / 32],
3966 io_task->cmd_bhs->iscsi_hdr.lun, sizeof(struct scsi_lun));
3967
3968 AMAP_SET_BITS(struct amap_iscsi_wrb, lun, pwrb,
3969 cpu_to_be16((unsigned short)io_task->cmd_bhs->iscsi_hdr.
3970 lun[0]));
3971 AMAP_SET_BITS(struct amap_iscsi_wrb, r2t_exp_dtl, pwrb, xferlen);
3972 AMAP_SET_BITS(struct amap_iscsi_wrb, wrb_idx, pwrb,
3973 io_task->pwrb_handle->wrb_index);
3974 AMAP_SET_BITS(struct amap_iscsi_wrb, cmdsn_itt, pwrb,
3975 be32_to_cpu(task->cmdsn));
3976 AMAP_SET_BITS(struct amap_iscsi_wrb, sgl_icd_idx, pwrb,
3977 io_task->psgl_handle->sgl_index);
3978
3979 hwi_write_sgl(pwrb, sg, num_sg, io_task);
3980
3981 AMAP_SET_BITS(struct amap_iscsi_wrb, ptr2nextwrb, pwrb,
3982 io_task->pwrb_handle->nxt_wrb_index);
3983 be_dws_le_to_cpu(pwrb, sizeof(struct iscsi_wrb));
3984
3985 doorbell |= beiscsi_conn->beiscsi_conn_cid & DB_WRB_POST_CID_MASK;
32951dd8 3986 doorbell |= (io_task->pwrb_handle->wrb_index &
6733b39a
JK		 3987 DB_DEF_PDU_WRB_INDEX_MASK) << DB_DEF_PDU_WRB_INDEX_SHIFT;
3988 doorbell |= 1 << DB_DEF_PDU_NUM_POSTED_SHIFT;
3989
3990 iowrite32(doorbell, phba->db_va + DB_TXULP0_OFFSET);
3991 return 0;
3992}
3993
3994static int beiscsi_mtask(struct iscsi_task *task)
3995{
dafab8e0 3996 struct beiscsi_io_task *io_task = task->dd_data;
6733b39a
JK		 3997 struct iscsi_conn *conn = task->conn;
3998 struct beiscsi_conn *beiscsi_conn = conn->dd_data;
3999 struct beiscsi_hba *phba = beiscsi_conn->phba;
4000 struct iscsi_wrb *pwrb = NULL;
4001 unsigned int doorbell = 0;
dafab8e0 4002 unsigned int cid;
6733b39a 4003
bfead3b2 4004 cid = beiscsi_conn->beiscsi_conn_cid;
6733b39a 4005 pwrb = io_task->pwrb_handle->pwrb;
caf818f1 4006 memset(pwrb, 0, sizeof(*pwrb));
6733b39a
JK		 4007 AMAP_SET_BITS(struct amap_iscsi_wrb, cmdsn_itt, pwrb,
4008 be32_to_cpu(task->cmdsn));
4009 AMAP_SET_BITS(struct amap_iscsi_wrb, wrb_idx, pwrb,
4010 io_task->pwrb_handle->wrb_index);
4011 AMAP_SET_BITS(struct amap_iscsi_wrb, sgl_icd_idx, pwrb,
4012 io_task->psgl_handle->sgl_index);
dafab8e0 4013
6733b39a
JK		 4014 switch (task->hdr->opcode & ISCSI_OPCODE_MASK) {
4015 case ISCSI_OP_LOGIN:
32951dd8
JK		 4016 AMAP_SET_BITS(struct amap_iscsi_wrb, type, pwrb,
4017 TGT_DM_CMD);
6733b39a
JK		 4018 AMAP_SET_BITS(struct amap_iscsi_wrb, dmsg, pwrb, 0);
4019 AMAP_SET_BITS(struct amap_iscsi_wrb, cmdsn_itt, pwrb, 1);
4020 hwi_write_buffer(pwrb, task);
4021 break;
4022 case ISCSI_OP_NOOP_OUT:
32951dd8
JK		 4023 AMAP_SET_BITS(struct amap_iscsi_wrb, type, pwrb,
4024 INI_RD_CMD);
0ecb0b45
JK		 4025 if (task->hdr->ttt == ISCSI_RESERVED_TAG)
4026 AMAP_SET_BITS(struct amap_iscsi_wrb, dmsg, pwrb, 0);
4027 else
4028 AMAP_SET_BITS(struct amap_iscsi_wrb, dmsg, pwrb, 1);
6733b39a
JK		 4029 hwi_write_buffer(pwrb, task);
4030 break;
4031 case ISCSI_OP_TEXT:
32951dd8 4032 AMAP_SET_BITS(struct amap_iscsi_wrb, type, pwrb,
b30c6dab 4033 TGT_DM_CMD);
0ecb0b45 4034 AMAP_SET_BITS(struct amap_iscsi_wrb, dmsg, pwrb, 0);
6733b39a
JK		 4035 hwi_write_buffer(pwrb, task);
4036 break;
4037 case ISCSI_OP_SCSI_TMFUNC:
32951dd8
JK		 4038 AMAP_SET_BITS(struct amap_iscsi_wrb, type, pwrb,
4039 INI_TMF_CMD);
6733b39a
JK		 4040 AMAP_SET_BITS(struct amap_iscsi_wrb, dmsg, pwrb, 0);
4041 hwi_write_buffer(pwrb, task);
4042 break;
4043 case ISCSI_OP_LOGOUT:
4044 AMAP_SET_BITS(struct amap_iscsi_wrb, dmsg, pwrb, 0);
4045 AMAP_SET_BITS(struct amap_iscsi_wrb, type, pwrb,
dafab8e0 4046 HWH_TYPE_LOGOUT);
6733b39a
JK		 4047 hwi_write_buffer(pwrb, task);
4048 break;
4049
4050 default:
457ff3b7 4051 SE_DEBUG(DBG_LVL_1, "opcode =%d Not supported\n",
6733b39a
JK		 4052 task->hdr->opcode & ISCSI_OPCODE_MASK);
4053 return -EINVAL;
4054 }
4055
4056 AMAP_SET_BITS(struct amap_iscsi_wrb, r2t_exp_dtl, pwrb,
51a46250 4057 task->data_count);
6733b39a
JK		 4058 AMAP_SET_BITS(struct amap_iscsi_wrb, ptr2nextwrb, pwrb,
4059 io_task->pwrb_handle->nxt_wrb_index);
4060 be_dws_le_to_cpu(pwrb, sizeof(struct iscsi_wrb));
4061
bfead3b2 4062 doorbell |= cid & DB_WRB_POST_CID_MASK;
32951dd8 4063 doorbell |= (io_task->pwrb_handle->wrb_index &
6733b39a
JK		 4064 DB_DEF_PDU_WRB_INDEX_MASK) << DB_DEF_PDU_WRB_INDEX_SHIFT;
4065 doorbell |= 1 << DB_DEF_PDU_NUM_POSTED_SHIFT;
4066 iowrite32(doorbell, phba->db_va + DB_TXULP0_OFFSET);
4067 return 0;
4068}
4069
4070static int beiscsi_task_xmit(struct iscsi_task *task)
4071{
6733b39a
JK		 4072 struct beiscsi_io_task *io_task = task->dd_data;
4073 struct scsi_cmnd *sc = task->sc;
6733b39a
JK		 4074 struct scatterlist *sg;
4075 int num_sg;
4076 unsigned int writedir = 0, xferlen = 0;
4077
6733b39a
JK		 4078 if (!sc)
4079 return beiscsi_mtask(task);
4080
4081 io_task->scsi_cmnd = sc;
4082 num_sg = scsi_dma_map(sc);
4083 if (num_sg < 0) {
4084 SE_DEBUG(DBG_LVL_1, " scsi_dma_map Failed\n")
4085 return num_sg;
4086 }
6733b39a
JK		 4087 xferlen = scsi_bufflen(sc);
4088 sg = scsi_sglist(sc);
4089 if (sc->sc_data_direction == DMA_TO_DEVICE) {
4090 writedir = 1;
457ff3b7 4091 SE_DEBUG(DBG_LVL_4, "task->imm_count=0x%08x\n",
6733b39a
JK		 4092 task->imm_count);
4093 } else
4094 writedir = 0;
4095 return beiscsi_iotask(task, sg, num_sg, xferlen, writedir);
4096}
4097
4098static void beiscsi_remove(struct pci_dev *pcidev)
4099{
4100 struct beiscsi_hba *phba = NULL;
bfead3b2
JK		 4101 struct hwi_controller *phwi_ctrlr;
4102 struct hwi_context_memory *phwi_context;
4103 struct be_eq_obj *pbe_eq;
4104 unsigned int i, msix_vec;
e9b91193
JK		 4105 u8 *real_offset = 0;
4106 u32 value = 0;
6733b39a
JK		 4107
4108 phba = (struct beiscsi_hba *)pci_get_drvdata(pcidev);
4109 if (!phba) {
457ff3b7 4110 dev_err(&pcidev->dev, "beiscsi_remove called with no phba\n");
6733b39a
JK		 4111 return;
4112 }
4113
bfead3b2
JK		 4114 phwi_ctrlr = phba->phwi_ctrlr;
4115 phwi_context = phwi_ctrlr->phwi_ctxt;
6733b39a 4116 hwi_disable_intr(phba);
bfead3b2
JK		 4117 if (phba->msix_enabled) {
4118 for (i = 0; i <= phba->num_cpus; i++) {
4119 msix_vec = phba->msix_entries[i].vector;
4120 free_irq(msix_vec, &phwi_context->be_eq[i]);
4121 }
4122 } else
4123 if (phba->pcidev->irq)
4124 free_irq(phba->pcidev->irq, phba);
4125 pci_disable_msix(phba->pcidev);
6733b39a
JK		 4126 destroy_workqueue(phba->wq);
4127 if (blk_iopoll_enabled)
bfead3b2
JK		 4128 for (i = 0; i < phba->num_cpus; i++) {
4129 pbe_eq = &phwi_context->be_eq[i];
4130 blk_iopoll_disable(&pbe_eq->iopoll);
4131 }
6733b39a
JK		 4132
4133 beiscsi_clean_port(phba);
4134 beiscsi_free_mem(phba);
e9b91193
JK		 4135 real_offset = (u8 *)phba->csr_va + MPU_EP_SEMAPHORE;
4136
4137 value = readl((void *)real_offset);
4138
4139 if (value & 0x00010000) {
4140 value &= 0xfffeffff;
4141 writel(value, (void *)real_offset);
4142 }
6733b39a
JK		 4143 beiscsi_unmap_pci_function(phba);
4144 pci_free_consistent(phba->pcidev,
4145 phba->ctrl.mbox_mem_alloced.size,
4146 phba->ctrl.mbox_mem_alloced.va,
4147 phba->ctrl.mbox_mem_alloced.dma);
0b1d3cbf
JK		 4148 if (phba->boot_kset)
4149 iscsi_boot_destroy_kset(phba->boot_kset);
6733b39a
JK		 4150 iscsi_host_remove(phba->shost);
4151 pci_dev_put(phba->pcidev);
4152 iscsi_host_free(phba->shost);
4153}
4154
bfead3b2
JK		 4155static void beiscsi_msix_enable(struct beiscsi_hba *phba)
4156{
4157 int i, status;
4158
4159 for (i = 0; i <= phba->num_cpus; i++)
4160 phba->msix_entries[i].entry = i;
4161
4162 status = pci_enable_msix(phba->pcidev, phba->msix_entries,
4163 (phba->num_cpus + 1));
4164 if (!status)
4165 phba->msix_enabled = true;
4166
4167 return;
4168}
4169
6733b39a
JK		 4170static int __devinit beiscsi_dev_probe(struct pci_dev *pcidev,
4171 const struct pci_device_id *id)
4172{
4173 struct beiscsi_hba *phba = NULL;
bfead3b2
JK		 4174 struct hwi_controller *phwi_ctrlr;
4175 struct hwi_context_memory *phwi_context;
4176 struct be_eq_obj *pbe_eq;
238f6b72 4177 int ret, num_cpus, i;
e9b91193
JK		 4178 u8 *real_offset = 0;
4179 u32 value = 0;
6733b39a
JK		 4180
4181 ret = beiscsi_enable_pci(pcidev);
4182 if (ret < 0) {
82284c09
DC		 4183 dev_err(&pcidev->dev, "beiscsi_dev_probe-"
4184 " Failed to enable pci device\n");
6733b39a
JK		 4185 return ret;
4186 }
4187
4188 phba = beiscsi_hba_alloc(pcidev);
4189 if (!phba) {
4190 dev_err(&pcidev->dev, "beiscsi_dev_probe-"
457ff3b7 4191 " Failed in beiscsi_hba_alloc\n");
6733b39a
JK		 4192 goto disable_pci;
4193 }
4194
f98c96b0
JK		 4195 switch (pcidev->device) {
4196 case BE_DEVICE_ID1:
4197 case OC_DEVICE_ID1:
4198 case OC_DEVICE_ID2:
4199 phba->generation = BE_GEN2;
4200 break;
4201 case BE_DEVICE_ID2:
4202 case OC_DEVICE_ID3:
4203 phba->generation = BE_GEN3;
4204 break;
4205 default:
4206 phba->generation = 0;
4207 }
4208
bfead3b2
JK		 4209 if (enable_msix)
4210 num_cpus = find_num_cpus();
4211 else
4212 num_cpus = 1;
4213 phba->num_cpus = num_cpus;
457ff3b7 4214 SE_DEBUG(DBG_LVL_8, "num_cpus = %d\n", phba->num_cpus);
bfead3b2
JK		 4215
4216 if (enable_msix)
4217 beiscsi_msix_enable(phba);
6733b39a
JK		 4218 ret = be_ctrl_init(phba, pcidev);
4219 if (ret) {
4220 shost_printk(KERN_ERR, phba->shost, "beiscsi_dev_probe-"
4221 "Failed in be_ctrl_init\n");
4222 goto hba_free;
4223 }
4224
e9b91193
JK		 4225 if (!num_hba) {
4226 real_offset = (u8 *)phba->csr_va + MPU_EP_SEMAPHORE;
4227 value = readl((void *)real_offset);
4228 if (value & 0x00010000) {
4229 gcrashmode++;
4230 shost_printk(KERN_ERR, phba->shost,
4231 "Loading Driver in crashdump mode\n");
4232 ret = beiscsi_pci_soft_reset(phba);
4233 if (ret) {
4234 shost_printk(KERN_ERR, phba->shost,
4235 "Reset Failed. Aborting Crashdump\n");
4236 goto hba_free;
4237 }
4238 ret = be_chk_reset_complete(phba);
4239 if (ret) {
4240 shost_printk(KERN_ERR, phba->shost,
4241 "Failed to get out of reset."
4242 "Aborting Crashdump\n");
4243 goto hba_free;
4244 }
4245 } else {
4246 value |= 0x00010000;
4247 writel(value, (void *)real_offset);
4248 num_hba++;
4249 }
4250 }
4251
6733b39a
JK		 4252 spin_lock_init(&phba->io_sgl_lock);
4253 spin_lock_init(&phba->mgmt_sgl_lock);
4254 spin_lock_init(&phba->isr_lock);
7da50879
JK		 4255 ret = mgmt_get_fw_config(&phba->ctrl, phba);
4256 if (ret != 0) {
4257 shost_printk(KERN_ERR, phba->shost,
4258 "Error getting fw config\n");
4259 goto free_port;
4260 }
4261 phba->shost->max_id = phba->fw_config.iscsi_cid_count;
6733b39a 4262 beiscsi_get_params(phba);
aa874f07 4263 phba->shost->can_queue = phba->params.ios_per_ctrl;
6733b39a
JK		 4264 ret = beiscsi_init_port(phba);
4265 if (ret < 0) {
4266 shost_printk(KERN_ERR, phba->shost, "beiscsi_dev_probe-"
4267 "Failed in beiscsi_init_port\n");
4268 goto free_port;
4269 }
4270
756d29c8
JK		 4271 for (i = 0; i < MAX_MCC_CMD ; i++) {
4272 init_waitqueue_head(&phba->ctrl.mcc_wait[i + 1]);
4273 phba->ctrl.mcc_tag[i] = i + 1;
4274 phba->ctrl.mcc_numtag[i + 1] = 0;
4275 phba->ctrl.mcc_tag_available++;
4276 }
4277
4278 phba->ctrl.mcc_alloc_index = phba->ctrl.mcc_free_index = 0;
4279
6733b39a
JK		 4280 snprintf(phba->wq_name, sizeof(phba->wq_name), "beiscsi_q_irq%u",
4281 phba->shost->host_no);
278274d5 4282 phba->wq = alloc_workqueue(phba->wq_name, WQ_MEM_RECLAIM, 1);
6733b39a
JK		 4283 if (!phba->wq) {
4284 shost_printk(KERN_ERR, phba->shost, "beiscsi_dev_probe-"
4285 "Failed to allocate work queue\n");
4286 goto free_twq;
4287 }
4288
4289 INIT_WORK(&phba->work_cqs, beiscsi_process_all_cqs);
4290
bfead3b2
JK		 4291 phwi_ctrlr = phba->phwi_ctrlr;
4292 phwi_context = phwi_ctrlr->phwi_ctxt;
6733b39a 4293 if (blk_iopoll_enabled) {
bfead3b2
JK		 4294 for (i = 0; i < phba->num_cpus; i++) {
4295 pbe_eq = &phwi_context->be_eq[i];
4296 blk_iopoll_init(&pbe_eq->iopoll, be_iopoll_budget,
4297 be_iopoll);
4298 blk_iopoll_enable(&pbe_eq->iopoll);
4299 }
6733b39a 4300 }
6733b39a
JK		 4301 ret = beiscsi_init_irqs(phba);
4302 if (ret < 0) {
4303 shost_printk(KERN_ERR, phba->shost, "beiscsi_dev_probe-"
4304 "Failed to beiscsi_init_irqs\n");
4305 goto free_blkenbld;
4306 }
238f6b72 4307 hwi_enable_intr(phba);
c7acc5b8
JK		 4308 ret = beiscsi_get_boot_info(phba);
4309 if (ret < 0) {
4310 shost_printk(KERN_ERR, phba->shost, "beiscsi_dev_probe-"
4311 "No Boot Devices !!!!!\n");
4312 }
457ff3b7 4313 SE_DEBUG(DBG_LVL_8, "\n\n\n SUCCESS - DRIVER LOADED\n\n\n");
6733b39a
JK		 4314 return 0;
4315
6733b39a
JK		 4316free_blkenbld:
4317 destroy_workqueue(phba->wq);
4318 if (blk_iopoll_enabled)
bfead3b2
JK		 4319 for (i = 0; i < phba->num_cpus; i++) {
4320 pbe_eq = &phwi_context->be_eq[i];
4321 blk_iopoll_disable(&pbe_eq->iopoll);
4322 }
6733b39a
JK		 4323free_twq:
4324 beiscsi_clean_port(phba);
4325 beiscsi_free_mem(phba);
4326free_port:
e9b91193
JK		 4327 real_offset = (u8 *)phba->csr_va + MPU_EP_SEMAPHORE;
4328
4329 value = readl((void *)real_offset);
4330
4331 if (value & 0x00010000) {
4332 value &= 0xfffeffff;
4333 writel(value, (void *)real_offset);
4334 }
4335
6733b39a
JK		 4336 pci_free_consistent(phba->pcidev,
4337 phba->ctrl.mbox_mem_alloced.size,
4338 phba->ctrl.mbox_mem_alloced.va,
4339 phba->ctrl.mbox_mem_alloced.dma);
4340 beiscsi_unmap_pci_function(phba);
4341hba_free:
238f6b72
JK		 4342 if (phba->msix_enabled)
4343 pci_disable_msix(phba->pcidev);
6733b39a
JK		 4344 iscsi_host_remove(phba->shost);
4345 pci_dev_put(phba->pcidev);
4346 iscsi_host_free(phba->shost);
4347disable_pci:
4348 pci_disable_device(pcidev);
4349 return ret;
4350}
4351
4352struct iscsi_transport beiscsi_iscsi_transport = {
4353 .owner = THIS_MODULE,
4354 .name = DRV_NAME,
9db0fb3a 4355 .caps = CAP_RECOVERY_L0 | CAP_HDRDGST | CAP_TEXT_NEGO |
6733b39a
JK		 4356 CAP_MULTI_R2T | CAP_DATADGST | CAP_DATA_PATH_OFFLOAD,
4357 .param_mask = ISCSI_MAX_RECV_DLENGTH |
4358 ISCSI_MAX_XMIT_DLENGTH |
4359 ISCSI_HDRDGST_EN |
4360 ISCSI_DATADGST_EN |
4361 ISCSI_INITIAL_R2T_EN |
4362 ISCSI_MAX_R2T |
4363 ISCSI_IMM_DATA_EN |
4364 ISCSI_FIRST_BURST |
4365 ISCSI_MAX_BURST |
4366 ISCSI_PDU_INORDER_EN |
4367 ISCSI_DATASEQ_INORDER_EN |
4368 ISCSI_ERL |
4369 ISCSI_CONN_PORT |
4370 ISCSI_CONN_ADDRESS |
4371 ISCSI_EXP_STATSN |
4372 ISCSI_PERSISTENT_PORT |
4373 ISCSI_PERSISTENT_ADDRESS |
4374 ISCSI_TARGET_NAME | ISCSI_TPGT |
4375 ISCSI_USERNAME | ISCSI_PASSWORD |
4376 ISCSI_USERNAME_IN | ISCSI_PASSWORD_IN |
4377 ISCSI_FAST_ABORT | ISCSI_ABORT_TMO |
7da50879 4378 ISCSI_LU_RESET_TMO |
6733b39a
JK		 4379 ISCSI_PING_TMO | ISCSI_RECV_TMO |
4380 ISCSI_IFACE_NAME | ISCSI_INITIATOR_NAME,
4381 .host_param_mask = ISCSI_HOST_HWADDRESS | ISCSI_HOST_IPADDRESS |
4382 ISCSI_HOST_INITIATOR_NAME,
4383 .create_session = beiscsi_session_create,
4384 .destroy_session = beiscsi_session_destroy,
4385 .create_conn = beiscsi_conn_create,
4386 .bind_conn = beiscsi_conn_bind,
4387 .destroy_conn = iscsi_conn_teardown,
4388 .set_param = beiscsi_set_param,
c7f7fd5b 4389 .get_conn_param = iscsi_conn_get_param,
6733b39a
JK		 4390 .get_session_param = iscsi_session_get_param,
4391 .get_host_param = beiscsi_get_host_param,
4392 .start_conn = beiscsi_conn_start,
fa95d206 4393 .stop_conn = iscsi_conn_stop,
6733b39a
JK		 4394 .send_pdu = iscsi_conn_send_pdu,
4395 .xmit_task = beiscsi_task_xmit,
4396 .cleanup_task = beiscsi_cleanup_task,
4397 .alloc_pdu = beiscsi_alloc_pdu,
4398 .parse_pdu_itt = beiscsi_parse_pdu,
4399 .get_stats = beiscsi_conn_get_stats,
c7f7fd5b 4400 .get_ep_param = beiscsi_ep_get_param,
6733b39a
JK		 4401 .ep_connect = beiscsi_ep_connect,
4402 .ep_poll = beiscsi_ep_poll,
4403 .ep_disconnect = beiscsi_ep_disconnect,
4404 .session_recovery_timedout = iscsi_session_recovery_timedout,
4405};
4406
4407static struct pci_driver beiscsi_pci_driver = {
4408 .name = DRV_NAME,
4409 .probe = beiscsi_dev_probe,
4410 .remove = beiscsi_remove,
4411 .id_table = beiscsi_pci_id_table
4412};
4413
bfead3b2 4414
6733b39a
JK		 4415static int __init beiscsi_module_init(void)
4416{
4417 int ret;
4418
4419 beiscsi_scsi_transport =
4420 iscsi_register_transport(&beiscsi_iscsi_transport);
4421 if (!beiscsi_scsi_transport) {
4422 SE_DEBUG(DBG_LVL_1,
4423 "beiscsi_module_init - Unable to register beiscsi"
4424 "transport.\n");
f55a24f2 4425 return -ENOMEM;
6733b39a 4426 }
457ff3b7 4427 SE_DEBUG(DBG_LVL_8, "In beiscsi_module_init, tt=%p\n",
6733b39a
JK		 4428 &beiscsi_iscsi_transport);
4429
4430 ret = pci_register_driver(&beiscsi_pci_driver);
4431 if (ret) {
4432 SE_DEBUG(DBG_LVL_1,
4433 "beiscsi_module_init - Unable to register"
4434 "beiscsi pci driver.\n");
4435 goto unregister_iscsi_transport;
4436 }
4437 return 0;
4438
4439unregister_iscsi_transport:
4440 iscsi_unregister_transport(&beiscsi_iscsi_transport);
4441 return ret;
4442}
4443
4444static void __exit beiscsi_module_exit(void)
4445{
4446 pci_unregister_driver(&beiscsi_pci_driver);
4447 iscsi_unregister_transport(&beiscsi_iscsi_transport);
4448}
4449
4450module_init(beiscsi_module_init);
4451module_exit(beiscsi_module_exit);
ubuntu-bionic-kernel mirror