xref: /openbmc/linux/drivers/scsi/be2iscsi/be_main.c (revision 4053a4be)
16733b39aSJayamohan Kallickal /**
2255fa9a3SJayamohan Kallickal  * Copyright (C) 2005 - 2011 Emulex
36733b39aSJayamohan Kallickal  * All rights reserved.
46733b39aSJayamohan Kallickal  *
56733b39aSJayamohan Kallickal  * This program is free software; you can redistribute it and/or
66733b39aSJayamohan Kallickal  * modify it under the terms of the GNU General Public License version 2
76733b39aSJayamohan Kallickal  * as published by the Free Software Foundation.  The full GNU General
86733b39aSJayamohan Kallickal  * Public License is included in this distribution in the file called COPYING.
96733b39aSJayamohan Kallickal  *
10255fa9a3SJayamohan Kallickal  * Written by: Jayamohan Kallickal (jayamohan.kallickal@emulex.com)
116733b39aSJayamohan Kallickal  *
126733b39aSJayamohan Kallickal  * Contact Information:
13255fa9a3SJayamohan Kallickal  * linux-drivers@emulex.com
146733b39aSJayamohan Kallickal  *
15255fa9a3SJayamohan Kallickal  * Emulex
16255fa9a3SJayamohan Kallickal  * 3333 Susan Street
17255fa9a3SJayamohan Kallickal  * Costa Mesa, CA 92626
186733b39aSJayamohan Kallickal  */
19255fa9a3SJayamohan Kallickal 
206733b39aSJayamohan Kallickal #include <linux/reboot.h>
216733b39aSJayamohan Kallickal #include <linux/delay.h>
225a0e3ad6STejun Heo #include <linux/slab.h>
236733b39aSJayamohan Kallickal #include <linux/interrupt.h>
246733b39aSJayamohan Kallickal #include <linux/blkdev.h>
256733b39aSJayamohan Kallickal #include <linux/pci.h>
266733b39aSJayamohan Kallickal #include <linux/string.h>
276733b39aSJayamohan Kallickal #include <linux/kernel.h>
286733b39aSJayamohan Kallickal #include <linux/semaphore.h>
29c7acc5b8SJayamohan Kallickal #include <linux/iscsi_boot_sysfs.h>
30acf3368fSPaul Gortmaker #include <linux/module.h>
316733b39aSJayamohan Kallickal 
326733b39aSJayamohan Kallickal #include <scsi/libiscsi.h>
336733b39aSJayamohan Kallickal #include <scsi/scsi_transport_iscsi.h>
346733b39aSJayamohan Kallickal #include <scsi/scsi_transport.h>
356733b39aSJayamohan Kallickal #include <scsi/scsi_cmnd.h>
366733b39aSJayamohan Kallickal #include <scsi/scsi_device.h>
376733b39aSJayamohan Kallickal #include <scsi/scsi_host.h>
386733b39aSJayamohan Kallickal #include <scsi/scsi.h>
396733b39aSJayamohan Kallickal #include "be_main.h"
406733b39aSJayamohan Kallickal #include "be_iscsi.h"
416733b39aSJayamohan Kallickal #include "be_mgmt.h"
426733b39aSJayamohan Kallickal 
436733b39aSJayamohan Kallickal static unsigned int be_iopoll_budget = 10;
446733b39aSJayamohan Kallickal static unsigned int be_max_phys_size = 64;
45bfead3b2SJayamohan Kallickal static unsigned int enable_msix = 1;
46e9b91193SJayamohan Kallickal static unsigned int gcrashmode = 0;
47e9b91193SJayamohan Kallickal static unsigned int num_hba = 0;
486733b39aSJayamohan Kallickal 
496733b39aSJayamohan Kallickal MODULE_DEVICE_TABLE(pci, beiscsi_pci_id_table);
506733b39aSJayamohan Kallickal MODULE_DESCRIPTION(DRV_DESC " " BUILD_STR);
516733b39aSJayamohan Kallickal MODULE_AUTHOR("ServerEngines Corporation");
526733b39aSJayamohan Kallickal MODULE_LICENSE("GPL");
536733b39aSJayamohan Kallickal module_param(be_iopoll_budget, int, 0);
546733b39aSJayamohan Kallickal module_param(enable_msix, int, 0);
556733b39aSJayamohan Kallickal module_param(be_max_phys_size, uint, S_IRUGO);
566733b39aSJayamohan Kallickal MODULE_PARM_DESC(be_max_phys_size, "Maximum Size (In Kilobytes) of physically"
576733b39aSJayamohan Kallickal 				   "contiguous memory that can be allocated."
586733b39aSJayamohan Kallickal 				   "Range is 16 - 128");
596733b39aSJayamohan Kallickal 
606733b39aSJayamohan Kallickal static int beiscsi_slave_configure(struct scsi_device *sdev)
616733b39aSJayamohan Kallickal {
626733b39aSJayamohan Kallickal 	blk_queue_max_segment_size(sdev->request_queue, 65536);
636733b39aSJayamohan Kallickal 	return 0;
646733b39aSJayamohan Kallickal }
656733b39aSJayamohan Kallickal 
664183122dSJayamohan Kallickal static int beiscsi_eh_abort(struct scsi_cmnd *sc)
674183122dSJayamohan Kallickal {
684183122dSJayamohan Kallickal 	struct iscsi_cls_session *cls_session;
694183122dSJayamohan Kallickal 	struct iscsi_task *aborted_task = (struct iscsi_task *)sc->SCp.ptr;
704183122dSJayamohan Kallickal 	struct beiscsi_io_task *aborted_io_task;
714183122dSJayamohan Kallickal 	struct iscsi_conn *conn;
724183122dSJayamohan Kallickal 	struct beiscsi_conn *beiscsi_conn;
734183122dSJayamohan Kallickal 	struct beiscsi_hba *phba;
744183122dSJayamohan Kallickal 	struct iscsi_session *session;
754183122dSJayamohan Kallickal 	struct invalidate_command_table *inv_tbl;
763cbb7a74SJayamohan Kallickal 	struct be_dma_mem nonemb_cmd;
774183122dSJayamohan Kallickal 	unsigned int cid, tag, num_invalidate;
784183122dSJayamohan Kallickal 
794183122dSJayamohan Kallickal 	cls_session = starget_to_session(scsi_target(sc->device));
804183122dSJayamohan Kallickal 	session = cls_session->dd_data;
814183122dSJayamohan Kallickal 
824183122dSJayamohan Kallickal 	spin_lock_bh(&session->lock);
834183122dSJayamohan Kallickal 	if (!aborted_task || !aborted_task->sc) {
844183122dSJayamohan Kallickal 		/* we raced */
854183122dSJayamohan Kallickal 		spin_unlock_bh(&session->lock);
864183122dSJayamohan Kallickal 		return SUCCESS;
874183122dSJayamohan Kallickal 	}
884183122dSJayamohan Kallickal 
894183122dSJayamohan Kallickal 	aborted_io_task = aborted_task->dd_data;
904183122dSJayamohan Kallickal 	if (!aborted_io_task->scsi_cmnd) {
914183122dSJayamohan Kallickal 		/* raced or invalid command */
924183122dSJayamohan Kallickal 		spin_unlock_bh(&session->lock);
934183122dSJayamohan Kallickal 		return SUCCESS;
944183122dSJayamohan Kallickal 	}
954183122dSJayamohan Kallickal 	spin_unlock_bh(&session->lock);
964183122dSJayamohan Kallickal 	conn = aborted_task->conn;
974183122dSJayamohan Kallickal 	beiscsi_conn = conn->dd_data;
984183122dSJayamohan Kallickal 	phba = beiscsi_conn->phba;
994183122dSJayamohan Kallickal 
1004183122dSJayamohan Kallickal 	/* invalidate iocb */
1014183122dSJayamohan Kallickal 	cid = beiscsi_conn->beiscsi_conn_cid;
1024183122dSJayamohan Kallickal 	inv_tbl = phba->inv_tbl;
1034183122dSJayamohan Kallickal 	memset(inv_tbl, 0x0, sizeof(*inv_tbl));
1044183122dSJayamohan Kallickal 	inv_tbl->cid = cid;
1054183122dSJayamohan Kallickal 	inv_tbl->icd = aborted_io_task->psgl_handle->sgl_index;
1064183122dSJayamohan Kallickal 	num_invalidate = 1;
1073cbb7a74SJayamohan Kallickal 	nonemb_cmd.va = pci_alloc_consistent(phba->ctrl.pdev,
1083cbb7a74SJayamohan Kallickal 				sizeof(struct invalidate_commands_params_in),
1093cbb7a74SJayamohan Kallickal 				&nonemb_cmd.dma);
1103cbb7a74SJayamohan Kallickal 	if (nonemb_cmd.va == NULL) {
1113cbb7a74SJayamohan Kallickal 		SE_DEBUG(DBG_LVL_1,
1123cbb7a74SJayamohan Kallickal 			 "Failed to allocate memory for"
1133cbb7a74SJayamohan Kallickal 			 "mgmt_invalidate_icds\n");
1143cbb7a74SJayamohan Kallickal 		return FAILED;
1153cbb7a74SJayamohan Kallickal 	}
1163cbb7a74SJayamohan Kallickal 	nonemb_cmd.size = sizeof(struct invalidate_commands_params_in);
1173cbb7a74SJayamohan Kallickal 
1183cbb7a74SJayamohan Kallickal 	tag = mgmt_invalidate_icds(phba, inv_tbl, num_invalidate,
1193cbb7a74SJayamohan Kallickal 				   cid, &nonemb_cmd);
1204183122dSJayamohan Kallickal 	if (!tag) {
1214183122dSJayamohan Kallickal 		shost_printk(KERN_WARNING, phba->shost,
1224183122dSJayamohan Kallickal 			     "mgmt_invalidate_icds could not be"
1234183122dSJayamohan Kallickal 			     " submitted\n");
1243cbb7a74SJayamohan Kallickal 		pci_free_consistent(phba->ctrl.pdev, nonemb_cmd.size,
1253cbb7a74SJayamohan Kallickal 				    nonemb_cmd.va, nonemb_cmd.dma);
1263cbb7a74SJayamohan Kallickal 
1274183122dSJayamohan Kallickal 		return FAILED;
1284183122dSJayamohan Kallickal 	} else {
1294183122dSJayamohan Kallickal 		wait_event_interruptible(phba->ctrl.mcc_wait[tag],
1304183122dSJayamohan Kallickal 					 phba->ctrl.mcc_numtag[tag]);
1314183122dSJayamohan Kallickal 		free_mcc_tag(&phba->ctrl, tag);
1324183122dSJayamohan Kallickal 	}
1333cbb7a74SJayamohan Kallickal 	pci_free_consistent(phba->ctrl.pdev, nonemb_cmd.size,
1343cbb7a74SJayamohan Kallickal 			    nonemb_cmd.va, nonemb_cmd.dma);
1354183122dSJayamohan Kallickal 	return iscsi_eh_abort(sc);
1364183122dSJayamohan Kallickal }
1374183122dSJayamohan Kallickal 
1384183122dSJayamohan Kallickal static int beiscsi_eh_device_reset(struct scsi_cmnd *sc)
1394183122dSJayamohan Kallickal {
1404183122dSJayamohan Kallickal 	struct iscsi_task *abrt_task;
1414183122dSJayamohan Kallickal 	struct beiscsi_io_task *abrt_io_task;
1424183122dSJayamohan Kallickal 	struct iscsi_conn *conn;
1434183122dSJayamohan Kallickal 	struct beiscsi_conn *beiscsi_conn;
1444183122dSJayamohan Kallickal 	struct beiscsi_hba *phba;
1454183122dSJayamohan Kallickal 	struct iscsi_session *session;
1464183122dSJayamohan Kallickal 	struct iscsi_cls_session *cls_session;
1474183122dSJayamohan Kallickal 	struct invalidate_command_table *inv_tbl;
1483cbb7a74SJayamohan Kallickal 	struct be_dma_mem nonemb_cmd;
1494183122dSJayamohan Kallickal 	unsigned int cid, tag, i, num_invalidate;
1504183122dSJayamohan Kallickal 	int rc = FAILED;
1514183122dSJayamohan Kallickal 
1524183122dSJayamohan Kallickal 	/* invalidate iocbs */
1534183122dSJayamohan Kallickal 	cls_session = starget_to_session(scsi_target(sc->device));
1544183122dSJayamohan Kallickal 	session = cls_session->dd_data;
1554183122dSJayamohan Kallickal 	spin_lock_bh(&session->lock);
1564183122dSJayamohan Kallickal 	if (!session->leadconn || session->state != ISCSI_STATE_LOGGED_IN)
1574183122dSJayamohan Kallickal 		goto unlock;
1584183122dSJayamohan Kallickal 
1594183122dSJayamohan Kallickal 	conn = session->leadconn;
1604183122dSJayamohan Kallickal 	beiscsi_conn = conn->dd_data;
1614183122dSJayamohan Kallickal 	phba = beiscsi_conn->phba;
1624183122dSJayamohan Kallickal 	cid = beiscsi_conn->beiscsi_conn_cid;
1634183122dSJayamohan Kallickal 	inv_tbl = phba->inv_tbl;
1644183122dSJayamohan Kallickal 	memset(inv_tbl, 0x0, sizeof(*inv_tbl) * BE2_CMDS_PER_CXN);
1654183122dSJayamohan Kallickal 	num_invalidate = 0;
1664183122dSJayamohan Kallickal 	for (i = 0; i < conn->session->cmds_max; i++) {
1674183122dSJayamohan Kallickal 		abrt_task = conn->session->cmds[i];
1684183122dSJayamohan Kallickal 		abrt_io_task = abrt_task->dd_data;
1694183122dSJayamohan Kallickal 		if (!abrt_task->sc || abrt_task->state == ISCSI_TASK_FREE)
1704183122dSJayamohan Kallickal 			continue;
1714183122dSJayamohan Kallickal 
1724183122dSJayamohan Kallickal 		if (abrt_task->sc->device->lun != abrt_task->sc->device->lun)
1734183122dSJayamohan Kallickal 			continue;
1744183122dSJayamohan Kallickal 
1754183122dSJayamohan Kallickal 		inv_tbl->cid = cid;
1764183122dSJayamohan Kallickal 		inv_tbl->icd = abrt_io_task->psgl_handle->sgl_index;
1774183122dSJayamohan Kallickal 		num_invalidate++;
1784183122dSJayamohan Kallickal 		inv_tbl++;
1794183122dSJayamohan Kallickal 	}
1804183122dSJayamohan Kallickal 	spin_unlock_bh(&session->lock);
1814183122dSJayamohan Kallickal 	inv_tbl = phba->inv_tbl;
1824183122dSJayamohan Kallickal 
1833cbb7a74SJayamohan Kallickal 	nonemb_cmd.va = pci_alloc_consistent(phba->ctrl.pdev,
1843cbb7a74SJayamohan Kallickal 				sizeof(struct invalidate_commands_params_in),
1853cbb7a74SJayamohan Kallickal 				&nonemb_cmd.dma);
1863cbb7a74SJayamohan Kallickal 	if (nonemb_cmd.va == NULL) {
1873cbb7a74SJayamohan Kallickal 		SE_DEBUG(DBG_LVL_1,
1883cbb7a74SJayamohan Kallickal 			 "Failed to allocate memory for"
1893cbb7a74SJayamohan Kallickal 			 "mgmt_invalidate_icds\n");
1903cbb7a74SJayamohan Kallickal 		return FAILED;
1913cbb7a74SJayamohan Kallickal 	}
1923cbb7a74SJayamohan Kallickal 	nonemb_cmd.size = sizeof(struct invalidate_commands_params_in);
1933cbb7a74SJayamohan Kallickal 	memset(nonemb_cmd.va, 0, nonemb_cmd.size);
1943cbb7a74SJayamohan Kallickal 	tag = mgmt_invalidate_icds(phba, inv_tbl, num_invalidate,
1953cbb7a74SJayamohan Kallickal 				   cid, &nonemb_cmd);
1964183122dSJayamohan Kallickal 	if (!tag) {
1974183122dSJayamohan Kallickal 		shost_printk(KERN_WARNING, phba->shost,
1984183122dSJayamohan Kallickal 			     "mgmt_invalidate_icds could not be"
1994183122dSJayamohan Kallickal 			     " submitted\n");
2003cbb7a74SJayamohan Kallickal 		pci_free_consistent(phba->ctrl.pdev, nonemb_cmd.size,
2013cbb7a74SJayamohan Kallickal 				    nonemb_cmd.va, nonemb_cmd.dma);
2024183122dSJayamohan Kallickal 		return FAILED;
2034183122dSJayamohan Kallickal 	} else {
2044183122dSJayamohan Kallickal 		wait_event_interruptible(phba->ctrl.mcc_wait[tag],
2054183122dSJayamohan Kallickal 					 phba->ctrl.mcc_numtag[tag]);
2064183122dSJayamohan Kallickal 		free_mcc_tag(&phba->ctrl, tag);
2074183122dSJayamohan Kallickal 	}
2083cbb7a74SJayamohan Kallickal 	pci_free_consistent(phba->ctrl.pdev, nonemb_cmd.size,
2093cbb7a74SJayamohan Kallickal 			    nonemb_cmd.va, nonemb_cmd.dma);
2104183122dSJayamohan Kallickal 	return iscsi_eh_device_reset(sc);
2114183122dSJayamohan Kallickal unlock:
2124183122dSJayamohan Kallickal 	spin_unlock_bh(&session->lock);
2134183122dSJayamohan Kallickal 	return rc;
2144183122dSJayamohan Kallickal }
2154183122dSJayamohan Kallickal 
216c7acc5b8SJayamohan Kallickal static ssize_t beiscsi_show_boot_tgt_info(void *data, int type, char *buf)
217c7acc5b8SJayamohan Kallickal {
218c7acc5b8SJayamohan Kallickal 	struct beiscsi_hba *phba = data;
219f457a46fSMike Christie 	struct mgmt_session_info *boot_sess = &phba->boot_sess;
220f457a46fSMike Christie 	struct mgmt_conn_info *boot_conn = &boot_sess->conn_list[0];
221c7acc5b8SJayamohan Kallickal 	char *str = buf;
222c7acc5b8SJayamohan Kallickal 	int rc;
223c7acc5b8SJayamohan Kallickal 
224c7acc5b8SJayamohan Kallickal 	switch (type) {
225c7acc5b8SJayamohan Kallickal 	case ISCSI_BOOT_TGT_NAME:
226c7acc5b8SJayamohan Kallickal 		rc = sprintf(buf, "%.*s\n",
227f457a46fSMike Christie 			    (int)strlen(boot_sess->target_name),
228f457a46fSMike Christie 			    (char *)&boot_sess->target_name);
229c7acc5b8SJayamohan Kallickal 		break;
230c7acc5b8SJayamohan Kallickal 	case ISCSI_BOOT_TGT_IP_ADDR:
231f457a46fSMike Christie 		if (boot_conn->dest_ipaddr.ip_type == 0x1)
232c7acc5b8SJayamohan Kallickal 			rc = sprintf(buf, "%pI4\n",
233f457a46fSMike Christie 				(char *)&boot_conn->dest_ipaddr.ip_address);
234c7acc5b8SJayamohan Kallickal 		else
235c7acc5b8SJayamohan Kallickal 			rc = sprintf(str, "%pI6\n",
236f457a46fSMike Christie 				(char *)&boot_conn->dest_ipaddr.ip_address);
237c7acc5b8SJayamohan Kallickal 		break;
238c7acc5b8SJayamohan Kallickal 	case ISCSI_BOOT_TGT_PORT:
239f457a46fSMike Christie 		rc = sprintf(str, "%d\n", boot_conn->dest_port);
240c7acc5b8SJayamohan Kallickal 		break;
241c7acc5b8SJayamohan Kallickal 
242c7acc5b8SJayamohan Kallickal 	case ISCSI_BOOT_TGT_CHAP_NAME:
243c7acc5b8SJayamohan Kallickal 		rc = sprintf(str,  "%.*s\n",
244f457a46fSMike Christie 			     boot_conn->negotiated_login_options.auth_data.chap.
245c7acc5b8SJayamohan Kallickal 			     target_chap_name_length,
246f457a46fSMike Christie 			     (char *)&boot_conn->negotiated_login_options.
247f457a46fSMike Christie 			     auth_data.chap.target_chap_name);
248c7acc5b8SJayamohan Kallickal 		break;
249c7acc5b8SJayamohan Kallickal 	case ISCSI_BOOT_TGT_CHAP_SECRET:
250c7acc5b8SJayamohan Kallickal 		rc = sprintf(str,  "%.*s\n",
251f457a46fSMike Christie 			     boot_conn->negotiated_login_options.auth_data.chap.
252c7acc5b8SJayamohan Kallickal 			     target_secret_length,
253f457a46fSMike Christie 			     (char *)&boot_conn->negotiated_login_options.
254f457a46fSMike Christie 			     auth_data.chap.target_secret);
255c7acc5b8SJayamohan Kallickal 		break;
256c7acc5b8SJayamohan Kallickal 	case ISCSI_BOOT_TGT_REV_CHAP_NAME:
257c7acc5b8SJayamohan Kallickal 		rc = sprintf(str,  "%.*s\n",
258f457a46fSMike Christie 			     boot_conn->negotiated_login_options.auth_data.chap.
259c7acc5b8SJayamohan Kallickal 			     intr_chap_name_length,
260f457a46fSMike Christie 			     (char *)&boot_conn->negotiated_login_options.
261f457a46fSMike Christie 			     auth_data.chap.intr_chap_name);
262c7acc5b8SJayamohan Kallickal 		break;
263c7acc5b8SJayamohan Kallickal 	case ISCSI_BOOT_TGT_REV_CHAP_SECRET:
264c7acc5b8SJayamohan Kallickal 		rc = sprintf(str,  "%.*s\n",
265f457a46fSMike Christie 			     boot_conn->negotiated_login_options.auth_data.chap.
266c7acc5b8SJayamohan Kallickal 			     intr_secret_length,
267f457a46fSMike Christie 			     (char *)&boot_conn->negotiated_login_options.
268f457a46fSMike Christie 			     auth_data.chap.intr_secret);
269c7acc5b8SJayamohan Kallickal 		break;
270c7acc5b8SJayamohan Kallickal 	case ISCSI_BOOT_TGT_FLAGS:
271c7acc5b8SJayamohan Kallickal 		rc = sprintf(str, "2\n");
272c7acc5b8SJayamohan Kallickal 		break;
273c7acc5b8SJayamohan Kallickal 	case ISCSI_BOOT_TGT_NIC_ASSOC:
274c7acc5b8SJayamohan Kallickal 		rc = sprintf(str, "0\n");
275c7acc5b8SJayamohan Kallickal 		break;
276c7acc5b8SJayamohan Kallickal 	default:
277c7acc5b8SJayamohan Kallickal 		rc = -ENOSYS;
278c7acc5b8SJayamohan Kallickal 		break;
279c7acc5b8SJayamohan Kallickal 	}
280c7acc5b8SJayamohan Kallickal 	return rc;
281c7acc5b8SJayamohan Kallickal }
282c7acc5b8SJayamohan Kallickal 
283c7acc5b8SJayamohan Kallickal static ssize_t beiscsi_show_boot_ini_info(void *data, int type, char *buf)
284c7acc5b8SJayamohan Kallickal {
285c7acc5b8SJayamohan Kallickal 	struct beiscsi_hba *phba = data;
286c7acc5b8SJayamohan Kallickal 	char *str = buf;
287c7acc5b8SJayamohan Kallickal 	int rc;
288c7acc5b8SJayamohan Kallickal 
289c7acc5b8SJayamohan Kallickal 	switch (type) {
290c7acc5b8SJayamohan Kallickal 	case ISCSI_BOOT_INI_INITIATOR_NAME:
291c7acc5b8SJayamohan Kallickal 		rc = sprintf(str, "%s\n", phba->boot_sess.initiator_iscsiname);
292c7acc5b8SJayamohan Kallickal 		break;
293c7acc5b8SJayamohan Kallickal 	default:
294c7acc5b8SJayamohan Kallickal 		rc = -ENOSYS;
295c7acc5b8SJayamohan Kallickal 		break;
296c7acc5b8SJayamohan Kallickal 	}
297c7acc5b8SJayamohan Kallickal 	return rc;
298c7acc5b8SJayamohan Kallickal }
299c7acc5b8SJayamohan Kallickal 
300c7acc5b8SJayamohan Kallickal static ssize_t beiscsi_show_boot_eth_info(void *data, int type, char *buf)
301c7acc5b8SJayamohan Kallickal {
302c7acc5b8SJayamohan Kallickal 	struct beiscsi_hba *phba = data;
303c7acc5b8SJayamohan Kallickal 	char *str = buf;
304c7acc5b8SJayamohan Kallickal 	int rc;
305c7acc5b8SJayamohan Kallickal 
306c7acc5b8SJayamohan Kallickal 	switch (type) {
307c7acc5b8SJayamohan Kallickal 	case ISCSI_BOOT_ETH_FLAGS:
308c7acc5b8SJayamohan Kallickal 		rc = sprintf(str, "2\n");
309c7acc5b8SJayamohan Kallickal 		break;
310c7acc5b8SJayamohan Kallickal 	case ISCSI_BOOT_ETH_INDEX:
311c7acc5b8SJayamohan Kallickal 		rc = sprintf(str, "0\n");
312c7acc5b8SJayamohan Kallickal 		break;
313c7acc5b8SJayamohan Kallickal 	case ISCSI_BOOT_ETH_MAC:
314c7acc5b8SJayamohan Kallickal 		rc  = beiscsi_get_macaddr(buf, phba);
315c7acc5b8SJayamohan Kallickal 		if (rc < 0) {
316c7acc5b8SJayamohan Kallickal 			SE_DEBUG(DBG_LVL_1, "beiscsi_get_macaddr Failed\n");
317c7acc5b8SJayamohan Kallickal 			return rc;
318c7acc5b8SJayamohan Kallickal 		}
319c7acc5b8SJayamohan Kallickal 	break;
320c7acc5b8SJayamohan Kallickal 	default:
321c7acc5b8SJayamohan Kallickal 		rc = -ENOSYS;
322c7acc5b8SJayamohan Kallickal 		break;
323c7acc5b8SJayamohan Kallickal 	}
324c7acc5b8SJayamohan Kallickal 	return rc;
325c7acc5b8SJayamohan Kallickal }
326c7acc5b8SJayamohan Kallickal 
327c7acc5b8SJayamohan Kallickal 
328c7acc5b8SJayamohan Kallickal static mode_t beiscsi_tgt_get_attr_visibility(void *data, int type)
329c7acc5b8SJayamohan Kallickal {
330c7acc5b8SJayamohan Kallickal 	int rc;
331c7acc5b8SJayamohan Kallickal 
332c7acc5b8SJayamohan Kallickal 	switch (type) {
333c7acc5b8SJayamohan Kallickal 	case ISCSI_BOOT_TGT_NAME:
334c7acc5b8SJayamohan Kallickal 	case ISCSI_BOOT_TGT_IP_ADDR:
335c7acc5b8SJayamohan Kallickal 	case ISCSI_BOOT_TGT_PORT:
336c7acc5b8SJayamohan Kallickal 	case ISCSI_BOOT_TGT_CHAP_NAME:
337c7acc5b8SJayamohan Kallickal 	case ISCSI_BOOT_TGT_CHAP_SECRET:
338c7acc5b8SJayamohan Kallickal 	case ISCSI_BOOT_TGT_REV_CHAP_NAME:
339c7acc5b8SJayamohan Kallickal 	case ISCSI_BOOT_TGT_REV_CHAP_SECRET:
340c7acc5b8SJayamohan Kallickal 	case ISCSI_BOOT_TGT_NIC_ASSOC:
341c7acc5b8SJayamohan Kallickal 	case ISCSI_BOOT_TGT_FLAGS:
342c7acc5b8SJayamohan Kallickal 		rc = S_IRUGO;
343c7acc5b8SJayamohan Kallickal 		break;
344c7acc5b8SJayamohan Kallickal 	default:
345c7acc5b8SJayamohan Kallickal 		rc = 0;
346c7acc5b8SJayamohan Kallickal 		break;
347c7acc5b8SJayamohan Kallickal 	}
348c7acc5b8SJayamohan Kallickal 	return rc;
349c7acc5b8SJayamohan Kallickal }
350c7acc5b8SJayamohan Kallickal 
351c7acc5b8SJayamohan Kallickal static mode_t beiscsi_ini_get_attr_visibility(void *data, int type)
352c7acc5b8SJayamohan Kallickal {
353c7acc5b8SJayamohan Kallickal 	int rc;
354c7acc5b8SJayamohan Kallickal 
355c7acc5b8SJayamohan Kallickal 	switch (type) {
356c7acc5b8SJayamohan Kallickal 	case ISCSI_BOOT_INI_INITIATOR_NAME:
357c7acc5b8SJayamohan Kallickal 		rc = S_IRUGO;
358c7acc5b8SJayamohan Kallickal 		break;
359c7acc5b8SJayamohan Kallickal 	default:
360c7acc5b8SJayamohan Kallickal 		rc = 0;
361c7acc5b8SJayamohan Kallickal 		break;
362c7acc5b8SJayamohan Kallickal 	}
363c7acc5b8SJayamohan Kallickal 	return rc;
364c7acc5b8SJayamohan Kallickal }
365c7acc5b8SJayamohan Kallickal 
366c7acc5b8SJayamohan Kallickal 
367c7acc5b8SJayamohan Kallickal static mode_t beiscsi_eth_get_attr_visibility(void *data, int type)
368c7acc5b8SJayamohan Kallickal {
369c7acc5b8SJayamohan Kallickal 	int rc;
370c7acc5b8SJayamohan Kallickal 
371c7acc5b8SJayamohan Kallickal 	switch (type) {
372c7acc5b8SJayamohan Kallickal 	case ISCSI_BOOT_ETH_FLAGS:
373c7acc5b8SJayamohan Kallickal 	case ISCSI_BOOT_ETH_MAC:
374c7acc5b8SJayamohan Kallickal 	case ISCSI_BOOT_ETH_INDEX:
375c7acc5b8SJayamohan Kallickal 		rc = S_IRUGO;
376c7acc5b8SJayamohan Kallickal 		break;
377c7acc5b8SJayamohan Kallickal 	default:
378c7acc5b8SJayamohan Kallickal 		rc = 0;
379c7acc5b8SJayamohan Kallickal 		break;
380c7acc5b8SJayamohan Kallickal 	}
381c7acc5b8SJayamohan Kallickal 	return rc;
382c7acc5b8SJayamohan Kallickal }
383c7acc5b8SJayamohan Kallickal 
384bfead3b2SJayamohan Kallickal /*------------------- PCI Driver operations and data ----------------- */
385bfead3b2SJayamohan Kallickal static DEFINE_PCI_DEVICE_TABLE(beiscsi_pci_id_table) = {
386bfead3b2SJayamohan Kallickal 	{ PCI_DEVICE(BE_VENDOR_ID, BE_DEVICE_ID1) },
387f98c96b0SJayamohan Kallickal 	{ PCI_DEVICE(BE_VENDOR_ID, BE_DEVICE_ID2) },
388bfead3b2SJayamohan Kallickal 	{ PCI_DEVICE(BE_VENDOR_ID, OC_DEVICE_ID1) },
389bfead3b2SJayamohan Kallickal 	{ PCI_DEVICE(BE_VENDOR_ID, OC_DEVICE_ID2) },
390bfead3b2SJayamohan Kallickal 	{ PCI_DEVICE(BE_VENDOR_ID, OC_DEVICE_ID3) },
391bfead3b2SJayamohan Kallickal 	{ 0 }
392bfead3b2SJayamohan Kallickal };
393bfead3b2SJayamohan Kallickal MODULE_DEVICE_TABLE(pci, beiscsi_pci_id_table);
394bfead3b2SJayamohan Kallickal 
3956733b39aSJayamohan Kallickal static struct scsi_host_template beiscsi_sht = {
3966733b39aSJayamohan Kallickal 	.module = THIS_MODULE,
3976733b39aSJayamohan Kallickal 	.name = "ServerEngines 10Gbe open-iscsi Initiator Driver",
3986733b39aSJayamohan Kallickal 	.proc_name = DRV_NAME,
3996733b39aSJayamohan Kallickal 	.queuecommand = iscsi_queuecommand,
4006733b39aSJayamohan Kallickal 	.change_queue_depth = iscsi_change_queue_depth,
4016733b39aSJayamohan Kallickal 	.slave_configure = beiscsi_slave_configure,
4026733b39aSJayamohan Kallickal 	.target_alloc = iscsi_target_alloc,
4034183122dSJayamohan Kallickal 	.eh_abort_handler = beiscsi_eh_abort,
4044183122dSJayamohan Kallickal 	.eh_device_reset_handler = beiscsi_eh_device_reset,
405309ce156SJayamohan Kallickal 	.eh_target_reset_handler = iscsi_eh_session_reset,
4066733b39aSJayamohan Kallickal 	.sg_tablesize = BEISCSI_SGLIST_ELEMENTS,
4076733b39aSJayamohan Kallickal 	.can_queue = BE2_IO_DEPTH,
4086733b39aSJayamohan Kallickal 	.this_id = -1,
4096733b39aSJayamohan Kallickal 	.max_sectors = BEISCSI_MAX_SECTORS,
4106733b39aSJayamohan Kallickal 	.cmd_per_lun = BEISCSI_CMD_PER_LUN,
4116733b39aSJayamohan Kallickal 	.use_clustering = ENABLE_CLUSTERING,
4126733b39aSJayamohan Kallickal };
4136733b39aSJayamohan Kallickal 
414bfead3b2SJayamohan Kallickal static struct scsi_transport_template *beiscsi_scsi_transport;
4156733b39aSJayamohan Kallickal 
4166733b39aSJayamohan Kallickal static struct beiscsi_hba *beiscsi_hba_alloc(struct pci_dev *pcidev)
4176733b39aSJayamohan Kallickal {
4186733b39aSJayamohan Kallickal 	struct beiscsi_hba *phba;
4196733b39aSJayamohan Kallickal 	struct Scsi_Host *shost;
4206733b39aSJayamohan Kallickal 
4216733b39aSJayamohan Kallickal 	shost = iscsi_host_alloc(&beiscsi_sht, sizeof(*phba), 0);
4226733b39aSJayamohan Kallickal 	if (!shost) {
4236733b39aSJayamohan Kallickal 		dev_err(&pcidev->dev, "beiscsi_hba_alloc -"
4246733b39aSJayamohan Kallickal 			"iscsi_host_alloc failed\n");
4256733b39aSJayamohan Kallickal 		return NULL;
4266733b39aSJayamohan Kallickal 	}
4276733b39aSJayamohan Kallickal 	shost->dma_boundary = pcidev->dma_mask;
4286733b39aSJayamohan Kallickal 	shost->max_id = BE2_MAX_SESSIONS;
4296733b39aSJayamohan Kallickal 	shost->max_channel = 0;
4306733b39aSJayamohan Kallickal 	shost->max_cmd_len = BEISCSI_MAX_CMD_LEN;
4316733b39aSJayamohan Kallickal 	shost->max_lun = BEISCSI_NUM_MAX_LUN;
4326733b39aSJayamohan Kallickal 	shost->transportt = beiscsi_scsi_transport;
4336733b39aSJayamohan Kallickal 	phba = iscsi_host_priv(shost);
4346733b39aSJayamohan Kallickal 	memset(phba, 0, sizeof(*phba));
4356733b39aSJayamohan Kallickal 	phba->shost = shost;
4366733b39aSJayamohan Kallickal 	phba->pcidev = pci_dev_get(pcidev);
4372807afb7SJayamohan Kallickal 	pci_set_drvdata(pcidev, phba);
4386733b39aSJayamohan Kallickal 
4396733b39aSJayamohan Kallickal 	if (iscsi_host_add(shost, &phba->pcidev->dev))
4406733b39aSJayamohan Kallickal 		goto free_devices;
441c7acc5b8SJayamohan Kallickal 
4426733b39aSJayamohan Kallickal 	return phba;
4436733b39aSJayamohan Kallickal 
4446733b39aSJayamohan Kallickal free_devices:
4456733b39aSJayamohan Kallickal 	pci_dev_put(phba->pcidev);
4466733b39aSJayamohan Kallickal 	iscsi_host_free(phba->shost);
4476733b39aSJayamohan Kallickal 	return NULL;
4486733b39aSJayamohan Kallickal }
4496733b39aSJayamohan Kallickal 
4506733b39aSJayamohan Kallickal static void beiscsi_unmap_pci_function(struct beiscsi_hba *phba)
4516733b39aSJayamohan Kallickal {
4526733b39aSJayamohan Kallickal 	if (phba->csr_va) {
4536733b39aSJayamohan Kallickal 		iounmap(phba->csr_va);
4546733b39aSJayamohan Kallickal 		phba->csr_va = NULL;
4556733b39aSJayamohan Kallickal 	}
4566733b39aSJayamohan Kallickal 	if (phba->db_va) {
4576733b39aSJayamohan Kallickal 		iounmap(phba->db_va);
4586733b39aSJayamohan Kallickal 		phba->db_va = NULL;
4596733b39aSJayamohan Kallickal 	}
4606733b39aSJayamohan Kallickal 	if (phba->pci_va) {
4616733b39aSJayamohan Kallickal 		iounmap(phba->pci_va);
4626733b39aSJayamohan Kallickal 		phba->pci_va = NULL;
4636733b39aSJayamohan Kallickal 	}
4646733b39aSJayamohan Kallickal }
4656733b39aSJayamohan Kallickal 
4666733b39aSJayamohan Kallickal static int beiscsi_map_pci_bars(struct beiscsi_hba *phba,
4676733b39aSJayamohan Kallickal 				struct pci_dev *pcidev)
4686733b39aSJayamohan Kallickal {
4696733b39aSJayamohan Kallickal 	u8 __iomem *addr;
470f98c96b0SJayamohan Kallickal 	int pcicfg_reg;
4716733b39aSJayamohan Kallickal 
4726733b39aSJayamohan Kallickal 	addr = ioremap_nocache(pci_resource_start(pcidev, 2),
4736733b39aSJayamohan Kallickal 			       pci_resource_len(pcidev, 2));
4746733b39aSJayamohan Kallickal 	if (addr == NULL)
4756733b39aSJayamohan Kallickal 		return -ENOMEM;
4766733b39aSJayamohan Kallickal 	phba->ctrl.csr = addr;
4776733b39aSJayamohan Kallickal 	phba->csr_va = addr;
4786733b39aSJayamohan Kallickal 	phba->csr_pa.u.a64.address = pci_resource_start(pcidev, 2);
4796733b39aSJayamohan Kallickal 
4806733b39aSJayamohan Kallickal 	addr = ioremap_nocache(pci_resource_start(pcidev, 4), 128 * 1024);
4816733b39aSJayamohan Kallickal 	if (addr == NULL)
4826733b39aSJayamohan Kallickal 		goto pci_map_err;
4836733b39aSJayamohan Kallickal 	phba->ctrl.db = addr;
4846733b39aSJayamohan Kallickal 	phba->db_va = addr;
4856733b39aSJayamohan Kallickal 	phba->db_pa.u.a64.address =  pci_resource_start(pcidev, 4);
4866733b39aSJayamohan Kallickal 
487f98c96b0SJayamohan Kallickal 	if (phba->generation == BE_GEN2)
488f98c96b0SJayamohan Kallickal 		pcicfg_reg = 1;
489f98c96b0SJayamohan Kallickal 	else
490f98c96b0SJayamohan Kallickal 		pcicfg_reg = 0;
491f98c96b0SJayamohan Kallickal 
492f98c96b0SJayamohan Kallickal 	addr = ioremap_nocache(pci_resource_start(pcidev, pcicfg_reg),
493f98c96b0SJayamohan Kallickal 			       pci_resource_len(pcidev, pcicfg_reg));
494f98c96b0SJayamohan Kallickal 
4956733b39aSJayamohan Kallickal 	if (addr == NULL)
4966733b39aSJayamohan Kallickal 		goto pci_map_err;
4976733b39aSJayamohan Kallickal 	phba->ctrl.pcicfg = addr;
4986733b39aSJayamohan Kallickal 	phba->pci_va = addr;
499f98c96b0SJayamohan Kallickal 	phba->pci_pa.u.a64.address = pci_resource_start(pcidev, pcicfg_reg);
5006733b39aSJayamohan Kallickal 	return 0;
5016733b39aSJayamohan Kallickal 
5026733b39aSJayamohan Kallickal pci_map_err:
5036733b39aSJayamohan Kallickal 	beiscsi_unmap_pci_function(phba);
5046733b39aSJayamohan Kallickal 	return -ENOMEM;
5056733b39aSJayamohan Kallickal }
5066733b39aSJayamohan Kallickal 
5076733b39aSJayamohan Kallickal static int beiscsi_enable_pci(struct pci_dev *pcidev)
5086733b39aSJayamohan Kallickal {
5096733b39aSJayamohan Kallickal 	int ret;
5106733b39aSJayamohan Kallickal 
5116733b39aSJayamohan Kallickal 	ret = pci_enable_device(pcidev);
5126733b39aSJayamohan Kallickal 	if (ret) {
5136733b39aSJayamohan Kallickal 		dev_err(&pcidev->dev, "beiscsi_enable_pci - enable device "
5146733b39aSJayamohan Kallickal 			"failed. Returning -ENODEV\n");
5156733b39aSJayamohan Kallickal 		return ret;
5166733b39aSJayamohan Kallickal 	}
5176733b39aSJayamohan Kallickal 
518bfead3b2SJayamohan Kallickal 	pci_set_master(pcidev);
5196733b39aSJayamohan Kallickal 	if (pci_set_consistent_dma_mask(pcidev, DMA_BIT_MASK(64))) {
5206733b39aSJayamohan Kallickal 		ret = pci_set_consistent_dma_mask(pcidev, DMA_BIT_MASK(32));
5216733b39aSJayamohan Kallickal 		if (ret) {
5226733b39aSJayamohan Kallickal 			dev_err(&pcidev->dev, "Could not set PCI DMA Mask\n");
5236733b39aSJayamohan Kallickal 			pci_disable_device(pcidev);
5246733b39aSJayamohan Kallickal 			return ret;
5256733b39aSJayamohan Kallickal 		}
5266733b39aSJayamohan Kallickal 	}
5276733b39aSJayamohan Kallickal 	return 0;
5286733b39aSJayamohan Kallickal }
5296733b39aSJayamohan Kallickal 
5306733b39aSJayamohan Kallickal static int be_ctrl_init(struct beiscsi_hba *phba, struct pci_dev *pdev)
5316733b39aSJayamohan Kallickal {
5326733b39aSJayamohan Kallickal 	struct be_ctrl_info *ctrl = &phba->ctrl;
5336733b39aSJayamohan Kallickal 	struct be_dma_mem *mbox_mem_alloc = &ctrl->mbox_mem_alloced;
5346733b39aSJayamohan Kallickal 	struct be_dma_mem *mbox_mem_align = &ctrl->mbox_mem;
5356733b39aSJayamohan Kallickal 	int status = 0;
5366733b39aSJayamohan Kallickal 
5376733b39aSJayamohan Kallickal 	ctrl->pdev = pdev;
5386733b39aSJayamohan Kallickal 	status = beiscsi_map_pci_bars(phba, pdev);
5396733b39aSJayamohan Kallickal 	if (status)
5406733b39aSJayamohan Kallickal 		return status;
5416733b39aSJayamohan Kallickal 	mbox_mem_alloc->size = sizeof(struct be_mcc_mailbox) + 16;
5426733b39aSJayamohan Kallickal 	mbox_mem_alloc->va = pci_alloc_consistent(pdev,
5436733b39aSJayamohan Kallickal 						  mbox_mem_alloc->size,
5446733b39aSJayamohan Kallickal 						  &mbox_mem_alloc->dma);
5456733b39aSJayamohan Kallickal 	if (!mbox_mem_alloc->va) {
5466733b39aSJayamohan Kallickal 		beiscsi_unmap_pci_function(phba);
5476733b39aSJayamohan Kallickal 		status = -ENOMEM;
5486733b39aSJayamohan Kallickal 		return status;
5496733b39aSJayamohan Kallickal 	}
5506733b39aSJayamohan Kallickal 
5516733b39aSJayamohan Kallickal 	mbox_mem_align->size = sizeof(struct be_mcc_mailbox);
5526733b39aSJayamohan Kallickal 	mbox_mem_align->va = PTR_ALIGN(mbox_mem_alloc->va, 16);
5536733b39aSJayamohan Kallickal 	mbox_mem_align->dma = PTR_ALIGN(mbox_mem_alloc->dma, 16);
5546733b39aSJayamohan Kallickal 	memset(mbox_mem_align->va, 0, sizeof(struct be_mcc_mailbox));
5556733b39aSJayamohan Kallickal 	spin_lock_init(&ctrl->mbox_lock);
556bfead3b2SJayamohan Kallickal 	spin_lock_init(&phba->ctrl.mcc_lock);
557bfead3b2SJayamohan Kallickal 	spin_lock_init(&phba->ctrl.mcc_cq_lock);
558bfead3b2SJayamohan Kallickal 
5596733b39aSJayamohan Kallickal 	return status;
5606733b39aSJayamohan Kallickal }
5616733b39aSJayamohan Kallickal 
5626733b39aSJayamohan Kallickal static void beiscsi_get_params(struct beiscsi_hba *phba)
5636733b39aSJayamohan Kallickal {
5647da50879SJayamohan Kallickal 	phba->params.ios_per_ctrl = (phba->fw_config.iscsi_icd_count
5657da50879SJayamohan Kallickal 				    - (phba->fw_config.iscsi_cid_count
5667da50879SJayamohan Kallickal 				    + BE2_TMFS
5677da50879SJayamohan Kallickal 				    + BE2_NOPOUT_REQ));
5687da50879SJayamohan Kallickal 	phba->params.cxns_per_ctrl = phba->fw_config.iscsi_cid_count;
569ed58ea2aSJayamohan Kallickal 	phba->params.asyncpdus_per_ctrl = phba->fw_config.iscsi_cid_count * 2;
5706eab04a8SJustin P. Mattock 	phba->params.icds_per_ctrl = phba->fw_config.iscsi_icd_count;
5716733b39aSJayamohan Kallickal 	phba->params.num_sge_per_io = BE2_SGE;
5726733b39aSJayamohan Kallickal 	phba->params.defpdu_hdr_sz = BE2_DEFPDU_HDR_SZ;
5736733b39aSJayamohan Kallickal 	phba->params.defpdu_data_sz = BE2_DEFPDU_DATA_SZ;
5746733b39aSJayamohan Kallickal 	phba->params.eq_timer = 64;
5756733b39aSJayamohan Kallickal 	phba->params.num_eq_entries =
5767da50879SJayamohan Kallickal 	    (((BE2_CMDS_PER_CXN * 2 + phba->fw_config.iscsi_cid_count * 2
5777da50879SJayamohan Kallickal 				    + BE2_TMFS) / 512) + 1) * 512;
5786733b39aSJayamohan Kallickal 	phba->params.num_eq_entries = (phba->params.num_eq_entries < 1024)
5796733b39aSJayamohan Kallickal 				? 1024 : phba->params.num_eq_entries;
5806733b39aSJayamohan Kallickal 	SE_DEBUG(DBG_LVL_8, "phba->params.num_eq_entries=%d\n",
5816733b39aSJayamohan Kallickal 			     phba->params.num_eq_entries);
5826733b39aSJayamohan Kallickal 	phba->params.num_cq_entries =
5837da50879SJayamohan Kallickal 	    (((BE2_CMDS_PER_CXN * 2 +  phba->fw_config.iscsi_cid_count * 2
5847da50879SJayamohan Kallickal 				    + BE2_TMFS) / 512) + 1) * 512;
5856733b39aSJayamohan Kallickal 	phba->params.wrbs_per_cxn = 256;
5866733b39aSJayamohan Kallickal }
5876733b39aSJayamohan Kallickal 
5886733b39aSJayamohan Kallickal static void hwi_ring_eq_db(struct beiscsi_hba *phba,
5896733b39aSJayamohan Kallickal 			   unsigned int id, unsigned int clr_interrupt,
5906733b39aSJayamohan Kallickal 			   unsigned int num_processed,
5916733b39aSJayamohan Kallickal 			   unsigned char rearm, unsigned char event)
5926733b39aSJayamohan Kallickal {
5936733b39aSJayamohan Kallickal 	u32 val = 0;
5946733b39aSJayamohan Kallickal 	val |= id & DB_EQ_RING_ID_MASK;
5956733b39aSJayamohan Kallickal 	if (rearm)
5966733b39aSJayamohan Kallickal 		val |= 1 << DB_EQ_REARM_SHIFT;
5976733b39aSJayamohan Kallickal 	if (clr_interrupt)
5986733b39aSJayamohan Kallickal 		val |= 1 << DB_EQ_CLR_SHIFT;
5996733b39aSJayamohan Kallickal 	if (event)
6006733b39aSJayamohan Kallickal 		val |= 1 << DB_EQ_EVNT_SHIFT;
6016733b39aSJayamohan Kallickal 	val |= num_processed << DB_EQ_NUM_POPPED_SHIFT;
6026733b39aSJayamohan Kallickal 	iowrite32(val, phba->db_va + DB_EQ_OFFSET);
6036733b39aSJayamohan Kallickal }
6046733b39aSJayamohan Kallickal 
6056733b39aSJayamohan Kallickal /**
606bfead3b2SJayamohan Kallickal  * be_isr_mcc - The isr routine of the driver.
607bfead3b2SJayamohan Kallickal  * @irq: Not used
608bfead3b2SJayamohan Kallickal  * @dev_id: Pointer to host adapter structure
609bfead3b2SJayamohan Kallickal  */
610bfead3b2SJayamohan Kallickal static irqreturn_t be_isr_mcc(int irq, void *dev_id)
611bfead3b2SJayamohan Kallickal {
612bfead3b2SJayamohan Kallickal 	struct beiscsi_hba *phba;
613bfead3b2SJayamohan Kallickal 	struct be_eq_entry *eqe = NULL;
614bfead3b2SJayamohan Kallickal 	struct be_queue_info *eq;
615bfead3b2SJayamohan Kallickal 	struct be_queue_info *mcc;
616bfead3b2SJayamohan Kallickal 	unsigned int num_eq_processed;
617bfead3b2SJayamohan Kallickal 	struct be_eq_obj *pbe_eq;
618bfead3b2SJayamohan Kallickal 	unsigned long flags;
619bfead3b2SJayamohan Kallickal 
620bfead3b2SJayamohan Kallickal 	pbe_eq = dev_id;
621bfead3b2SJayamohan Kallickal 	eq = &pbe_eq->q;
622bfead3b2SJayamohan Kallickal 	phba =  pbe_eq->phba;
623bfead3b2SJayamohan Kallickal 	mcc = &phba->ctrl.mcc_obj.cq;
624bfead3b2SJayamohan Kallickal 	eqe = queue_tail_node(eq);
625bfead3b2SJayamohan Kallickal 	if (!eqe)
626bfead3b2SJayamohan Kallickal 		SE_DEBUG(DBG_LVL_1, "eqe is NULL\n");
627bfead3b2SJayamohan Kallickal 
628bfead3b2SJayamohan Kallickal 	num_eq_processed = 0;
629bfead3b2SJayamohan Kallickal 
630bfead3b2SJayamohan Kallickal 	while (eqe->dw[offsetof(struct amap_eq_entry, valid) / 32]
631bfead3b2SJayamohan Kallickal 				& EQE_VALID_MASK) {
632bfead3b2SJayamohan Kallickal 		if (((eqe->dw[offsetof(struct amap_eq_entry,
633bfead3b2SJayamohan Kallickal 		     resource_id) / 32] &
634bfead3b2SJayamohan Kallickal 		     EQE_RESID_MASK) >> 16) == mcc->id) {
635bfead3b2SJayamohan Kallickal 			spin_lock_irqsave(&phba->isr_lock, flags);
636bfead3b2SJayamohan Kallickal 			phba->todo_mcc_cq = 1;
637bfead3b2SJayamohan Kallickal 			spin_unlock_irqrestore(&phba->isr_lock, flags);
638bfead3b2SJayamohan Kallickal 		}
639bfead3b2SJayamohan Kallickal 		AMAP_SET_BITS(struct amap_eq_entry, valid, eqe, 0);
640bfead3b2SJayamohan Kallickal 		queue_tail_inc(eq);
641bfead3b2SJayamohan Kallickal 		eqe = queue_tail_node(eq);
642bfead3b2SJayamohan Kallickal 		num_eq_processed++;
643bfead3b2SJayamohan Kallickal 	}
644bfead3b2SJayamohan Kallickal 	if (phba->todo_mcc_cq)
645bfead3b2SJayamohan Kallickal 		queue_work(phba->wq, &phba->work_cqs);
646bfead3b2SJayamohan Kallickal 	if (num_eq_processed)
647bfead3b2SJayamohan Kallickal 		hwi_ring_eq_db(phba, eq->id, 1,	num_eq_processed, 1, 1);
648bfead3b2SJayamohan Kallickal 
649bfead3b2SJayamohan Kallickal 	return IRQ_HANDLED;
650bfead3b2SJayamohan Kallickal }
651bfead3b2SJayamohan Kallickal 
652bfead3b2SJayamohan Kallickal /**
653bfead3b2SJayamohan Kallickal  * be_isr_msix - The isr routine of the driver.
654bfead3b2SJayamohan Kallickal  * @irq: Not used
655bfead3b2SJayamohan Kallickal  * @dev_id: Pointer to host adapter structure
656bfead3b2SJayamohan Kallickal  */
657bfead3b2SJayamohan Kallickal static irqreturn_t be_isr_msix(int irq, void *dev_id)
658bfead3b2SJayamohan Kallickal {
659bfead3b2SJayamohan Kallickal 	struct beiscsi_hba *phba;
660bfead3b2SJayamohan Kallickal 	struct be_eq_entry *eqe = NULL;
661bfead3b2SJayamohan Kallickal 	struct be_queue_info *eq;
662bfead3b2SJayamohan Kallickal 	struct be_queue_info *cq;
663bfead3b2SJayamohan Kallickal 	unsigned int num_eq_processed;
664bfead3b2SJayamohan Kallickal 	struct be_eq_obj *pbe_eq;
665bfead3b2SJayamohan Kallickal 	unsigned long flags;
666bfead3b2SJayamohan Kallickal 
667bfead3b2SJayamohan Kallickal 	pbe_eq = dev_id;
668bfead3b2SJayamohan Kallickal 	eq = &pbe_eq->q;
669bfead3b2SJayamohan Kallickal 	cq = pbe_eq->cq;
670bfead3b2SJayamohan Kallickal 	eqe = queue_tail_node(eq);
671bfead3b2SJayamohan Kallickal 	if (!eqe)
672bfead3b2SJayamohan Kallickal 		SE_DEBUG(DBG_LVL_1, "eqe is NULL\n");
673bfead3b2SJayamohan Kallickal 
674bfead3b2SJayamohan Kallickal 	phba = pbe_eq->phba;
675bfead3b2SJayamohan Kallickal 	num_eq_processed = 0;
676bfead3b2SJayamohan Kallickal 	if (blk_iopoll_enabled) {
677bfead3b2SJayamohan Kallickal 		while (eqe->dw[offsetof(struct amap_eq_entry, valid) / 32]
678bfead3b2SJayamohan Kallickal 					& EQE_VALID_MASK) {
679bfead3b2SJayamohan Kallickal 			if (!blk_iopoll_sched_prep(&pbe_eq->iopoll))
680bfead3b2SJayamohan Kallickal 				blk_iopoll_sched(&pbe_eq->iopoll);
681bfead3b2SJayamohan Kallickal 
682bfead3b2SJayamohan Kallickal 			AMAP_SET_BITS(struct amap_eq_entry, valid, eqe, 0);
683bfead3b2SJayamohan Kallickal 			queue_tail_inc(eq);
684bfead3b2SJayamohan Kallickal 			eqe = queue_tail_node(eq);
685bfead3b2SJayamohan Kallickal 			num_eq_processed++;
686bfead3b2SJayamohan Kallickal 		}
687bfead3b2SJayamohan Kallickal 		if (num_eq_processed)
688bfead3b2SJayamohan Kallickal 			hwi_ring_eq_db(phba, eq->id, 1,	num_eq_processed, 0, 1);
689bfead3b2SJayamohan Kallickal 
690bfead3b2SJayamohan Kallickal 		return IRQ_HANDLED;
691bfead3b2SJayamohan Kallickal 	} else {
692bfead3b2SJayamohan Kallickal 		while (eqe->dw[offsetof(struct amap_eq_entry, valid) / 32]
693bfead3b2SJayamohan Kallickal 						& EQE_VALID_MASK) {
694bfead3b2SJayamohan Kallickal 			spin_lock_irqsave(&phba->isr_lock, flags);
695bfead3b2SJayamohan Kallickal 			phba->todo_cq = 1;
696bfead3b2SJayamohan Kallickal 			spin_unlock_irqrestore(&phba->isr_lock, flags);
697bfead3b2SJayamohan Kallickal 			AMAP_SET_BITS(struct amap_eq_entry, valid, eqe, 0);
698bfead3b2SJayamohan Kallickal 			queue_tail_inc(eq);
699bfead3b2SJayamohan Kallickal 			eqe = queue_tail_node(eq);
700bfead3b2SJayamohan Kallickal 			num_eq_processed++;
701bfead3b2SJayamohan Kallickal 		}
702bfead3b2SJayamohan Kallickal 		if (phba->todo_cq)
703bfead3b2SJayamohan Kallickal 			queue_work(phba->wq, &phba->work_cqs);
704bfead3b2SJayamohan Kallickal 
705bfead3b2SJayamohan Kallickal 		if (num_eq_processed)
706bfead3b2SJayamohan Kallickal 			hwi_ring_eq_db(phba, eq->id, 1, num_eq_processed, 1, 1);
707bfead3b2SJayamohan Kallickal 
708bfead3b2SJayamohan Kallickal 		return IRQ_HANDLED;
709bfead3b2SJayamohan Kallickal 	}
710bfead3b2SJayamohan Kallickal }
711bfead3b2SJayamohan Kallickal 
712bfead3b2SJayamohan Kallickal /**
7136733b39aSJayamohan Kallickal  * be_isr - The isr routine of the driver.
7146733b39aSJayamohan Kallickal  * @irq: Not used
7156733b39aSJayamohan Kallickal  * @dev_id: Pointer to host adapter structure
7166733b39aSJayamohan Kallickal  */
7176733b39aSJayamohan Kallickal static irqreturn_t be_isr(int irq, void *dev_id)
7186733b39aSJayamohan Kallickal {
7196733b39aSJayamohan Kallickal 	struct beiscsi_hba *phba;
7206733b39aSJayamohan Kallickal 	struct hwi_controller *phwi_ctrlr;
7216733b39aSJayamohan Kallickal 	struct hwi_context_memory *phwi_context;
7226733b39aSJayamohan Kallickal 	struct be_eq_entry *eqe = NULL;
7236733b39aSJayamohan Kallickal 	struct be_queue_info *eq;
7246733b39aSJayamohan Kallickal 	struct be_queue_info *cq;
725bfead3b2SJayamohan Kallickal 	struct be_queue_info *mcc;
7266733b39aSJayamohan Kallickal 	unsigned long flags, index;
727bfead3b2SJayamohan Kallickal 	unsigned int num_mcceq_processed, num_ioeq_processed;
7286733b39aSJayamohan Kallickal 	struct be_ctrl_info *ctrl;
729bfead3b2SJayamohan Kallickal 	struct be_eq_obj *pbe_eq;
7306733b39aSJayamohan Kallickal 	int isr;
7316733b39aSJayamohan Kallickal 
7326733b39aSJayamohan Kallickal 	phba = dev_id;
7336eab04a8SJustin P. Mattock 	ctrl = &phba->ctrl;
7346733b39aSJayamohan Kallickal 	isr = ioread32(ctrl->csr + CEV_ISR0_OFFSET +
7356733b39aSJayamohan Kallickal 		       (PCI_FUNC(ctrl->pdev->devfn) * CEV_ISR_SIZE));
7366733b39aSJayamohan Kallickal 	if (!isr)
7376733b39aSJayamohan Kallickal 		return IRQ_NONE;
7386733b39aSJayamohan Kallickal 
7396733b39aSJayamohan Kallickal 	phwi_ctrlr = phba->phwi_ctrlr;
7406733b39aSJayamohan Kallickal 	phwi_context = phwi_ctrlr->phwi_ctxt;
741bfead3b2SJayamohan Kallickal 	pbe_eq = &phwi_context->be_eq[0];
742bfead3b2SJayamohan Kallickal 
743bfead3b2SJayamohan Kallickal 	eq = &phwi_context->be_eq[0].q;
744bfead3b2SJayamohan Kallickal 	mcc = &phba->ctrl.mcc_obj.cq;
7456733b39aSJayamohan Kallickal 	index = 0;
7466733b39aSJayamohan Kallickal 	eqe = queue_tail_node(eq);
7476733b39aSJayamohan Kallickal 	if (!eqe)
7486733b39aSJayamohan Kallickal 		SE_DEBUG(DBG_LVL_1, "eqe is NULL\n");
7496733b39aSJayamohan Kallickal 
750bfead3b2SJayamohan Kallickal 	num_ioeq_processed = 0;
751bfead3b2SJayamohan Kallickal 	num_mcceq_processed = 0;
7526733b39aSJayamohan Kallickal 	if (blk_iopoll_enabled) {
7536733b39aSJayamohan Kallickal 		while (eqe->dw[offsetof(struct amap_eq_entry, valid) / 32]
7546733b39aSJayamohan Kallickal 					& EQE_VALID_MASK) {
755bfead3b2SJayamohan Kallickal 			if (((eqe->dw[offsetof(struct amap_eq_entry,
756bfead3b2SJayamohan Kallickal 			     resource_id) / 32] &
757bfead3b2SJayamohan Kallickal 			     EQE_RESID_MASK) >> 16) == mcc->id) {
758bfead3b2SJayamohan Kallickal 				spin_lock_irqsave(&phba->isr_lock, flags);
759bfead3b2SJayamohan Kallickal 				phba->todo_mcc_cq = 1;
760bfead3b2SJayamohan Kallickal 				spin_unlock_irqrestore(&phba->isr_lock, flags);
761bfead3b2SJayamohan Kallickal 				num_mcceq_processed++;
762bfead3b2SJayamohan Kallickal 			} else {
763bfead3b2SJayamohan Kallickal 				if (!blk_iopoll_sched_prep(&pbe_eq->iopoll))
764bfead3b2SJayamohan Kallickal 					blk_iopoll_sched(&pbe_eq->iopoll);
765bfead3b2SJayamohan Kallickal 				num_ioeq_processed++;
766bfead3b2SJayamohan Kallickal 			}
7676733b39aSJayamohan Kallickal 			AMAP_SET_BITS(struct amap_eq_entry, valid, eqe, 0);
7686733b39aSJayamohan Kallickal 			queue_tail_inc(eq);
7696733b39aSJayamohan Kallickal 			eqe = queue_tail_node(eq);
7706733b39aSJayamohan Kallickal 		}
771bfead3b2SJayamohan Kallickal 		if (num_ioeq_processed || num_mcceq_processed) {
772bfead3b2SJayamohan Kallickal 			if (phba->todo_mcc_cq)
773bfead3b2SJayamohan Kallickal 				queue_work(phba->wq, &phba->work_cqs);
774bfead3b2SJayamohan Kallickal 
775bfead3b2SJayamohan Kallickal 			if ((num_mcceq_processed) && (!num_ioeq_processed))
776bfead3b2SJayamohan Kallickal 				hwi_ring_eq_db(phba, eq->id, 0,
777bfead3b2SJayamohan Kallickal 					      (num_ioeq_processed +
778bfead3b2SJayamohan Kallickal 					       num_mcceq_processed) , 1, 1);
779bfead3b2SJayamohan Kallickal 			else
780bfead3b2SJayamohan Kallickal 				hwi_ring_eq_db(phba, eq->id, 0,
781bfead3b2SJayamohan Kallickal 					       (num_ioeq_processed +
782bfead3b2SJayamohan Kallickal 						num_mcceq_processed), 0, 1);
783bfead3b2SJayamohan Kallickal 
7846733b39aSJayamohan Kallickal 			return IRQ_HANDLED;
7856733b39aSJayamohan Kallickal 		} else
7866733b39aSJayamohan Kallickal 			return IRQ_NONE;
7876733b39aSJayamohan Kallickal 	} else {
788bfead3b2SJayamohan Kallickal 		cq = &phwi_context->be_cq[0];
7896733b39aSJayamohan Kallickal 		while (eqe->dw[offsetof(struct amap_eq_entry, valid) / 32]
7906733b39aSJayamohan Kallickal 						& EQE_VALID_MASK) {
7916733b39aSJayamohan Kallickal 
7926733b39aSJayamohan Kallickal 			if (((eqe->dw[offsetof(struct amap_eq_entry,
7936733b39aSJayamohan Kallickal 			     resource_id) / 32] &
7946733b39aSJayamohan Kallickal 			     EQE_RESID_MASK) >> 16) != cq->id) {
7956733b39aSJayamohan Kallickal 				spin_lock_irqsave(&phba->isr_lock, flags);
7966733b39aSJayamohan Kallickal 				phba->todo_mcc_cq = 1;
7976733b39aSJayamohan Kallickal 				spin_unlock_irqrestore(&phba->isr_lock, flags);
7986733b39aSJayamohan Kallickal 			} else {
7996733b39aSJayamohan Kallickal 				spin_lock_irqsave(&phba->isr_lock, flags);
8006733b39aSJayamohan Kallickal 				phba->todo_cq = 1;
8016733b39aSJayamohan Kallickal 				spin_unlock_irqrestore(&phba->isr_lock, flags);
8026733b39aSJayamohan Kallickal 			}
8036733b39aSJayamohan Kallickal 			AMAP_SET_BITS(struct amap_eq_entry, valid, eqe, 0);
8046733b39aSJayamohan Kallickal 			queue_tail_inc(eq);
8056733b39aSJayamohan Kallickal 			eqe = queue_tail_node(eq);
806bfead3b2SJayamohan Kallickal 			num_ioeq_processed++;
8076733b39aSJayamohan Kallickal 		}
8086733b39aSJayamohan Kallickal 		if (phba->todo_cq || phba->todo_mcc_cq)
8096733b39aSJayamohan Kallickal 			queue_work(phba->wq, &phba->work_cqs);
8106733b39aSJayamohan Kallickal 
811bfead3b2SJayamohan Kallickal 		if (num_ioeq_processed) {
812bfead3b2SJayamohan Kallickal 			hwi_ring_eq_db(phba, eq->id, 0,
813bfead3b2SJayamohan Kallickal 				       num_ioeq_processed, 1, 1);
8146733b39aSJayamohan Kallickal 			return IRQ_HANDLED;
8156733b39aSJayamohan Kallickal 		} else
8166733b39aSJayamohan Kallickal 			return IRQ_NONE;
8176733b39aSJayamohan Kallickal 	}
8186733b39aSJayamohan Kallickal }
8196733b39aSJayamohan Kallickal 
8206733b39aSJayamohan Kallickal static int beiscsi_init_irqs(struct beiscsi_hba *phba)
8216733b39aSJayamohan Kallickal {
8226733b39aSJayamohan Kallickal 	struct pci_dev *pcidev = phba->pcidev;
823bfead3b2SJayamohan Kallickal 	struct hwi_controller *phwi_ctrlr;
824bfead3b2SJayamohan Kallickal 	struct hwi_context_memory *phwi_context;
8254f5af07eSJayamohan Kallickal 	int ret, msix_vec, i, j;
8266733b39aSJayamohan Kallickal 
827bfead3b2SJayamohan Kallickal 	phwi_ctrlr = phba->phwi_ctrlr;
828bfead3b2SJayamohan Kallickal 	phwi_context = phwi_ctrlr->phwi_ctxt;
829bfead3b2SJayamohan Kallickal 
830bfead3b2SJayamohan Kallickal 	if (phba->msix_enabled) {
831bfead3b2SJayamohan Kallickal 		for (i = 0; i < phba->num_cpus; i++) {
8328fcfb210SJayamohan Kallickal 			phba->msi_name[i] = kzalloc(BEISCSI_MSI_NAME,
8338fcfb210SJayamohan Kallickal 						    GFP_KERNEL);
8348fcfb210SJayamohan Kallickal 			if (!phba->msi_name[i]) {
8358fcfb210SJayamohan Kallickal 				ret = -ENOMEM;
8368fcfb210SJayamohan Kallickal 				goto free_msix_irqs;
8378fcfb210SJayamohan Kallickal 			}
8388fcfb210SJayamohan Kallickal 
8398fcfb210SJayamohan Kallickal 			sprintf(phba->msi_name[i], "beiscsi_%02x_%02x",
8408fcfb210SJayamohan Kallickal 				phba->shost->host_no, i);
841bfead3b2SJayamohan Kallickal 			msix_vec = phba->msix_entries[i].vector;
8428fcfb210SJayamohan Kallickal 			ret = request_irq(msix_vec, be_isr_msix, 0,
8438fcfb210SJayamohan Kallickal 					  phba->msi_name[i],
844bfead3b2SJayamohan Kallickal 					  &phwi_context->be_eq[i]);
8454f5af07eSJayamohan Kallickal 			if (ret) {
8464f5af07eSJayamohan Kallickal 				shost_printk(KERN_ERR, phba->shost,
8474f5af07eSJayamohan Kallickal 					     "beiscsi_init_irqs-Failed to"
8484f5af07eSJayamohan Kallickal 					     "register msix for i = %d\n", i);
8498fcfb210SJayamohan Kallickal 				kfree(phba->msi_name[i]);
8504f5af07eSJayamohan Kallickal 				goto free_msix_irqs;
8514f5af07eSJayamohan Kallickal 			}
852bfead3b2SJayamohan Kallickal 		}
8538fcfb210SJayamohan Kallickal 		phba->msi_name[i] = kzalloc(BEISCSI_MSI_NAME, GFP_KERNEL);
8548fcfb210SJayamohan Kallickal 		if (!phba->msi_name[i]) {
8558fcfb210SJayamohan Kallickal 			ret = -ENOMEM;
8568fcfb210SJayamohan Kallickal 			goto free_msix_irqs;
8578fcfb210SJayamohan Kallickal 		}
8588fcfb210SJayamohan Kallickal 		sprintf(phba->msi_name[i], "beiscsi_mcc_%02x",
8598fcfb210SJayamohan Kallickal 			phba->shost->host_no);
860bfead3b2SJayamohan Kallickal 		msix_vec = phba->msix_entries[i].vector;
8618fcfb210SJayamohan Kallickal 		ret = request_irq(msix_vec, be_isr_mcc, 0, phba->msi_name[i],
862bfead3b2SJayamohan Kallickal 				  &phwi_context->be_eq[i]);
8634f5af07eSJayamohan Kallickal 		if (ret) {
8644f5af07eSJayamohan Kallickal 			shost_printk(KERN_ERR, phba->shost, "beiscsi_init_irqs-"
8654f5af07eSJayamohan Kallickal 				     "Failed to register beiscsi_msix_mcc\n");
8668fcfb210SJayamohan Kallickal 			kfree(phba->msi_name[i]);
8674f5af07eSJayamohan Kallickal 			goto free_msix_irqs;
8684f5af07eSJayamohan Kallickal 		}
8694f5af07eSJayamohan Kallickal 
870bfead3b2SJayamohan Kallickal 	} else {
871bfead3b2SJayamohan Kallickal 		ret = request_irq(pcidev->irq, be_isr, IRQF_SHARED,
872bfead3b2SJayamohan Kallickal 				  "beiscsi", phba);
8736733b39aSJayamohan Kallickal 		if (ret) {
8746733b39aSJayamohan Kallickal 			shost_printk(KERN_ERR, phba->shost, "beiscsi_init_irqs-"
8756733b39aSJayamohan Kallickal 				     "Failed to register irq\\n");
8766733b39aSJayamohan Kallickal 			return ret;
8776733b39aSJayamohan Kallickal 		}
878bfead3b2SJayamohan Kallickal 	}
8796733b39aSJayamohan Kallickal 	return 0;
8804f5af07eSJayamohan Kallickal free_msix_irqs:
8818fcfb210SJayamohan Kallickal 	for (j = i - 1; j >= 0; j--) {
8828fcfb210SJayamohan Kallickal 		kfree(phba->msi_name[j]);
8838fcfb210SJayamohan Kallickal 		msix_vec = phba->msix_entries[j].vector;
8844f5af07eSJayamohan Kallickal 		free_irq(msix_vec, &phwi_context->be_eq[j]);
8858fcfb210SJayamohan Kallickal 	}
8864f5af07eSJayamohan Kallickal 	return ret;
8876733b39aSJayamohan Kallickal }
8886733b39aSJayamohan Kallickal 
8896733b39aSJayamohan Kallickal static void hwi_ring_cq_db(struct beiscsi_hba *phba,
8906733b39aSJayamohan Kallickal 			   unsigned int id, unsigned int num_processed,
8916733b39aSJayamohan Kallickal 			   unsigned char rearm, unsigned char event)
8926733b39aSJayamohan Kallickal {
8936733b39aSJayamohan Kallickal 	u32 val = 0;
8946733b39aSJayamohan Kallickal 	val |= id & DB_CQ_RING_ID_MASK;
8956733b39aSJayamohan Kallickal 	if (rearm)
8966733b39aSJayamohan Kallickal 		val |= 1 << DB_CQ_REARM_SHIFT;
8976733b39aSJayamohan Kallickal 	val |= num_processed << DB_CQ_NUM_POPPED_SHIFT;
8986733b39aSJayamohan Kallickal 	iowrite32(val, phba->db_va + DB_CQ_OFFSET);
8996733b39aSJayamohan Kallickal }
9006733b39aSJayamohan Kallickal 
9016733b39aSJayamohan Kallickal static unsigned int
9026733b39aSJayamohan Kallickal beiscsi_process_async_pdu(struct beiscsi_conn *beiscsi_conn,
9036733b39aSJayamohan Kallickal 			  struct beiscsi_hba *phba,
9046733b39aSJayamohan Kallickal 			  unsigned short cid,
9056733b39aSJayamohan Kallickal 			  struct pdu_base *ppdu,
9066733b39aSJayamohan Kallickal 			  unsigned long pdu_len,
9076733b39aSJayamohan Kallickal 			  void *pbuffer, unsigned long buf_len)
9086733b39aSJayamohan Kallickal {
9096733b39aSJayamohan Kallickal 	struct iscsi_conn *conn = beiscsi_conn->conn;
9106733b39aSJayamohan Kallickal 	struct iscsi_session *session = conn->session;
911bfead3b2SJayamohan Kallickal 	struct iscsi_task *task;
912bfead3b2SJayamohan Kallickal 	struct beiscsi_io_task *io_task;
913bfead3b2SJayamohan Kallickal 	struct iscsi_hdr *login_hdr;
9146733b39aSJayamohan Kallickal 
9156733b39aSJayamohan Kallickal 	switch (ppdu->dw[offsetof(struct amap_pdu_base, opcode) / 32] &
9166733b39aSJayamohan Kallickal 						PDUBASE_OPCODE_MASK) {
9176733b39aSJayamohan Kallickal 	case ISCSI_OP_NOOP_IN:
9186733b39aSJayamohan Kallickal 		pbuffer = NULL;
9196733b39aSJayamohan Kallickal 		buf_len = 0;
9206733b39aSJayamohan Kallickal 		break;
9216733b39aSJayamohan Kallickal 	case ISCSI_OP_ASYNC_EVENT:
9226733b39aSJayamohan Kallickal 		break;
9236733b39aSJayamohan Kallickal 	case ISCSI_OP_REJECT:
9246733b39aSJayamohan Kallickal 		WARN_ON(!pbuffer);
9256733b39aSJayamohan Kallickal 		WARN_ON(!(buf_len == 48));
9266733b39aSJayamohan Kallickal 		SE_DEBUG(DBG_LVL_1, "In ISCSI_OP_REJECT\n");
9276733b39aSJayamohan Kallickal 		break;
9286733b39aSJayamohan Kallickal 	case ISCSI_OP_LOGIN_RSP:
9297bd6e25cSJayamohan Kallickal 	case ISCSI_OP_TEXT_RSP:
930bfead3b2SJayamohan Kallickal 		task = conn->login_task;
931bfead3b2SJayamohan Kallickal 		io_task = task->dd_data;
932bfead3b2SJayamohan Kallickal 		login_hdr = (struct iscsi_hdr *)ppdu;
933bfead3b2SJayamohan Kallickal 		login_hdr->itt = io_task->libiscsi_itt;
9346733b39aSJayamohan Kallickal 		break;
9356733b39aSJayamohan Kallickal 	default:
9366733b39aSJayamohan Kallickal 		shost_printk(KERN_WARNING, phba->shost,
9376733b39aSJayamohan Kallickal 			     "Unrecognized opcode 0x%x in async msg\n",
9386733b39aSJayamohan Kallickal 			     (ppdu->
9396733b39aSJayamohan Kallickal 			     dw[offsetof(struct amap_pdu_base, opcode) / 32]
9406733b39aSJayamohan Kallickal 						& PDUBASE_OPCODE_MASK));
9416733b39aSJayamohan Kallickal 		return 1;
9426733b39aSJayamohan Kallickal 	}
9436733b39aSJayamohan Kallickal 
9446733b39aSJayamohan Kallickal 	spin_lock_bh(&session->lock);
9456733b39aSJayamohan Kallickal 	__iscsi_complete_pdu(conn, (struct iscsi_hdr *)ppdu, pbuffer, buf_len);
9466733b39aSJayamohan Kallickal 	spin_unlock_bh(&session->lock);
9476733b39aSJayamohan Kallickal 	return 0;
9486733b39aSJayamohan Kallickal }
9496733b39aSJayamohan Kallickal 
9506733b39aSJayamohan Kallickal static struct sgl_handle *alloc_io_sgl_handle(struct beiscsi_hba *phba)
9516733b39aSJayamohan Kallickal {
9526733b39aSJayamohan Kallickal 	struct sgl_handle *psgl_handle;
9536733b39aSJayamohan Kallickal 
9546733b39aSJayamohan Kallickal 	if (phba->io_sgl_hndl_avbl) {
9556733b39aSJayamohan Kallickal 		SE_DEBUG(DBG_LVL_8,
9566733b39aSJayamohan Kallickal 			 "In alloc_io_sgl_handle,io_sgl_alloc_index=%d\n",
9576733b39aSJayamohan Kallickal 			 phba->io_sgl_alloc_index);
9586733b39aSJayamohan Kallickal 		psgl_handle = phba->io_sgl_hndl_base[phba->
9596733b39aSJayamohan Kallickal 						io_sgl_alloc_index];
9606733b39aSJayamohan Kallickal 		phba->io_sgl_hndl_base[phba->io_sgl_alloc_index] = NULL;
9616733b39aSJayamohan Kallickal 		phba->io_sgl_hndl_avbl--;
962bfead3b2SJayamohan Kallickal 		if (phba->io_sgl_alloc_index == (phba->params.
963bfead3b2SJayamohan Kallickal 						 ios_per_ctrl - 1))
9646733b39aSJayamohan Kallickal 			phba->io_sgl_alloc_index = 0;
9656733b39aSJayamohan Kallickal 		else
9666733b39aSJayamohan Kallickal 			phba->io_sgl_alloc_index++;
9676733b39aSJayamohan Kallickal 	} else
9686733b39aSJayamohan Kallickal 		psgl_handle = NULL;
9696733b39aSJayamohan Kallickal 	return psgl_handle;
9706733b39aSJayamohan Kallickal }
9716733b39aSJayamohan Kallickal 
9726733b39aSJayamohan Kallickal static void
9736733b39aSJayamohan Kallickal free_io_sgl_handle(struct beiscsi_hba *phba, struct sgl_handle *psgl_handle)
9746733b39aSJayamohan Kallickal {
9756733b39aSJayamohan Kallickal 	SE_DEBUG(DBG_LVL_8, "In free_,io_sgl_free_index=%d\n",
9766733b39aSJayamohan Kallickal 		 phba->io_sgl_free_index);
9776733b39aSJayamohan Kallickal 	if (phba->io_sgl_hndl_base[phba->io_sgl_free_index]) {
9786733b39aSJayamohan Kallickal 		/*
9796733b39aSJayamohan Kallickal 		 * this can happen if clean_task is called on a task that
9806733b39aSJayamohan Kallickal 		 * failed in xmit_task or alloc_pdu.
9816733b39aSJayamohan Kallickal 		 */
9826733b39aSJayamohan Kallickal 		 SE_DEBUG(DBG_LVL_8,
9836733b39aSJayamohan Kallickal 			 "Double Free in IO SGL io_sgl_free_index=%d,"
9846733b39aSJayamohan Kallickal 			 "value there=%p\n", phba->io_sgl_free_index,
9856733b39aSJayamohan Kallickal 			 phba->io_sgl_hndl_base[phba->io_sgl_free_index]);
9866733b39aSJayamohan Kallickal 		return;
9876733b39aSJayamohan Kallickal 	}
9886733b39aSJayamohan Kallickal 	phba->io_sgl_hndl_base[phba->io_sgl_free_index] = psgl_handle;
9896733b39aSJayamohan Kallickal 	phba->io_sgl_hndl_avbl++;
9906733b39aSJayamohan Kallickal 	if (phba->io_sgl_free_index == (phba->params.ios_per_ctrl - 1))
9916733b39aSJayamohan Kallickal 		phba->io_sgl_free_index = 0;
9926733b39aSJayamohan Kallickal 	else
9936733b39aSJayamohan Kallickal 		phba->io_sgl_free_index++;
9946733b39aSJayamohan Kallickal }
9956733b39aSJayamohan Kallickal 
9966733b39aSJayamohan Kallickal /**
9976733b39aSJayamohan Kallickal  * alloc_wrb_handle - To allocate a wrb handle
9986733b39aSJayamohan Kallickal  * @phba: The hba pointer
9996733b39aSJayamohan Kallickal  * @cid: The cid to use for allocation
10006733b39aSJayamohan Kallickal  *
10016733b39aSJayamohan Kallickal  * This happens under session_lock until submission to chip
10026733b39aSJayamohan Kallickal  */
1003d5431488SJayamohan Kallickal struct wrb_handle *alloc_wrb_handle(struct beiscsi_hba *phba, unsigned int cid)
10046733b39aSJayamohan Kallickal {
10056733b39aSJayamohan Kallickal 	struct hwi_wrb_context *pwrb_context;
10066733b39aSJayamohan Kallickal 	struct hwi_controller *phwi_ctrlr;
1007d5431488SJayamohan Kallickal 	struct wrb_handle *pwrb_handle, *pwrb_handle_tmp;
10086733b39aSJayamohan Kallickal 
10096733b39aSJayamohan Kallickal 	phwi_ctrlr = phba->phwi_ctrlr;
10106733b39aSJayamohan Kallickal 	pwrb_context = &phwi_ctrlr->wrb_context[cid];
1011d5431488SJayamohan Kallickal 	if (pwrb_context->wrb_handles_available >= 2) {
1012bfead3b2SJayamohan Kallickal 		pwrb_handle = pwrb_context->pwrb_handle_base[
1013bfead3b2SJayamohan Kallickal 					    pwrb_context->alloc_index];
1014bfead3b2SJayamohan Kallickal 		pwrb_context->wrb_handles_available--;
1015bfead3b2SJayamohan Kallickal 		if (pwrb_context->alloc_index ==
1016bfead3b2SJayamohan Kallickal 						(phba->params.wrbs_per_cxn - 1))
1017bfead3b2SJayamohan Kallickal 			pwrb_context->alloc_index = 0;
1018bfead3b2SJayamohan Kallickal 		else
1019bfead3b2SJayamohan Kallickal 			pwrb_context->alloc_index++;
1020d5431488SJayamohan Kallickal 		pwrb_handle_tmp = pwrb_context->pwrb_handle_base[
1021d5431488SJayamohan Kallickal 						pwrb_context->alloc_index];
1022d5431488SJayamohan Kallickal 		pwrb_handle->nxt_wrb_index = pwrb_handle_tmp->wrb_index;
1023bfead3b2SJayamohan Kallickal 	} else
1024bfead3b2SJayamohan Kallickal 		pwrb_handle = NULL;
10256733b39aSJayamohan Kallickal 	return pwrb_handle;
10266733b39aSJayamohan Kallickal }
10276733b39aSJayamohan Kallickal 
10286733b39aSJayamohan Kallickal /**
10296733b39aSJayamohan Kallickal  * free_wrb_handle - To free the wrb handle back to pool
10306733b39aSJayamohan Kallickal  * @phba: The hba pointer
10316733b39aSJayamohan Kallickal  * @pwrb_context: The context to free from
10326733b39aSJayamohan Kallickal  * @pwrb_handle: The wrb_handle to free
10336733b39aSJayamohan Kallickal  *
10346733b39aSJayamohan Kallickal  * This happens under session_lock until submission to chip
10356733b39aSJayamohan Kallickal  */
10366733b39aSJayamohan Kallickal static void
10376733b39aSJayamohan Kallickal free_wrb_handle(struct beiscsi_hba *phba, struct hwi_wrb_context *pwrb_context,
10386733b39aSJayamohan Kallickal 		struct wrb_handle *pwrb_handle)
10396733b39aSJayamohan Kallickal {
104032951dd8SJayamohan Kallickal 	pwrb_context->pwrb_handle_base[pwrb_context->free_index] = pwrb_handle;
1041bfead3b2SJayamohan Kallickal 	pwrb_context->wrb_handles_available++;
1042bfead3b2SJayamohan Kallickal 	if (pwrb_context->free_index == (phba->params.wrbs_per_cxn - 1))
1043bfead3b2SJayamohan Kallickal 		pwrb_context->free_index = 0;
1044bfead3b2SJayamohan Kallickal 	else
1045bfead3b2SJayamohan Kallickal 		pwrb_context->free_index++;
1046bfead3b2SJayamohan Kallickal 
10476733b39aSJayamohan Kallickal 	SE_DEBUG(DBG_LVL_8,
1048bfead3b2SJayamohan Kallickal 		 "FREE WRB: pwrb_handle=%p free_index=0x%x"
10496733b39aSJayamohan Kallickal 		 "wrb_handles_available=%d\n",
10506733b39aSJayamohan Kallickal 		 pwrb_handle, pwrb_context->free_index,
1051bfead3b2SJayamohan Kallickal 		 pwrb_context->wrb_handles_available);
10526733b39aSJayamohan Kallickal }
10536733b39aSJayamohan Kallickal 
10546733b39aSJayamohan Kallickal static struct sgl_handle *alloc_mgmt_sgl_handle(struct beiscsi_hba *phba)
10556733b39aSJayamohan Kallickal {
10566733b39aSJayamohan Kallickal 	struct sgl_handle *psgl_handle;
10576733b39aSJayamohan Kallickal 
10586733b39aSJayamohan Kallickal 	if (phba->eh_sgl_hndl_avbl) {
10596733b39aSJayamohan Kallickal 		psgl_handle = phba->eh_sgl_hndl_base[phba->eh_sgl_alloc_index];
10606733b39aSJayamohan Kallickal 		phba->eh_sgl_hndl_base[phba->eh_sgl_alloc_index] = NULL;
10616733b39aSJayamohan Kallickal 		SE_DEBUG(DBG_LVL_8, "mgmt_sgl_alloc_index=%d=0x%x\n",
10626733b39aSJayamohan Kallickal 			 phba->eh_sgl_alloc_index, phba->eh_sgl_alloc_index);
10636733b39aSJayamohan Kallickal 		phba->eh_sgl_hndl_avbl--;
10646733b39aSJayamohan Kallickal 		if (phba->eh_sgl_alloc_index ==
10656733b39aSJayamohan Kallickal 		    (phba->params.icds_per_ctrl - phba->params.ios_per_ctrl -
10666733b39aSJayamohan Kallickal 		     1))
10676733b39aSJayamohan Kallickal 			phba->eh_sgl_alloc_index = 0;
10686733b39aSJayamohan Kallickal 		else
10696733b39aSJayamohan Kallickal 			phba->eh_sgl_alloc_index++;
10706733b39aSJayamohan Kallickal 	} else
10716733b39aSJayamohan Kallickal 		psgl_handle = NULL;
10726733b39aSJayamohan Kallickal 	return psgl_handle;
10736733b39aSJayamohan Kallickal }
10746733b39aSJayamohan Kallickal 
10756733b39aSJayamohan Kallickal void
10766733b39aSJayamohan Kallickal free_mgmt_sgl_handle(struct beiscsi_hba *phba, struct sgl_handle *psgl_handle)
10776733b39aSJayamohan Kallickal {
10786733b39aSJayamohan Kallickal 
1079bfead3b2SJayamohan Kallickal 	SE_DEBUG(DBG_LVL_8, "In  free_mgmt_sgl_handle,eh_sgl_free_index=%d\n",
1080bfead3b2SJayamohan Kallickal 			     phba->eh_sgl_free_index);
10816733b39aSJayamohan Kallickal 	if (phba->eh_sgl_hndl_base[phba->eh_sgl_free_index]) {
10826733b39aSJayamohan Kallickal 		/*
10836733b39aSJayamohan Kallickal 		 * this can happen if clean_task is called on a task that
10846733b39aSJayamohan Kallickal 		 * failed in xmit_task or alloc_pdu.
10856733b39aSJayamohan Kallickal 		 */
10866733b39aSJayamohan Kallickal 		SE_DEBUG(DBG_LVL_8,
10876733b39aSJayamohan Kallickal 			 "Double Free in eh SGL ,eh_sgl_free_index=%d\n",
10886733b39aSJayamohan Kallickal 			 phba->eh_sgl_free_index);
10896733b39aSJayamohan Kallickal 		return;
10906733b39aSJayamohan Kallickal 	}
10916733b39aSJayamohan Kallickal 	phba->eh_sgl_hndl_base[phba->eh_sgl_free_index] = psgl_handle;
10926733b39aSJayamohan Kallickal 	phba->eh_sgl_hndl_avbl++;
10936733b39aSJayamohan Kallickal 	if (phba->eh_sgl_free_index ==
10946733b39aSJayamohan Kallickal 	    (phba->params.icds_per_ctrl - phba->params.ios_per_ctrl - 1))
10956733b39aSJayamohan Kallickal 		phba->eh_sgl_free_index = 0;
10966733b39aSJayamohan Kallickal 	else
10976733b39aSJayamohan Kallickal 		phba->eh_sgl_free_index++;
10986733b39aSJayamohan Kallickal }
10996733b39aSJayamohan Kallickal 
11006733b39aSJayamohan Kallickal static void
11016733b39aSJayamohan Kallickal be_complete_io(struct beiscsi_conn *beiscsi_conn,
11026733b39aSJayamohan Kallickal 	       struct iscsi_task *task, struct sol_cqe *psol)
11036733b39aSJayamohan Kallickal {
11046733b39aSJayamohan Kallickal 	struct beiscsi_io_task *io_task = task->dd_data;
11056733b39aSJayamohan Kallickal 	struct be_status_bhs *sts_bhs =
11066733b39aSJayamohan Kallickal 				(struct be_status_bhs *)io_task->cmd_bhs;
11076733b39aSJayamohan Kallickal 	struct iscsi_conn *conn = beiscsi_conn->conn;
11086733b39aSJayamohan Kallickal 	unsigned char *sense;
11096733b39aSJayamohan Kallickal 	u32 resid = 0, exp_cmdsn, max_cmdsn;
11106733b39aSJayamohan Kallickal 	u8 rsp, status, flags;
11116733b39aSJayamohan Kallickal 
1112bfead3b2SJayamohan Kallickal 	exp_cmdsn = (psol->
11136733b39aSJayamohan Kallickal 			dw[offsetof(struct amap_sol_cqe, i_exp_cmd_sn) / 32]
11146733b39aSJayamohan Kallickal 			& SOL_EXP_CMD_SN_MASK);
1115bfead3b2SJayamohan Kallickal 	max_cmdsn = ((psol->
11166733b39aSJayamohan Kallickal 			dw[offsetof(struct amap_sol_cqe, i_exp_cmd_sn) / 32]
11176733b39aSJayamohan Kallickal 			& SOL_EXP_CMD_SN_MASK) +
11186733b39aSJayamohan Kallickal 			((psol->dw[offsetof(struct amap_sol_cqe, i_cmd_wnd)
11196733b39aSJayamohan Kallickal 				/ 32] & SOL_CMD_WND_MASK) >> 24) - 1);
11206733b39aSJayamohan Kallickal 	rsp = ((psol->dw[offsetof(struct amap_sol_cqe, i_resp) / 32]
11216733b39aSJayamohan Kallickal 						& SOL_RESP_MASK) >> 16);
11226733b39aSJayamohan Kallickal 	status = ((psol->dw[offsetof(struct amap_sol_cqe, i_sts) / 32]
11236733b39aSJayamohan Kallickal 						& SOL_STS_MASK) >> 8);
11246733b39aSJayamohan Kallickal 	flags = ((psol->dw[offsetof(struct amap_sol_cqe, i_flags) / 32]
11256733b39aSJayamohan Kallickal 					& SOL_FLAGS_MASK) >> 24) | 0x80;
1126bd535451SJayamohan Kallickal 	if (!task->sc) {
1127bd535451SJayamohan Kallickal 		if (io_task->scsi_cmnd)
1128bd535451SJayamohan Kallickal 			scsi_dma_unmap(io_task->scsi_cmnd);
11296733b39aSJayamohan Kallickal 
1130bd535451SJayamohan Kallickal 		return;
1131bd535451SJayamohan Kallickal 	}
11326733b39aSJayamohan Kallickal 	task->sc->result = (DID_OK << 16) | status;
11336733b39aSJayamohan Kallickal 	if (rsp != ISCSI_STATUS_CMD_COMPLETED) {
11346733b39aSJayamohan Kallickal 		task->sc->result = DID_ERROR << 16;
11356733b39aSJayamohan Kallickal 		goto unmap;
11366733b39aSJayamohan Kallickal 	}
11376733b39aSJayamohan Kallickal 
11386733b39aSJayamohan Kallickal 	/* bidi not initially supported */
11396733b39aSJayamohan Kallickal 	if (flags & (ISCSI_FLAG_CMD_UNDERFLOW | ISCSI_FLAG_CMD_OVERFLOW)) {
11406733b39aSJayamohan Kallickal 		resid = (psol->dw[offsetof(struct amap_sol_cqe, i_res_cnt) /
11416733b39aSJayamohan Kallickal 				32] & SOL_RES_CNT_MASK);
11426733b39aSJayamohan Kallickal 
11436733b39aSJayamohan Kallickal 		if (!status && (flags & ISCSI_FLAG_CMD_OVERFLOW))
11446733b39aSJayamohan Kallickal 			task->sc->result = DID_ERROR << 16;
11456733b39aSJayamohan Kallickal 
11466733b39aSJayamohan Kallickal 		if (flags & ISCSI_FLAG_CMD_UNDERFLOW) {
11476733b39aSJayamohan Kallickal 			scsi_set_resid(task->sc, resid);
11486733b39aSJayamohan Kallickal 			if (!status && (scsi_bufflen(task->sc) - resid <
11496733b39aSJayamohan Kallickal 			    task->sc->underflow))
11506733b39aSJayamohan Kallickal 				task->sc->result = DID_ERROR << 16;
11516733b39aSJayamohan Kallickal 		}
11526733b39aSJayamohan Kallickal 	}
11536733b39aSJayamohan Kallickal 
11546733b39aSJayamohan Kallickal 	if (status == SAM_STAT_CHECK_CONDITION) {
11554053a4beSDan Carpenter 		u16 sense_len;
1156bfead3b2SJayamohan Kallickal 		unsigned short *slen = (unsigned short *)sts_bhs->sense_info;
11574053a4beSDan Carpenter 
11586733b39aSJayamohan Kallickal 		sense = sts_bhs->sense_info + sizeof(unsigned short);
11594053a4beSDan Carpenter 		sense_len = be16_to_cpu(*slen);
11606733b39aSJayamohan Kallickal 		memcpy(task->sc->sense_buffer, sense,
11616733b39aSJayamohan Kallickal 		       min_t(u16, sense_len, SCSI_SENSE_BUFFERSIZE));
11626733b39aSJayamohan Kallickal 	}
1163756d29c8SJayamohan Kallickal 
11646733b39aSJayamohan Kallickal 	if (io_task->cmd_bhs->iscsi_hdr.flags & ISCSI_FLAG_CMD_READ) {
11656733b39aSJayamohan Kallickal 		if (psol->dw[offsetof(struct amap_sol_cqe, i_res_cnt) / 32]
11666733b39aSJayamohan Kallickal 							& SOL_RES_CNT_MASK)
11676733b39aSJayamohan Kallickal 			 conn->rxdata_octets += (psol->
11686733b39aSJayamohan Kallickal 			     dw[offsetof(struct amap_sol_cqe, i_res_cnt) / 32]
11696733b39aSJayamohan Kallickal 			     & SOL_RES_CNT_MASK);
11706733b39aSJayamohan Kallickal 	}
11716733b39aSJayamohan Kallickal unmap:
11726733b39aSJayamohan Kallickal 	scsi_dma_unmap(io_task->scsi_cmnd);
11736733b39aSJayamohan Kallickal 	iscsi_complete_scsi_task(task, exp_cmdsn, max_cmdsn);
11746733b39aSJayamohan Kallickal }
11756733b39aSJayamohan Kallickal 
11766733b39aSJayamohan Kallickal static void
11776733b39aSJayamohan Kallickal be_complete_logout(struct beiscsi_conn *beiscsi_conn,
11786733b39aSJayamohan Kallickal 		   struct iscsi_task *task, struct sol_cqe *psol)
11796733b39aSJayamohan Kallickal {
11806733b39aSJayamohan Kallickal 	struct iscsi_logout_rsp *hdr;
1181bfead3b2SJayamohan Kallickal 	struct beiscsi_io_task *io_task = task->dd_data;
11826733b39aSJayamohan Kallickal 	struct iscsi_conn *conn = beiscsi_conn->conn;
11836733b39aSJayamohan Kallickal 
11846733b39aSJayamohan Kallickal 	hdr = (struct iscsi_logout_rsp *)task->hdr;
11857bd6e25cSJayamohan Kallickal 	hdr->opcode = ISCSI_OP_LOGOUT_RSP;
11866733b39aSJayamohan Kallickal 	hdr->t2wait = 5;
11876733b39aSJayamohan Kallickal 	hdr->t2retain = 0;
11886733b39aSJayamohan Kallickal 	hdr->flags = ((psol->dw[offsetof(struct amap_sol_cqe, i_flags) / 32]
11896733b39aSJayamohan Kallickal 					& SOL_FLAGS_MASK) >> 24) | 0x80;
11906733b39aSJayamohan Kallickal 	hdr->response = (psol->dw[offsetof(struct amap_sol_cqe, i_resp) /
11916733b39aSJayamohan Kallickal 					32] & SOL_RESP_MASK);
11926733b39aSJayamohan Kallickal 	hdr->exp_cmdsn = cpu_to_be32(psol->
11936733b39aSJayamohan Kallickal 			dw[offsetof(struct amap_sol_cqe, i_exp_cmd_sn) / 32]
11946733b39aSJayamohan Kallickal 					& SOL_EXP_CMD_SN_MASK);
11956733b39aSJayamohan Kallickal 	hdr->max_cmdsn = be32_to_cpu((psol->
11966733b39aSJayamohan Kallickal 			 dw[offsetof(struct amap_sol_cqe, i_exp_cmd_sn) / 32]
11976733b39aSJayamohan Kallickal 					& SOL_EXP_CMD_SN_MASK) +
11986733b39aSJayamohan Kallickal 			((psol->dw[offsetof(struct amap_sol_cqe, i_cmd_wnd)
11996733b39aSJayamohan Kallickal 					/ 32] & SOL_CMD_WND_MASK) >> 24) - 1);
12007bd6e25cSJayamohan Kallickal 	hdr->dlength[0] = 0;
12017bd6e25cSJayamohan Kallickal 	hdr->dlength[1] = 0;
12027bd6e25cSJayamohan Kallickal 	hdr->dlength[2] = 0;
12036733b39aSJayamohan Kallickal 	hdr->hlength = 0;
1204bfead3b2SJayamohan Kallickal 	hdr->itt = io_task->libiscsi_itt;
12056733b39aSJayamohan Kallickal 	__iscsi_complete_pdu(conn, (struct iscsi_hdr *)hdr, NULL, 0);
12066733b39aSJayamohan Kallickal }
12076733b39aSJayamohan Kallickal 
12086733b39aSJayamohan Kallickal static void
12096733b39aSJayamohan Kallickal be_complete_tmf(struct beiscsi_conn *beiscsi_conn,
12106733b39aSJayamohan Kallickal 		struct iscsi_task *task, struct sol_cqe *psol)
12116733b39aSJayamohan Kallickal {
12126733b39aSJayamohan Kallickal 	struct iscsi_tm_rsp *hdr;
12136733b39aSJayamohan Kallickal 	struct iscsi_conn *conn = beiscsi_conn->conn;
1214bfead3b2SJayamohan Kallickal 	struct beiscsi_io_task *io_task = task->dd_data;
12156733b39aSJayamohan Kallickal 
12166733b39aSJayamohan Kallickal 	hdr = (struct iscsi_tm_rsp *)task->hdr;
12177bd6e25cSJayamohan Kallickal 	hdr->opcode = ISCSI_OP_SCSI_TMFUNC_RSP;
12186733b39aSJayamohan Kallickal 	hdr->flags = ((psol->dw[offsetof(struct amap_sol_cqe, i_flags) / 32]
12196733b39aSJayamohan Kallickal 					& SOL_FLAGS_MASK) >> 24) | 0x80;
12206733b39aSJayamohan Kallickal 	hdr->response = (psol->dw[offsetof(struct amap_sol_cqe, i_resp) /
12216733b39aSJayamohan Kallickal 					32] & SOL_RESP_MASK);
12226733b39aSJayamohan Kallickal 	hdr->exp_cmdsn = cpu_to_be32(psol->dw[offsetof(struct amap_sol_cqe,
12236733b39aSJayamohan Kallickal 				    i_exp_cmd_sn) / 32] & SOL_EXP_CMD_SN_MASK);
12246733b39aSJayamohan Kallickal 	hdr->max_cmdsn = be32_to_cpu((psol->dw[offsetof(struct amap_sol_cqe,
12256733b39aSJayamohan Kallickal 			i_exp_cmd_sn) / 32] & SOL_EXP_CMD_SN_MASK) +
12266733b39aSJayamohan Kallickal 			((psol->dw[offsetof(struct amap_sol_cqe, i_cmd_wnd)
12276733b39aSJayamohan Kallickal 			/ 32] & SOL_CMD_WND_MASK) >> 24) - 1);
1228bfead3b2SJayamohan Kallickal 	hdr->itt = io_task->libiscsi_itt;
12296733b39aSJayamohan Kallickal 	__iscsi_complete_pdu(conn, (struct iscsi_hdr *)hdr, NULL, 0);
12306733b39aSJayamohan Kallickal }
12316733b39aSJayamohan Kallickal 
12326733b39aSJayamohan Kallickal static void
12336733b39aSJayamohan Kallickal hwi_complete_drvr_msgs(struct beiscsi_conn *beiscsi_conn,
12346733b39aSJayamohan Kallickal 		       struct beiscsi_hba *phba, struct sol_cqe *psol)
12356733b39aSJayamohan Kallickal {
12366733b39aSJayamohan Kallickal 	struct hwi_wrb_context *pwrb_context;
1237bfead3b2SJayamohan Kallickal 	struct wrb_handle *pwrb_handle = NULL;
12386733b39aSJayamohan Kallickal 	struct hwi_controller *phwi_ctrlr;
1239bfead3b2SJayamohan Kallickal 	struct iscsi_task *task;
1240bfead3b2SJayamohan Kallickal 	struct beiscsi_io_task *io_task;
12416733b39aSJayamohan Kallickal 	struct iscsi_conn *conn = beiscsi_conn->conn;
12426733b39aSJayamohan Kallickal 	struct iscsi_session *session = conn->session;
12436733b39aSJayamohan Kallickal 
12446733b39aSJayamohan Kallickal 	phwi_ctrlr = phba->phwi_ctrlr;
12456733b39aSJayamohan Kallickal 	pwrb_context = &phwi_ctrlr->wrb_context[((psol->
12466733b39aSJayamohan Kallickal 				dw[offsetof(struct amap_sol_cqe, cid) / 32] &
12477da50879SJayamohan Kallickal 				SOL_CID_MASK) >> 6) -
12487da50879SJayamohan Kallickal 				phba->fw_config.iscsi_cid_start];
12496733b39aSJayamohan Kallickal 	pwrb_handle = pwrb_context->pwrb_handle_basestd[((psol->
12506733b39aSJayamohan Kallickal 				dw[offsetof(struct amap_sol_cqe, wrb_index) /
12516733b39aSJayamohan Kallickal 				32] & SOL_WRB_INDEX_MASK) >> 16)];
1252bfead3b2SJayamohan Kallickal 	task = pwrb_handle->pio_handle;
125335e66019SJayamohan Kallickal 
1254bfead3b2SJayamohan Kallickal 	io_task = task->dd_data;
1255bfead3b2SJayamohan Kallickal 	spin_lock(&phba->mgmt_sgl_lock);
1256bfead3b2SJayamohan Kallickal 	free_mgmt_sgl_handle(phba, io_task->psgl_handle);
1257bfead3b2SJayamohan Kallickal 	spin_unlock(&phba->mgmt_sgl_lock);
12586733b39aSJayamohan Kallickal 	spin_lock_bh(&session->lock);
12596733b39aSJayamohan Kallickal 	free_wrb_handle(phba, pwrb_context, pwrb_handle);
12606733b39aSJayamohan Kallickal 	spin_unlock_bh(&session->lock);
12616733b39aSJayamohan Kallickal }
12626733b39aSJayamohan Kallickal 
12636733b39aSJayamohan Kallickal static void
12646733b39aSJayamohan Kallickal be_complete_nopin_resp(struct beiscsi_conn *beiscsi_conn,
12656733b39aSJayamohan Kallickal 		       struct iscsi_task *task, struct sol_cqe *psol)
12666733b39aSJayamohan Kallickal {
12676733b39aSJayamohan Kallickal 	struct iscsi_nopin *hdr;
12686733b39aSJayamohan Kallickal 	struct iscsi_conn *conn = beiscsi_conn->conn;
1269bfead3b2SJayamohan Kallickal 	struct beiscsi_io_task *io_task = task->dd_data;
12706733b39aSJayamohan Kallickal 
12716733b39aSJayamohan Kallickal 	hdr = (struct iscsi_nopin *)task->hdr;
12726733b39aSJayamohan Kallickal 	hdr->flags = ((psol->dw[offsetof(struct amap_sol_cqe, i_flags) / 32]
12736733b39aSJayamohan Kallickal 			& SOL_FLAGS_MASK) >> 24) | 0x80;
12746733b39aSJayamohan Kallickal 	hdr->exp_cmdsn = cpu_to_be32(psol->dw[offsetof(struct amap_sol_cqe,
12756733b39aSJayamohan Kallickal 				     i_exp_cmd_sn) / 32] & SOL_EXP_CMD_SN_MASK);
12766733b39aSJayamohan Kallickal 	hdr->max_cmdsn = be32_to_cpu((psol->dw[offsetof(struct amap_sol_cqe,
12776733b39aSJayamohan Kallickal 			i_exp_cmd_sn) / 32] & SOL_EXP_CMD_SN_MASK) +
12786733b39aSJayamohan Kallickal 			((psol->dw[offsetof(struct amap_sol_cqe, i_cmd_wnd)
12796733b39aSJayamohan Kallickal 			/ 32] & SOL_CMD_WND_MASK) >> 24) - 1);
12806733b39aSJayamohan Kallickal 	hdr->opcode = ISCSI_OP_NOOP_IN;
1281bfead3b2SJayamohan Kallickal 	hdr->itt = io_task->libiscsi_itt;
12826733b39aSJayamohan Kallickal 	__iscsi_complete_pdu(conn, (struct iscsi_hdr *)hdr, NULL, 0);
12836733b39aSJayamohan Kallickal }
12846733b39aSJayamohan Kallickal 
12856733b39aSJayamohan Kallickal static void hwi_complete_cmd(struct beiscsi_conn *beiscsi_conn,
12866733b39aSJayamohan Kallickal 			     struct beiscsi_hba *phba, struct sol_cqe *psol)
12876733b39aSJayamohan Kallickal {
12886733b39aSJayamohan Kallickal 	struct hwi_wrb_context *pwrb_context;
12896733b39aSJayamohan Kallickal 	struct wrb_handle *pwrb_handle;
12906733b39aSJayamohan Kallickal 	struct iscsi_wrb *pwrb = NULL;
12916733b39aSJayamohan Kallickal 	struct hwi_controller *phwi_ctrlr;
12926733b39aSJayamohan Kallickal 	struct iscsi_task *task;
1293bfead3b2SJayamohan Kallickal 	unsigned int type;
12946733b39aSJayamohan Kallickal 	struct iscsi_conn *conn = beiscsi_conn->conn;
12956733b39aSJayamohan Kallickal 	struct iscsi_session *session = conn->session;
12966733b39aSJayamohan Kallickal 
12976733b39aSJayamohan Kallickal 	phwi_ctrlr = phba->phwi_ctrlr;
129832951dd8SJayamohan Kallickal 	pwrb_context = &phwi_ctrlr->wrb_context[((psol->dw[offsetof
1299bfead3b2SJayamohan Kallickal 				(struct amap_sol_cqe, cid) / 32]
13007da50879SJayamohan Kallickal 				& SOL_CID_MASK) >> 6) -
13017da50879SJayamohan Kallickal 				phba->fw_config.iscsi_cid_start];
13026733b39aSJayamohan Kallickal 	pwrb_handle = pwrb_context->pwrb_handle_basestd[((psol->
13036733b39aSJayamohan Kallickal 				dw[offsetof(struct amap_sol_cqe, wrb_index) /
13046733b39aSJayamohan Kallickal 				32] & SOL_WRB_INDEX_MASK) >> 16)];
13056733b39aSJayamohan Kallickal 	task = pwrb_handle->pio_handle;
13066733b39aSJayamohan Kallickal 	pwrb = pwrb_handle->pwrb;
1307bfead3b2SJayamohan Kallickal 	type = (pwrb->dw[offsetof(struct amap_iscsi_wrb, type) / 32] &
1308bfead3b2SJayamohan Kallickal 				 WRB_TYPE_MASK) >> 28;
130932951dd8SJayamohan Kallickal 
1310bfead3b2SJayamohan Kallickal 	spin_lock_bh(&session->lock);
1311bfead3b2SJayamohan Kallickal 	switch (type) {
13126733b39aSJayamohan Kallickal 	case HWH_TYPE_IO:
13136733b39aSJayamohan Kallickal 	case HWH_TYPE_IO_RD:
13146733b39aSJayamohan Kallickal 		if ((task->hdr->opcode & ISCSI_OPCODE_MASK) ==
1315dafab8e0SJayamohan Kallickal 		     ISCSI_OP_NOOP_OUT)
13166733b39aSJayamohan Kallickal 			be_complete_nopin_resp(beiscsi_conn, task, psol);
1317dafab8e0SJayamohan Kallickal 		else
13186733b39aSJayamohan Kallickal 			be_complete_io(beiscsi_conn, task, psol);
13196733b39aSJayamohan Kallickal 		break;
13206733b39aSJayamohan Kallickal 
13216733b39aSJayamohan Kallickal 	case HWH_TYPE_LOGOUT:
1322dafab8e0SJayamohan Kallickal 		if ((task->hdr->opcode & ISCSI_OPCODE_MASK) == ISCSI_OP_LOGOUT)
13236733b39aSJayamohan Kallickal 			be_complete_logout(beiscsi_conn, task, psol);
1324dafab8e0SJayamohan Kallickal 		else
1325dafab8e0SJayamohan Kallickal 			be_complete_tmf(beiscsi_conn, task, psol);
1326dafab8e0SJayamohan Kallickal 
13276733b39aSJayamohan Kallickal 		break;
13286733b39aSJayamohan Kallickal 
13296733b39aSJayamohan Kallickal 	case HWH_TYPE_LOGIN:
13306733b39aSJayamohan Kallickal 		SE_DEBUG(DBG_LVL_1,
13316733b39aSJayamohan Kallickal 			 "\t\t No HWH_TYPE_LOGIN Expected in hwi_complete_cmd"
13326733b39aSJayamohan Kallickal 			 "- Solicited path\n");
13336733b39aSJayamohan Kallickal 		break;
13346733b39aSJayamohan Kallickal 
13356733b39aSJayamohan Kallickal 	case HWH_TYPE_NOP:
13366733b39aSJayamohan Kallickal 		be_complete_nopin_resp(beiscsi_conn, task, psol);
13376733b39aSJayamohan Kallickal 		break;
13386733b39aSJayamohan Kallickal 
13396733b39aSJayamohan Kallickal 	default:
13406733b39aSJayamohan Kallickal 		shost_printk(KERN_WARNING, phba->shost,
1341bfead3b2SJayamohan Kallickal 				"In hwi_complete_cmd, unknown type = %d"
1342bfead3b2SJayamohan Kallickal 				"wrb_index 0x%x CID 0x%x\n", type,
1343bfead3b2SJayamohan Kallickal 				((psol->dw[offsetof(struct amap_iscsi_wrb,
1344bfead3b2SJayamohan Kallickal 				type) / 32] & SOL_WRB_INDEX_MASK) >> 16),
1345bfead3b2SJayamohan Kallickal 				((psol->dw[offsetof(struct amap_sol_cqe,
1346bfead3b2SJayamohan Kallickal 				cid) / 32] & SOL_CID_MASK) >> 6));
13476733b39aSJayamohan Kallickal 		break;
13486733b39aSJayamohan Kallickal 	}
134935e66019SJayamohan Kallickal 
13506733b39aSJayamohan Kallickal 	spin_unlock_bh(&session->lock);
13516733b39aSJayamohan Kallickal }
13526733b39aSJayamohan Kallickal 
13536733b39aSJayamohan Kallickal static struct list_head *hwi_get_async_busy_list(struct hwi_async_pdu_context
13546733b39aSJayamohan Kallickal 					  *pasync_ctx, unsigned int is_header,
13556733b39aSJayamohan Kallickal 					  unsigned int host_write_ptr)
13566733b39aSJayamohan Kallickal {
13576733b39aSJayamohan Kallickal 	if (is_header)
13586733b39aSJayamohan Kallickal 		return &pasync_ctx->async_entry[host_write_ptr].
13596733b39aSJayamohan Kallickal 		    header_busy_list;
13606733b39aSJayamohan Kallickal 	else
13616733b39aSJayamohan Kallickal 		return &pasync_ctx->async_entry[host_write_ptr].data_busy_list;
13626733b39aSJayamohan Kallickal }
13636733b39aSJayamohan Kallickal 
13646733b39aSJayamohan Kallickal static struct async_pdu_handle *
13656733b39aSJayamohan Kallickal hwi_get_async_handle(struct beiscsi_hba *phba,
13666733b39aSJayamohan Kallickal 		     struct beiscsi_conn *beiscsi_conn,
13676733b39aSJayamohan Kallickal 		     struct hwi_async_pdu_context *pasync_ctx,
13686733b39aSJayamohan Kallickal 		     struct i_t_dpdu_cqe *pdpdu_cqe, unsigned int *pcq_index)
13696733b39aSJayamohan Kallickal {
13706733b39aSJayamohan Kallickal 	struct be_bus_address phys_addr;
13716733b39aSJayamohan Kallickal 	struct list_head *pbusy_list;
13726733b39aSJayamohan Kallickal 	struct async_pdu_handle *pasync_handle = NULL;
13736733b39aSJayamohan Kallickal 	int buffer_len = 0;
13746733b39aSJayamohan Kallickal 	unsigned char buffer_index = -1;
13756733b39aSJayamohan Kallickal 	unsigned char is_header = 0;
13766733b39aSJayamohan Kallickal 
13776733b39aSJayamohan Kallickal 	phys_addr.u.a32.address_lo =
13786733b39aSJayamohan Kallickal 	    pdpdu_cqe->dw[offsetof(struct amap_i_t_dpdu_cqe, db_addr_lo) / 32] -
13796733b39aSJayamohan Kallickal 	    ((pdpdu_cqe->dw[offsetof(struct amap_i_t_dpdu_cqe, dpl) / 32]
13806733b39aSJayamohan Kallickal 						& PDUCQE_DPL_MASK) >> 16);
13816733b39aSJayamohan Kallickal 	phys_addr.u.a32.address_hi =
13826733b39aSJayamohan Kallickal 	    pdpdu_cqe->dw[offsetof(struct amap_i_t_dpdu_cqe, db_addr_hi) / 32];
13836733b39aSJayamohan Kallickal 
13846733b39aSJayamohan Kallickal 	phys_addr.u.a64.address =
13856733b39aSJayamohan Kallickal 			*((unsigned long long *)(&phys_addr.u.a64.address));
13866733b39aSJayamohan Kallickal 
13876733b39aSJayamohan Kallickal 	switch (pdpdu_cqe->dw[offsetof(struct amap_i_t_dpdu_cqe, code) / 32]
13886733b39aSJayamohan Kallickal 			& PDUCQE_CODE_MASK) {
13896733b39aSJayamohan Kallickal 	case UNSOL_HDR_NOTIFY:
13906733b39aSJayamohan Kallickal 		is_header = 1;
13916733b39aSJayamohan Kallickal 
13926733b39aSJayamohan Kallickal 		pbusy_list = hwi_get_async_busy_list(pasync_ctx, 1,
13936733b39aSJayamohan Kallickal 			(pdpdu_cqe->dw[offsetof(struct amap_i_t_dpdu_cqe,
13946733b39aSJayamohan Kallickal 			index) / 32] & PDUCQE_INDEX_MASK));
13956733b39aSJayamohan Kallickal 
13966733b39aSJayamohan Kallickal 		buffer_len = (unsigned int)(phys_addr.u.a64.address -
13976733b39aSJayamohan Kallickal 				pasync_ctx->async_header.pa_base.u.a64.address);
13986733b39aSJayamohan Kallickal 
13996733b39aSJayamohan Kallickal 		buffer_index = buffer_len /
14006733b39aSJayamohan Kallickal 				pasync_ctx->async_header.buffer_size;
14016733b39aSJayamohan Kallickal 
14026733b39aSJayamohan Kallickal 		break;
14036733b39aSJayamohan Kallickal 	case UNSOL_DATA_NOTIFY:
14046733b39aSJayamohan Kallickal 		pbusy_list = hwi_get_async_busy_list(pasync_ctx, 0, (pdpdu_cqe->
14056733b39aSJayamohan Kallickal 					dw[offsetof(struct amap_i_t_dpdu_cqe,
14066733b39aSJayamohan Kallickal 					index) / 32] & PDUCQE_INDEX_MASK));
14076733b39aSJayamohan Kallickal 		buffer_len = (unsigned long)(phys_addr.u.a64.address -
14086733b39aSJayamohan Kallickal 					pasync_ctx->async_data.pa_base.u.
14096733b39aSJayamohan Kallickal 					a64.address);
14106733b39aSJayamohan Kallickal 		buffer_index = buffer_len / pasync_ctx->async_data.buffer_size;
14116733b39aSJayamohan Kallickal 		break;
14126733b39aSJayamohan Kallickal 	default:
14136733b39aSJayamohan Kallickal 		pbusy_list = NULL;
14146733b39aSJayamohan Kallickal 		shost_printk(KERN_WARNING, phba->shost,
14156733b39aSJayamohan Kallickal 			"Unexpected code=%d\n",
14166733b39aSJayamohan Kallickal 			 pdpdu_cqe->dw[offsetof(struct amap_i_t_dpdu_cqe,
14176733b39aSJayamohan Kallickal 					code) / 32] & PDUCQE_CODE_MASK);
14186733b39aSJayamohan Kallickal 		return NULL;
14196733b39aSJayamohan Kallickal 	}
14206733b39aSJayamohan Kallickal 
14216733b39aSJayamohan Kallickal 	WARN_ON(!(buffer_index <= pasync_ctx->async_data.num_entries));
14226733b39aSJayamohan Kallickal 	WARN_ON(list_empty(pbusy_list));
14236733b39aSJayamohan Kallickal 	list_for_each_entry(pasync_handle, pbusy_list, link) {
14246733b39aSJayamohan Kallickal 		WARN_ON(pasync_handle->consumed);
14256733b39aSJayamohan Kallickal 		if (pasync_handle->index == buffer_index)
14266733b39aSJayamohan Kallickal 			break;
14276733b39aSJayamohan Kallickal 	}
14286733b39aSJayamohan Kallickal 
14296733b39aSJayamohan Kallickal 	WARN_ON(!pasync_handle);
14306733b39aSJayamohan Kallickal 
14317da50879SJayamohan Kallickal 	pasync_handle->cri = (unsigned short)beiscsi_conn->beiscsi_conn_cid -
14327da50879SJayamohan Kallickal 					     phba->fw_config.iscsi_cid_start;
14336733b39aSJayamohan Kallickal 	pasync_handle->is_header = is_header;
14346733b39aSJayamohan Kallickal 	pasync_handle->buffer_len = ((pdpdu_cqe->
14356733b39aSJayamohan Kallickal 			dw[offsetof(struct amap_i_t_dpdu_cqe, dpl) / 32]
14366733b39aSJayamohan Kallickal 			& PDUCQE_DPL_MASK) >> 16);
14376733b39aSJayamohan Kallickal 
14386733b39aSJayamohan Kallickal 	*pcq_index = (pdpdu_cqe->dw[offsetof(struct amap_i_t_dpdu_cqe,
14396733b39aSJayamohan Kallickal 			index) / 32] & PDUCQE_INDEX_MASK);
14406733b39aSJayamohan Kallickal 	return pasync_handle;
14416733b39aSJayamohan Kallickal }
14426733b39aSJayamohan Kallickal 
14436733b39aSJayamohan Kallickal static unsigned int
14446733b39aSJayamohan Kallickal hwi_update_async_writables(struct hwi_async_pdu_context *pasync_ctx,
14456733b39aSJayamohan Kallickal 			   unsigned int is_header, unsigned int cq_index)
14466733b39aSJayamohan Kallickal {
14476733b39aSJayamohan Kallickal 	struct list_head *pbusy_list;
14486733b39aSJayamohan Kallickal 	struct async_pdu_handle *pasync_handle;
14496733b39aSJayamohan Kallickal 	unsigned int num_entries, writables = 0;
14506733b39aSJayamohan Kallickal 	unsigned int *pep_read_ptr, *pwritables;
14516733b39aSJayamohan Kallickal 
14526733b39aSJayamohan Kallickal 
14536733b39aSJayamohan Kallickal 	if (is_header) {
14546733b39aSJayamohan Kallickal 		pep_read_ptr = &pasync_ctx->async_header.ep_read_ptr;
14556733b39aSJayamohan Kallickal 		pwritables = &pasync_ctx->async_header.writables;
14566733b39aSJayamohan Kallickal 		num_entries = pasync_ctx->async_header.num_entries;
14576733b39aSJayamohan Kallickal 	} else {
14586733b39aSJayamohan Kallickal 		pep_read_ptr = &pasync_ctx->async_data.ep_read_ptr;
14596733b39aSJayamohan Kallickal 		pwritables = &pasync_ctx->async_data.writables;
14606733b39aSJayamohan Kallickal 		num_entries = pasync_ctx->async_data.num_entries;
14616733b39aSJayamohan Kallickal 	}
14626733b39aSJayamohan Kallickal 
14636733b39aSJayamohan Kallickal 	while ((*pep_read_ptr) != cq_index) {
14646733b39aSJayamohan Kallickal 		(*pep_read_ptr)++;
14656733b39aSJayamohan Kallickal 		*pep_read_ptr = (*pep_read_ptr) % num_entries;
14666733b39aSJayamohan Kallickal 
14676733b39aSJayamohan Kallickal 		pbusy_list = hwi_get_async_busy_list(pasync_ctx, is_header,
14686733b39aSJayamohan Kallickal 						     *pep_read_ptr);
14696733b39aSJayamohan Kallickal 		if (writables == 0)
14706733b39aSJayamohan Kallickal 			WARN_ON(list_empty(pbusy_list));
14716733b39aSJayamohan Kallickal 
14726733b39aSJayamohan Kallickal 		if (!list_empty(pbusy_list)) {
14736733b39aSJayamohan Kallickal 			pasync_handle = list_entry(pbusy_list->next,
14746733b39aSJayamohan Kallickal 						   struct async_pdu_handle,
14756733b39aSJayamohan Kallickal 						   link);
14766733b39aSJayamohan Kallickal 			WARN_ON(!pasync_handle);
14776733b39aSJayamohan Kallickal 			pasync_handle->consumed = 1;
14786733b39aSJayamohan Kallickal 		}
14796733b39aSJayamohan Kallickal 
14806733b39aSJayamohan Kallickal 		writables++;
14816733b39aSJayamohan Kallickal 	}
14826733b39aSJayamohan Kallickal 
14836733b39aSJayamohan Kallickal 	if (!writables) {
14846733b39aSJayamohan Kallickal 		SE_DEBUG(DBG_LVL_1,
14856733b39aSJayamohan Kallickal 			 "Duplicate notification received - index 0x%x!!\n",
14866733b39aSJayamohan Kallickal 			 cq_index);
14876733b39aSJayamohan Kallickal 		WARN_ON(1);
14886733b39aSJayamohan Kallickal 	}
14896733b39aSJayamohan Kallickal 
14906733b39aSJayamohan Kallickal 	*pwritables = *pwritables + writables;
14916733b39aSJayamohan Kallickal 	return 0;
14926733b39aSJayamohan Kallickal }
14936733b39aSJayamohan Kallickal 
14946733b39aSJayamohan Kallickal static unsigned int hwi_free_async_msg(struct beiscsi_hba *phba,
14956733b39aSJayamohan Kallickal 				       unsigned int cri)
14966733b39aSJayamohan Kallickal {
14976733b39aSJayamohan Kallickal 	struct hwi_controller *phwi_ctrlr;
14986733b39aSJayamohan Kallickal 	struct hwi_async_pdu_context *pasync_ctx;
14996733b39aSJayamohan Kallickal 	struct async_pdu_handle *pasync_handle, *tmp_handle;
15006733b39aSJayamohan Kallickal 	struct list_head *plist;
15016733b39aSJayamohan Kallickal 	unsigned int i = 0;
15026733b39aSJayamohan Kallickal 
15036733b39aSJayamohan Kallickal 	phwi_ctrlr = phba->phwi_ctrlr;
15046733b39aSJayamohan Kallickal 	pasync_ctx = HWI_GET_ASYNC_PDU_CTX(phwi_ctrlr);
15056733b39aSJayamohan Kallickal 
15066733b39aSJayamohan Kallickal 	plist  = &pasync_ctx->async_entry[cri].wait_queue.list;
15076733b39aSJayamohan Kallickal 
15086733b39aSJayamohan Kallickal 	list_for_each_entry_safe(pasync_handle, tmp_handle, plist, link) {
15096733b39aSJayamohan Kallickal 		list_del(&pasync_handle->link);
15106733b39aSJayamohan Kallickal 
15116733b39aSJayamohan Kallickal 		if (i == 0) {
15126733b39aSJayamohan Kallickal 			list_add_tail(&pasync_handle->link,
15136733b39aSJayamohan Kallickal 				      &pasync_ctx->async_header.free_list);
15146733b39aSJayamohan Kallickal 			pasync_ctx->async_header.free_entries++;
15156733b39aSJayamohan Kallickal 			i++;
15166733b39aSJayamohan Kallickal 		} else {
15176733b39aSJayamohan Kallickal 			list_add_tail(&pasync_handle->link,
15186733b39aSJayamohan Kallickal 				      &pasync_ctx->async_data.free_list);
15196733b39aSJayamohan Kallickal 			pasync_ctx->async_data.free_entries++;
15206733b39aSJayamohan Kallickal 			i++;
15216733b39aSJayamohan Kallickal 		}
15226733b39aSJayamohan Kallickal 	}
15236733b39aSJayamohan Kallickal 
15246733b39aSJayamohan Kallickal 	INIT_LIST_HEAD(&pasync_ctx->async_entry[cri].wait_queue.list);
15256733b39aSJayamohan Kallickal 	pasync_ctx->async_entry[cri].wait_queue.hdr_received = 0;
15266733b39aSJayamohan Kallickal 	pasync_ctx->async_entry[cri].wait_queue.bytes_received = 0;
15276733b39aSJayamohan Kallickal 	return 0;
15286733b39aSJayamohan Kallickal }
15296733b39aSJayamohan Kallickal 
15306733b39aSJayamohan Kallickal static struct phys_addr *
15316733b39aSJayamohan Kallickal hwi_get_ring_address(struct hwi_async_pdu_context *pasync_ctx,
15326733b39aSJayamohan Kallickal 		     unsigned int is_header, unsigned int host_write_ptr)
15336733b39aSJayamohan Kallickal {
15346733b39aSJayamohan Kallickal 	struct phys_addr *pasync_sge = NULL;
15356733b39aSJayamohan Kallickal 
15366733b39aSJayamohan Kallickal 	if (is_header)
15376733b39aSJayamohan Kallickal 		pasync_sge = pasync_ctx->async_header.ring_base;
15386733b39aSJayamohan Kallickal 	else
15396733b39aSJayamohan Kallickal 		pasync_sge = pasync_ctx->async_data.ring_base;
15406733b39aSJayamohan Kallickal 
15416733b39aSJayamohan Kallickal 	return pasync_sge + host_write_ptr;
15426733b39aSJayamohan Kallickal }
15436733b39aSJayamohan Kallickal 
15446733b39aSJayamohan Kallickal static void hwi_post_async_buffers(struct beiscsi_hba *phba,
15456733b39aSJayamohan Kallickal 				   unsigned int is_header)
15466733b39aSJayamohan Kallickal {
15476733b39aSJayamohan Kallickal 	struct hwi_controller *phwi_ctrlr;
15486733b39aSJayamohan Kallickal 	struct hwi_async_pdu_context *pasync_ctx;
15496733b39aSJayamohan Kallickal 	struct async_pdu_handle *pasync_handle;
15506733b39aSJayamohan Kallickal 	struct list_head *pfree_link, *pbusy_list;
15516733b39aSJayamohan Kallickal 	struct phys_addr *pasync_sge;
15526733b39aSJayamohan Kallickal 	unsigned int ring_id, num_entries;
15536733b39aSJayamohan Kallickal 	unsigned int host_write_num;
15546733b39aSJayamohan Kallickal 	unsigned int writables;
15556733b39aSJayamohan Kallickal 	unsigned int i = 0;
15566733b39aSJayamohan Kallickal 	u32 doorbell = 0;
15576733b39aSJayamohan Kallickal 
15586733b39aSJayamohan Kallickal 	phwi_ctrlr = phba->phwi_ctrlr;
15596733b39aSJayamohan Kallickal 	pasync_ctx = HWI_GET_ASYNC_PDU_CTX(phwi_ctrlr);
15606733b39aSJayamohan Kallickal 
15616733b39aSJayamohan Kallickal 	if (is_header) {
15626733b39aSJayamohan Kallickal 		num_entries = pasync_ctx->async_header.num_entries;
15636733b39aSJayamohan Kallickal 		writables = min(pasync_ctx->async_header.writables,
15646733b39aSJayamohan Kallickal 				pasync_ctx->async_header.free_entries);
15656733b39aSJayamohan Kallickal 		pfree_link = pasync_ctx->async_header.free_list.next;
15666733b39aSJayamohan Kallickal 		host_write_num = pasync_ctx->async_header.host_write_ptr;
15676733b39aSJayamohan Kallickal 		ring_id = phwi_ctrlr->default_pdu_hdr.id;
15686733b39aSJayamohan Kallickal 	} else {
15696733b39aSJayamohan Kallickal 		num_entries = pasync_ctx->async_data.num_entries;
15706733b39aSJayamohan Kallickal 		writables = min(pasync_ctx->async_data.writables,
15716733b39aSJayamohan Kallickal 				pasync_ctx->async_data.free_entries);
15726733b39aSJayamohan Kallickal 		pfree_link = pasync_ctx->async_data.free_list.next;
15736733b39aSJayamohan Kallickal 		host_write_num = pasync_ctx->async_data.host_write_ptr;
15746733b39aSJayamohan Kallickal 		ring_id = phwi_ctrlr->default_pdu_data.id;
15756733b39aSJayamohan Kallickal 	}
15766733b39aSJayamohan Kallickal 
15776733b39aSJayamohan Kallickal 	writables = (writables / 8) * 8;
15786733b39aSJayamohan Kallickal 	if (writables) {
15796733b39aSJayamohan Kallickal 		for (i = 0; i < writables; i++) {
15806733b39aSJayamohan Kallickal 			pbusy_list =
15816733b39aSJayamohan Kallickal 			    hwi_get_async_busy_list(pasync_ctx, is_header,
15826733b39aSJayamohan Kallickal 						    host_write_num);
15836733b39aSJayamohan Kallickal 			pasync_handle =
15846733b39aSJayamohan Kallickal 			    list_entry(pfree_link, struct async_pdu_handle,
15856733b39aSJayamohan Kallickal 								link);
15866733b39aSJayamohan Kallickal 			WARN_ON(!pasync_handle);
15876733b39aSJayamohan Kallickal 			pasync_handle->consumed = 0;
15886733b39aSJayamohan Kallickal 
15896733b39aSJayamohan Kallickal 			pfree_link = pfree_link->next;
15906733b39aSJayamohan Kallickal 
15916733b39aSJayamohan Kallickal 			pasync_sge = hwi_get_ring_address(pasync_ctx,
15926733b39aSJayamohan Kallickal 						is_header, host_write_num);
15936733b39aSJayamohan Kallickal 
15946733b39aSJayamohan Kallickal 			pasync_sge->hi = pasync_handle->pa.u.a32.address_lo;
15956733b39aSJayamohan Kallickal 			pasync_sge->lo = pasync_handle->pa.u.a32.address_hi;
15966733b39aSJayamohan Kallickal 
15976733b39aSJayamohan Kallickal 			list_move(&pasync_handle->link, pbusy_list);
15986733b39aSJayamohan Kallickal 
15996733b39aSJayamohan Kallickal 			host_write_num++;
16006733b39aSJayamohan Kallickal 			host_write_num = host_write_num % num_entries;
16016733b39aSJayamohan Kallickal 		}
16026733b39aSJayamohan Kallickal 
16036733b39aSJayamohan Kallickal 		if (is_header) {
16046733b39aSJayamohan Kallickal 			pasync_ctx->async_header.host_write_ptr =
16056733b39aSJayamohan Kallickal 							host_write_num;
16066733b39aSJayamohan Kallickal 			pasync_ctx->async_header.free_entries -= writables;
16076733b39aSJayamohan Kallickal 			pasync_ctx->async_header.writables -= writables;
16086733b39aSJayamohan Kallickal 			pasync_ctx->async_header.busy_entries += writables;
16096733b39aSJayamohan Kallickal 		} else {
16106733b39aSJayamohan Kallickal 			pasync_ctx->async_data.host_write_ptr = host_write_num;
16116733b39aSJayamohan Kallickal 			pasync_ctx->async_data.free_entries -= writables;
16126733b39aSJayamohan Kallickal 			pasync_ctx->async_data.writables -= writables;
16136733b39aSJayamohan Kallickal 			pasync_ctx->async_data.busy_entries += writables;
16146733b39aSJayamohan Kallickal 		}
16156733b39aSJayamohan Kallickal 
16166733b39aSJayamohan Kallickal 		doorbell |= ring_id & DB_DEF_PDU_RING_ID_MASK;
16176733b39aSJayamohan Kallickal 		doorbell |= 1 << DB_DEF_PDU_REARM_SHIFT;
16186733b39aSJayamohan Kallickal 		doorbell |= 0 << DB_DEF_PDU_EVENT_SHIFT;
16196733b39aSJayamohan Kallickal 		doorbell |= (writables & DB_DEF_PDU_CQPROC_MASK)
16206733b39aSJayamohan Kallickal 					<< DB_DEF_PDU_CQPROC_SHIFT;
16216733b39aSJayamohan Kallickal 
16226733b39aSJayamohan Kallickal 		iowrite32(doorbell, phba->db_va + DB_RXULP0_OFFSET);
16236733b39aSJayamohan Kallickal 	}
16246733b39aSJayamohan Kallickal }
16256733b39aSJayamohan Kallickal 
16266733b39aSJayamohan Kallickal static void hwi_flush_default_pdu_buffer(struct beiscsi_hba *phba,
16276733b39aSJayamohan Kallickal 					 struct beiscsi_conn *beiscsi_conn,
16286733b39aSJayamohan Kallickal 					 struct i_t_dpdu_cqe *pdpdu_cqe)
16296733b39aSJayamohan Kallickal {
16306733b39aSJayamohan Kallickal 	struct hwi_controller *phwi_ctrlr;
16316733b39aSJayamohan Kallickal 	struct hwi_async_pdu_context *pasync_ctx;
16326733b39aSJayamohan Kallickal 	struct async_pdu_handle *pasync_handle = NULL;
16336733b39aSJayamohan Kallickal 	unsigned int cq_index = -1;
16346733b39aSJayamohan Kallickal 
16356733b39aSJayamohan Kallickal 	phwi_ctrlr = phba->phwi_ctrlr;
16366733b39aSJayamohan Kallickal 	pasync_ctx = HWI_GET_ASYNC_PDU_CTX(phwi_ctrlr);
16376733b39aSJayamohan Kallickal 
16386733b39aSJayamohan Kallickal 	pasync_handle = hwi_get_async_handle(phba, beiscsi_conn, pasync_ctx,
16396733b39aSJayamohan Kallickal 					     pdpdu_cqe, &cq_index);
16406733b39aSJayamohan Kallickal 	BUG_ON(pasync_handle->is_header != 0);
16416733b39aSJayamohan Kallickal 	if (pasync_handle->consumed == 0)
16426733b39aSJayamohan Kallickal 		hwi_update_async_writables(pasync_ctx, pasync_handle->is_header,
16436733b39aSJayamohan Kallickal 					   cq_index);
16446733b39aSJayamohan Kallickal 
16456733b39aSJayamohan Kallickal 	hwi_free_async_msg(phba, pasync_handle->cri);
16466733b39aSJayamohan Kallickal 	hwi_post_async_buffers(phba, pasync_handle->is_header);
16476733b39aSJayamohan Kallickal }
16486733b39aSJayamohan Kallickal 
16496733b39aSJayamohan Kallickal static unsigned int
16506733b39aSJayamohan Kallickal hwi_fwd_async_msg(struct beiscsi_conn *beiscsi_conn,
16516733b39aSJayamohan Kallickal 		  struct beiscsi_hba *phba,
16526733b39aSJayamohan Kallickal 		  struct hwi_async_pdu_context *pasync_ctx, unsigned short cri)
16536733b39aSJayamohan Kallickal {
16546733b39aSJayamohan Kallickal 	struct list_head *plist;
16556733b39aSJayamohan Kallickal 	struct async_pdu_handle *pasync_handle;
16566733b39aSJayamohan Kallickal 	void *phdr = NULL;
16576733b39aSJayamohan Kallickal 	unsigned int hdr_len = 0, buf_len = 0;
16586733b39aSJayamohan Kallickal 	unsigned int status, index = 0, offset = 0;
16596733b39aSJayamohan Kallickal 	void *pfirst_buffer = NULL;
16606733b39aSJayamohan Kallickal 	unsigned int num_buf = 0;
16616733b39aSJayamohan Kallickal 
16626733b39aSJayamohan Kallickal 	plist = &pasync_ctx->async_entry[cri].wait_queue.list;
16636733b39aSJayamohan Kallickal 
16646733b39aSJayamohan Kallickal 	list_for_each_entry(pasync_handle, plist, link) {
16656733b39aSJayamohan Kallickal 		if (index == 0) {
16666733b39aSJayamohan Kallickal 			phdr = pasync_handle->pbuffer;
16676733b39aSJayamohan Kallickal 			hdr_len = pasync_handle->buffer_len;
16686733b39aSJayamohan Kallickal 		} else {
16696733b39aSJayamohan Kallickal 			buf_len = pasync_handle->buffer_len;
16706733b39aSJayamohan Kallickal 			if (!num_buf) {
16716733b39aSJayamohan Kallickal 				pfirst_buffer = pasync_handle->pbuffer;
16726733b39aSJayamohan Kallickal 				num_buf++;
16736733b39aSJayamohan Kallickal 			}
16746733b39aSJayamohan Kallickal 			memcpy(pfirst_buffer + offset,
16756733b39aSJayamohan Kallickal 			       pasync_handle->pbuffer, buf_len);
16766733b39aSJayamohan Kallickal 			offset = buf_len;
16776733b39aSJayamohan Kallickal 		}
16786733b39aSJayamohan Kallickal 		index++;
16796733b39aSJayamohan Kallickal 	}
16806733b39aSJayamohan Kallickal 
16816733b39aSJayamohan Kallickal 	status = beiscsi_process_async_pdu(beiscsi_conn, phba,
16827da50879SJayamohan Kallickal 					   (beiscsi_conn->beiscsi_conn_cid -
16837da50879SJayamohan Kallickal 					    phba->fw_config.iscsi_cid_start),
16846733b39aSJayamohan Kallickal 					    phdr, hdr_len, pfirst_buffer,
16856733b39aSJayamohan Kallickal 					    buf_len);
16866733b39aSJayamohan Kallickal 
16876733b39aSJayamohan Kallickal 	if (status == 0)
16886733b39aSJayamohan Kallickal 		hwi_free_async_msg(phba, cri);
16896733b39aSJayamohan Kallickal 	return 0;
16906733b39aSJayamohan Kallickal }
16916733b39aSJayamohan Kallickal 
16926733b39aSJayamohan Kallickal static unsigned int
16936733b39aSJayamohan Kallickal hwi_gather_async_pdu(struct beiscsi_conn *beiscsi_conn,
16946733b39aSJayamohan Kallickal 		     struct beiscsi_hba *phba,
16956733b39aSJayamohan Kallickal 		     struct async_pdu_handle *pasync_handle)
16966733b39aSJayamohan Kallickal {
16976733b39aSJayamohan Kallickal 	struct hwi_async_pdu_context *pasync_ctx;
16986733b39aSJayamohan Kallickal 	struct hwi_controller *phwi_ctrlr;
16996733b39aSJayamohan Kallickal 	unsigned int bytes_needed = 0, status = 0;
17006733b39aSJayamohan Kallickal 	unsigned short cri = pasync_handle->cri;
17016733b39aSJayamohan Kallickal 	struct pdu_base *ppdu;
17026733b39aSJayamohan Kallickal 
17036733b39aSJayamohan Kallickal 	phwi_ctrlr = phba->phwi_ctrlr;
17046733b39aSJayamohan Kallickal 	pasync_ctx = HWI_GET_ASYNC_PDU_CTX(phwi_ctrlr);
17056733b39aSJayamohan Kallickal 
17066733b39aSJayamohan Kallickal 	list_del(&pasync_handle->link);
17076733b39aSJayamohan Kallickal 	if (pasync_handle->is_header) {
17086733b39aSJayamohan Kallickal 		pasync_ctx->async_header.busy_entries--;
17096733b39aSJayamohan Kallickal 		if (pasync_ctx->async_entry[cri].wait_queue.hdr_received) {
17106733b39aSJayamohan Kallickal 			hwi_free_async_msg(phba, cri);
17116733b39aSJayamohan Kallickal 			BUG();
17126733b39aSJayamohan Kallickal 		}
17136733b39aSJayamohan Kallickal 
17146733b39aSJayamohan Kallickal 		pasync_ctx->async_entry[cri].wait_queue.bytes_received = 0;
17156733b39aSJayamohan Kallickal 		pasync_ctx->async_entry[cri].wait_queue.hdr_received = 1;
17166733b39aSJayamohan Kallickal 		pasync_ctx->async_entry[cri].wait_queue.hdr_len =
17176733b39aSJayamohan Kallickal 				(unsigned short)pasync_handle->buffer_len;
17186733b39aSJayamohan Kallickal 		list_add_tail(&pasync_handle->link,
17196733b39aSJayamohan Kallickal 			      &pasync_ctx->async_entry[cri].wait_queue.list);
17206733b39aSJayamohan Kallickal 
17216733b39aSJayamohan Kallickal 		ppdu = pasync_handle->pbuffer;
17226733b39aSJayamohan Kallickal 		bytes_needed = ((((ppdu->dw[offsetof(struct amap_pdu_base,
17236733b39aSJayamohan Kallickal 			data_len_hi) / 32] & PDUBASE_DATALENHI_MASK) << 8) &
17246733b39aSJayamohan Kallickal 			0xFFFF0000) | ((be16_to_cpu((ppdu->
17256733b39aSJayamohan Kallickal 			dw[offsetof(struct amap_pdu_base, data_len_lo) / 32]
17266733b39aSJayamohan Kallickal 			& PDUBASE_DATALENLO_MASK) >> 16)) & 0x0000FFFF));
17276733b39aSJayamohan Kallickal 
17286733b39aSJayamohan Kallickal 		if (status == 0) {
17296733b39aSJayamohan Kallickal 			pasync_ctx->async_entry[cri].wait_queue.bytes_needed =
17306733b39aSJayamohan Kallickal 			    bytes_needed;
17316733b39aSJayamohan Kallickal 
17326733b39aSJayamohan Kallickal 			if (bytes_needed == 0)
17336733b39aSJayamohan Kallickal 				status = hwi_fwd_async_msg(beiscsi_conn, phba,
17346733b39aSJayamohan Kallickal 							   pasync_ctx, cri);
17356733b39aSJayamohan Kallickal 		}
17366733b39aSJayamohan Kallickal 	} else {
17376733b39aSJayamohan Kallickal 		pasync_ctx->async_data.busy_entries--;
17386733b39aSJayamohan Kallickal 		if (pasync_ctx->async_entry[cri].wait_queue.hdr_received) {
17396733b39aSJayamohan Kallickal 			list_add_tail(&pasync_handle->link,
17406733b39aSJayamohan Kallickal 				      &pasync_ctx->async_entry[cri].wait_queue.
17416733b39aSJayamohan Kallickal 				      list);
17426733b39aSJayamohan Kallickal 			pasync_ctx->async_entry[cri].wait_queue.
17436733b39aSJayamohan Kallickal 				bytes_received +=
17446733b39aSJayamohan Kallickal 				(unsigned short)pasync_handle->buffer_len;
17456733b39aSJayamohan Kallickal 
17466733b39aSJayamohan Kallickal 			if (pasync_ctx->async_entry[cri].wait_queue.
17476733b39aSJayamohan Kallickal 			    bytes_received >=
17486733b39aSJayamohan Kallickal 			    pasync_ctx->async_entry[cri].wait_queue.
17496733b39aSJayamohan Kallickal 			    bytes_needed)
17506733b39aSJayamohan Kallickal 				status = hwi_fwd_async_msg(beiscsi_conn, phba,
17516733b39aSJayamohan Kallickal 							   pasync_ctx, cri);
17526733b39aSJayamohan Kallickal 		}
17536733b39aSJayamohan Kallickal 	}
17546733b39aSJayamohan Kallickal 	return status;
17556733b39aSJayamohan Kallickal }
17566733b39aSJayamohan Kallickal 
17576733b39aSJayamohan Kallickal static void hwi_process_default_pdu_ring(struct beiscsi_conn *beiscsi_conn,
17586733b39aSJayamohan Kallickal 					 struct beiscsi_hba *phba,
17596733b39aSJayamohan Kallickal 					 struct i_t_dpdu_cqe *pdpdu_cqe)
17606733b39aSJayamohan Kallickal {
17616733b39aSJayamohan Kallickal 	struct hwi_controller *phwi_ctrlr;
17626733b39aSJayamohan Kallickal 	struct hwi_async_pdu_context *pasync_ctx;
17636733b39aSJayamohan Kallickal 	struct async_pdu_handle *pasync_handle = NULL;
17646733b39aSJayamohan Kallickal 	unsigned int cq_index = -1;
17656733b39aSJayamohan Kallickal 
17666733b39aSJayamohan Kallickal 	phwi_ctrlr = phba->phwi_ctrlr;
17676733b39aSJayamohan Kallickal 	pasync_ctx = HWI_GET_ASYNC_PDU_CTX(phwi_ctrlr);
17686733b39aSJayamohan Kallickal 	pasync_handle = hwi_get_async_handle(phba, beiscsi_conn, pasync_ctx,
17696733b39aSJayamohan Kallickal 					     pdpdu_cqe, &cq_index);
17706733b39aSJayamohan Kallickal 
17716733b39aSJayamohan Kallickal 	if (pasync_handle->consumed == 0)
17726733b39aSJayamohan Kallickal 		hwi_update_async_writables(pasync_ctx, pasync_handle->is_header,
17736733b39aSJayamohan Kallickal 					   cq_index);
17746733b39aSJayamohan Kallickal 	hwi_gather_async_pdu(beiscsi_conn, phba, pasync_handle);
17756733b39aSJayamohan Kallickal 	hwi_post_async_buffers(phba, pasync_handle->is_header);
17766733b39aSJayamohan Kallickal }
17776733b39aSJayamohan Kallickal 
1778756d29c8SJayamohan Kallickal static void  beiscsi_process_mcc_isr(struct beiscsi_hba *phba)
1779756d29c8SJayamohan Kallickal {
1780756d29c8SJayamohan Kallickal 	struct be_queue_info *mcc_cq;
1781756d29c8SJayamohan Kallickal 	struct  be_mcc_compl *mcc_compl;
1782756d29c8SJayamohan Kallickal 	unsigned int num_processed = 0;
1783756d29c8SJayamohan Kallickal 
1784756d29c8SJayamohan Kallickal 	mcc_cq = &phba->ctrl.mcc_obj.cq;
1785756d29c8SJayamohan Kallickal 	mcc_compl = queue_tail_node(mcc_cq);
1786756d29c8SJayamohan Kallickal 	mcc_compl->flags = le32_to_cpu(mcc_compl->flags);
1787756d29c8SJayamohan Kallickal 	while (mcc_compl->flags & CQE_FLAGS_VALID_MASK) {
1788756d29c8SJayamohan Kallickal 
1789756d29c8SJayamohan Kallickal 		if (num_processed >= 32) {
1790756d29c8SJayamohan Kallickal 			hwi_ring_cq_db(phba, mcc_cq->id,
1791756d29c8SJayamohan Kallickal 					num_processed, 0, 0);
1792756d29c8SJayamohan Kallickal 			num_processed = 0;
1793756d29c8SJayamohan Kallickal 		}
1794756d29c8SJayamohan Kallickal 		if (mcc_compl->flags & CQE_FLAGS_ASYNC_MASK) {
1795756d29c8SJayamohan Kallickal 			/* Interpret flags as an async trailer */
1796756d29c8SJayamohan Kallickal 			if (is_link_state_evt(mcc_compl->flags))
1797756d29c8SJayamohan Kallickal 				/* Interpret compl as a async link evt */
1798756d29c8SJayamohan Kallickal 				beiscsi_async_link_state_process(phba,
1799756d29c8SJayamohan Kallickal 				(struct be_async_event_link_state *) mcc_compl);
1800756d29c8SJayamohan Kallickal 			else
1801756d29c8SJayamohan Kallickal 				SE_DEBUG(DBG_LVL_1,
1802756d29c8SJayamohan Kallickal 					" Unsupported Async Event, flags"
1803756d29c8SJayamohan Kallickal 					" = 0x%08x\n", mcc_compl->flags);
1804756d29c8SJayamohan Kallickal 		} else if (mcc_compl->flags & CQE_FLAGS_COMPLETED_MASK) {
1805756d29c8SJayamohan Kallickal 			be_mcc_compl_process_isr(&phba->ctrl, mcc_compl);
1806756d29c8SJayamohan Kallickal 			atomic_dec(&phba->ctrl.mcc_obj.q.used);
1807756d29c8SJayamohan Kallickal 		}
1808756d29c8SJayamohan Kallickal 
1809756d29c8SJayamohan Kallickal 		mcc_compl->flags = 0;
1810756d29c8SJayamohan Kallickal 		queue_tail_inc(mcc_cq);
1811756d29c8SJayamohan Kallickal 		mcc_compl = queue_tail_node(mcc_cq);
1812756d29c8SJayamohan Kallickal 		mcc_compl->flags = le32_to_cpu(mcc_compl->flags);
1813756d29c8SJayamohan Kallickal 		num_processed++;
1814756d29c8SJayamohan Kallickal 	}
1815756d29c8SJayamohan Kallickal 
1816756d29c8SJayamohan Kallickal 	if (num_processed > 0)
1817756d29c8SJayamohan Kallickal 		hwi_ring_cq_db(phba, mcc_cq->id, num_processed, 1, 0);
1818756d29c8SJayamohan Kallickal 
1819756d29c8SJayamohan Kallickal }
1820bfead3b2SJayamohan Kallickal 
1821bfead3b2SJayamohan Kallickal static unsigned int beiscsi_process_cq(struct be_eq_obj *pbe_eq)
18226733b39aSJayamohan Kallickal {
18236733b39aSJayamohan Kallickal 	struct be_queue_info *cq;
18246733b39aSJayamohan Kallickal 	struct sol_cqe *sol;
18256733b39aSJayamohan Kallickal 	struct dmsg_cqe *dmsg;
18266733b39aSJayamohan Kallickal 	unsigned int num_processed = 0;
18276733b39aSJayamohan Kallickal 	unsigned int tot_nump = 0;
18286733b39aSJayamohan Kallickal 	struct beiscsi_conn *beiscsi_conn;
1829c2462288SJayamohan Kallickal 	struct beiscsi_endpoint *beiscsi_ep;
1830c2462288SJayamohan Kallickal 	struct iscsi_endpoint *ep;
1831bfead3b2SJayamohan Kallickal 	struct beiscsi_hba *phba;
18326733b39aSJayamohan Kallickal 
1833bfead3b2SJayamohan Kallickal 	cq = pbe_eq->cq;
18346733b39aSJayamohan Kallickal 	sol = queue_tail_node(cq);
1835bfead3b2SJayamohan Kallickal 	phba = pbe_eq->phba;
18366733b39aSJayamohan Kallickal 
18376733b39aSJayamohan Kallickal 	while (sol->dw[offsetof(struct amap_sol_cqe, valid) / 32] &
18386733b39aSJayamohan Kallickal 	       CQE_VALID_MASK) {
18396733b39aSJayamohan Kallickal 		be_dws_le_to_cpu(sol, sizeof(struct sol_cqe));
18406733b39aSJayamohan Kallickal 
1841c2462288SJayamohan Kallickal 		ep = phba->ep_array[(u32) ((sol->
18426733b39aSJayamohan Kallickal 				   dw[offsetof(struct amap_sol_cqe, cid) / 32] &
18437da50879SJayamohan Kallickal 				   SOL_CID_MASK) >> 6) -
18447da50879SJayamohan Kallickal 				   phba->fw_config.iscsi_cid_start];
184532951dd8SJayamohan Kallickal 
1846c2462288SJayamohan Kallickal 		beiscsi_ep = ep->dd_data;
1847c2462288SJayamohan Kallickal 		beiscsi_conn = beiscsi_ep->conn;
1848756d29c8SJayamohan Kallickal 
18496733b39aSJayamohan Kallickal 		if (num_processed >= 32) {
1850bfead3b2SJayamohan Kallickal 			hwi_ring_cq_db(phba, cq->id,
18516733b39aSJayamohan Kallickal 					num_processed, 0, 0);
18526733b39aSJayamohan Kallickal 			tot_nump += num_processed;
18536733b39aSJayamohan Kallickal 			num_processed = 0;
18546733b39aSJayamohan Kallickal 		}
18556733b39aSJayamohan Kallickal 
18566733b39aSJayamohan Kallickal 		switch ((u32) sol->dw[offsetof(struct amap_sol_cqe, code) /
18576733b39aSJayamohan Kallickal 			32] & CQE_CODE_MASK) {
18586733b39aSJayamohan Kallickal 		case SOL_CMD_COMPLETE:
18596733b39aSJayamohan Kallickal 			hwi_complete_cmd(beiscsi_conn, phba, sol);
18606733b39aSJayamohan Kallickal 			break;
18616733b39aSJayamohan Kallickal 		case DRIVERMSG_NOTIFY:
18626733b39aSJayamohan Kallickal 			SE_DEBUG(DBG_LVL_8, "Received DRIVERMSG_NOTIFY\n");
18636733b39aSJayamohan Kallickal 			dmsg = (struct dmsg_cqe *)sol;
18646733b39aSJayamohan Kallickal 			hwi_complete_drvr_msgs(beiscsi_conn, phba, sol);
18656733b39aSJayamohan Kallickal 			break;
18666733b39aSJayamohan Kallickal 		case UNSOL_HDR_NOTIFY:
1867bfead3b2SJayamohan Kallickal 			SE_DEBUG(DBG_LVL_8, "Received UNSOL_HDR_ NOTIFY\n");
1868bfead3b2SJayamohan Kallickal 			hwi_process_default_pdu_ring(beiscsi_conn, phba,
1869bfead3b2SJayamohan Kallickal 					     (struct i_t_dpdu_cqe *)sol);
1870bfead3b2SJayamohan Kallickal 			break;
18716733b39aSJayamohan Kallickal 		case UNSOL_DATA_NOTIFY:
1872bfead3b2SJayamohan Kallickal 			SE_DEBUG(DBG_LVL_8, "Received UNSOL_DATA_NOTIFY\n");
18736733b39aSJayamohan Kallickal 			hwi_process_default_pdu_ring(beiscsi_conn, phba,
18746733b39aSJayamohan Kallickal 					     (struct i_t_dpdu_cqe *)sol);
18756733b39aSJayamohan Kallickal 			break;
18766733b39aSJayamohan Kallickal 		case CXN_INVALIDATE_INDEX_NOTIFY:
18776733b39aSJayamohan Kallickal 		case CMD_INVALIDATED_NOTIFY:
18786733b39aSJayamohan Kallickal 		case CXN_INVALIDATE_NOTIFY:
18796733b39aSJayamohan Kallickal 			SE_DEBUG(DBG_LVL_1,
18806733b39aSJayamohan Kallickal 				 "Ignoring CQ Error notification for cmd/cxn"
18816733b39aSJayamohan Kallickal 				 "invalidate\n");
18826733b39aSJayamohan Kallickal 			break;
18836733b39aSJayamohan Kallickal 		case SOL_CMD_KILLED_DATA_DIGEST_ERR:
18846733b39aSJayamohan Kallickal 		case CMD_KILLED_INVALID_STATSN_RCVD:
18856733b39aSJayamohan Kallickal 		case CMD_KILLED_INVALID_R2T_RCVD:
18866733b39aSJayamohan Kallickal 		case CMD_CXN_KILLED_LUN_INVALID:
18876733b39aSJayamohan Kallickal 		case CMD_CXN_KILLED_ICD_INVALID:
18886733b39aSJayamohan Kallickal 		case CMD_CXN_KILLED_ITT_INVALID:
18896733b39aSJayamohan Kallickal 		case CMD_CXN_KILLED_SEQ_OUTOFORDER:
18906733b39aSJayamohan Kallickal 		case CMD_CXN_KILLED_INVALID_DATASN_RCVD:
18916733b39aSJayamohan Kallickal 			SE_DEBUG(DBG_LVL_1,
18926733b39aSJayamohan Kallickal 				 "CQ Error notification for cmd.. "
18936733b39aSJayamohan Kallickal 				 "code %d cid 0x%x\n",
18946733b39aSJayamohan Kallickal 				 sol->dw[offsetof(struct amap_sol_cqe, code) /
18956733b39aSJayamohan Kallickal 				 32] & CQE_CODE_MASK,
18966733b39aSJayamohan Kallickal 				 (sol->dw[offsetof(struct amap_sol_cqe, cid) /
18976733b39aSJayamohan Kallickal 				 32] & SOL_CID_MASK));
18986733b39aSJayamohan Kallickal 			break;
18996733b39aSJayamohan Kallickal 		case UNSOL_DATA_DIGEST_ERROR_NOTIFY:
19006733b39aSJayamohan Kallickal 			SE_DEBUG(DBG_LVL_1,
19016733b39aSJayamohan Kallickal 				 "Digest error on def pdu ring, dropping..\n");
19026733b39aSJayamohan Kallickal 			hwi_flush_default_pdu_buffer(phba, beiscsi_conn,
19036733b39aSJayamohan Kallickal 					     (struct i_t_dpdu_cqe *) sol);
19046733b39aSJayamohan Kallickal 			break;
19056733b39aSJayamohan Kallickal 		case CXN_KILLED_PDU_SIZE_EXCEEDS_DSL:
19066733b39aSJayamohan Kallickal 		case CXN_KILLED_BURST_LEN_MISMATCH:
19076733b39aSJayamohan Kallickal 		case CXN_KILLED_AHS_RCVD:
19086733b39aSJayamohan Kallickal 		case CXN_KILLED_HDR_DIGEST_ERR:
19096733b39aSJayamohan Kallickal 		case CXN_KILLED_UNKNOWN_HDR:
19106733b39aSJayamohan Kallickal 		case CXN_KILLED_STALE_ITT_TTT_RCVD:
19116733b39aSJayamohan Kallickal 		case CXN_KILLED_INVALID_ITT_TTT_RCVD:
19126733b39aSJayamohan Kallickal 		case CXN_KILLED_TIMED_OUT:
19136733b39aSJayamohan Kallickal 		case CXN_KILLED_FIN_RCVD:
19146733b39aSJayamohan Kallickal 		case CXN_KILLED_BAD_UNSOL_PDU_RCVD:
19156733b39aSJayamohan Kallickal 		case CXN_KILLED_BAD_WRB_INDEX_ERROR:
19166733b39aSJayamohan Kallickal 		case CXN_KILLED_OVER_RUN_RESIDUAL:
19176733b39aSJayamohan Kallickal 		case CXN_KILLED_UNDER_RUN_RESIDUAL:
19186733b39aSJayamohan Kallickal 		case CXN_KILLED_CMND_DATA_NOT_ON_SAME_CONN:
1919bfead3b2SJayamohan Kallickal 			SE_DEBUG(DBG_LVL_1, "CQ Error %d, reset CID "
19206733b39aSJayamohan Kallickal 				 "0x%x...\n",
19216733b39aSJayamohan Kallickal 				 sol->dw[offsetof(struct amap_sol_cqe, code) /
19226733b39aSJayamohan Kallickal 				 32] & CQE_CODE_MASK,
19237da50879SJayamohan Kallickal 				 (sol->dw[offsetof(struct amap_sol_cqe, cid) /
19247da50879SJayamohan Kallickal 				 32] & CQE_CID_MASK));
19256733b39aSJayamohan Kallickal 			iscsi_conn_failure(beiscsi_conn->conn,
19266733b39aSJayamohan Kallickal 					   ISCSI_ERR_CONN_FAILED);
19276733b39aSJayamohan Kallickal 			break;
19286733b39aSJayamohan Kallickal 		case CXN_KILLED_RST_SENT:
19296733b39aSJayamohan Kallickal 		case CXN_KILLED_RST_RCVD:
1930bfead3b2SJayamohan Kallickal 			SE_DEBUG(DBG_LVL_1, "CQ Error %d, reset"
1931bfead3b2SJayamohan Kallickal 				"received/sent on CID 0x%x...\n",
19326733b39aSJayamohan Kallickal 				 sol->dw[offsetof(struct amap_sol_cqe, code) /
19336733b39aSJayamohan Kallickal 				 32] & CQE_CODE_MASK,
19347da50879SJayamohan Kallickal 				 (sol->dw[offsetof(struct amap_sol_cqe, cid) /
19357da50879SJayamohan Kallickal 				 32] & CQE_CID_MASK));
19366733b39aSJayamohan Kallickal 			iscsi_conn_failure(beiscsi_conn->conn,
19376733b39aSJayamohan Kallickal 					   ISCSI_ERR_CONN_FAILED);
19386733b39aSJayamohan Kallickal 			break;
19396733b39aSJayamohan Kallickal 		default:
19406733b39aSJayamohan Kallickal 			SE_DEBUG(DBG_LVL_1, "CQ Error Invalid code= %d "
19416733b39aSJayamohan Kallickal 				 "received on CID 0x%x...\n",
19426733b39aSJayamohan Kallickal 				 sol->dw[offsetof(struct amap_sol_cqe, code) /
19436733b39aSJayamohan Kallickal 				 32] & CQE_CODE_MASK,
19447da50879SJayamohan Kallickal 				 (sol->dw[offsetof(struct amap_sol_cqe, cid) /
19457da50879SJayamohan Kallickal 				 32] & CQE_CID_MASK));
19466733b39aSJayamohan Kallickal 			break;
19476733b39aSJayamohan Kallickal 		}
19486733b39aSJayamohan Kallickal 
19496733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_sol_cqe, valid, sol, 0);
19506733b39aSJayamohan Kallickal 		queue_tail_inc(cq);
19516733b39aSJayamohan Kallickal 		sol = queue_tail_node(cq);
19526733b39aSJayamohan Kallickal 		num_processed++;
19536733b39aSJayamohan Kallickal 	}
19546733b39aSJayamohan Kallickal 
19556733b39aSJayamohan Kallickal 	if (num_processed > 0) {
19566733b39aSJayamohan Kallickal 		tot_nump += num_processed;
1957bfead3b2SJayamohan Kallickal 		hwi_ring_cq_db(phba, cq->id, num_processed, 1, 0);
19586733b39aSJayamohan Kallickal 	}
19596733b39aSJayamohan Kallickal 	return tot_nump;
19606733b39aSJayamohan Kallickal }
19616733b39aSJayamohan Kallickal 
1962756d29c8SJayamohan Kallickal void beiscsi_process_all_cqs(struct work_struct *work)
19636733b39aSJayamohan Kallickal {
19646733b39aSJayamohan Kallickal 	unsigned long flags;
1965bfead3b2SJayamohan Kallickal 	struct hwi_controller *phwi_ctrlr;
1966bfead3b2SJayamohan Kallickal 	struct hwi_context_memory *phwi_context;
1967bfead3b2SJayamohan Kallickal 	struct be_eq_obj *pbe_eq;
19686733b39aSJayamohan Kallickal 	struct beiscsi_hba *phba =
19696733b39aSJayamohan Kallickal 	    container_of(work, struct beiscsi_hba, work_cqs);
19706733b39aSJayamohan Kallickal 
1971bfead3b2SJayamohan Kallickal 	phwi_ctrlr = phba->phwi_ctrlr;
1972bfead3b2SJayamohan Kallickal 	phwi_context = phwi_ctrlr->phwi_ctxt;
1973bfead3b2SJayamohan Kallickal 	if (phba->msix_enabled)
1974bfead3b2SJayamohan Kallickal 		pbe_eq = &phwi_context->be_eq[phba->num_cpus];
1975bfead3b2SJayamohan Kallickal 	else
1976bfead3b2SJayamohan Kallickal 		pbe_eq = &phwi_context->be_eq[0];
1977bfead3b2SJayamohan Kallickal 
19786733b39aSJayamohan Kallickal 	if (phba->todo_mcc_cq) {
19796733b39aSJayamohan Kallickal 		spin_lock_irqsave(&phba->isr_lock, flags);
19806733b39aSJayamohan Kallickal 		phba->todo_mcc_cq = 0;
19816733b39aSJayamohan Kallickal 		spin_unlock_irqrestore(&phba->isr_lock, flags);
1982756d29c8SJayamohan Kallickal 		beiscsi_process_mcc_isr(phba);
19836733b39aSJayamohan Kallickal 	}
19846733b39aSJayamohan Kallickal 
19856733b39aSJayamohan Kallickal 	if (phba->todo_cq) {
19866733b39aSJayamohan Kallickal 		spin_lock_irqsave(&phba->isr_lock, flags);
19876733b39aSJayamohan Kallickal 		phba->todo_cq = 0;
19886733b39aSJayamohan Kallickal 		spin_unlock_irqrestore(&phba->isr_lock, flags);
1989bfead3b2SJayamohan Kallickal 		beiscsi_process_cq(pbe_eq);
19906733b39aSJayamohan Kallickal 	}
19916733b39aSJayamohan Kallickal }
19926733b39aSJayamohan Kallickal 
19936733b39aSJayamohan Kallickal static int be_iopoll(struct blk_iopoll *iop, int budget)
19946733b39aSJayamohan Kallickal {
19956733b39aSJayamohan Kallickal 	static unsigned int ret;
19966733b39aSJayamohan Kallickal 	struct beiscsi_hba *phba;
1997bfead3b2SJayamohan Kallickal 	struct be_eq_obj *pbe_eq;
19986733b39aSJayamohan Kallickal 
1999bfead3b2SJayamohan Kallickal 	pbe_eq = container_of(iop, struct be_eq_obj, iopoll);
2000bfead3b2SJayamohan Kallickal 	ret = beiscsi_process_cq(pbe_eq);
20016733b39aSJayamohan Kallickal 	if (ret < budget) {
2002bfead3b2SJayamohan Kallickal 		phba = pbe_eq->phba;
20036733b39aSJayamohan Kallickal 		blk_iopoll_complete(iop);
2004bfead3b2SJayamohan Kallickal 		SE_DEBUG(DBG_LVL_8, "rearm pbe_eq->q.id =%d\n", pbe_eq->q.id);
2005bfead3b2SJayamohan Kallickal 		hwi_ring_eq_db(phba, pbe_eq->q.id, 0, 0, 1, 1);
20066733b39aSJayamohan Kallickal 	}
20076733b39aSJayamohan Kallickal 	return ret;
20086733b39aSJayamohan Kallickal }
20096733b39aSJayamohan Kallickal 
20106733b39aSJayamohan Kallickal static void
20116733b39aSJayamohan Kallickal hwi_write_sgl(struct iscsi_wrb *pwrb, struct scatterlist *sg,
20126733b39aSJayamohan Kallickal 	      unsigned int num_sg, struct beiscsi_io_task *io_task)
20136733b39aSJayamohan Kallickal {
20146733b39aSJayamohan Kallickal 	struct iscsi_sge *psgl;
201558ff4bd0SJayamohan Kallickal 	unsigned int sg_len, index;
20166733b39aSJayamohan Kallickal 	unsigned int sge_len = 0;
20176733b39aSJayamohan Kallickal 	unsigned long long addr;
20186733b39aSJayamohan Kallickal 	struct scatterlist *l_sg;
20196733b39aSJayamohan Kallickal 	unsigned int offset;
20206733b39aSJayamohan Kallickal 
20216733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_wrb, iscsi_bhs_addr_lo, pwrb,
20226733b39aSJayamohan Kallickal 				      io_task->bhs_pa.u.a32.address_lo);
20236733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_wrb, iscsi_bhs_addr_hi, pwrb,
20246733b39aSJayamohan Kallickal 				      io_task->bhs_pa.u.a32.address_hi);
20256733b39aSJayamohan Kallickal 
20266733b39aSJayamohan Kallickal 	l_sg = sg;
202748bd86cfSJayamohan Kallickal 	for (index = 0; (index < num_sg) && (index < 2); index++,
202848bd86cfSJayamohan Kallickal 							 sg = sg_next(sg)) {
20296733b39aSJayamohan Kallickal 		if (index == 0) {
20306733b39aSJayamohan Kallickal 			sg_len = sg_dma_len(sg);
20316733b39aSJayamohan Kallickal 			addr = (u64) sg_dma_address(sg);
20326733b39aSJayamohan Kallickal 			AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_addr_lo, pwrb,
2033457ff3b7SJayamohan Kallickal 						((u32)(addr & 0xFFFFFFFF)));
20346733b39aSJayamohan Kallickal 			AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_addr_hi, pwrb,
2035457ff3b7SJayamohan Kallickal 							((u32)(addr >> 32)));
20366733b39aSJayamohan Kallickal 			AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_len, pwrb,
20376733b39aSJayamohan Kallickal 							sg_len);
20386733b39aSJayamohan Kallickal 			sge_len = sg_len;
20396733b39aSJayamohan Kallickal 		} else {
20406733b39aSJayamohan Kallickal 			AMAP_SET_BITS(struct amap_iscsi_wrb, sge1_r2t_offset,
20416733b39aSJayamohan Kallickal 							pwrb, sge_len);
20426733b39aSJayamohan Kallickal 			sg_len = sg_dma_len(sg);
20436733b39aSJayamohan Kallickal 			addr = (u64) sg_dma_address(sg);
20446733b39aSJayamohan Kallickal 			AMAP_SET_BITS(struct amap_iscsi_wrb, sge1_addr_lo, pwrb,
2045457ff3b7SJayamohan Kallickal 						((u32)(addr & 0xFFFFFFFF)));
20466733b39aSJayamohan Kallickal 			AMAP_SET_BITS(struct amap_iscsi_wrb, sge1_addr_hi, pwrb,
2047457ff3b7SJayamohan Kallickal 							((u32)(addr >> 32)));
20486733b39aSJayamohan Kallickal 			AMAP_SET_BITS(struct amap_iscsi_wrb, sge1_len, pwrb,
20496733b39aSJayamohan Kallickal 							sg_len);
20506733b39aSJayamohan Kallickal 		}
20516733b39aSJayamohan Kallickal 	}
20526733b39aSJayamohan Kallickal 	psgl = (struct iscsi_sge *)io_task->psgl_handle->pfrag;
20536733b39aSJayamohan Kallickal 	memset(psgl, 0, sizeof(*psgl) * BE2_SGE);
20546733b39aSJayamohan Kallickal 
20556733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_sge, len, psgl, io_task->bhs_len - 2);
20566733b39aSJayamohan Kallickal 
20576733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_sge, addr_hi, psgl,
20586733b39aSJayamohan Kallickal 			io_task->bhs_pa.u.a32.address_hi);
20596733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_sge, addr_lo, psgl,
20606733b39aSJayamohan Kallickal 			io_task->bhs_pa.u.a32.address_lo);
20616733b39aSJayamohan Kallickal 
2062caf818f1SJayamohan Kallickal 	if (num_sg == 1) {
2063caf818f1SJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_last, pwrb,
2064caf818f1SJayamohan Kallickal 								1);
2065caf818f1SJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_wrb, sge1_last, pwrb,
2066caf818f1SJayamohan Kallickal 								0);
2067caf818f1SJayamohan Kallickal 	} else if (num_sg == 2) {
2068caf818f1SJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_last, pwrb,
2069caf818f1SJayamohan Kallickal 								0);
2070caf818f1SJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_wrb, sge1_last, pwrb,
2071caf818f1SJayamohan Kallickal 								1);
2072caf818f1SJayamohan Kallickal 	} else {
2073caf818f1SJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_last, pwrb,
2074caf818f1SJayamohan Kallickal 								0);
2075caf818f1SJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_wrb, sge1_last, pwrb,
2076caf818f1SJayamohan Kallickal 								0);
2077caf818f1SJayamohan Kallickal 	}
20786733b39aSJayamohan Kallickal 	sg = l_sg;
20796733b39aSJayamohan Kallickal 	psgl++;
20806733b39aSJayamohan Kallickal 	psgl++;
20816733b39aSJayamohan Kallickal 	offset = 0;
208248bd86cfSJayamohan Kallickal 	for (index = 0; index < num_sg; index++, sg = sg_next(sg), psgl++) {
20836733b39aSJayamohan Kallickal 		sg_len = sg_dma_len(sg);
20846733b39aSJayamohan Kallickal 		addr = (u64) sg_dma_address(sg);
20856733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_sge, addr_lo, psgl,
20866733b39aSJayamohan Kallickal 						(addr & 0xFFFFFFFF));
20876733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_sge, addr_hi, psgl,
20886733b39aSJayamohan Kallickal 						(addr >> 32));
20896733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_sge, len, psgl, sg_len);
20906733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_sge, sge_offset, psgl, offset);
20916733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_sge, last_sge, psgl, 0);
20926733b39aSJayamohan Kallickal 		offset += sg_len;
20936733b39aSJayamohan Kallickal 	}
20946733b39aSJayamohan Kallickal 	psgl--;
20956733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_sge, last_sge, psgl, 1);
20966733b39aSJayamohan Kallickal }
20976733b39aSJayamohan Kallickal 
20986733b39aSJayamohan Kallickal static void hwi_write_buffer(struct iscsi_wrb *pwrb, struct iscsi_task *task)
20996733b39aSJayamohan Kallickal {
21006733b39aSJayamohan Kallickal 	struct iscsi_sge *psgl;
21016733b39aSJayamohan Kallickal 	unsigned long long addr;
21026733b39aSJayamohan Kallickal 	struct beiscsi_io_task *io_task = task->dd_data;
21036733b39aSJayamohan Kallickal 	struct beiscsi_conn *beiscsi_conn = io_task->conn;
21046733b39aSJayamohan Kallickal 	struct beiscsi_hba *phba = beiscsi_conn->phba;
21056733b39aSJayamohan Kallickal 
21066733b39aSJayamohan Kallickal 	io_task->bhs_len = sizeof(struct be_nonio_bhs) - 2;
21076733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_wrb, iscsi_bhs_addr_lo, pwrb,
21086733b39aSJayamohan Kallickal 				io_task->bhs_pa.u.a32.address_lo);
21096733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_wrb, iscsi_bhs_addr_hi, pwrb,
21106733b39aSJayamohan Kallickal 				io_task->bhs_pa.u.a32.address_hi);
21116733b39aSJayamohan Kallickal 
21126733b39aSJayamohan Kallickal 	if (task->data) {
21136733b39aSJayamohan Kallickal 		if (task->data_count) {
21146733b39aSJayamohan Kallickal 			AMAP_SET_BITS(struct amap_iscsi_wrb, dsp, pwrb, 1);
21156733b39aSJayamohan Kallickal 			addr = (u64) pci_map_single(phba->pcidev,
21166733b39aSJayamohan Kallickal 						    task->data,
21176733b39aSJayamohan Kallickal 						    task->data_count, 1);
21186733b39aSJayamohan Kallickal 		} else {
21196733b39aSJayamohan Kallickal 			AMAP_SET_BITS(struct amap_iscsi_wrb, dsp, pwrb, 0);
21206733b39aSJayamohan Kallickal 			addr = 0;
21216733b39aSJayamohan Kallickal 		}
21226733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_addr_lo, pwrb,
2123457ff3b7SJayamohan Kallickal 						((u32)(addr & 0xFFFFFFFF)));
21246733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_addr_hi, pwrb,
2125457ff3b7SJayamohan Kallickal 						((u32)(addr >> 32)));
21266733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_len, pwrb,
21276733b39aSJayamohan Kallickal 						task->data_count);
21286733b39aSJayamohan Kallickal 
21296733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_last, pwrb, 1);
21306733b39aSJayamohan Kallickal 	} else {
21316733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_wrb, dsp, pwrb, 0);
21326733b39aSJayamohan Kallickal 		addr = 0;
21336733b39aSJayamohan Kallickal 	}
21346733b39aSJayamohan Kallickal 
21356733b39aSJayamohan Kallickal 	psgl = (struct iscsi_sge *)io_task->psgl_handle->pfrag;
21366733b39aSJayamohan Kallickal 
21376733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_sge, len, psgl, io_task->bhs_len);
21386733b39aSJayamohan Kallickal 
21396733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_sge, addr_hi, psgl,
21406733b39aSJayamohan Kallickal 		      io_task->bhs_pa.u.a32.address_hi);
21416733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_sge, addr_lo, psgl,
21426733b39aSJayamohan Kallickal 		      io_task->bhs_pa.u.a32.address_lo);
21436733b39aSJayamohan Kallickal 	if (task->data) {
21446733b39aSJayamohan Kallickal 		psgl++;
21456733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_sge, addr_hi, psgl, 0);
21466733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_sge, addr_lo, psgl, 0);
21476733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_sge, len, psgl, 0);
21486733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_sge, sge_offset, psgl, 0);
21496733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_sge, rsvd0, psgl, 0);
21506733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_sge, last_sge, psgl, 0);
21516733b39aSJayamohan Kallickal 
21526733b39aSJayamohan Kallickal 		psgl++;
21536733b39aSJayamohan Kallickal 		if (task->data) {
21546733b39aSJayamohan Kallickal 			AMAP_SET_BITS(struct amap_iscsi_sge, addr_lo, psgl,
2155457ff3b7SJayamohan Kallickal 						((u32)(addr & 0xFFFFFFFF)));
21566733b39aSJayamohan Kallickal 			AMAP_SET_BITS(struct amap_iscsi_sge, addr_hi, psgl,
2157457ff3b7SJayamohan Kallickal 						((u32)(addr >> 32)));
21586733b39aSJayamohan Kallickal 		}
21596733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_sge, len, psgl, 0x106);
21606733b39aSJayamohan Kallickal 	}
21616733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_sge, last_sge, psgl, 1);
21626733b39aSJayamohan Kallickal }
21636733b39aSJayamohan Kallickal 
21646733b39aSJayamohan Kallickal static void beiscsi_find_mem_req(struct beiscsi_hba *phba)
21656733b39aSJayamohan Kallickal {
2166bfead3b2SJayamohan Kallickal 	unsigned int num_cq_pages, num_async_pdu_buf_pages;
21676733b39aSJayamohan Kallickal 	unsigned int num_async_pdu_data_pages, wrb_sz_per_cxn;
21686733b39aSJayamohan Kallickal 	unsigned int num_async_pdu_buf_sgl_pages, num_async_pdu_data_sgl_pages;
21696733b39aSJayamohan Kallickal 
21706733b39aSJayamohan Kallickal 	num_cq_pages = PAGES_REQUIRED(phba->params.num_cq_entries * \
21716733b39aSJayamohan Kallickal 				      sizeof(struct sol_cqe));
21726733b39aSJayamohan Kallickal 	num_async_pdu_buf_pages =
21736733b39aSJayamohan Kallickal 			PAGES_REQUIRED(phba->params.asyncpdus_per_ctrl * \
21746733b39aSJayamohan Kallickal 				       phba->params.defpdu_hdr_sz);
21756733b39aSJayamohan Kallickal 	num_async_pdu_buf_sgl_pages =
21766733b39aSJayamohan Kallickal 			PAGES_REQUIRED(phba->params.asyncpdus_per_ctrl * \
21776733b39aSJayamohan Kallickal 				       sizeof(struct phys_addr));
21786733b39aSJayamohan Kallickal 	num_async_pdu_data_pages =
21796733b39aSJayamohan Kallickal 			PAGES_REQUIRED(phba->params.asyncpdus_per_ctrl * \
21806733b39aSJayamohan Kallickal 				       phba->params.defpdu_data_sz);
21816733b39aSJayamohan Kallickal 	num_async_pdu_data_sgl_pages =
21826733b39aSJayamohan Kallickal 			PAGES_REQUIRED(phba->params.asyncpdus_per_ctrl * \
21836733b39aSJayamohan Kallickal 				       sizeof(struct phys_addr));
21846733b39aSJayamohan Kallickal 
21856733b39aSJayamohan Kallickal 	phba->params.hwi_ws_sz = sizeof(struct hwi_controller);
21866733b39aSJayamohan Kallickal 
21876733b39aSJayamohan Kallickal 	phba->mem_req[ISCSI_MEM_GLOBAL_HEADER] = 2 *
21886733b39aSJayamohan Kallickal 						 BE_ISCSI_PDU_HEADER_SIZE;
21896733b39aSJayamohan Kallickal 	phba->mem_req[HWI_MEM_ADDN_CONTEXT] =
21906733b39aSJayamohan Kallickal 					    sizeof(struct hwi_context_memory);
21916733b39aSJayamohan Kallickal 
21926733b39aSJayamohan Kallickal 
21936733b39aSJayamohan Kallickal 	phba->mem_req[HWI_MEM_WRB] = sizeof(struct iscsi_wrb)
21946733b39aSJayamohan Kallickal 	    * (phba->params.wrbs_per_cxn)
21956733b39aSJayamohan Kallickal 	    * phba->params.cxns_per_ctrl;
21966733b39aSJayamohan Kallickal 	wrb_sz_per_cxn =  sizeof(struct wrb_handle) *
21976733b39aSJayamohan Kallickal 				 (phba->params.wrbs_per_cxn);
21986733b39aSJayamohan Kallickal 	phba->mem_req[HWI_MEM_WRBH] = roundup_pow_of_two((wrb_sz_per_cxn) *
21996733b39aSJayamohan Kallickal 				phba->params.cxns_per_ctrl);
22006733b39aSJayamohan Kallickal 
22016733b39aSJayamohan Kallickal 	phba->mem_req[HWI_MEM_SGLH] = sizeof(struct sgl_handle) *
22026733b39aSJayamohan Kallickal 		phba->params.icds_per_ctrl;
22036733b39aSJayamohan Kallickal 	phba->mem_req[HWI_MEM_SGE] = sizeof(struct iscsi_sge) *
22046733b39aSJayamohan Kallickal 		phba->params.num_sge_per_io * phba->params.icds_per_ctrl;
22056733b39aSJayamohan Kallickal 
22066733b39aSJayamohan Kallickal 	phba->mem_req[HWI_MEM_ASYNC_HEADER_BUF] =
22076733b39aSJayamohan Kallickal 		num_async_pdu_buf_pages * PAGE_SIZE;
22086733b39aSJayamohan Kallickal 	phba->mem_req[HWI_MEM_ASYNC_DATA_BUF] =
22096733b39aSJayamohan Kallickal 		num_async_pdu_data_pages * PAGE_SIZE;
22106733b39aSJayamohan Kallickal 	phba->mem_req[HWI_MEM_ASYNC_HEADER_RING] =
22116733b39aSJayamohan Kallickal 		num_async_pdu_buf_sgl_pages * PAGE_SIZE;
22126733b39aSJayamohan Kallickal 	phba->mem_req[HWI_MEM_ASYNC_DATA_RING] =
22136733b39aSJayamohan Kallickal 		num_async_pdu_data_sgl_pages * PAGE_SIZE;
22146733b39aSJayamohan Kallickal 	phba->mem_req[HWI_MEM_ASYNC_HEADER_HANDLE] =
22156733b39aSJayamohan Kallickal 		phba->params.asyncpdus_per_ctrl *
22166733b39aSJayamohan Kallickal 		sizeof(struct async_pdu_handle);
22176733b39aSJayamohan Kallickal 	phba->mem_req[HWI_MEM_ASYNC_DATA_HANDLE] =
22186733b39aSJayamohan Kallickal 		phba->params.asyncpdus_per_ctrl *
22196733b39aSJayamohan Kallickal 		sizeof(struct async_pdu_handle);
22206733b39aSJayamohan Kallickal 	phba->mem_req[HWI_MEM_ASYNC_PDU_CONTEXT] =
22216733b39aSJayamohan Kallickal 		sizeof(struct hwi_async_pdu_context) +
22226733b39aSJayamohan Kallickal 		(phba->params.cxns_per_ctrl * sizeof(struct hwi_async_entry));
22236733b39aSJayamohan Kallickal }
22246733b39aSJayamohan Kallickal 
22256733b39aSJayamohan Kallickal static int beiscsi_alloc_mem(struct beiscsi_hba *phba)
22266733b39aSJayamohan Kallickal {
22276733b39aSJayamohan Kallickal 	struct be_mem_descriptor *mem_descr;
22286733b39aSJayamohan Kallickal 	dma_addr_t bus_add;
22296733b39aSJayamohan Kallickal 	struct mem_array *mem_arr, *mem_arr_orig;
22306733b39aSJayamohan Kallickal 	unsigned int i, j, alloc_size, curr_alloc_size;
22316733b39aSJayamohan Kallickal 
22326733b39aSJayamohan Kallickal 	phba->phwi_ctrlr = kmalloc(phba->params.hwi_ws_sz, GFP_KERNEL);
22336733b39aSJayamohan Kallickal 	if (!phba->phwi_ctrlr)
22346733b39aSJayamohan Kallickal 		return -ENOMEM;
22356733b39aSJayamohan Kallickal 
22366733b39aSJayamohan Kallickal 	phba->init_mem = kcalloc(SE_MEM_MAX, sizeof(*mem_descr),
22376733b39aSJayamohan Kallickal 				 GFP_KERNEL);
22386733b39aSJayamohan Kallickal 	if (!phba->init_mem) {
22396733b39aSJayamohan Kallickal 		kfree(phba->phwi_ctrlr);
22406733b39aSJayamohan Kallickal 		return -ENOMEM;
22416733b39aSJayamohan Kallickal 	}
22426733b39aSJayamohan Kallickal 
22436733b39aSJayamohan Kallickal 	mem_arr_orig = kmalloc(sizeof(*mem_arr_orig) * BEISCSI_MAX_FRAGS_INIT,
22446733b39aSJayamohan Kallickal 			       GFP_KERNEL);
22456733b39aSJayamohan Kallickal 	if (!mem_arr_orig) {
22466733b39aSJayamohan Kallickal 		kfree(phba->init_mem);
22476733b39aSJayamohan Kallickal 		kfree(phba->phwi_ctrlr);
22486733b39aSJayamohan Kallickal 		return -ENOMEM;
22496733b39aSJayamohan Kallickal 	}
22506733b39aSJayamohan Kallickal 
22516733b39aSJayamohan Kallickal 	mem_descr = phba->init_mem;
22526733b39aSJayamohan Kallickal 	for (i = 0; i < SE_MEM_MAX; i++) {
22536733b39aSJayamohan Kallickal 		j = 0;
22546733b39aSJayamohan Kallickal 		mem_arr = mem_arr_orig;
22556733b39aSJayamohan Kallickal 		alloc_size = phba->mem_req[i];
22566733b39aSJayamohan Kallickal 		memset(mem_arr, 0, sizeof(struct mem_array) *
22576733b39aSJayamohan Kallickal 		       BEISCSI_MAX_FRAGS_INIT);
22586733b39aSJayamohan Kallickal 		curr_alloc_size = min(be_max_phys_size * 1024, alloc_size);
22596733b39aSJayamohan Kallickal 		do {
22606733b39aSJayamohan Kallickal 			mem_arr->virtual_address = pci_alloc_consistent(
22616733b39aSJayamohan Kallickal 							phba->pcidev,
22626733b39aSJayamohan Kallickal 							curr_alloc_size,
22636733b39aSJayamohan Kallickal 							&bus_add);
22646733b39aSJayamohan Kallickal 			if (!mem_arr->virtual_address) {
22656733b39aSJayamohan Kallickal 				if (curr_alloc_size <= BE_MIN_MEM_SIZE)
22666733b39aSJayamohan Kallickal 					goto free_mem;
22676733b39aSJayamohan Kallickal 				if (curr_alloc_size -
22686733b39aSJayamohan Kallickal 					rounddown_pow_of_two(curr_alloc_size))
22696733b39aSJayamohan Kallickal 					curr_alloc_size = rounddown_pow_of_two
22706733b39aSJayamohan Kallickal 							     (curr_alloc_size);
22716733b39aSJayamohan Kallickal 				else
22726733b39aSJayamohan Kallickal 					curr_alloc_size = curr_alloc_size / 2;
22736733b39aSJayamohan Kallickal 			} else {
22746733b39aSJayamohan Kallickal 				mem_arr->bus_address.u.
22756733b39aSJayamohan Kallickal 				    a64.address = (__u64) bus_add;
22766733b39aSJayamohan Kallickal 				mem_arr->size = curr_alloc_size;
22776733b39aSJayamohan Kallickal 				alloc_size -= curr_alloc_size;
22786733b39aSJayamohan Kallickal 				curr_alloc_size = min(be_max_phys_size *
22796733b39aSJayamohan Kallickal 						      1024, alloc_size);
22806733b39aSJayamohan Kallickal 				j++;
22816733b39aSJayamohan Kallickal 				mem_arr++;
22826733b39aSJayamohan Kallickal 			}
22836733b39aSJayamohan Kallickal 		} while (alloc_size);
22846733b39aSJayamohan Kallickal 		mem_descr->num_elements = j;
22856733b39aSJayamohan Kallickal 		mem_descr->size_in_bytes = phba->mem_req[i];
22866733b39aSJayamohan Kallickal 		mem_descr->mem_array = kmalloc(sizeof(*mem_arr) * j,
22876733b39aSJayamohan Kallickal 					       GFP_KERNEL);
22886733b39aSJayamohan Kallickal 		if (!mem_descr->mem_array)
22896733b39aSJayamohan Kallickal 			goto free_mem;
22906733b39aSJayamohan Kallickal 
22916733b39aSJayamohan Kallickal 		memcpy(mem_descr->mem_array, mem_arr_orig,
22926733b39aSJayamohan Kallickal 		       sizeof(struct mem_array) * j);
22936733b39aSJayamohan Kallickal 		mem_descr++;
22946733b39aSJayamohan Kallickal 	}
22956733b39aSJayamohan Kallickal 	kfree(mem_arr_orig);
22966733b39aSJayamohan Kallickal 	return 0;
22976733b39aSJayamohan Kallickal free_mem:
22986733b39aSJayamohan Kallickal 	mem_descr->num_elements = j;
22996733b39aSJayamohan Kallickal 	while ((i) || (j)) {
23006733b39aSJayamohan Kallickal 		for (j = mem_descr->num_elements; j > 0; j--) {
23016733b39aSJayamohan Kallickal 			pci_free_consistent(phba->pcidev,
23026733b39aSJayamohan Kallickal 					    mem_descr->mem_array[j - 1].size,
23036733b39aSJayamohan Kallickal 					    mem_descr->mem_array[j - 1].
23046733b39aSJayamohan Kallickal 					    virtual_address,
2305457ff3b7SJayamohan Kallickal 					    (unsigned long)mem_descr->
2306457ff3b7SJayamohan Kallickal 					    mem_array[j - 1].
23076733b39aSJayamohan Kallickal 					    bus_address.u.a64.address);
23086733b39aSJayamohan Kallickal 		}
23096733b39aSJayamohan Kallickal 		if (i) {
23106733b39aSJayamohan Kallickal 			i--;
23116733b39aSJayamohan Kallickal 			kfree(mem_descr->mem_array);
23126733b39aSJayamohan Kallickal 			mem_descr--;
23136733b39aSJayamohan Kallickal 		}
23146733b39aSJayamohan Kallickal 	}
23156733b39aSJayamohan Kallickal 	kfree(mem_arr_orig);
23166733b39aSJayamohan Kallickal 	kfree(phba->init_mem);
23176733b39aSJayamohan Kallickal 	kfree(phba->phwi_ctrlr);
23186733b39aSJayamohan Kallickal 	return -ENOMEM;
23196733b39aSJayamohan Kallickal }
23206733b39aSJayamohan Kallickal 
23216733b39aSJayamohan Kallickal static int beiscsi_get_memory(struct beiscsi_hba *phba)
23226733b39aSJayamohan Kallickal {
23236733b39aSJayamohan Kallickal 	beiscsi_find_mem_req(phba);
23246733b39aSJayamohan Kallickal 	return beiscsi_alloc_mem(phba);
23256733b39aSJayamohan Kallickal }
23266733b39aSJayamohan Kallickal 
23276733b39aSJayamohan Kallickal static void iscsi_init_global_templates(struct beiscsi_hba *phba)
23286733b39aSJayamohan Kallickal {
23296733b39aSJayamohan Kallickal 	struct pdu_data_out *pdata_out;
23306733b39aSJayamohan Kallickal 	struct pdu_nop_out *pnop_out;
23316733b39aSJayamohan Kallickal 	struct be_mem_descriptor *mem_descr;
23326733b39aSJayamohan Kallickal 
23336733b39aSJayamohan Kallickal 	mem_descr = phba->init_mem;
23346733b39aSJayamohan Kallickal 	mem_descr += ISCSI_MEM_GLOBAL_HEADER;
23356733b39aSJayamohan Kallickal 	pdata_out =
23366733b39aSJayamohan Kallickal 	    (struct pdu_data_out *)mem_descr->mem_array[0].virtual_address;
23376733b39aSJayamohan Kallickal 	memset(pdata_out, 0, BE_ISCSI_PDU_HEADER_SIZE);
23386733b39aSJayamohan Kallickal 
23396733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_pdu_data_out, opcode, pdata_out,
23406733b39aSJayamohan Kallickal 		      IIOC_SCSI_DATA);
23416733b39aSJayamohan Kallickal 
23426733b39aSJayamohan Kallickal 	pnop_out =
23436733b39aSJayamohan Kallickal 	    (struct pdu_nop_out *)((unsigned char *)mem_descr->mem_array[0].
23446733b39aSJayamohan Kallickal 				   virtual_address + BE_ISCSI_PDU_HEADER_SIZE);
23456733b39aSJayamohan Kallickal 
23466733b39aSJayamohan Kallickal 	memset(pnop_out, 0, BE_ISCSI_PDU_HEADER_SIZE);
23476733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_pdu_nop_out, ttt, pnop_out, 0xFFFFFFFF);
23486733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_pdu_nop_out, f_bit, pnop_out, 1);
23496733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_pdu_nop_out, i_bit, pnop_out, 0);
23506733b39aSJayamohan Kallickal }
23516733b39aSJayamohan Kallickal 
23526733b39aSJayamohan Kallickal static void beiscsi_init_wrb_handle(struct beiscsi_hba *phba)
23536733b39aSJayamohan Kallickal {
23546733b39aSJayamohan Kallickal 	struct be_mem_descriptor *mem_descr_wrbh, *mem_descr_wrb;
23556733b39aSJayamohan Kallickal 	struct wrb_handle *pwrb_handle;
23566733b39aSJayamohan Kallickal 	struct hwi_controller *phwi_ctrlr;
23576733b39aSJayamohan Kallickal 	struct hwi_wrb_context *pwrb_context;
23586733b39aSJayamohan Kallickal 	struct iscsi_wrb *pwrb;
23596733b39aSJayamohan Kallickal 	unsigned int num_cxn_wrbh;
23606733b39aSJayamohan Kallickal 	unsigned int num_cxn_wrb, j, idx, index;
23616733b39aSJayamohan Kallickal 
23626733b39aSJayamohan Kallickal 	mem_descr_wrbh = phba->init_mem;
23636733b39aSJayamohan Kallickal 	mem_descr_wrbh += HWI_MEM_WRBH;
23646733b39aSJayamohan Kallickal 
23656733b39aSJayamohan Kallickal 	mem_descr_wrb = phba->init_mem;
23666733b39aSJayamohan Kallickal 	mem_descr_wrb += HWI_MEM_WRB;
23676733b39aSJayamohan Kallickal 
23686733b39aSJayamohan Kallickal 	idx = 0;
23696733b39aSJayamohan Kallickal 	pwrb_handle = mem_descr_wrbh->mem_array[idx].virtual_address;
23706733b39aSJayamohan Kallickal 	num_cxn_wrbh = ((mem_descr_wrbh->mem_array[idx].size) /
23716733b39aSJayamohan Kallickal 			((sizeof(struct wrb_handle)) *
23726733b39aSJayamohan Kallickal 			 phba->params.wrbs_per_cxn));
23736733b39aSJayamohan Kallickal 	phwi_ctrlr = phba->phwi_ctrlr;
23746733b39aSJayamohan Kallickal 
23756733b39aSJayamohan Kallickal 	for (index = 0; index < phba->params.cxns_per_ctrl * 2; index += 2) {
23766733b39aSJayamohan Kallickal 		pwrb_context = &phwi_ctrlr->wrb_context[index];
23776733b39aSJayamohan Kallickal 		pwrb_context->pwrb_handle_base =
23786733b39aSJayamohan Kallickal 				kzalloc(sizeof(struct wrb_handle *) *
23796733b39aSJayamohan Kallickal 					phba->params.wrbs_per_cxn, GFP_KERNEL);
23806733b39aSJayamohan Kallickal 		pwrb_context->pwrb_handle_basestd =
23816733b39aSJayamohan Kallickal 				kzalloc(sizeof(struct wrb_handle *) *
23826733b39aSJayamohan Kallickal 					phba->params.wrbs_per_cxn, GFP_KERNEL);
23836733b39aSJayamohan Kallickal 		if (num_cxn_wrbh) {
23846733b39aSJayamohan Kallickal 			pwrb_context->alloc_index = 0;
23856733b39aSJayamohan Kallickal 			pwrb_context->wrb_handles_available = 0;
23866733b39aSJayamohan Kallickal 			for (j = 0; j < phba->params.wrbs_per_cxn; j++) {
23876733b39aSJayamohan Kallickal 				pwrb_context->pwrb_handle_base[j] = pwrb_handle;
23886733b39aSJayamohan Kallickal 				pwrb_context->pwrb_handle_basestd[j] =
23896733b39aSJayamohan Kallickal 								pwrb_handle;
23906733b39aSJayamohan Kallickal 				pwrb_context->wrb_handles_available++;
2391bfead3b2SJayamohan Kallickal 				pwrb_handle->wrb_index = j;
23926733b39aSJayamohan Kallickal 				pwrb_handle++;
23936733b39aSJayamohan Kallickal 			}
23946733b39aSJayamohan Kallickal 			pwrb_context->free_index = 0;
23956733b39aSJayamohan Kallickal 			num_cxn_wrbh--;
23966733b39aSJayamohan Kallickal 		} else {
23976733b39aSJayamohan Kallickal 			idx++;
23986733b39aSJayamohan Kallickal 			pwrb_handle =
23996733b39aSJayamohan Kallickal 			    mem_descr_wrbh->mem_array[idx].virtual_address;
24006733b39aSJayamohan Kallickal 			num_cxn_wrbh =
24016733b39aSJayamohan Kallickal 			    ((mem_descr_wrbh->mem_array[idx].size) /
24026733b39aSJayamohan Kallickal 			     ((sizeof(struct wrb_handle)) *
24036733b39aSJayamohan Kallickal 			      phba->params.wrbs_per_cxn));
24046733b39aSJayamohan Kallickal 			pwrb_context->alloc_index = 0;
24056733b39aSJayamohan Kallickal 			for (j = 0; j < phba->params.wrbs_per_cxn; j++) {
24066733b39aSJayamohan Kallickal 				pwrb_context->pwrb_handle_base[j] = pwrb_handle;
24076733b39aSJayamohan Kallickal 				pwrb_context->pwrb_handle_basestd[j] =
24086733b39aSJayamohan Kallickal 				    pwrb_handle;
24096733b39aSJayamohan Kallickal 				pwrb_context->wrb_handles_available++;
2410bfead3b2SJayamohan Kallickal 				pwrb_handle->wrb_index = j;
24116733b39aSJayamohan Kallickal 				pwrb_handle++;
24126733b39aSJayamohan Kallickal 			}
24136733b39aSJayamohan Kallickal 			pwrb_context->free_index = 0;
24146733b39aSJayamohan Kallickal 			num_cxn_wrbh--;
24156733b39aSJayamohan Kallickal 		}
24166733b39aSJayamohan Kallickal 	}
24176733b39aSJayamohan Kallickal 	idx = 0;
24186733b39aSJayamohan Kallickal 	pwrb = mem_descr_wrb->mem_array[idx].virtual_address;
24197c56533cSJayamohan Kallickal 	num_cxn_wrb = (mem_descr_wrb->mem_array[idx].size) /
24207c56533cSJayamohan Kallickal 		      ((sizeof(struct iscsi_wrb) *
24217c56533cSJayamohan Kallickal 			phba->params.wrbs_per_cxn));
2422ed58ea2aSJayamohan Kallickal 	for (index = 0; index < phba->params.cxns_per_ctrl * 2; index += 2) {
24236733b39aSJayamohan Kallickal 		pwrb_context = &phwi_ctrlr->wrb_context[index];
24246733b39aSJayamohan Kallickal 		if (num_cxn_wrb) {
24256733b39aSJayamohan Kallickal 			for (j = 0; j < phba->params.wrbs_per_cxn; j++) {
24266733b39aSJayamohan Kallickal 				pwrb_handle = pwrb_context->pwrb_handle_base[j];
24276733b39aSJayamohan Kallickal 				pwrb_handle->pwrb = pwrb;
24286733b39aSJayamohan Kallickal 				pwrb++;
24296733b39aSJayamohan Kallickal 			}
24306733b39aSJayamohan Kallickal 			num_cxn_wrb--;
24316733b39aSJayamohan Kallickal 		} else {
24326733b39aSJayamohan Kallickal 			idx++;
24336733b39aSJayamohan Kallickal 			pwrb = mem_descr_wrb->mem_array[idx].virtual_address;
24347c56533cSJayamohan Kallickal 			num_cxn_wrb = (mem_descr_wrb->mem_array[idx].size) /
24357c56533cSJayamohan Kallickal 				      ((sizeof(struct iscsi_wrb) *
24367c56533cSJayamohan Kallickal 					phba->params.wrbs_per_cxn));
24376733b39aSJayamohan Kallickal 			for (j = 0; j < phba->params.wrbs_per_cxn; j++) {
24386733b39aSJayamohan Kallickal 				pwrb_handle = pwrb_context->pwrb_handle_base[j];
24396733b39aSJayamohan Kallickal 				pwrb_handle->pwrb = pwrb;
24406733b39aSJayamohan Kallickal 				pwrb++;
24416733b39aSJayamohan Kallickal 			}
24426733b39aSJayamohan Kallickal 			num_cxn_wrb--;
24436733b39aSJayamohan Kallickal 		}
24446733b39aSJayamohan Kallickal 	}
24456733b39aSJayamohan Kallickal }
24466733b39aSJayamohan Kallickal 
24476733b39aSJayamohan Kallickal static void hwi_init_async_pdu_ctx(struct beiscsi_hba *phba)
24486733b39aSJayamohan Kallickal {
24496733b39aSJayamohan Kallickal 	struct hwi_controller *phwi_ctrlr;
24506733b39aSJayamohan Kallickal 	struct hba_parameters *p = &phba->params;
24516733b39aSJayamohan Kallickal 	struct hwi_async_pdu_context *pasync_ctx;
24526733b39aSJayamohan Kallickal 	struct async_pdu_handle *pasync_header_h, *pasync_data_h;
24536733b39aSJayamohan Kallickal 	unsigned int index;
24546733b39aSJayamohan Kallickal 	struct be_mem_descriptor *mem_descr;
24556733b39aSJayamohan Kallickal 
24566733b39aSJayamohan Kallickal 	mem_descr = (struct be_mem_descriptor *)phba->init_mem;
24576733b39aSJayamohan Kallickal 	mem_descr += HWI_MEM_ASYNC_PDU_CONTEXT;
24586733b39aSJayamohan Kallickal 
24596733b39aSJayamohan Kallickal 	phwi_ctrlr = phba->phwi_ctrlr;
24606733b39aSJayamohan Kallickal 	phwi_ctrlr->phwi_ctxt->pasync_ctx = (struct hwi_async_pdu_context *)
24616733b39aSJayamohan Kallickal 				mem_descr->mem_array[0].virtual_address;
24626733b39aSJayamohan Kallickal 	pasync_ctx = phwi_ctrlr->phwi_ctxt->pasync_ctx;
24636733b39aSJayamohan Kallickal 	memset(pasync_ctx, 0, sizeof(*pasync_ctx));
24646733b39aSJayamohan Kallickal 
24656733b39aSJayamohan Kallickal 	pasync_ctx->async_header.num_entries = p->asyncpdus_per_ctrl;
24666733b39aSJayamohan Kallickal 	pasync_ctx->async_header.buffer_size = p->defpdu_hdr_sz;
24676733b39aSJayamohan Kallickal 	pasync_ctx->async_data.buffer_size = p->defpdu_data_sz;
24686733b39aSJayamohan Kallickal 	pasync_ctx->async_data.num_entries = p->asyncpdus_per_ctrl;
24696733b39aSJayamohan Kallickal 
24706733b39aSJayamohan Kallickal 	mem_descr = (struct be_mem_descriptor *)phba->init_mem;
24716733b39aSJayamohan Kallickal 	mem_descr += HWI_MEM_ASYNC_HEADER_BUF;
24726733b39aSJayamohan Kallickal 	if (mem_descr->mem_array[0].virtual_address) {
24736733b39aSJayamohan Kallickal 		SE_DEBUG(DBG_LVL_8,
24746733b39aSJayamohan Kallickal 			 "hwi_init_async_pdu_ctx HWI_MEM_ASYNC_HEADER_BUF"
24756733b39aSJayamohan Kallickal 			 "va=%p\n", mem_descr->mem_array[0].virtual_address);
24766733b39aSJayamohan Kallickal 	} else
24776733b39aSJayamohan Kallickal 		shost_printk(KERN_WARNING, phba->shost,
24786733b39aSJayamohan Kallickal 			     "No Virtual address\n");
24796733b39aSJayamohan Kallickal 
24806733b39aSJayamohan Kallickal 	pasync_ctx->async_header.va_base =
24816733b39aSJayamohan Kallickal 			mem_descr->mem_array[0].virtual_address;
24826733b39aSJayamohan Kallickal 
24836733b39aSJayamohan Kallickal 	pasync_ctx->async_header.pa_base.u.a64.address =
24846733b39aSJayamohan Kallickal 			mem_descr->mem_array[0].bus_address.u.a64.address;
24856733b39aSJayamohan Kallickal 
24866733b39aSJayamohan Kallickal 	mem_descr = (struct be_mem_descriptor *)phba->init_mem;
24876733b39aSJayamohan Kallickal 	mem_descr += HWI_MEM_ASYNC_HEADER_RING;
24886733b39aSJayamohan Kallickal 	if (mem_descr->mem_array[0].virtual_address) {
24896733b39aSJayamohan Kallickal 		SE_DEBUG(DBG_LVL_8,
24906733b39aSJayamohan Kallickal 			 "hwi_init_async_pdu_ctx HWI_MEM_ASYNC_HEADER_RING"
24916733b39aSJayamohan Kallickal 			 "va=%p\n", mem_descr->mem_array[0].virtual_address);
24926733b39aSJayamohan Kallickal 	} else
24936733b39aSJayamohan Kallickal 		shost_printk(KERN_WARNING, phba->shost,
24946733b39aSJayamohan Kallickal 			    "No Virtual address\n");
24956733b39aSJayamohan Kallickal 	pasync_ctx->async_header.ring_base =
24966733b39aSJayamohan Kallickal 			mem_descr->mem_array[0].virtual_address;
24976733b39aSJayamohan Kallickal 
24986733b39aSJayamohan Kallickal 	mem_descr = (struct be_mem_descriptor *)phba->init_mem;
24996733b39aSJayamohan Kallickal 	mem_descr += HWI_MEM_ASYNC_HEADER_HANDLE;
25006733b39aSJayamohan Kallickal 	if (mem_descr->mem_array[0].virtual_address) {
25016733b39aSJayamohan Kallickal 		SE_DEBUG(DBG_LVL_8,
25026733b39aSJayamohan Kallickal 			 "hwi_init_async_pdu_ctx HWI_MEM_ASYNC_HEADER_HANDLE"
25036733b39aSJayamohan Kallickal 			 "va=%p\n", mem_descr->mem_array[0].virtual_address);
25046733b39aSJayamohan Kallickal 	} else
25056733b39aSJayamohan Kallickal 		shost_printk(KERN_WARNING, phba->shost,
25066733b39aSJayamohan Kallickal 			    "No Virtual address\n");
25076733b39aSJayamohan Kallickal 
25086733b39aSJayamohan Kallickal 	pasync_ctx->async_header.handle_base =
25096733b39aSJayamohan Kallickal 			mem_descr->mem_array[0].virtual_address;
25106733b39aSJayamohan Kallickal 	pasync_ctx->async_header.writables = 0;
25116733b39aSJayamohan Kallickal 	INIT_LIST_HEAD(&pasync_ctx->async_header.free_list);
25126733b39aSJayamohan Kallickal 
25136733b39aSJayamohan Kallickal 	mem_descr = (struct be_mem_descriptor *)phba->init_mem;
25146733b39aSJayamohan Kallickal 	mem_descr += HWI_MEM_ASYNC_DATA_BUF;
25156733b39aSJayamohan Kallickal 	if (mem_descr->mem_array[0].virtual_address) {
25166733b39aSJayamohan Kallickal 		SE_DEBUG(DBG_LVL_8,
25176733b39aSJayamohan Kallickal 			 "hwi_init_async_pdu_ctx HWI_MEM_ASYNC_DATA_BUF"
25186733b39aSJayamohan Kallickal 			 "va=%p\n", mem_descr->mem_array[0].virtual_address);
25196733b39aSJayamohan Kallickal 	} else
25206733b39aSJayamohan Kallickal 		shost_printk(KERN_WARNING, phba->shost,
25216733b39aSJayamohan Kallickal 			    "No Virtual address\n");
25226733b39aSJayamohan Kallickal 	pasync_ctx->async_data.va_base =
25236733b39aSJayamohan Kallickal 			mem_descr->mem_array[0].virtual_address;
25246733b39aSJayamohan Kallickal 	pasync_ctx->async_data.pa_base.u.a64.address =
25256733b39aSJayamohan Kallickal 			mem_descr->mem_array[0].bus_address.u.a64.address;
25266733b39aSJayamohan Kallickal 
25276733b39aSJayamohan Kallickal 	mem_descr = (struct be_mem_descriptor *)phba->init_mem;
25286733b39aSJayamohan Kallickal 	mem_descr += HWI_MEM_ASYNC_DATA_RING;
25296733b39aSJayamohan Kallickal 	if (mem_descr->mem_array[0].virtual_address) {
25306733b39aSJayamohan Kallickal 		SE_DEBUG(DBG_LVL_8,
25316733b39aSJayamohan Kallickal 			 "hwi_init_async_pdu_ctx HWI_MEM_ASYNC_DATA_RING"
25326733b39aSJayamohan Kallickal 			 "va=%p\n", mem_descr->mem_array[0].virtual_address);
25336733b39aSJayamohan Kallickal 	} else
25346733b39aSJayamohan Kallickal 		shost_printk(KERN_WARNING, phba->shost,
25356733b39aSJayamohan Kallickal 			     "No Virtual address\n");
25366733b39aSJayamohan Kallickal 
25376733b39aSJayamohan Kallickal 	pasync_ctx->async_data.ring_base =
25386733b39aSJayamohan Kallickal 			mem_descr->mem_array[0].virtual_address;
25396733b39aSJayamohan Kallickal 
25406733b39aSJayamohan Kallickal 	mem_descr = (struct be_mem_descriptor *)phba->init_mem;
25416733b39aSJayamohan Kallickal 	mem_descr += HWI_MEM_ASYNC_DATA_HANDLE;
25426733b39aSJayamohan Kallickal 	if (!mem_descr->mem_array[0].virtual_address)
25436733b39aSJayamohan Kallickal 		shost_printk(KERN_WARNING, phba->shost,
25446733b39aSJayamohan Kallickal 			    "No Virtual address\n");
25456733b39aSJayamohan Kallickal 
25466733b39aSJayamohan Kallickal 	pasync_ctx->async_data.handle_base =
25476733b39aSJayamohan Kallickal 			mem_descr->mem_array[0].virtual_address;
25486733b39aSJayamohan Kallickal 	pasync_ctx->async_data.writables = 0;
25496733b39aSJayamohan Kallickal 	INIT_LIST_HEAD(&pasync_ctx->async_data.free_list);
25506733b39aSJayamohan Kallickal 
25516733b39aSJayamohan Kallickal 	pasync_header_h =
25526733b39aSJayamohan Kallickal 		(struct async_pdu_handle *)pasync_ctx->async_header.handle_base;
25536733b39aSJayamohan Kallickal 	pasync_data_h =
25546733b39aSJayamohan Kallickal 		(struct async_pdu_handle *)pasync_ctx->async_data.handle_base;
25556733b39aSJayamohan Kallickal 
25566733b39aSJayamohan Kallickal 	for (index = 0; index < p->asyncpdus_per_ctrl; index++) {
25576733b39aSJayamohan Kallickal 		pasync_header_h->cri = -1;
25586733b39aSJayamohan Kallickal 		pasync_header_h->index = (char)index;
25596733b39aSJayamohan Kallickal 		INIT_LIST_HEAD(&pasync_header_h->link);
25606733b39aSJayamohan Kallickal 		pasync_header_h->pbuffer =
25616733b39aSJayamohan Kallickal 			(void *)((unsigned long)
25626733b39aSJayamohan Kallickal 			(pasync_ctx->async_header.va_base) +
25636733b39aSJayamohan Kallickal 			(p->defpdu_hdr_sz * index));
25646733b39aSJayamohan Kallickal 
25656733b39aSJayamohan Kallickal 		pasync_header_h->pa.u.a64.address =
25666733b39aSJayamohan Kallickal 			pasync_ctx->async_header.pa_base.u.a64.address +
25676733b39aSJayamohan Kallickal 			(p->defpdu_hdr_sz * index);
25686733b39aSJayamohan Kallickal 
25696733b39aSJayamohan Kallickal 		list_add_tail(&pasync_header_h->link,
25706733b39aSJayamohan Kallickal 				&pasync_ctx->async_header.free_list);
25716733b39aSJayamohan Kallickal 		pasync_header_h++;
25726733b39aSJayamohan Kallickal 		pasync_ctx->async_header.free_entries++;
25736733b39aSJayamohan Kallickal 		pasync_ctx->async_header.writables++;
25746733b39aSJayamohan Kallickal 
25756733b39aSJayamohan Kallickal 		INIT_LIST_HEAD(&pasync_ctx->async_entry[index].wait_queue.list);
25766733b39aSJayamohan Kallickal 		INIT_LIST_HEAD(&pasync_ctx->async_entry[index].
25776733b39aSJayamohan Kallickal 			       header_busy_list);
25786733b39aSJayamohan Kallickal 		pasync_data_h->cri = -1;
25796733b39aSJayamohan Kallickal 		pasync_data_h->index = (char)index;
25806733b39aSJayamohan Kallickal 		INIT_LIST_HEAD(&pasync_data_h->link);
25816733b39aSJayamohan Kallickal 		pasync_data_h->pbuffer =
25826733b39aSJayamohan Kallickal 			(void *)((unsigned long)
25836733b39aSJayamohan Kallickal 			(pasync_ctx->async_data.va_base) +
25846733b39aSJayamohan Kallickal 			(p->defpdu_data_sz * index));
25856733b39aSJayamohan Kallickal 
25866733b39aSJayamohan Kallickal 		pasync_data_h->pa.u.a64.address =
25876733b39aSJayamohan Kallickal 		    pasync_ctx->async_data.pa_base.u.a64.address +
25886733b39aSJayamohan Kallickal 		    (p->defpdu_data_sz * index);
25896733b39aSJayamohan Kallickal 
25906733b39aSJayamohan Kallickal 		list_add_tail(&pasync_data_h->link,
25916733b39aSJayamohan Kallickal 			      &pasync_ctx->async_data.free_list);
25926733b39aSJayamohan Kallickal 		pasync_data_h++;
25936733b39aSJayamohan Kallickal 		pasync_ctx->async_data.free_entries++;
25946733b39aSJayamohan Kallickal 		pasync_ctx->async_data.writables++;
25956733b39aSJayamohan Kallickal 
25966733b39aSJayamohan Kallickal 		INIT_LIST_HEAD(&pasync_ctx->async_entry[index].data_busy_list);
25976733b39aSJayamohan Kallickal 	}
25986733b39aSJayamohan Kallickal 
25996733b39aSJayamohan Kallickal 	pasync_ctx->async_header.host_write_ptr = 0;
26006733b39aSJayamohan Kallickal 	pasync_ctx->async_header.ep_read_ptr = -1;
26016733b39aSJayamohan Kallickal 	pasync_ctx->async_data.host_write_ptr = 0;
26026733b39aSJayamohan Kallickal 	pasync_ctx->async_data.ep_read_ptr = -1;
26036733b39aSJayamohan Kallickal }
26046733b39aSJayamohan Kallickal 
26056733b39aSJayamohan Kallickal static int
26066733b39aSJayamohan Kallickal be_sgl_create_contiguous(void *virtual_address,
26076733b39aSJayamohan Kallickal 			 u64 physical_address, u32 length,
26086733b39aSJayamohan Kallickal 			 struct be_dma_mem *sgl)
26096733b39aSJayamohan Kallickal {
26106733b39aSJayamohan Kallickal 	WARN_ON(!virtual_address);
26116733b39aSJayamohan Kallickal 	WARN_ON(!physical_address);
26126733b39aSJayamohan Kallickal 	WARN_ON(!length > 0);
26136733b39aSJayamohan Kallickal 	WARN_ON(!sgl);
26146733b39aSJayamohan Kallickal 
26156733b39aSJayamohan Kallickal 	sgl->va = virtual_address;
2616457ff3b7SJayamohan Kallickal 	sgl->dma = (unsigned long)physical_address;
26176733b39aSJayamohan Kallickal 	sgl->size = length;
26186733b39aSJayamohan Kallickal 
26196733b39aSJayamohan Kallickal 	return 0;
26206733b39aSJayamohan Kallickal }
26216733b39aSJayamohan Kallickal 
26226733b39aSJayamohan Kallickal static void be_sgl_destroy_contiguous(struct be_dma_mem *sgl)
26236733b39aSJayamohan Kallickal {
26246733b39aSJayamohan Kallickal 	memset(sgl, 0, sizeof(*sgl));
26256733b39aSJayamohan Kallickal }
26266733b39aSJayamohan Kallickal 
26276733b39aSJayamohan Kallickal static void
26286733b39aSJayamohan Kallickal hwi_build_be_sgl_arr(struct beiscsi_hba *phba,
26296733b39aSJayamohan Kallickal 		     struct mem_array *pmem, struct be_dma_mem *sgl)
26306733b39aSJayamohan Kallickal {
26316733b39aSJayamohan Kallickal 	if (sgl->va)
26326733b39aSJayamohan Kallickal 		be_sgl_destroy_contiguous(sgl);
26336733b39aSJayamohan Kallickal 
26346733b39aSJayamohan Kallickal 	be_sgl_create_contiguous(pmem->virtual_address,
26356733b39aSJayamohan Kallickal 				 pmem->bus_address.u.a64.address,
26366733b39aSJayamohan Kallickal 				 pmem->size, sgl);
26376733b39aSJayamohan Kallickal }
26386733b39aSJayamohan Kallickal 
26396733b39aSJayamohan Kallickal static void
26406733b39aSJayamohan Kallickal hwi_build_be_sgl_by_offset(struct beiscsi_hba *phba,
26416733b39aSJayamohan Kallickal 			   struct mem_array *pmem, struct be_dma_mem *sgl)
26426733b39aSJayamohan Kallickal {
26436733b39aSJayamohan Kallickal 	if (sgl->va)
26446733b39aSJayamohan Kallickal 		be_sgl_destroy_contiguous(sgl);
26456733b39aSJayamohan Kallickal 
26466733b39aSJayamohan Kallickal 	be_sgl_create_contiguous((unsigned char *)pmem->virtual_address,
26476733b39aSJayamohan Kallickal 				 pmem->bus_address.u.a64.address,
26486733b39aSJayamohan Kallickal 				 pmem->size, sgl);
26496733b39aSJayamohan Kallickal }
26506733b39aSJayamohan Kallickal 
26516733b39aSJayamohan Kallickal static int be_fill_queue(struct be_queue_info *q,
26526733b39aSJayamohan Kallickal 		u16 len, u16 entry_size, void *vaddress)
26536733b39aSJayamohan Kallickal {
26546733b39aSJayamohan Kallickal 	struct be_dma_mem *mem = &q->dma_mem;
26556733b39aSJayamohan Kallickal 
26566733b39aSJayamohan Kallickal 	memset(q, 0, sizeof(*q));
26576733b39aSJayamohan Kallickal 	q->len = len;
26586733b39aSJayamohan Kallickal 	q->entry_size = entry_size;
26596733b39aSJayamohan Kallickal 	mem->size = len * entry_size;
26606733b39aSJayamohan Kallickal 	mem->va = vaddress;
26616733b39aSJayamohan Kallickal 	if (!mem->va)
26626733b39aSJayamohan Kallickal 		return -ENOMEM;
26636733b39aSJayamohan Kallickal 	memset(mem->va, 0, mem->size);
26646733b39aSJayamohan Kallickal 	return 0;
26656733b39aSJayamohan Kallickal }
26666733b39aSJayamohan Kallickal 
2667bfead3b2SJayamohan Kallickal static int beiscsi_create_eqs(struct beiscsi_hba *phba,
26686733b39aSJayamohan Kallickal 			     struct hwi_context_memory *phwi_context)
26696733b39aSJayamohan Kallickal {
2670bfead3b2SJayamohan Kallickal 	unsigned int i, num_eq_pages;
2671bfead3b2SJayamohan Kallickal 	int ret, eq_for_mcc;
26726733b39aSJayamohan Kallickal 	struct be_queue_info *eq;
26736733b39aSJayamohan Kallickal 	struct be_dma_mem *mem;
26746733b39aSJayamohan Kallickal 	void *eq_vaddress;
2675bfead3b2SJayamohan Kallickal 	dma_addr_t paddr;
26766733b39aSJayamohan Kallickal 
2677bfead3b2SJayamohan Kallickal 	num_eq_pages = PAGES_REQUIRED(phba->params.num_eq_entries * \
2678bfead3b2SJayamohan Kallickal 				      sizeof(struct be_eq_entry));
2679bfead3b2SJayamohan Kallickal 
2680bfead3b2SJayamohan Kallickal 	if (phba->msix_enabled)
2681bfead3b2SJayamohan Kallickal 		eq_for_mcc = 1;
2682bfead3b2SJayamohan Kallickal 	else
2683bfead3b2SJayamohan Kallickal 		eq_for_mcc = 0;
2684bfead3b2SJayamohan Kallickal 	for (i = 0; i < (phba->num_cpus + eq_for_mcc); i++) {
2685bfead3b2SJayamohan Kallickal 		eq = &phwi_context->be_eq[i].q;
26866733b39aSJayamohan Kallickal 		mem = &eq->dma_mem;
2687bfead3b2SJayamohan Kallickal 		phwi_context->be_eq[i].phba = phba;
2688bfead3b2SJayamohan Kallickal 		eq_vaddress = pci_alloc_consistent(phba->pcidev,
2689bfead3b2SJayamohan Kallickal 						     num_eq_pages * PAGE_SIZE,
2690bfead3b2SJayamohan Kallickal 						     &paddr);
2691bfead3b2SJayamohan Kallickal 		if (!eq_vaddress)
2692bfead3b2SJayamohan Kallickal 			goto create_eq_error;
26936733b39aSJayamohan Kallickal 
2694bfead3b2SJayamohan Kallickal 		mem->va = eq_vaddress;
26956733b39aSJayamohan Kallickal 		ret = be_fill_queue(eq, phba->params.num_eq_entries,
26966733b39aSJayamohan Kallickal 				    sizeof(struct be_eq_entry), eq_vaddress);
26976733b39aSJayamohan Kallickal 		if (ret) {
26986733b39aSJayamohan Kallickal 			shost_printk(KERN_ERR, phba->shost,
26996733b39aSJayamohan Kallickal 				     "be_fill_queue Failed for EQ\n");
2700bfead3b2SJayamohan Kallickal 			goto create_eq_error;
27016733b39aSJayamohan Kallickal 		}
27026733b39aSJayamohan Kallickal 
2703bfead3b2SJayamohan Kallickal 		mem->dma = paddr;
27046733b39aSJayamohan Kallickal 		ret = beiscsi_cmd_eq_create(&phba->ctrl, eq,
2705bfead3b2SJayamohan Kallickal 					    phwi_context->cur_eqd);
27066733b39aSJayamohan Kallickal 		if (ret) {
2707bfead3b2SJayamohan Kallickal 			shost_printk(KERN_ERR, phba->shost,
2708bfead3b2SJayamohan Kallickal 				     "beiscsi_cmd_eq_create"
27096733b39aSJayamohan Kallickal 				     "Failedfor EQ\n");
2710bfead3b2SJayamohan Kallickal 			goto create_eq_error;
2711bfead3b2SJayamohan Kallickal 		}
2712bfead3b2SJayamohan Kallickal 		SE_DEBUG(DBG_LVL_8, "eqid = %d\n", phwi_context->be_eq[i].q.id);
2713bfead3b2SJayamohan Kallickal 	}
2714bfead3b2SJayamohan Kallickal 	return 0;
2715bfead3b2SJayamohan Kallickal create_eq_error:
2716bfead3b2SJayamohan Kallickal 	for (i = 0; i < (phba->num_cpus + 1); i++) {
2717bfead3b2SJayamohan Kallickal 		eq = &phwi_context->be_eq[i].q;
2718bfead3b2SJayamohan Kallickal 		mem = &eq->dma_mem;
2719bfead3b2SJayamohan Kallickal 		if (mem->va)
2720bfead3b2SJayamohan Kallickal 			pci_free_consistent(phba->pcidev, num_eq_pages
2721bfead3b2SJayamohan Kallickal 					    * PAGE_SIZE,
2722bfead3b2SJayamohan Kallickal 					    mem->va, mem->dma);
2723bfead3b2SJayamohan Kallickal 	}
27246733b39aSJayamohan Kallickal 	return ret;
27256733b39aSJayamohan Kallickal }
27266733b39aSJayamohan Kallickal 
2727bfead3b2SJayamohan Kallickal static int beiscsi_create_cqs(struct beiscsi_hba *phba,
27286733b39aSJayamohan Kallickal 			     struct hwi_context_memory *phwi_context)
27296733b39aSJayamohan Kallickal {
2730bfead3b2SJayamohan Kallickal 	unsigned int i, num_cq_pages;
27316733b39aSJayamohan Kallickal 	int ret;
27326733b39aSJayamohan Kallickal 	struct be_queue_info *cq, *eq;
27336733b39aSJayamohan Kallickal 	struct be_dma_mem *mem;
2734bfead3b2SJayamohan Kallickal 	struct be_eq_obj *pbe_eq;
27356733b39aSJayamohan Kallickal 	void *cq_vaddress;
2736bfead3b2SJayamohan Kallickal 	dma_addr_t paddr;
27376733b39aSJayamohan Kallickal 
2738bfead3b2SJayamohan Kallickal 	num_cq_pages = PAGES_REQUIRED(phba->params.num_cq_entries * \
2739bfead3b2SJayamohan Kallickal 				      sizeof(struct sol_cqe));
2740bfead3b2SJayamohan Kallickal 
2741bfead3b2SJayamohan Kallickal 	for (i = 0; i < phba->num_cpus; i++) {
2742bfead3b2SJayamohan Kallickal 		cq = &phwi_context->be_cq[i];
2743bfead3b2SJayamohan Kallickal 		eq = &phwi_context->be_eq[i].q;
2744bfead3b2SJayamohan Kallickal 		pbe_eq = &phwi_context->be_eq[i];
2745bfead3b2SJayamohan Kallickal 		pbe_eq->cq = cq;
2746bfead3b2SJayamohan Kallickal 		pbe_eq->phba = phba;
27476733b39aSJayamohan Kallickal 		mem = &cq->dma_mem;
2748bfead3b2SJayamohan Kallickal 		cq_vaddress = pci_alloc_consistent(phba->pcidev,
2749bfead3b2SJayamohan Kallickal 						     num_cq_pages * PAGE_SIZE,
2750bfead3b2SJayamohan Kallickal 						     &paddr);
2751bfead3b2SJayamohan Kallickal 		if (!cq_vaddress)
2752bfead3b2SJayamohan Kallickal 			goto create_cq_error;
27537da50879SJayamohan Kallickal 		ret = be_fill_queue(cq, phba->params.num_cq_entries,
27546733b39aSJayamohan Kallickal 				    sizeof(struct sol_cqe), cq_vaddress);
27556733b39aSJayamohan Kallickal 		if (ret) {
27566733b39aSJayamohan Kallickal 			shost_printk(KERN_ERR, phba->shost,
27576733b39aSJayamohan Kallickal 				     "be_fill_queue Failed for ISCSI CQ\n");
2758bfead3b2SJayamohan Kallickal 			goto create_cq_error;
27596733b39aSJayamohan Kallickal 		}
27606733b39aSJayamohan Kallickal 
2761bfead3b2SJayamohan Kallickal 		mem->dma = paddr;
2762bfead3b2SJayamohan Kallickal 		ret = beiscsi_cmd_cq_create(&phba->ctrl, cq, eq, false,
2763bfead3b2SJayamohan Kallickal 					    false, 0);
27646733b39aSJayamohan Kallickal 		if (ret) {
27656733b39aSJayamohan Kallickal 			shost_printk(KERN_ERR, phba->shost,
2766bfead3b2SJayamohan Kallickal 				     "beiscsi_cmd_eq_create"
2767bfead3b2SJayamohan Kallickal 				     "Failed for ISCSI CQ\n");
2768bfead3b2SJayamohan Kallickal 			goto create_cq_error;
27696733b39aSJayamohan Kallickal 		}
2770bfead3b2SJayamohan Kallickal 		SE_DEBUG(DBG_LVL_8, "iscsi cq_id is %d for eq_id %d\n",
2771bfead3b2SJayamohan Kallickal 						 cq->id, eq->id);
27726733b39aSJayamohan Kallickal 		SE_DEBUG(DBG_LVL_8, "ISCSI CQ CREATED\n");
2773bfead3b2SJayamohan Kallickal 	}
27746733b39aSJayamohan Kallickal 	return 0;
2775bfead3b2SJayamohan Kallickal 
2776bfead3b2SJayamohan Kallickal create_cq_error:
2777bfead3b2SJayamohan Kallickal 	for (i = 0; i < phba->num_cpus; i++) {
2778bfead3b2SJayamohan Kallickal 		cq = &phwi_context->be_cq[i];
2779bfead3b2SJayamohan Kallickal 		mem = &cq->dma_mem;
2780bfead3b2SJayamohan Kallickal 		if (mem->va)
2781bfead3b2SJayamohan Kallickal 			pci_free_consistent(phba->pcidev, num_cq_pages
2782bfead3b2SJayamohan Kallickal 					    * PAGE_SIZE,
2783bfead3b2SJayamohan Kallickal 					    mem->va, mem->dma);
2784bfead3b2SJayamohan Kallickal 	}
2785bfead3b2SJayamohan Kallickal 	return ret;
2786bfead3b2SJayamohan Kallickal 
27876733b39aSJayamohan Kallickal }
27886733b39aSJayamohan Kallickal 
27896733b39aSJayamohan Kallickal static int
27906733b39aSJayamohan Kallickal beiscsi_create_def_hdr(struct beiscsi_hba *phba,
27916733b39aSJayamohan Kallickal 		       struct hwi_context_memory *phwi_context,
27926733b39aSJayamohan Kallickal 		       struct hwi_controller *phwi_ctrlr,
27936733b39aSJayamohan Kallickal 		       unsigned int def_pdu_ring_sz)
27946733b39aSJayamohan Kallickal {
27956733b39aSJayamohan Kallickal 	unsigned int idx;
27966733b39aSJayamohan Kallickal 	int ret;
27976733b39aSJayamohan Kallickal 	struct be_queue_info *dq, *cq;
27986733b39aSJayamohan Kallickal 	struct be_dma_mem *mem;
27996733b39aSJayamohan Kallickal 	struct be_mem_descriptor *mem_descr;
28006733b39aSJayamohan Kallickal 	void *dq_vaddress;
28016733b39aSJayamohan Kallickal 
28026733b39aSJayamohan Kallickal 	idx = 0;
28036733b39aSJayamohan Kallickal 	dq = &phwi_context->be_def_hdrq;
2804bfead3b2SJayamohan Kallickal 	cq = &phwi_context->be_cq[0];
28056733b39aSJayamohan Kallickal 	mem = &dq->dma_mem;
28066733b39aSJayamohan Kallickal 	mem_descr = phba->init_mem;
28076733b39aSJayamohan Kallickal 	mem_descr += HWI_MEM_ASYNC_HEADER_RING;
28086733b39aSJayamohan Kallickal 	dq_vaddress = mem_descr->mem_array[idx].virtual_address;
28096733b39aSJayamohan Kallickal 	ret = be_fill_queue(dq, mem_descr->mem_array[0].size /
28106733b39aSJayamohan Kallickal 			    sizeof(struct phys_addr),
28116733b39aSJayamohan Kallickal 			    sizeof(struct phys_addr), dq_vaddress);
28126733b39aSJayamohan Kallickal 	if (ret) {
28136733b39aSJayamohan Kallickal 		shost_printk(KERN_ERR, phba->shost,
28146733b39aSJayamohan Kallickal 			     "be_fill_queue Failed for DEF PDU HDR\n");
28156733b39aSJayamohan Kallickal 		return ret;
28166733b39aSJayamohan Kallickal 	}
2817457ff3b7SJayamohan Kallickal 	mem->dma = (unsigned long)mem_descr->mem_array[idx].
2818457ff3b7SJayamohan Kallickal 				  bus_address.u.a64.address;
28196733b39aSJayamohan Kallickal 	ret = be_cmd_create_default_pdu_queue(&phba->ctrl, cq, dq,
28206733b39aSJayamohan Kallickal 					      def_pdu_ring_sz,
28216733b39aSJayamohan Kallickal 					      phba->params.defpdu_hdr_sz);
28226733b39aSJayamohan Kallickal 	if (ret) {
28236733b39aSJayamohan Kallickal 		shost_printk(KERN_ERR, phba->shost,
28246733b39aSJayamohan Kallickal 			     "be_cmd_create_default_pdu_queue Failed DEFHDR\n");
28256733b39aSJayamohan Kallickal 		return ret;
28266733b39aSJayamohan Kallickal 	}
28276733b39aSJayamohan Kallickal 	phwi_ctrlr->default_pdu_hdr.id = phwi_context->be_def_hdrq.id;
28286733b39aSJayamohan Kallickal 	SE_DEBUG(DBG_LVL_8, "iscsi def pdu id is %d\n",
28296733b39aSJayamohan Kallickal 		 phwi_context->be_def_hdrq.id);
28306733b39aSJayamohan Kallickal 	hwi_post_async_buffers(phba, 1);
28316733b39aSJayamohan Kallickal 	return 0;
28326733b39aSJayamohan Kallickal }
28336733b39aSJayamohan Kallickal 
28346733b39aSJayamohan Kallickal static int
28356733b39aSJayamohan Kallickal beiscsi_create_def_data(struct beiscsi_hba *phba,
28366733b39aSJayamohan Kallickal 			struct hwi_context_memory *phwi_context,
28376733b39aSJayamohan Kallickal 			struct hwi_controller *phwi_ctrlr,
28386733b39aSJayamohan Kallickal 			unsigned int def_pdu_ring_sz)
28396733b39aSJayamohan Kallickal {
28406733b39aSJayamohan Kallickal 	unsigned int idx;
28416733b39aSJayamohan Kallickal 	int ret;
28426733b39aSJayamohan Kallickal 	struct be_queue_info *dataq, *cq;
28436733b39aSJayamohan Kallickal 	struct be_dma_mem *mem;
28446733b39aSJayamohan Kallickal 	struct be_mem_descriptor *mem_descr;
28456733b39aSJayamohan Kallickal 	void *dq_vaddress;
28466733b39aSJayamohan Kallickal 
28476733b39aSJayamohan Kallickal 	idx = 0;
28486733b39aSJayamohan Kallickal 	dataq = &phwi_context->be_def_dataq;
2849bfead3b2SJayamohan Kallickal 	cq = &phwi_context->be_cq[0];
28506733b39aSJayamohan Kallickal 	mem = &dataq->dma_mem;
28516733b39aSJayamohan Kallickal 	mem_descr = phba->init_mem;
28526733b39aSJayamohan Kallickal 	mem_descr += HWI_MEM_ASYNC_DATA_RING;
28536733b39aSJayamohan Kallickal 	dq_vaddress = mem_descr->mem_array[idx].virtual_address;
28546733b39aSJayamohan Kallickal 	ret = be_fill_queue(dataq, mem_descr->mem_array[0].size /
28556733b39aSJayamohan Kallickal 			    sizeof(struct phys_addr),
28566733b39aSJayamohan Kallickal 			    sizeof(struct phys_addr), dq_vaddress);
28576733b39aSJayamohan Kallickal 	if (ret) {
28586733b39aSJayamohan Kallickal 		shost_printk(KERN_ERR, phba->shost,
28596733b39aSJayamohan Kallickal 			     "be_fill_queue Failed for DEF PDU DATA\n");
28606733b39aSJayamohan Kallickal 		return ret;
28616733b39aSJayamohan Kallickal 	}
2862457ff3b7SJayamohan Kallickal 	mem->dma = (unsigned long)mem_descr->mem_array[idx].
2863457ff3b7SJayamohan Kallickal 				  bus_address.u.a64.address;
28646733b39aSJayamohan Kallickal 	ret = be_cmd_create_default_pdu_queue(&phba->ctrl, cq, dataq,
28656733b39aSJayamohan Kallickal 					      def_pdu_ring_sz,
28666733b39aSJayamohan Kallickal 					      phba->params.defpdu_data_sz);
28676733b39aSJayamohan Kallickal 	if (ret) {
28686733b39aSJayamohan Kallickal 		shost_printk(KERN_ERR, phba->shost,
28696733b39aSJayamohan Kallickal 			     "be_cmd_create_default_pdu_queue Failed"
28706733b39aSJayamohan Kallickal 			     " for DEF PDU DATA\n");
28716733b39aSJayamohan Kallickal 		return ret;
28726733b39aSJayamohan Kallickal 	}
28736733b39aSJayamohan Kallickal 	phwi_ctrlr->default_pdu_data.id = phwi_context->be_def_dataq.id;
28746733b39aSJayamohan Kallickal 	SE_DEBUG(DBG_LVL_8, "iscsi def data id is %d\n",
28756733b39aSJayamohan Kallickal 		 phwi_context->be_def_dataq.id);
28766733b39aSJayamohan Kallickal 	hwi_post_async_buffers(phba, 0);
28776733b39aSJayamohan Kallickal 	SE_DEBUG(DBG_LVL_8, "DEFAULT PDU DATA RING CREATED\n");
28786733b39aSJayamohan Kallickal 	return 0;
28796733b39aSJayamohan Kallickal }
28806733b39aSJayamohan Kallickal 
28816733b39aSJayamohan Kallickal static int
28826733b39aSJayamohan Kallickal beiscsi_post_pages(struct beiscsi_hba *phba)
28836733b39aSJayamohan Kallickal {
28846733b39aSJayamohan Kallickal 	struct be_mem_descriptor *mem_descr;
28856733b39aSJayamohan Kallickal 	struct mem_array *pm_arr;
28866733b39aSJayamohan Kallickal 	unsigned int page_offset, i;
28876733b39aSJayamohan Kallickal 	struct be_dma_mem sgl;
28886733b39aSJayamohan Kallickal 	int status;
28896733b39aSJayamohan Kallickal 
28906733b39aSJayamohan Kallickal 	mem_descr = phba->init_mem;
28916733b39aSJayamohan Kallickal 	mem_descr += HWI_MEM_SGE;
28926733b39aSJayamohan Kallickal 	pm_arr = mem_descr->mem_array;
28936733b39aSJayamohan Kallickal 
28946733b39aSJayamohan Kallickal 	page_offset = (sizeof(struct iscsi_sge) * phba->params.num_sge_per_io *
28956733b39aSJayamohan Kallickal 			phba->fw_config.iscsi_icd_start) / PAGE_SIZE;
28966733b39aSJayamohan Kallickal 	for (i = 0; i < mem_descr->num_elements; i++) {
28976733b39aSJayamohan Kallickal 		hwi_build_be_sgl_arr(phba, pm_arr, &sgl);
28986733b39aSJayamohan Kallickal 		status = be_cmd_iscsi_post_sgl_pages(&phba->ctrl, &sgl,
28996733b39aSJayamohan Kallickal 						page_offset,
29006733b39aSJayamohan Kallickal 						(pm_arr->size / PAGE_SIZE));
29016733b39aSJayamohan Kallickal 		page_offset += pm_arr->size / PAGE_SIZE;
29026733b39aSJayamohan Kallickal 		if (status != 0) {
29036733b39aSJayamohan Kallickal 			shost_printk(KERN_ERR, phba->shost,
29046733b39aSJayamohan Kallickal 				     "post sgl failed.\n");
29056733b39aSJayamohan Kallickal 			return status;
29066733b39aSJayamohan Kallickal 		}
29076733b39aSJayamohan Kallickal 		pm_arr++;
29086733b39aSJayamohan Kallickal 	}
29096733b39aSJayamohan Kallickal 	SE_DEBUG(DBG_LVL_8, "POSTED PAGES\n");
29106733b39aSJayamohan Kallickal 	return 0;
29116733b39aSJayamohan Kallickal }
29126733b39aSJayamohan Kallickal 
2913bfead3b2SJayamohan Kallickal static void be_queue_free(struct beiscsi_hba *phba, struct be_queue_info *q)
2914bfead3b2SJayamohan Kallickal {
2915bfead3b2SJayamohan Kallickal 	struct be_dma_mem *mem = &q->dma_mem;
2916bfead3b2SJayamohan Kallickal 	if (mem->va)
2917bfead3b2SJayamohan Kallickal 		pci_free_consistent(phba->pcidev, mem->size,
2918bfead3b2SJayamohan Kallickal 			mem->va, mem->dma);
2919bfead3b2SJayamohan Kallickal }
2920bfead3b2SJayamohan Kallickal 
2921bfead3b2SJayamohan Kallickal static int be_queue_alloc(struct beiscsi_hba *phba, struct be_queue_info *q,
2922bfead3b2SJayamohan Kallickal 		u16 len, u16 entry_size)
2923bfead3b2SJayamohan Kallickal {
2924bfead3b2SJayamohan Kallickal 	struct be_dma_mem *mem = &q->dma_mem;
2925bfead3b2SJayamohan Kallickal 
2926bfead3b2SJayamohan Kallickal 	memset(q, 0, sizeof(*q));
2927bfead3b2SJayamohan Kallickal 	q->len = len;
2928bfead3b2SJayamohan Kallickal 	q->entry_size = entry_size;
2929bfead3b2SJayamohan Kallickal 	mem->size = len * entry_size;
2930bfead3b2SJayamohan Kallickal 	mem->va = pci_alloc_consistent(phba->pcidev, mem->size, &mem->dma);
2931bfead3b2SJayamohan Kallickal 	if (!mem->va)
2932d3ad2bb3SJayamohan Kallickal 		return -ENOMEM;
2933bfead3b2SJayamohan Kallickal 	memset(mem->va, 0, mem->size);
2934bfead3b2SJayamohan Kallickal 	return 0;
2935bfead3b2SJayamohan Kallickal }
2936bfead3b2SJayamohan Kallickal 
29376733b39aSJayamohan Kallickal static int
29386733b39aSJayamohan Kallickal beiscsi_create_wrb_rings(struct beiscsi_hba *phba,
29396733b39aSJayamohan Kallickal 			 struct hwi_context_memory *phwi_context,
29406733b39aSJayamohan Kallickal 			 struct hwi_controller *phwi_ctrlr)
29416733b39aSJayamohan Kallickal {
29426733b39aSJayamohan Kallickal 	unsigned int wrb_mem_index, offset, size, num_wrb_rings;
29436733b39aSJayamohan Kallickal 	u64 pa_addr_lo;
29446733b39aSJayamohan Kallickal 	unsigned int idx, num, i;
29456733b39aSJayamohan Kallickal 	struct mem_array *pwrb_arr;
29466733b39aSJayamohan Kallickal 	void *wrb_vaddr;
29476733b39aSJayamohan Kallickal 	struct be_dma_mem sgl;
29486733b39aSJayamohan Kallickal 	struct be_mem_descriptor *mem_descr;
29496733b39aSJayamohan Kallickal 	int status;
29506733b39aSJayamohan Kallickal 
29516733b39aSJayamohan Kallickal 	idx = 0;
29526733b39aSJayamohan Kallickal 	mem_descr = phba->init_mem;
29536733b39aSJayamohan Kallickal 	mem_descr += HWI_MEM_WRB;
29546733b39aSJayamohan Kallickal 	pwrb_arr = kmalloc(sizeof(*pwrb_arr) * phba->params.cxns_per_ctrl,
29556733b39aSJayamohan Kallickal 			   GFP_KERNEL);
29566733b39aSJayamohan Kallickal 	if (!pwrb_arr) {
29576733b39aSJayamohan Kallickal 		shost_printk(KERN_ERR, phba->shost,
29586733b39aSJayamohan Kallickal 			     "Memory alloc failed in create wrb ring.\n");
29596733b39aSJayamohan Kallickal 		return -ENOMEM;
29606733b39aSJayamohan Kallickal 	}
29616733b39aSJayamohan Kallickal 	wrb_vaddr = mem_descr->mem_array[idx].virtual_address;
29626733b39aSJayamohan Kallickal 	pa_addr_lo = mem_descr->mem_array[idx].bus_address.u.a64.address;
29636733b39aSJayamohan Kallickal 	num_wrb_rings = mem_descr->mem_array[idx].size /
29646733b39aSJayamohan Kallickal 		(phba->params.wrbs_per_cxn * sizeof(struct iscsi_wrb));
29656733b39aSJayamohan Kallickal 
29666733b39aSJayamohan Kallickal 	for (num = 0; num < phba->params.cxns_per_ctrl; num++) {
29676733b39aSJayamohan Kallickal 		if (num_wrb_rings) {
29686733b39aSJayamohan Kallickal 			pwrb_arr[num].virtual_address = wrb_vaddr;
29696733b39aSJayamohan Kallickal 			pwrb_arr[num].bus_address.u.a64.address	= pa_addr_lo;
29706733b39aSJayamohan Kallickal 			pwrb_arr[num].size = phba->params.wrbs_per_cxn *
29716733b39aSJayamohan Kallickal 					    sizeof(struct iscsi_wrb);
29726733b39aSJayamohan Kallickal 			wrb_vaddr += pwrb_arr[num].size;
29736733b39aSJayamohan Kallickal 			pa_addr_lo += pwrb_arr[num].size;
29746733b39aSJayamohan Kallickal 			num_wrb_rings--;
29756733b39aSJayamohan Kallickal 		} else {
29766733b39aSJayamohan Kallickal 			idx++;
29776733b39aSJayamohan Kallickal 			wrb_vaddr = mem_descr->mem_array[idx].virtual_address;
29786733b39aSJayamohan Kallickal 			pa_addr_lo = mem_descr->mem_array[idx].\
29796733b39aSJayamohan Kallickal 					bus_address.u.a64.address;
29806733b39aSJayamohan Kallickal 			num_wrb_rings = mem_descr->mem_array[idx].size /
29816733b39aSJayamohan Kallickal 					(phba->params.wrbs_per_cxn *
29826733b39aSJayamohan Kallickal 					sizeof(struct iscsi_wrb));
29836733b39aSJayamohan Kallickal 			pwrb_arr[num].virtual_address = wrb_vaddr;
29846733b39aSJayamohan Kallickal 			pwrb_arr[num].bus_address.u.a64.address\
29856733b39aSJayamohan Kallickal 						= pa_addr_lo;
29866733b39aSJayamohan Kallickal 			pwrb_arr[num].size = phba->params.wrbs_per_cxn *
29876733b39aSJayamohan Kallickal 						 sizeof(struct iscsi_wrb);
29886733b39aSJayamohan Kallickal 			wrb_vaddr += pwrb_arr[num].size;
29896733b39aSJayamohan Kallickal 			pa_addr_lo   += pwrb_arr[num].size;
29906733b39aSJayamohan Kallickal 			num_wrb_rings--;
29916733b39aSJayamohan Kallickal 		}
29926733b39aSJayamohan Kallickal 	}
29936733b39aSJayamohan Kallickal 	for (i = 0; i < phba->params.cxns_per_ctrl; i++) {
29946733b39aSJayamohan Kallickal 		wrb_mem_index = 0;
29956733b39aSJayamohan Kallickal 		offset = 0;
29966733b39aSJayamohan Kallickal 		size = 0;
29976733b39aSJayamohan Kallickal 
29986733b39aSJayamohan Kallickal 		hwi_build_be_sgl_by_offset(phba, &pwrb_arr[i], &sgl);
29996733b39aSJayamohan Kallickal 		status = be_cmd_wrbq_create(&phba->ctrl, &sgl,
30006733b39aSJayamohan Kallickal 					    &phwi_context->be_wrbq[i]);
30016733b39aSJayamohan Kallickal 		if (status != 0) {
30026733b39aSJayamohan Kallickal 			shost_printk(KERN_ERR, phba->shost,
30036733b39aSJayamohan Kallickal 				     "wrbq create failed.");
30041462b8ffSDan Carpenter 			kfree(pwrb_arr);
30056733b39aSJayamohan Kallickal 			return status;
30066733b39aSJayamohan Kallickal 		}
30077da50879SJayamohan Kallickal 		phwi_ctrlr->wrb_context[i * 2].cid = phwi_context->be_wrbq[i].
30087da50879SJayamohan Kallickal 								   id;
30096733b39aSJayamohan Kallickal 	}
30106733b39aSJayamohan Kallickal 	kfree(pwrb_arr);
30116733b39aSJayamohan Kallickal 	return 0;
30126733b39aSJayamohan Kallickal }
30136733b39aSJayamohan Kallickal 
30146733b39aSJayamohan Kallickal static void free_wrb_handles(struct beiscsi_hba *phba)
30156733b39aSJayamohan Kallickal {
30166733b39aSJayamohan Kallickal 	unsigned int index;
30176733b39aSJayamohan Kallickal 	struct hwi_controller *phwi_ctrlr;
30186733b39aSJayamohan Kallickal 	struct hwi_wrb_context *pwrb_context;
30196733b39aSJayamohan Kallickal 
30206733b39aSJayamohan Kallickal 	phwi_ctrlr = phba->phwi_ctrlr;
30216733b39aSJayamohan Kallickal 	for (index = 0; index < phba->params.cxns_per_ctrl * 2; index += 2) {
30226733b39aSJayamohan Kallickal 		pwrb_context = &phwi_ctrlr->wrb_context[index];
30236733b39aSJayamohan Kallickal 		kfree(pwrb_context->pwrb_handle_base);
30246733b39aSJayamohan Kallickal 		kfree(pwrb_context->pwrb_handle_basestd);
30256733b39aSJayamohan Kallickal 	}
30266733b39aSJayamohan Kallickal }
30276733b39aSJayamohan Kallickal 
3028bfead3b2SJayamohan Kallickal static void be_mcc_queues_destroy(struct beiscsi_hba *phba)
3029bfead3b2SJayamohan Kallickal {
3030bfead3b2SJayamohan Kallickal 	struct be_queue_info *q;
3031bfead3b2SJayamohan Kallickal 	struct be_ctrl_info *ctrl = &phba->ctrl;
3032bfead3b2SJayamohan Kallickal 
3033bfead3b2SJayamohan Kallickal 	q = &phba->ctrl.mcc_obj.q;
3034bfead3b2SJayamohan Kallickal 	if (q->created)
3035bfead3b2SJayamohan Kallickal 		beiscsi_cmd_q_destroy(ctrl, q, QTYPE_MCCQ);
3036bfead3b2SJayamohan Kallickal 	be_queue_free(phba, q);
3037bfead3b2SJayamohan Kallickal 
3038bfead3b2SJayamohan Kallickal 	q = &phba->ctrl.mcc_obj.cq;
3039bfead3b2SJayamohan Kallickal 	if (q->created)
3040bfead3b2SJayamohan Kallickal 		beiscsi_cmd_q_destroy(ctrl, q, QTYPE_CQ);
3041bfead3b2SJayamohan Kallickal 	be_queue_free(phba, q);
3042bfead3b2SJayamohan Kallickal }
3043bfead3b2SJayamohan Kallickal 
30446733b39aSJayamohan Kallickal static void hwi_cleanup(struct beiscsi_hba *phba)
30456733b39aSJayamohan Kallickal {
30466733b39aSJayamohan Kallickal 	struct be_queue_info *q;
30476733b39aSJayamohan Kallickal 	struct be_ctrl_info *ctrl = &phba->ctrl;
30486733b39aSJayamohan Kallickal 	struct hwi_controller *phwi_ctrlr;
30496733b39aSJayamohan Kallickal 	struct hwi_context_memory *phwi_context;
3050bfead3b2SJayamohan Kallickal 	int i, eq_num;
30516733b39aSJayamohan Kallickal 
30526733b39aSJayamohan Kallickal 	phwi_ctrlr = phba->phwi_ctrlr;
30536733b39aSJayamohan Kallickal 	phwi_context = phwi_ctrlr->phwi_ctxt;
30546733b39aSJayamohan Kallickal 	for (i = 0; i < phba->params.cxns_per_ctrl; i++) {
30556733b39aSJayamohan Kallickal 		q = &phwi_context->be_wrbq[i];
30566733b39aSJayamohan Kallickal 		if (q->created)
30576733b39aSJayamohan Kallickal 			beiscsi_cmd_q_destroy(ctrl, q, QTYPE_WRBQ);
30586733b39aSJayamohan Kallickal 	}
30596733b39aSJayamohan Kallickal 	free_wrb_handles(phba);
30606733b39aSJayamohan Kallickal 
30616733b39aSJayamohan Kallickal 	q = &phwi_context->be_def_hdrq;
30626733b39aSJayamohan Kallickal 	if (q->created)
30636733b39aSJayamohan Kallickal 		beiscsi_cmd_q_destroy(ctrl, q, QTYPE_DPDUQ);
30646733b39aSJayamohan Kallickal 
30656733b39aSJayamohan Kallickal 	q = &phwi_context->be_def_dataq;
30666733b39aSJayamohan Kallickal 	if (q->created)
30676733b39aSJayamohan Kallickal 		beiscsi_cmd_q_destroy(ctrl, q, QTYPE_DPDUQ);
30686733b39aSJayamohan Kallickal 
30696733b39aSJayamohan Kallickal 	beiscsi_cmd_q_destroy(ctrl, NULL, QTYPE_SGL);
30706733b39aSJayamohan Kallickal 
3071bfead3b2SJayamohan Kallickal 	for (i = 0; i < (phba->num_cpus); i++) {
3072bfead3b2SJayamohan Kallickal 		q = &phwi_context->be_cq[i];
30736733b39aSJayamohan Kallickal 		if (q->created)
30746733b39aSJayamohan Kallickal 			beiscsi_cmd_q_destroy(ctrl, q, QTYPE_CQ);
3075bfead3b2SJayamohan Kallickal 	}
3076bfead3b2SJayamohan Kallickal 	if (phba->msix_enabled)
3077bfead3b2SJayamohan Kallickal 		eq_num = 1;
3078bfead3b2SJayamohan Kallickal 	else
3079bfead3b2SJayamohan Kallickal 		eq_num = 0;
3080bfead3b2SJayamohan Kallickal 	for (i = 0; i < (phba->num_cpus + eq_num); i++) {
3081bfead3b2SJayamohan Kallickal 		q = &phwi_context->be_eq[i].q;
30826733b39aSJayamohan Kallickal 		if (q->created)
30836733b39aSJayamohan Kallickal 			beiscsi_cmd_q_destroy(ctrl, q, QTYPE_EQ);
30846733b39aSJayamohan Kallickal 	}
3085bfead3b2SJayamohan Kallickal 	be_mcc_queues_destroy(phba);
3086bfead3b2SJayamohan Kallickal }
3087bfead3b2SJayamohan Kallickal 
3088bfead3b2SJayamohan Kallickal static int be_mcc_queues_create(struct beiscsi_hba *phba,
3089bfead3b2SJayamohan Kallickal 				struct hwi_context_memory *phwi_context)
3090bfead3b2SJayamohan Kallickal {
3091bfead3b2SJayamohan Kallickal 	struct be_queue_info *q, *cq;
3092bfead3b2SJayamohan Kallickal 	struct be_ctrl_info *ctrl = &phba->ctrl;
3093bfead3b2SJayamohan Kallickal 
3094bfead3b2SJayamohan Kallickal 	/* Alloc MCC compl queue */
3095bfead3b2SJayamohan Kallickal 	cq = &phba->ctrl.mcc_obj.cq;
3096bfead3b2SJayamohan Kallickal 	if (be_queue_alloc(phba, cq, MCC_CQ_LEN,
3097bfead3b2SJayamohan Kallickal 			sizeof(struct be_mcc_compl)))
3098bfead3b2SJayamohan Kallickal 		goto err;
3099bfead3b2SJayamohan Kallickal 	/* Ask BE to create MCC compl queue; */
3100bfead3b2SJayamohan Kallickal 	if (phba->msix_enabled) {
3101bfead3b2SJayamohan Kallickal 		if (beiscsi_cmd_cq_create(ctrl, cq, &phwi_context->be_eq
3102bfead3b2SJayamohan Kallickal 					 [phba->num_cpus].q, false, true, 0))
3103bfead3b2SJayamohan Kallickal 		goto mcc_cq_free;
3104bfead3b2SJayamohan Kallickal 	} else {
3105bfead3b2SJayamohan Kallickal 		if (beiscsi_cmd_cq_create(ctrl, cq, &phwi_context->be_eq[0].q,
3106bfead3b2SJayamohan Kallickal 					  false, true, 0))
3107bfead3b2SJayamohan Kallickal 		goto mcc_cq_free;
3108bfead3b2SJayamohan Kallickal 	}
3109bfead3b2SJayamohan Kallickal 
3110bfead3b2SJayamohan Kallickal 	/* Alloc MCC queue */
3111bfead3b2SJayamohan Kallickal 	q = &phba->ctrl.mcc_obj.q;
3112bfead3b2SJayamohan Kallickal 	if (be_queue_alloc(phba, q, MCC_Q_LEN, sizeof(struct be_mcc_wrb)))
3113bfead3b2SJayamohan Kallickal 		goto mcc_cq_destroy;
3114bfead3b2SJayamohan Kallickal 
3115bfead3b2SJayamohan Kallickal 	/* Ask BE to create MCC queue */
311635e66019SJayamohan Kallickal 	if (beiscsi_cmd_mccq_create(phba, q, cq))
3117bfead3b2SJayamohan Kallickal 		goto mcc_q_free;
3118bfead3b2SJayamohan Kallickal 
3119bfead3b2SJayamohan Kallickal 	return 0;
3120bfead3b2SJayamohan Kallickal 
3121bfead3b2SJayamohan Kallickal mcc_q_free:
3122bfead3b2SJayamohan Kallickal 	be_queue_free(phba, q);
3123bfead3b2SJayamohan Kallickal mcc_cq_destroy:
3124bfead3b2SJayamohan Kallickal 	beiscsi_cmd_q_destroy(ctrl, cq, QTYPE_CQ);
3125bfead3b2SJayamohan Kallickal mcc_cq_free:
3126bfead3b2SJayamohan Kallickal 	be_queue_free(phba, cq);
3127bfead3b2SJayamohan Kallickal err:
3128d3ad2bb3SJayamohan Kallickal 	return -ENOMEM;
3129bfead3b2SJayamohan Kallickal }
3130bfead3b2SJayamohan Kallickal 
3131bfead3b2SJayamohan Kallickal static int find_num_cpus(void)
3132bfead3b2SJayamohan Kallickal {
3133bfead3b2SJayamohan Kallickal 	int  num_cpus = 0;
3134bfead3b2SJayamohan Kallickal 
3135bfead3b2SJayamohan Kallickal 	num_cpus = num_online_cpus();
3136bfead3b2SJayamohan Kallickal 	if (num_cpus >= MAX_CPUS)
3137bfead3b2SJayamohan Kallickal 		num_cpus = MAX_CPUS - 1;
3138bfead3b2SJayamohan Kallickal 
3139bfead3b2SJayamohan Kallickal 	SE_DEBUG(DBG_LVL_8, "num_cpus = %d\n", num_cpus);
3140bfead3b2SJayamohan Kallickal 	return num_cpus;
3141bfead3b2SJayamohan Kallickal }
31426733b39aSJayamohan Kallickal 
31436733b39aSJayamohan Kallickal static int hwi_init_port(struct beiscsi_hba *phba)
31446733b39aSJayamohan Kallickal {
31456733b39aSJayamohan Kallickal 	struct hwi_controller *phwi_ctrlr;
31466733b39aSJayamohan Kallickal 	struct hwi_context_memory *phwi_context;
31476733b39aSJayamohan Kallickal 	unsigned int def_pdu_ring_sz;
31486733b39aSJayamohan Kallickal 	struct be_ctrl_info *ctrl = &phba->ctrl;
31496733b39aSJayamohan Kallickal 	int status;
31506733b39aSJayamohan Kallickal 
31516733b39aSJayamohan Kallickal 	def_pdu_ring_sz =
31526733b39aSJayamohan Kallickal 		phba->params.asyncpdus_per_ctrl * sizeof(struct phys_addr);
31536733b39aSJayamohan Kallickal 	phwi_ctrlr = phba->phwi_ctrlr;
31546733b39aSJayamohan Kallickal 	phwi_context = phwi_ctrlr->phwi_ctxt;
3155bfead3b2SJayamohan Kallickal 	phwi_context->max_eqd = 0;
3156bfead3b2SJayamohan Kallickal 	phwi_context->min_eqd = 0;
3157bfead3b2SJayamohan Kallickal 	phwi_context->cur_eqd = 64;
31586733b39aSJayamohan Kallickal 	be_cmd_fw_initialize(&phba->ctrl);
3159bfead3b2SJayamohan Kallickal 
3160bfead3b2SJayamohan Kallickal 	status = beiscsi_create_eqs(phba, phwi_context);
31616733b39aSJayamohan Kallickal 	if (status != 0) {
31626733b39aSJayamohan Kallickal 		shost_printk(KERN_ERR, phba->shost, "EQ not created\n");
31636733b39aSJayamohan Kallickal 		goto error;
31646733b39aSJayamohan Kallickal 	}
31656733b39aSJayamohan Kallickal 
3166bfead3b2SJayamohan Kallickal 	status = be_mcc_queues_create(phba, phwi_context);
3167bfead3b2SJayamohan Kallickal 	if (status != 0)
3168bfead3b2SJayamohan Kallickal 		goto error;
3169bfead3b2SJayamohan Kallickal 
3170bfead3b2SJayamohan Kallickal 	status = mgmt_check_supported_fw(ctrl, phba);
31716733b39aSJayamohan Kallickal 	if (status != 0) {
31726733b39aSJayamohan Kallickal 		shost_printk(KERN_ERR, phba->shost,
31736733b39aSJayamohan Kallickal 			     "Unsupported fw version\n");
31746733b39aSJayamohan Kallickal 		goto error;
31756733b39aSJayamohan Kallickal 	}
31766733b39aSJayamohan Kallickal 
3177bfead3b2SJayamohan Kallickal 	status = beiscsi_create_cqs(phba, phwi_context);
31786733b39aSJayamohan Kallickal 	if (status != 0) {
31796733b39aSJayamohan Kallickal 		shost_printk(KERN_ERR, phba->shost, "CQ not created\n");
31806733b39aSJayamohan Kallickal 		goto error;
31816733b39aSJayamohan Kallickal 	}
31826733b39aSJayamohan Kallickal 
31836733b39aSJayamohan Kallickal 	status = beiscsi_create_def_hdr(phba, phwi_context, phwi_ctrlr,
31846733b39aSJayamohan Kallickal 					def_pdu_ring_sz);
31856733b39aSJayamohan Kallickal 	if (status != 0) {
31866733b39aSJayamohan Kallickal 		shost_printk(KERN_ERR, phba->shost,
31876733b39aSJayamohan Kallickal 			     "Default Header not created\n");
31886733b39aSJayamohan Kallickal 		goto error;
31896733b39aSJayamohan Kallickal 	}
31906733b39aSJayamohan Kallickal 
31916733b39aSJayamohan Kallickal 	status = beiscsi_create_def_data(phba, phwi_context,
31926733b39aSJayamohan Kallickal 					 phwi_ctrlr, def_pdu_ring_sz);
31936733b39aSJayamohan Kallickal 	if (status != 0) {
31946733b39aSJayamohan Kallickal 		shost_printk(KERN_ERR, phba->shost,
31956733b39aSJayamohan Kallickal 			     "Default Data not created\n");
31966733b39aSJayamohan Kallickal 		goto error;
31976733b39aSJayamohan Kallickal 	}
31986733b39aSJayamohan Kallickal 
31996733b39aSJayamohan Kallickal 	status = beiscsi_post_pages(phba);
32006733b39aSJayamohan Kallickal 	if (status != 0) {
32016733b39aSJayamohan Kallickal 		shost_printk(KERN_ERR, phba->shost, "Post SGL Pages Failed\n");
32026733b39aSJayamohan Kallickal 		goto error;
32036733b39aSJayamohan Kallickal 	}
32046733b39aSJayamohan Kallickal 
32056733b39aSJayamohan Kallickal 	status = beiscsi_create_wrb_rings(phba,	phwi_context, phwi_ctrlr);
32066733b39aSJayamohan Kallickal 	if (status != 0) {
32076733b39aSJayamohan Kallickal 		shost_printk(KERN_ERR, phba->shost,
32086733b39aSJayamohan Kallickal 			     "WRB Rings not created\n");
32096733b39aSJayamohan Kallickal 		goto error;
32106733b39aSJayamohan Kallickal 	}
32116733b39aSJayamohan Kallickal 
32126733b39aSJayamohan Kallickal 	SE_DEBUG(DBG_LVL_8, "hwi_init_port success\n");
32136733b39aSJayamohan Kallickal 	return 0;
32146733b39aSJayamohan Kallickal 
32156733b39aSJayamohan Kallickal error:
32166733b39aSJayamohan Kallickal 	shost_printk(KERN_ERR, phba->shost, "hwi_init_port failed");
32176733b39aSJayamohan Kallickal 	hwi_cleanup(phba);
32186733b39aSJayamohan Kallickal 	return -ENOMEM;
32196733b39aSJayamohan Kallickal }
32206733b39aSJayamohan Kallickal 
32216733b39aSJayamohan Kallickal static int hwi_init_controller(struct beiscsi_hba *phba)
32226733b39aSJayamohan Kallickal {
32236733b39aSJayamohan Kallickal 	struct hwi_controller *phwi_ctrlr;
32246733b39aSJayamohan Kallickal 
32256733b39aSJayamohan Kallickal 	phwi_ctrlr = phba->phwi_ctrlr;
32266733b39aSJayamohan Kallickal 	if (1 == phba->init_mem[HWI_MEM_ADDN_CONTEXT].num_elements) {
32276733b39aSJayamohan Kallickal 		phwi_ctrlr->phwi_ctxt = (struct hwi_context_memory *)phba->
32286733b39aSJayamohan Kallickal 		    init_mem[HWI_MEM_ADDN_CONTEXT].mem_array[0].virtual_address;
32296733b39aSJayamohan Kallickal 		SE_DEBUG(DBG_LVL_8, " phwi_ctrlr->phwi_ctxt=%p\n",
32306733b39aSJayamohan Kallickal 			 phwi_ctrlr->phwi_ctxt);
32316733b39aSJayamohan Kallickal 	} else {
32326733b39aSJayamohan Kallickal 		shost_printk(KERN_ERR, phba->shost,
32336733b39aSJayamohan Kallickal 			     "HWI_MEM_ADDN_CONTEXT is more than one element."
32346733b39aSJayamohan Kallickal 			     "Failing to load\n");
32356733b39aSJayamohan Kallickal 		return -ENOMEM;
32366733b39aSJayamohan Kallickal 	}
32376733b39aSJayamohan Kallickal 
32386733b39aSJayamohan Kallickal 	iscsi_init_global_templates(phba);
32396733b39aSJayamohan Kallickal 	beiscsi_init_wrb_handle(phba);
32406733b39aSJayamohan Kallickal 	hwi_init_async_pdu_ctx(phba);
32416733b39aSJayamohan Kallickal 	if (hwi_init_port(phba) != 0) {
32426733b39aSJayamohan Kallickal 		shost_printk(KERN_ERR, phba->shost,
32436733b39aSJayamohan Kallickal 			     "hwi_init_controller failed\n");
32446733b39aSJayamohan Kallickal 		return -ENOMEM;
32456733b39aSJayamohan Kallickal 	}
32466733b39aSJayamohan Kallickal 	return 0;
32476733b39aSJayamohan Kallickal }
32486733b39aSJayamohan Kallickal 
32496733b39aSJayamohan Kallickal static void beiscsi_free_mem(struct beiscsi_hba *phba)
32506733b39aSJayamohan Kallickal {
32516733b39aSJayamohan Kallickal 	struct be_mem_descriptor *mem_descr;
32526733b39aSJayamohan Kallickal 	int i, j;
32536733b39aSJayamohan Kallickal 
32546733b39aSJayamohan Kallickal 	mem_descr = phba->init_mem;
32556733b39aSJayamohan Kallickal 	i = 0;
32566733b39aSJayamohan Kallickal 	j = 0;
32576733b39aSJayamohan Kallickal 	for (i = 0; i < SE_MEM_MAX; i++) {
32586733b39aSJayamohan Kallickal 		for (j = mem_descr->num_elements; j > 0; j--) {
32596733b39aSJayamohan Kallickal 			pci_free_consistent(phba->pcidev,
32606733b39aSJayamohan Kallickal 			  mem_descr->mem_array[j - 1].size,
32616733b39aSJayamohan Kallickal 			  mem_descr->mem_array[j - 1].virtual_address,
3262457ff3b7SJayamohan Kallickal 			  (unsigned long)mem_descr->mem_array[j - 1].
3263457ff3b7SJayamohan Kallickal 			  bus_address.u.a64.address);
32646733b39aSJayamohan Kallickal 		}
32656733b39aSJayamohan Kallickal 		kfree(mem_descr->mem_array);
32666733b39aSJayamohan Kallickal 		mem_descr++;
32676733b39aSJayamohan Kallickal 	}
32686733b39aSJayamohan Kallickal 	kfree(phba->init_mem);
32696733b39aSJayamohan Kallickal 	kfree(phba->phwi_ctrlr);
32706733b39aSJayamohan Kallickal }
32716733b39aSJayamohan Kallickal 
32726733b39aSJayamohan Kallickal static int beiscsi_init_controller(struct beiscsi_hba *phba)
32736733b39aSJayamohan Kallickal {
32746733b39aSJayamohan Kallickal 	int ret = -ENOMEM;
32756733b39aSJayamohan Kallickal 
32766733b39aSJayamohan Kallickal 	ret = beiscsi_get_memory(phba);
32776733b39aSJayamohan Kallickal 	if (ret < 0) {
32786733b39aSJayamohan Kallickal 		shost_printk(KERN_ERR, phba->shost, "beiscsi_dev_probe -"
32796733b39aSJayamohan Kallickal 			     "Failed in beiscsi_alloc_memory\n");
32806733b39aSJayamohan Kallickal 		return ret;
32816733b39aSJayamohan Kallickal 	}
32826733b39aSJayamohan Kallickal 
32836733b39aSJayamohan Kallickal 	ret = hwi_init_controller(phba);
32846733b39aSJayamohan Kallickal 	if (ret)
32856733b39aSJayamohan Kallickal 		goto free_init;
32866733b39aSJayamohan Kallickal 	SE_DEBUG(DBG_LVL_8, "Return success from beiscsi_init_controller");
32876733b39aSJayamohan Kallickal 	return 0;
32886733b39aSJayamohan Kallickal 
32896733b39aSJayamohan Kallickal free_init:
32906733b39aSJayamohan Kallickal 	beiscsi_free_mem(phba);
32916733b39aSJayamohan Kallickal 	return -ENOMEM;
32926733b39aSJayamohan Kallickal }
32936733b39aSJayamohan Kallickal 
32946733b39aSJayamohan Kallickal static int beiscsi_init_sgl_handle(struct beiscsi_hba *phba)
32956733b39aSJayamohan Kallickal {
32966733b39aSJayamohan Kallickal 	struct be_mem_descriptor *mem_descr_sglh, *mem_descr_sg;
32976733b39aSJayamohan Kallickal 	struct sgl_handle *psgl_handle;
32986733b39aSJayamohan Kallickal 	struct iscsi_sge *pfrag;
32996733b39aSJayamohan Kallickal 	unsigned int arr_index, i, idx;
33006733b39aSJayamohan Kallickal 
33016733b39aSJayamohan Kallickal 	phba->io_sgl_hndl_avbl = 0;
33026733b39aSJayamohan Kallickal 	phba->eh_sgl_hndl_avbl = 0;
3303bfead3b2SJayamohan Kallickal 
33046733b39aSJayamohan Kallickal 	mem_descr_sglh = phba->init_mem;
33056733b39aSJayamohan Kallickal 	mem_descr_sglh += HWI_MEM_SGLH;
33066733b39aSJayamohan Kallickal 	if (1 == mem_descr_sglh->num_elements) {
33076733b39aSJayamohan Kallickal 		phba->io_sgl_hndl_base = kzalloc(sizeof(struct sgl_handle *) *
33086733b39aSJayamohan Kallickal 						 phba->params.ios_per_ctrl,
33096733b39aSJayamohan Kallickal 						 GFP_KERNEL);
33106733b39aSJayamohan Kallickal 		if (!phba->io_sgl_hndl_base) {
33116733b39aSJayamohan Kallickal 			shost_printk(KERN_ERR, phba->shost,
33126733b39aSJayamohan Kallickal 				     "Mem Alloc Failed. Failing to load\n");
33136733b39aSJayamohan Kallickal 			return -ENOMEM;
33146733b39aSJayamohan Kallickal 		}
33156733b39aSJayamohan Kallickal 		phba->eh_sgl_hndl_base = kzalloc(sizeof(struct sgl_handle *) *
33166733b39aSJayamohan Kallickal 						 (phba->params.icds_per_ctrl -
33176733b39aSJayamohan Kallickal 						 phba->params.ios_per_ctrl),
33186733b39aSJayamohan Kallickal 						 GFP_KERNEL);
33196733b39aSJayamohan Kallickal 		if (!phba->eh_sgl_hndl_base) {
33206733b39aSJayamohan Kallickal 			kfree(phba->io_sgl_hndl_base);
33216733b39aSJayamohan Kallickal 			shost_printk(KERN_ERR, phba->shost,
33226733b39aSJayamohan Kallickal 				     "Mem Alloc Failed. Failing to load\n");
33236733b39aSJayamohan Kallickal 			return -ENOMEM;
33246733b39aSJayamohan Kallickal 		}
33256733b39aSJayamohan Kallickal 	} else {
33266733b39aSJayamohan Kallickal 		shost_printk(KERN_ERR, phba->shost,
33276733b39aSJayamohan Kallickal 			     "HWI_MEM_SGLH is more than one element."
33286733b39aSJayamohan Kallickal 			     "Failing to load\n");
33296733b39aSJayamohan Kallickal 		return -ENOMEM;
33306733b39aSJayamohan Kallickal 	}
33316733b39aSJayamohan Kallickal 
33326733b39aSJayamohan Kallickal 	arr_index = 0;
33336733b39aSJayamohan Kallickal 	idx = 0;
33346733b39aSJayamohan Kallickal 	while (idx < mem_descr_sglh->num_elements) {
33356733b39aSJayamohan Kallickal 		psgl_handle = mem_descr_sglh->mem_array[idx].virtual_address;
33366733b39aSJayamohan Kallickal 
33376733b39aSJayamohan Kallickal 		for (i = 0; i < (mem_descr_sglh->mem_array[idx].size /
33386733b39aSJayamohan Kallickal 		      sizeof(struct sgl_handle)); i++) {
33396733b39aSJayamohan Kallickal 			if (arr_index < phba->params.ios_per_ctrl) {
33406733b39aSJayamohan Kallickal 				phba->io_sgl_hndl_base[arr_index] = psgl_handle;
33416733b39aSJayamohan Kallickal 				phba->io_sgl_hndl_avbl++;
33426733b39aSJayamohan Kallickal 				arr_index++;
33436733b39aSJayamohan Kallickal 			} else {
33446733b39aSJayamohan Kallickal 				phba->eh_sgl_hndl_base[arr_index -
33456733b39aSJayamohan Kallickal 					phba->params.ios_per_ctrl] =
33466733b39aSJayamohan Kallickal 								psgl_handle;
33476733b39aSJayamohan Kallickal 				arr_index++;
33486733b39aSJayamohan Kallickal 				phba->eh_sgl_hndl_avbl++;
33496733b39aSJayamohan Kallickal 			}
33506733b39aSJayamohan Kallickal 			psgl_handle++;
33516733b39aSJayamohan Kallickal 		}
33526733b39aSJayamohan Kallickal 		idx++;
33536733b39aSJayamohan Kallickal 	}
33546733b39aSJayamohan Kallickal 	SE_DEBUG(DBG_LVL_8,
33556733b39aSJayamohan Kallickal 		 "phba->io_sgl_hndl_avbl=%d"
33566733b39aSJayamohan Kallickal 		 "phba->eh_sgl_hndl_avbl=%d\n",
33576733b39aSJayamohan Kallickal 		 phba->io_sgl_hndl_avbl,
33586733b39aSJayamohan Kallickal 		 phba->eh_sgl_hndl_avbl);
33596733b39aSJayamohan Kallickal 	mem_descr_sg = phba->init_mem;
33606733b39aSJayamohan Kallickal 	mem_descr_sg += HWI_MEM_SGE;
33616733b39aSJayamohan Kallickal 	SE_DEBUG(DBG_LVL_8, "\n mem_descr_sg->num_elements=%d\n",
33626733b39aSJayamohan Kallickal 		 mem_descr_sg->num_elements);
33636733b39aSJayamohan Kallickal 	arr_index = 0;
33646733b39aSJayamohan Kallickal 	idx = 0;
33656733b39aSJayamohan Kallickal 	while (idx < mem_descr_sg->num_elements) {
33666733b39aSJayamohan Kallickal 		pfrag = mem_descr_sg->mem_array[idx].virtual_address;
33676733b39aSJayamohan Kallickal 
33686733b39aSJayamohan Kallickal 		for (i = 0;
33696733b39aSJayamohan Kallickal 		     i < (mem_descr_sg->mem_array[idx].size) /
33706733b39aSJayamohan Kallickal 		     (sizeof(struct iscsi_sge) * phba->params.num_sge_per_io);
33716733b39aSJayamohan Kallickal 		     i++) {
33726733b39aSJayamohan Kallickal 			if (arr_index < phba->params.ios_per_ctrl)
33736733b39aSJayamohan Kallickal 				psgl_handle = phba->io_sgl_hndl_base[arr_index];
33746733b39aSJayamohan Kallickal 			else
33756733b39aSJayamohan Kallickal 				psgl_handle = phba->eh_sgl_hndl_base[arr_index -
33766733b39aSJayamohan Kallickal 						phba->params.ios_per_ctrl];
33776733b39aSJayamohan Kallickal 			psgl_handle->pfrag = pfrag;
33786733b39aSJayamohan Kallickal 			AMAP_SET_BITS(struct amap_iscsi_sge, addr_hi, pfrag, 0);
33796733b39aSJayamohan Kallickal 			AMAP_SET_BITS(struct amap_iscsi_sge, addr_lo, pfrag, 0);
33806733b39aSJayamohan Kallickal 			pfrag += phba->params.num_sge_per_io;
33816733b39aSJayamohan Kallickal 			psgl_handle->sgl_index =
33827da50879SJayamohan Kallickal 				phba->fw_config.iscsi_icd_start + arr_index++;
33836733b39aSJayamohan Kallickal 		}
33846733b39aSJayamohan Kallickal 		idx++;
33856733b39aSJayamohan Kallickal 	}
33866733b39aSJayamohan Kallickal 	phba->io_sgl_free_index = 0;
33876733b39aSJayamohan Kallickal 	phba->io_sgl_alloc_index = 0;
33886733b39aSJayamohan Kallickal 	phba->eh_sgl_free_index = 0;
33896733b39aSJayamohan Kallickal 	phba->eh_sgl_alloc_index = 0;
33906733b39aSJayamohan Kallickal 	return 0;
33916733b39aSJayamohan Kallickal }
33926733b39aSJayamohan Kallickal 
33936733b39aSJayamohan Kallickal static int hba_setup_cid_tbls(struct beiscsi_hba *phba)
33946733b39aSJayamohan Kallickal {
33956733b39aSJayamohan Kallickal 	int i, new_cid;
33966733b39aSJayamohan Kallickal 
3397c2462288SJayamohan Kallickal 	phba->cid_array = kzalloc(sizeof(void *) * phba->params.cxns_per_ctrl,
33986733b39aSJayamohan Kallickal 				  GFP_KERNEL);
33996733b39aSJayamohan Kallickal 	if (!phba->cid_array) {
34006733b39aSJayamohan Kallickal 		shost_printk(KERN_ERR, phba->shost,
34016733b39aSJayamohan Kallickal 			     "Failed to allocate memory in "
34026733b39aSJayamohan Kallickal 			     "hba_setup_cid_tbls\n");
34036733b39aSJayamohan Kallickal 		return -ENOMEM;
34046733b39aSJayamohan Kallickal 	}
3405c2462288SJayamohan Kallickal 	phba->ep_array = kzalloc(sizeof(struct iscsi_endpoint *) *
34066733b39aSJayamohan Kallickal 				 phba->params.cxns_per_ctrl * 2, GFP_KERNEL);
34076733b39aSJayamohan Kallickal 	if (!phba->ep_array) {
34086733b39aSJayamohan Kallickal 		shost_printk(KERN_ERR, phba->shost,
34096733b39aSJayamohan Kallickal 			     "Failed to allocate memory in "
34106733b39aSJayamohan Kallickal 			     "hba_setup_cid_tbls\n");
34116733b39aSJayamohan Kallickal 		kfree(phba->cid_array);
34126733b39aSJayamohan Kallickal 		return -ENOMEM;
34136733b39aSJayamohan Kallickal 	}
34147da50879SJayamohan Kallickal 	new_cid = phba->fw_config.iscsi_cid_start;
34156733b39aSJayamohan Kallickal 	for (i = 0; i < phba->params.cxns_per_ctrl; i++) {
34166733b39aSJayamohan Kallickal 		phba->cid_array[i] = new_cid;
34176733b39aSJayamohan Kallickal 		new_cid += 2;
34186733b39aSJayamohan Kallickal 	}
34196733b39aSJayamohan Kallickal 	phba->avlbl_cids = phba->params.cxns_per_ctrl;
34206733b39aSJayamohan Kallickal 	return 0;
34216733b39aSJayamohan Kallickal }
34226733b39aSJayamohan Kallickal 
3423238f6b72SJayamohan Kallickal static void hwi_enable_intr(struct beiscsi_hba *phba)
34246733b39aSJayamohan Kallickal {
34256733b39aSJayamohan Kallickal 	struct be_ctrl_info *ctrl = &phba->ctrl;
34266733b39aSJayamohan Kallickal 	struct hwi_controller *phwi_ctrlr;
34276733b39aSJayamohan Kallickal 	struct hwi_context_memory *phwi_context;
34286733b39aSJayamohan Kallickal 	struct be_queue_info *eq;
34296733b39aSJayamohan Kallickal 	u8 __iomem *addr;
3430bfead3b2SJayamohan Kallickal 	u32 reg, i;
34316733b39aSJayamohan Kallickal 	u32 enabled;
34326733b39aSJayamohan Kallickal 
34336733b39aSJayamohan Kallickal 	phwi_ctrlr = phba->phwi_ctrlr;
34346733b39aSJayamohan Kallickal 	phwi_context = phwi_ctrlr->phwi_ctxt;
34356733b39aSJayamohan Kallickal 
34366733b39aSJayamohan Kallickal 	addr = (u8 __iomem *) ((u8 __iomem *) ctrl->pcicfg +
34376733b39aSJayamohan Kallickal 			PCICFG_MEMBAR_CTRL_INT_CTRL_OFFSET);
34386733b39aSJayamohan Kallickal 	reg = ioread32(addr);
34396733b39aSJayamohan Kallickal 
34406733b39aSJayamohan Kallickal 	enabled = reg & MEMBAR_CTRL_INT_CTRL_HOSTINTR_MASK;
34416733b39aSJayamohan Kallickal 	if (!enabled) {
34426733b39aSJayamohan Kallickal 		reg |= MEMBAR_CTRL_INT_CTRL_HOSTINTR_MASK;
34436733b39aSJayamohan Kallickal 		SE_DEBUG(DBG_LVL_8, "reg =x%08x addr=%p\n", reg, addr);
34446733b39aSJayamohan Kallickal 		iowrite32(reg, addr);
3445665d6d94SJayamohan Kallickal 	}
3446665d6d94SJayamohan Kallickal 
3447c03af1aeSJayamohan Kallickal 	if (!phba->msix_enabled) {
3448c03af1aeSJayamohan Kallickal 		eq = &phwi_context->be_eq[0].q;
3449c03af1aeSJayamohan Kallickal 		SE_DEBUG(DBG_LVL_8, "eq->id=%d\n", eq->id);
3450c03af1aeSJayamohan Kallickal 		hwi_ring_eq_db(phba, eq->id, 0, 0, 1, 1);
3451c03af1aeSJayamohan Kallickal 	} else {
3452bfead3b2SJayamohan Kallickal 		for (i = 0; i <= phba->num_cpus; i++) {
3453bfead3b2SJayamohan Kallickal 			eq = &phwi_context->be_eq[i].q;
34546733b39aSJayamohan Kallickal 			SE_DEBUG(DBG_LVL_8, "eq->id=%d\n", eq->id);
34556733b39aSJayamohan Kallickal 			hwi_ring_eq_db(phba, eq->id, 0, 0, 1, 1);
3456bfead3b2SJayamohan Kallickal 		}
3457c03af1aeSJayamohan Kallickal 	}
3458c03af1aeSJayamohan Kallickal }
34596733b39aSJayamohan Kallickal 
34606733b39aSJayamohan Kallickal static void hwi_disable_intr(struct beiscsi_hba *phba)
34616733b39aSJayamohan Kallickal {
34626733b39aSJayamohan Kallickal 	struct be_ctrl_info *ctrl = &phba->ctrl;
34636733b39aSJayamohan Kallickal 
34646733b39aSJayamohan Kallickal 	u8 __iomem *addr = ctrl->pcicfg + PCICFG_MEMBAR_CTRL_INT_CTRL_OFFSET;
34656733b39aSJayamohan Kallickal 	u32 reg = ioread32(addr);
34666733b39aSJayamohan Kallickal 
34676733b39aSJayamohan Kallickal 	u32 enabled = reg & MEMBAR_CTRL_INT_CTRL_HOSTINTR_MASK;
34686733b39aSJayamohan Kallickal 	if (enabled) {
34696733b39aSJayamohan Kallickal 		reg &= ~MEMBAR_CTRL_INT_CTRL_HOSTINTR_MASK;
34706733b39aSJayamohan Kallickal 		iowrite32(reg, addr);
34716733b39aSJayamohan Kallickal 	} else
34726733b39aSJayamohan Kallickal 		shost_printk(KERN_WARNING, phba->shost,
34736733b39aSJayamohan Kallickal 			     "In hwi_disable_intr, Already Disabled\n");
34746733b39aSJayamohan Kallickal }
34756733b39aSJayamohan Kallickal 
3476c7acc5b8SJayamohan Kallickal static int beiscsi_get_boot_info(struct beiscsi_hba *phba)
3477c7acc5b8SJayamohan Kallickal {
3478c7acc5b8SJayamohan Kallickal 	struct be_cmd_resp_get_boot_target *boot_resp;
3479c7acc5b8SJayamohan Kallickal 	struct be_cmd_resp_get_session *session_resp;
3480c7acc5b8SJayamohan Kallickal 	struct be_mcc_wrb *wrb;
3481c7acc5b8SJayamohan Kallickal 	struct be_dma_mem nonemb_cmd;
3482c7acc5b8SJayamohan Kallickal 	unsigned int tag, wrb_num;
3483c7acc5b8SJayamohan Kallickal 	unsigned short status, extd_status;
3484c7acc5b8SJayamohan Kallickal 	struct be_queue_info *mccq = &phba->ctrl.mcc_obj.q;
3485f457a46fSMike Christie 	int ret = -ENOMEM;
3486c7acc5b8SJayamohan Kallickal 
3487c7acc5b8SJayamohan Kallickal 	tag = beiscsi_get_boot_target(phba);
3488c7acc5b8SJayamohan Kallickal 	if (!tag) {
3489c7acc5b8SJayamohan Kallickal 		SE_DEBUG(DBG_LVL_1, "be_cmd_get_mac_addr Failed\n");
3490c7acc5b8SJayamohan Kallickal 		return -EAGAIN;
3491c7acc5b8SJayamohan Kallickal 	} else
3492c7acc5b8SJayamohan Kallickal 		wait_event_interruptible(phba->ctrl.mcc_wait[tag],
3493c7acc5b8SJayamohan Kallickal 					 phba->ctrl.mcc_numtag[tag]);
3494c7acc5b8SJayamohan Kallickal 
3495c7acc5b8SJayamohan Kallickal 	wrb_num = (phba->ctrl.mcc_numtag[tag] & 0x00FF0000) >> 16;
3496c7acc5b8SJayamohan Kallickal 	extd_status = (phba->ctrl.mcc_numtag[tag] & 0x0000FF00) >> 8;
3497c7acc5b8SJayamohan Kallickal 	status = phba->ctrl.mcc_numtag[tag] & 0x000000FF;
3498c7acc5b8SJayamohan Kallickal 	if (status || extd_status) {
3499c7acc5b8SJayamohan Kallickal 		SE_DEBUG(DBG_LVL_1, "be_cmd_get_mac_addr Failed"
3500c7acc5b8SJayamohan Kallickal 				    " status = %d extd_status = %d\n",
3501c7acc5b8SJayamohan Kallickal 				    status, extd_status);
3502c7acc5b8SJayamohan Kallickal 		free_mcc_tag(&phba->ctrl, tag);
3503c7acc5b8SJayamohan Kallickal 		return -EBUSY;
3504c7acc5b8SJayamohan Kallickal 	}
3505c7acc5b8SJayamohan Kallickal 	wrb = queue_get_wrb(mccq, wrb_num);
3506c7acc5b8SJayamohan Kallickal 	free_mcc_tag(&phba->ctrl, tag);
3507c7acc5b8SJayamohan Kallickal 	boot_resp = embedded_payload(wrb);
3508c7acc5b8SJayamohan Kallickal 
3509c7acc5b8SJayamohan Kallickal 	if (boot_resp->boot_session_handle < 0) {
3510f457a46fSMike Christie 		shost_printk(KERN_INFO, phba->shost, "No Boot Session.\n");
3511c7acc5b8SJayamohan Kallickal 		return -ENXIO;
3512c7acc5b8SJayamohan Kallickal 	}
3513c7acc5b8SJayamohan Kallickal 
3514c7acc5b8SJayamohan Kallickal 	nonemb_cmd.va = pci_alloc_consistent(phba->ctrl.pdev,
3515c7acc5b8SJayamohan Kallickal 				sizeof(*session_resp),
3516c7acc5b8SJayamohan Kallickal 				&nonemb_cmd.dma);
3517c7acc5b8SJayamohan Kallickal 	if (nonemb_cmd.va == NULL) {
3518c7acc5b8SJayamohan Kallickal 		SE_DEBUG(DBG_LVL_1,
3519c7acc5b8SJayamohan Kallickal 			 "Failed to allocate memory for"
3520c7acc5b8SJayamohan Kallickal 			 "beiscsi_get_session_info\n");
3521c7acc5b8SJayamohan Kallickal 		return -ENOMEM;
3522c7acc5b8SJayamohan Kallickal 	}
3523c7acc5b8SJayamohan Kallickal 
3524c7acc5b8SJayamohan Kallickal 	memset(nonemb_cmd.va, 0, sizeof(*session_resp));
3525c7acc5b8SJayamohan Kallickal 	tag = beiscsi_get_session_info(phba,
3526c7acc5b8SJayamohan Kallickal 		boot_resp->boot_session_handle, &nonemb_cmd);
3527c7acc5b8SJayamohan Kallickal 	if (!tag) {
3528c7acc5b8SJayamohan Kallickal 		SE_DEBUG(DBG_LVL_1, "beiscsi_get_session_info"
3529c7acc5b8SJayamohan Kallickal 			" Failed\n");
3530c7acc5b8SJayamohan Kallickal 		goto boot_freemem;
3531c7acc5b8SJayamohan Kallickal 	} else
3532c7acc5b8SJayamohan Kallickal 		wait_event_interruptible(phba->ctrl.mcc_wait[tag],
3533c7acc5b8SJayamohan Kallickal 					 phba->ctrl.mcc_numtag[tag]);
3534c7acc5b8SJayamohan Kallickal 
3535c7acc5b8SJayamohan Kallickal 	wrb_num = (phba->ctrl.mcc_numtag[tag] & 0x00FF0000) >> 16;
3536c7acc5b8SJayamohan Kallickal 	extd_status = (phba->ctrl.mcc_numtag[tag] & 0x0000FF00) >> 8;
3537c7acc5b8SJayamohan Kallickal 	status = phba->ctrl.mcc_numtag[tag] & 0x000000FF;
3538c7acc5b8SJayamohan Kallickal 	if (status || extd_status) {
3539c7acc5b8SJayamohan Kallickal 		SE_DEBUG(DBG_LVL_1, "beiscsi_get_session_info Failed"
3540c7acc5b8SJayamohan Kallickal 				    " status = %d extd_status = %d\n",
3541c7acc5b8SJayamohan Kallickal 				    status, extd_status);
3542c7acc5b8SJayamohan Kallickal 		free_mcc_tag(&phba->ctrl, tag);
3543c7acc5b8SJayamohan Kallickal 		goto boot_freemem;
3544c7acc5b8SJayamohan Kallickal 	}
3545c7acc5b8SJayamohan Kallickal 	wrb = queue_get_wrb(mccq, wrb_num);
3546c7acc5b8SJayamohan Kallickal 	free_mcc_tag(&phba->ctrl, tag);
3547c7acc5b8SJayamohan Kallickal 	session_resp = nonemb_cmd.va ;
3548f457a46fSMike Christie 
3549c7acc5b8SJayamohan Kallickal 	memcpy(&phba->boot_sess, &session_resp->session_info,
3550c7acc5b8SJayamohan Kallickal 	       sizeof(struct mgmt_session_info));
3551f457a46fSMike Christie 	ret = 0;
3552f457a46fSMike Christie 
3553c7acc5b8SJayamohan Kallickal boot_freemem:
3554c7acc5b8SJayamohan Kallickal 	pci_free_consistent(phba->ctrl.pdev, nonemb_cmd.size,
3555c7acc5b8SJayamohan Kallickal 		    nonemb_cmd.va, nonemb_cmd.dma);
3556f457a46fSMike Christie 	return ret;
3557f457a46fSMike Christie }
3558f457a46fSMike Christie 
3559f457a46fSMike Christie static void beiscsi_boot_release(void *data)
3560f457a46fSMike Christie {
3561f457a46fSMike Christie 	struct beiscsi_hba *phba = data;
3562f457a46fSMike Christie 
3563f457a46fSMike Christie 	scsi_host_put(phba->shost);
3564f457a46fSMike Christie }
3565f457a46fSMike Christie 
3566f457a46fSMike Christie static int beiscsi_setup_boot_info(struct beiscsi_hba *phba)
3567f457a46fSMike Christie {
3568f457a46fSMike Christie 	struct iscsi_boot_kobj *boot_kobj;
3569f457a46fSMike Christie 
3570f457a46fSMike Christie 	/* get boot info using mgmt cmd */
3571f457a46fSMike Christie 	if (beiscsi_get_boot_info(phba))
3572f457a46fSMike Christie 		/* Try to see if we can carry on without this */
3573f457a46fSMike Christie 		return 0;
3574f457a46fSMike Christie 
3575f457a46fSMike Christie 	phba->boot_kset = iscsi_boot_create_host_kset(phba->shost->host_no);
3576f457a46fSMike Christie 	if (!phba->boot_kset)
3577f457a46fSMike Christie 		return -ENOMEM;
3578f457a46fSMike Christie 
3579f457a46fSMike Christie 	/* get a ref because the show function will ref the phba */
3580f457a46fSMike Christie 	if (!scsi_host_get(phba->shost))
3581f457a46fSMike Christie 		goto free_kset;
3582f457a46fSMike Christie 	boot_kobj = iscsi_boot_create_target(phba->boot_kset, 0, phba,
3583f457a46fSMike Christie 					     beiscsi_show_boot_tgt_info,
3584f457a46fSMike Christie 					     beiscsi_tgt_get_attr_visibility,
3585f457a46fSMike Christie 					     beiscsi_boot_release);
3586f457a46fSMike Christie 	if (!boot_kobj)
3587f457a46fSMike Christie 		goto put_shost;
3588f457a46fSMike Christie 
3589f457a46fSMike Christie 	if (!scsi_host_get(phba->shost))
3590f457a46fSMike Christie 		goto free_kset;
3591f457a46fSMike Christie 	boot_kobj = iscsi_boot_create_initiator(phba->boot_kset, 0, phba,
3592f457a46fSMike Christie 						beiscsi_show_boot_ini_info,
3593f457a46fSMike Christie 						beiscsi_ini_get_attr_visibility,
3594f457a46fSMike Christie 						beiscsi_boot_release);
3595f457a46fSMike Christie 	if (!boot_kobj)
3596f457a46fSMike Christie 		goto put_shost;
3597f457a46fSMike Christie 
3598f457a46fSMike Christie 	if (!scsi_host_get(phba->shost))
3599f457a46fSMike Christie 		goto free_kset;
3600f457a46fSMike Christie 	boot_kobj = iscsi_boot_create_ethernet(phba->boot_kset, 0, phba,
3601f457a46fSMike Christie 					       beiscsi_show_boot_eth_info,
3602f457a46fSMike Christie 					       beiscsi_eth_get_attr_visibility,
3603f457a46fSMike Christie 					       beiscsi_boot_release);
3604f457a46fSMike Christie 	if (!boot_kobj)
3605f457a46fSMike Christie 		goto put_shost;
3606f457a46fSMike Christie 	return 0;
3607f457a46fSMike Christie 
3608f457a46fSMike Christie put_shost:
3609f457a46fSMike Christie 	scsi_host_put(phba->shost);
3610f457a46fSMike Christie free_kset:
3611f457a46fSMike Christie 	iscsi_boot_destroy_kset(phba->boot_kset);
3612c7acc5b8SJayamohan Kallickal 	return -ENOMEM;
3613c7acc5b8SJayamohan Kallickal }
3614c7acc5b8SJayamohan Kallickal 
36156733b39aSJayamohan Kallickal static int beiscsi_init_port(struct beiscsi_hba *phba)
36166733b39aSJayamohan Kallickal {
36176733b39aSJayamohan Kallickal 	int ret;
36186733b39aSJayamohan Kallickal 
36196733b39aSJayamohan Kallickal 	ret = beiscsi_init_controller(phba);
36206733b39aSJayamohan Kallickal 	if (ret < 0) {
36216733b39aSJayamohan Kallickal 		shost_printk(KERN_ERR, phba->shost,
36226733b39aSJayamohan Kallickal 			     "beiscsi_dev_probe - Failed in"
36236733b39aSJayamohan Kallickal 			     "beiscsi_init_controller\n");
36246733b39aSJayamohan Kallickal 		return ret;
36256733b39aSJayamohan Kallickal 	}
36266733b39aSJayamohan Kallickal 	ret = beiscsi_init_sgl_handle(phba);
36276733b39aSJayamohan Kallickal 	if (ret < 0) {
36286733b39aSJayamohan Kallickal 		shost_printk(KERN_ERR, phba->shost,
36296733b39aSJayamohan Kallickal 			     "beiscsi_dev_probe - Failed in"
36306733b39aSJayamohan Kallickal 			     "beiscsi_init_sgl_handle\n");
36316733b39aSJayamohan Kallickal 		goto do_cleanup_ctrlr;
36326733b39aSJayamohan Kallickal 	}
36336733b39aSJayamohan Kallickal 
36346733b39aSJayamohan Kallickal 	if (hba_setup_cid_tbls(phba)) {
36356733b39aSJayamohan Kallickal 		shost_printk(KERN_ERR, phba->shost,
36366733b39aSJayamohan Kallickal 			     "Failed in hba_setup_cid_tbls\n");
36376733b39aSJayamohan Kallickal 		kfree(phba->io_sgl_hndl_base);
36386733b39aSJayamohan Kallickal 		kfree(phba->eh_sgl_hndl_base);
36396733b39aSJayamohan Kallickal 		goto do_cleanup_ctrlr;
36406733b39aSJayamohan Kallickal 	}
36416733b39aSJayamohan Kallickal 
36426733b39aSJayamohan Kallickal 	return ret;
36436733b39aSJayamohan Kallickal 
36446733b39aSJayamohan Kallickal do_cleanup_ctrlr:
36456733b39aSJayamohan Kallickal 	hwi_cleanup(phba);
36466733b39aSJayamohan Kallickal 	return ret;
36476733b39aSJayamohan Kallickal }
36486733b39aSJayamohan Kallickal 
36496733b39aSJayamohan Kallickal static void hwi_purge_eq(struct beiscsi_hba *phba)
36506733b39aSJayamohan Kallickal {
36516733b39aSJayamohan Kallickal 	struct hwi_controller *phwi_ctrlr;
36526733b39aSJayamohan Kallickal 	struct hwi_context_memory *phwi_context;
36536733b39aSJayamohan Kallickal 	struct be_queue_info *eq;
36546733b39aSJayamohan Kallickal 	struct be_eq_entry *eqe = NULL;
3655bfead3b2SJayamohan Kallickal 	int i, eq_msix;
3656756d29c8SJayamohan Kallickal 	unsigned int num_processed;
36576733b39aSJayamohan Kallickal 
36586733b39aSJayamohan Kallickal 	phwi_ctrlr = phba->phwi_ctrlr;
36596733b39aSJayamohan Kallickal 	phwi_context = phwi_ctrlr->phwi_ctxt;
3660bfead3b2SJayamohan Kallickal 	if (phba->msix_enabled)
3661bfead3b2SJayamohan Kallickal 		eq_msix = 1;
3662bfead3b2SJayamohan Kallickal 	else
3663bfead3b2SJayamohan Kallickal 		eq_msix = 0;
3664bfead3b2SJayamohan Kallickal 
3665bfead3b2SJayamohan Kallickal 	for (i = 0; i < (phba->num_cpus + eq_msix); i++) {
3666bfead3b2SJayamohan Kallickal 		eq = &phwi_context->be_eq[i].q;
36676733b39aSJayamohan Kallickal 		eqe = queue_tail_node(eq);
3668756d29c8SJayamohan Kallickal 		num_processed = 0;
36696733b39aSJayamohan Kallickal 		while (eqe->dw[offsetof(struct amap_eq_entry, valid) / 32]
36706733b39aSJayamohan Kallickal 					& EQE_VALID_MASK) {
36716733b39aSJayamohan Kallickal 			AMAP_SET_BITS(struct amap_eq_entry, valid, eqe, 0);
36726733b39aSJayamohan Kallickal 			queue_tail_inc(eq);
36736733b39aSJayamohan Kallickal 			eqe = queue_tail_node(eq);
3674756d29c8SJayamohan Kallickal 			num_processed++;
36756733b39aSJayamohan Kallickal 		}
3676756d29c8SJayamohan Kallickal 
3677756d29c8SJayamohan Kallickal 		if (num_processed)
3678756d29c8SJayamohan Kallickal 			hwi_ring_eq_db(phba, eq->id, 1,	num_processed, 1, 1);
36796733b39aSJayamohan Kallickal 	}
3680bfead3b2SJayamohan Kallickal }
36816733b39aSJayamohan Kallickal 
36826733b39aSJayamohan Kallickal static void beiscsi_clean_port(struct beiscsi_hba *phba)
36836733b39aSJayamohan Kallickal {
368403a12310SJayamohan Kallickal 	int mgmt_status;
36856733b39aSJayamohan Kallickal 
36866733b39aSJayamohan Kallickal 	mgmt_status = mgmt_epfw_cleanup(phba, CMD_CONNECTION_CHUTE_0);
36876733b39aSJayamohan Kallickal 	if (mgmt_status)
36886733b39aSJayamohan Kallickal 		shost_printk(KERN_WARNING, phba->shost,
36896733b39aSJayamohan Kallickal 			     "mgmt_epfw_cleanup FAILED\n");
3690756d29c8SJayamohan Kallickal 
36916733b39aSJayamohan Kallickal 	hwi_purge_eq(phba);
3692756d29c8SJayamohan Kallickal 	hwi_cleanup(phba);
36936733b39aSJayamohan Kallickal 	kfree(phba->io_sgl_hndl_base);
36946733b39aSJayamohan Kallickal 	kfree(phba->eh_sgl_hndl_base);
36956733b39aSJayamohan Kallickal 	kfree(phba->cid_array);
36966733b39aSJayamohan Kallickal 	kfree(phba->ep_array);
36976733b39aSJayamohan Kallickal }
36986733b39aSJayamohan Kallickal 
36996733b39aSJayamohan Kallickal void
37006733b39aSJayamohan Kallickal beiscsi_offload_connection(struct beiscsi_conn *beiscsi_conn,
37016733b39aSJayamohan Kallickal 			   struct beiscsi_offload_params *params)
37026733b39aSJayamohan Kallickal {
37036733b39aSJayamohan Kallickal 	struct wrb_handle *pwrb_handle;
37046733b39aSJayamohan Kallickal 	struct iscsi_target_context_update_wrb *pwrb = NULL;
37056733b39aSJayamohan Kallickal 	struct be_mem_descriptor *mem_descr;
37066733b39aSJayamohan Kallickal 	struct beiscsi_hba *phba = beiscsi_conn->phba;
37076733b39aSJayamohan Kallickal 	u32 doorbell = 0;
37086733b39aSJayamohan Kallickal 
37096733b39aSJayamohan Kallickal 	/*
37106733b39aSJayamohan Kallickal 	 * We can always use 0 here because it is reserved by libiscsi for
37116733b39aSJayamohan Kallickal 	 * login/startup related tasks.
37126733b39aSJayamohan Kallickal 	 */
37137da50879SJayamohan Kallickal 	pwrb_handle = alloc_wrb_handle(phba, (beiscsi_conn->beiscsi_conn_cid -
3714d5431488SJayamohan Kallickal 				       phba->fw_config.iscsi_cid_start));
37156733b39aSJayamohan Kallickal 	pwrb = (struct iscsi_target_context_update_wrb *)pwrb_handle->pwrb;
37166733b39aSJayamohan Kallickal 	memset(pwrb, 0, sizeof(*pwrb));
37176733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb,
37186733b39aSJayamohan Kallickal 		      max_burst_length, pwrb, params->dw[offsetof
37196733b39aSJayamohan Kallickal 		      (struct amap_beiscsi_offload_params,
37206733b39aSJayamohan Kallickal 		      max_burst_length) / 32]);
37216733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb,
37226733b39aSJayamohan Kallickal 		      max_send_data_segment_length, pwrb,
37236733b39aSJayamohan Kallickal 		      params->dw[offsetof(struct amap_beiscsi_offload_params,
37246733b39aSJayamohan Kallickal 		      max_send_data_segment_length) / 32]);
37256733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb,
37266733b39aSJayamohan Kallickal 		      first_burst_length,
37276733b39aSJayamohan Kallickal 		      pwrb,
37286733b39aSJayamohan Kallickal 		      params->dw[offsetof(struct amap_beiscsi_offload_params,
37296733b39aSJayamohan Kallickal 		      first_burst_length) / 32]);
37306733b39aSJayamohan Kallickal 
37316733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, erl, pwrb,
37326733b39aSJayamohan Kallickal 		      (params->dw[offsetof(struct amap_beiscsi_offload_params,
37336733b39aSJayamohan Kallickal 		      erl) / 32] & OFFLD_PARAMS_ERL));
37346733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, dde, pwrb,
37356733b39aSJayamohan Kallickal 		      (params->dw[offsetof(struct amap_beiscsi_offload_params,
37366733b39aSJayamohan Kallickal 		      dde) / 32] & OFFLD_PARAMS_DDE) >> 2);
37376733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, hde, pwrb,
37386733b39aSJayamohan Kallickal 		      (params->dw[offsetof(struct amap_beiscsi_offload_params,
37396733b39aSJayamohan Kallickal 		      hde) / 32] & OFFLD_PARAMS_HDE) >> 3);
37406733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, ir2t, pwrb,
37416733b39aSJayamohan Kallickal 		      (params->dw[offsetof(struct amap_beiscsi_offload_params,
37426733b39aSJayamohan Kallickal 		      ir2t) / 32] & OFFLD_PARAMS_IR2T) >> 4);
37436733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, imd, pwrb,
37446733b39aSJayamohan Kallickal 		      (params->dw[offsetof(struct amap_beiscsi_offload_params,
37456733b39aSJayamohan Kallickal 		       imd) / 32] & OFFLD_PARAMS_IMD) >> 5);
37466733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, stat_sn,
37476733b39aSJayamohan Kallickal 		      pwrb,
37486733b39aSJayamohan Kallickal 		      (params->dw[offsetof(struct amap_beiscsi_offload_params,
37496733b39aSJayamohan Kallickal 		      exp_statsn) / 32] + 1));
37506733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, type, pwrb,
37516733b39aSJayamohan Kallickal 		      0x7);
37526733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, wrb_idx,
37536733b39aSJayamohan Kallickal 		      pwrb, pwrb_handle->wrb_index);
37546733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, ptr2nextwrb,
37556733b39aSJayamohan Kallickal 		      pwrb, pwrb_handle->nxt_wrb_index);
37566733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb,
37576733b39aSJayamohan Kallickal 			session_state, pwrb, 0);
37586733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, compltonack,
37596733b39aSJayamohan Kallickal 		      pwrb, 1);
37606733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, notpredblq,
37616733b39aSJayamohan Kallickal 		      pwrb, 0);
37626733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, mode, pwrb,
37636733b39aSJayamohan Kallickal 		      0);
37646733b39aSJayamohan Kallickal 
37656733b39aSJayamohan Kallickal 	mem_descr = phba->init_mem;
37666733b39aSJayamohan Kallickal 	mem_descr += ISCSI_MEM_GLOBAL_HEADER;
37676733b39aSJayamohan Kallickal 
37686733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb,
37696733b39aSJayamohan Kallickal 			pad_buffer_addr_hi, pwrb,
37706733b39aSJayamohan Kallickal 		      mem_descr->mem_array[0].bus_address.u.a32.address_hi);
37716733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb,
37726733b39aSJayamohan Kallickal 			pad_buffer_addr_lo, pwrb,
37736733b39aSJayamohan Kallickal 		      mem_descr->mem_array[0].bus_address.u.a32.address_lo);
37746733b39aSJayamohan Kallickal 
37756733b39aSJayamohan Kallickal 	be_dws_le_to_cpu(pwrb, sizeof(struct iscsi_target_context_update_wrb));
37766733b39aSJayamohan Kallickal 
37776733b39aSJayamohan Kallickal 	doorbell |= beiscsi_conn->beiscsi_conn_cid & DB_WRB_POST_CID_MASK;
3778bfead3b2SJayamohan Kallickal 	doorbell |= (pwrb_handle->wrb_index & DB_DEF_PDU_WRB_INDEX_MASK)
3779bfead3b2SJayamohan Kallickal 			     << DB_DEF_PDU_WRB_INDEX_SHIFT;
37806733b39aSJayamohan Kallickal 	doorbell |= 1 << DB_DEF_PDU_NUM_POSTED_SHIFT;
37816733b39aSJayamohan Kallickal 
37826733b39aSJayamohan Kallickal 	iowrite32(doorbell, phba->db_va + DB_TXULP0_OFFSET);
37836733b39aSJayamohan Kallickal }
37846733b39aSJayamohan Kallickal 
37856733b39aSJayamohan Kallickal static void beiscsi_parse_pdu(struct iscsi_conn *conn, itt_t itt,
37866733b39aSJayamohan Kallickal 			      int *index, int *age)
37876733b39aSJayamohan Kallickal {
3788bfead3b2SJayamohan Kallickal 	*index = (int)itt;
37896733b39aSJayamohan Kallickal 	if (age)
37906733b39aSJayamohan Kallickal 		*age = conn->session->age;
37916733b39aSJayamohan Kallickal }
37926733b39aSJayamohan Kallickal 
37936733b39aSJayamohan Kallickal /**
37946733b39aSJayamohan Kallickal  * beiscsi_alloc_pdu - allocates pdu and related resources
37956733b39aSJayamohan Kallickal  * @task: libiscsi task
37966733b39aSJayamohan Kallickal  * @opcode: opcode of pdu for task
37976733b39aSJayamohan Kallickal  *
37986733b39aSJayamohan Kallickal  * This is called with the session lock held. It will allocate
37996733b39aSJayamohan Kallickal  * the wrb and sgl if needed for the command. And it will prep
38006733b39aSJayamohan Kallickal  * the pdu's itt. beiscsi_parse_pdu will later translate
38016733b39aSJayamohan Kallickal  * the pdu itt to the libiscsi task itt.
38026733b39aSJayamohan Kallickal  */
38036733b39aSJayamohan Kallickal static int beiscsi_alloc_pdu(struct iscsi_task *task, uint8_t opcode)
38046733b39aSJayamohan Kallickal {
38056733b39aSJayamohan Kallickal 	struct beiscsi_io_task *io_task = task->dd_data;
38066733b39aSJayamohan Kallickal 	struct iscsi_conn *conn = task->conn;
38076733b39aSJayamohan Kallickal 	struct beiscsi_conn *beiscsi_conn = conn->dd_data;
38086733b39aSJayamohan Kallickal 	struct beiscsi_hba *phba = beiscsi_conn->phba;
38096733b39aSJayamohan Kallickal 	struct hwi_wrb_context *pwrb_context;
38106733b39aSJayamohan Kallickal 	struct hwi_controller *phwi_ctrlr;
38116733b39aSJayamohan Kallickal 	itt_t itt;
38122afc95bfSJayamohan Kallickal 	struct beiscsi_session *beiscsi_sess = beiscsi_conn->beiscsi_sess;
38132afc95bfSJayamohan Kallickal 	dma_addr_t paddr;
38146733b39aSJayamohan Kallickal 
38152afc95bfSJayamohan Kallickal 	io_task->cmd_bhs = pci_pool_alloc(beiscsi_sess->bhs_pool,
3816bc7accecSMike Christie 					  GFP_ATOMIC, &paddr);
38172afc95bfSJayamohan Kallickal 	if (!io_task->cmd_bhs)
38182afc95bfSJayamohan Kallickal 		return -ENOMEM;
38192afc95bfSJayamohan Kallickal 	io_task->bhs_pa.u.a64.address = paddr;
3820bfead3b2SJayamohan Kallickal 	io_task->libiscsi_itt = (itt_t)task->itt;
38216733b39aSJayamohan Kallickal 	io_task->conn = beiscsi_conn;
38226733b39aSJayamohan Kallickal 
38236733b39aSJayamohan Kallickal 	task->hdr = (struct iscsi_hdr *)&io_task->cmd_bhs->iscsi_hdr;
38246733b39aSJayamohan Kallickal 	task->hdr_max = sizeof(struct be_cmd_bhs);
3825d2cecf0dSJayamohan Kallickal 	io_task->psgl_handle = NULL;
3826d2cecf0dSJayamohan Kallickal 	io_task->psgl_handle = NULL;
38276733b39aSJayamohan Kallickal 
38286733b39aSJayamohan Kallickal 	if (task->sc) {
38296733b39aSJayamohan Kallickal 		spin_lock(&phba->io_sgl_lock);
38306733b39aSJayamohan Kallickal 		io_task->psgl_handle = alloc_io_sgl_handle(phba);
38316733b39aSJayamohan Kallickal 		spin_unlock(&phba->io_sgl_lock);
38322afc95bfSJayamohan Kallickal 		if (!io_task->psgl_handle)
38332afc95bfSJayamohan Kallickal 			goto free_hndls;
3834d2cecf0dSJayamohan Kallickal 		io_task->pwrb_handle = alloc_wrb_handle(phba,
3835d2cecf0dSJayamohan Kallickal 					beiscsi_conn->beiscsi_conn_cid -
3836d2cecf0dSJayamohan Kallickal 					phba->fw_config.iscsi_cid_start);
3837d2cecf0dSJayamohan Kallickal 		if (!io_task->pwrb_handle)
3838d2cecf0dSJayamohan Kallickal 			goto free_io_hndls;
38396733b39aSJayamohan Kallickal 	} else {
38406733b39aSJayamohan Kallickal 		io_task->scsi_cmnd = NULL;
3841d7aea67bSJayamohan Kallickal 		if ((opcode & ISCSI_OPCODE_MASK) == ISCSI_OP_LOGIN) {
38426733b39aSJayamohan Kallickal 			if (!beiscsi_conn->login_in_progress) {
38436733b39aSJayamohan Kallickal 				spin_lock(&phba->mgmt_sgl_lock);
38446733b39aSJayamohan Kallickal 				io_task->psgl_handle = (struct sgl_handle *)
38456733b39aSJayamohan Kallickal 						alloc_mgmt_sgl_handle(phba);
38466733b39aSJayamohan Kallickal 				spin_unlock(&phba->mgmt_sgl_lock);
38472afc95bfSJayamohan Kallickal 				if (!io_task->psgl_handle)
38482afc95bfSJayamohan Kallickal 					goto free_hndls;
38492afc95bfSJayamohan Kallickal 
38506733b39aSJayamohan Kallickal 				beiscsi_conn->login_in_progress = 1;
38516733b39aSJayamohan Kallickal 				beiscsi_conn->plogin_sgl_handle =
38526733b39aSJayamohan Kallickal 							io_task->psgl_handle;
3853d2cecf0dSJayamohan Kallickal 				io_task->pwrb_handle =
3854d2cecf0dSJayamohan Kallickal 					alloc_wrb_handle(phba,
3855d2cecf0dSJayamohan Kallickal 					beiscsi_conn->beiscsi_conn_cid -
3856d2cecf0dSJayamohan Kallickal 					phba->fw_config.iscsi_cid_start);
3857d2cecf0dSJayamohan Kallickal 				if (!io_task->pwrb_handle)
3858d2cecf0dSJayamohan Kallickal 					goto free_io_hndls;
3859d2cecf0dSJayamohan Kallickal 				beiscsi_conn->plogin_wrb_handle =
3860d2cecf0dSJayamohan Kallickal 							io_task->pwrb_handle;
3861d2cecf0dSJayamohan Kallickal 
38626733b39aSJayamohan Kallickal 			} else {
38636733b39aSJayamohan Kallickal 				io_task->psgl_handle =
38646733b39aSJayamohan Kallickal 						beiscsi_conn->plogin_sgl_handle;
3865d2cecf0dSJayamohan Kallickal 				io_task->pwrb_handle =
3866d2cecf0dSJayamohan Kallickal 						beiscsi_conn->plogin_wrb_handle;
38676733b39aSJayamohan Kallickal 			}
38686733b39aSJayamohan Kallickal 		} else {
38696733b39aSJayamohan Kallickal 			spin_lock(&phba->mgmt_sgl_lock);
38706733b39aSJayamohan Kallickal 			io_task->psgl_handle = alloc_mgmt_sgl_handle(phba);
38716733b39aSJayamohan Kallickal 			spin_unlock(&phba->mgmt_sgl_lock);
38722afc95bfSJayamohan Kallickal 			if (!io_task->psgl_handle)
38732afc95bfSJayamohan Kallickal 				goto free_hndls;
3874d2cecf0dSJayamohan Kallickal 			io_task->pwrb_handle =
3875d2cecf0dSJayamohan Kallickal 					alloc_wrb_handle(phba,
3876d2cecf0dSJayamohan Kallickal 					beiscsi_conn->beiscsi_conn_cid -
3877d2cecf0dSJayamohan Kallickal 					phba->fw_config.iscsi_cid_start);
3878d2cecf0dSJayamohan Kallickal 			if (!io_task->pwrb_handle)
3879d2cecf0dSJayamohan Kallickal 				goto free_mgmt_hndls;
3880d2cecf0dSJayamohan Kallickal 
38816733b39aSJayamohan Kallickal 		}
38826733b39aSJayamohan Kallickal 	}
3883bfead3b2SJayamohan Kallickal 	itt = (itt_t) cpu_to_be32(((unsigned int)io_task->pwrb_handle->
3884bfead3b2SJayamohan Kallickal 				 wrb_index << 16) | (unsigned int)
3885bfead3b2SJayamohan Kallickal 				(io_task->psgl_handle->sgl_index));
3886bfead3b2SJayamohan Kallickal 	io_task->pwrb_handle->pio_handle = task;
3887bfead3b2SJayamohan Kallickal 
38886733b39aSJayamohan Kallickal 	io_task->cmd_bhs->iscsi_hdr.itt = itt;
38896733b39aSJayamohan Kallickal 	return 0;
38902afc95bfSJayamohan Kallickal 
3891d2cecf0dSJayamohan Kallickal free_io_hndls:
3892d2cecf0dSJayamohan Kallickal 	spin_lock(&phba->io_sgl_lock);
3893d2cecf0dSJayamohan Kallickal 	free_io_sgl_handle(phba, io_task->psgl_handle);
3894d2cecf0dSJayamohan Kallickal 	spin_unlock(&phba->io_sgl_lock);
3895d2cecf0dSJayamohan Kallickal 	goto free_hndls;
3896d2cecf0dSJayamohan Kallickal free_mgmt_hndls:
3897d2cecf0dSJayamohan Kallickal 	spin_lock(&phba->mgmt_sgl_lock);
3898d2cecf0dSJayamohan Kallickal 	free_mgmt_sgl_handle(phba, io_task->psgl_handle);
3899d2cecf0dSJayamohan Kallickal 	spin_unlock(&phba->mgmt_sgl_lock);
39002afc95bfSJayamohan Kallickal free_hndls:
39012afc95bfSJayamohan Kallickal 	phwi_ctrlr = phba->phwi_ctrlr;
39027da50879SJayamohan Kallickal 	pwrb_context = &phwi_ctrlr->wrb_context[
39037da50879SJayamohan Kallickal 			beiscsi_conn->beiscsi_conn_cid -
39047da50879SJayamohan Kallickal 			phba->fw_config.iscsi_cid_start];
3905d2cecf0dSJayamohan Kallickal 	if (io_task->pwrb_handle)
39062afc95bfSJayamohan Kallickal 		free_wrb_handle(phba, pwrb_context, io_task->pwrb_handle);
39072afc95bfSJayamohan Kallickal 	io_task->pwrb_handle = NULL;
39082afc95bfSJayamohan Kallickal 	pci_pool_free(beiscsi_sess->bhs_pool, io_task->cmd_bhs,
39092afc95bfSJayamohan Kallickal 		      io_task->bhs_pa.u.a64.address);
39102afc95bfSJayamohan Kallickal 	SE_DEBUG(DBG_LVL_1, "Alloc of SGL_ICD Failed\n");
39112afc95bfSJayamohan Kallickal 	return -ENOMEM;
39126733b39aSJayamohan Kallickal }
39136733b39aSJayamohan Kallickal 
39146733b39aSJayamohan Kallickal static void beiscsi_cleanup_task(struct iscsi_task *task)
39156733b39aSJayamohan Kallickal {
39166733b39aSJayamohan Kallickal 	struct beiscsi_io_task *io_task = task->dd_data;
39176733b39aSJayamohan Kallickal 	struct iscsi_conn *conn = task->conn;
39186733b39aSJayamohan Kallickal 	struct beiscsi_conn *beiscsi_conn = conn->dd_data;
39196733b39aSJayamohan Kallickal 	struct beiscsi_hba *phba = beiscsi_conn->phba;
39202afc95bfSJayamohan Kallickal 	struct beiscsi_session *beiscsi_sess = beiscsi_conn->beiscsi_sess;
39216733b39aSJayamohan Kallickal 	struct hwi_wrb_context *pwrb_context;
39226733b39aSJayamohan Kallickal 	struct hwi_controller *phwi_ctrlr;
39236733b39aSJayamohan Kallickal 
39246733b39aSJayamohan Kallickal 	phwi_ctrlr = phba->phwi_ctrlr;
39257da50879SJayamohan Kallickal 	pwrb_context = &phwi_ctrlr->wrb_context[beiscsi_conn->beiscsi_conn_cid
39267da50879SJayamohan Kallickal 			- phba->fw_config.iscsi_cid_start];
39276733b39aSJayamohan Kallickal 	if (io_task->pwrb_handle) {
39286733b39aSJayamohan Kallickal 		free_wrb_handle(phba, pwrb_context, io_task->pwrb_handle);
39296733b39aSJayamohan Kallickal 		io_task->pwrb_handle = NULL;
39306733b39aSJayamohan Kallickal 	}
39316733b39aSJayamohan Kallickal 
39322afc95bfSJayamohan Kallickal 	if (io_task->cmd_bhs) {
39332afc95bfSJayamohan Kallickal 		pci_pool_free(beiscsi_sess->bhs_pool, io_task->cmd_bhs,
39342afc95bfSJayamohan Kallickal 			      io_task->bhs_pa.u.a64.address);
39352afc95bfSJayamohan Kallickal 	}
39362afc95bfSJayamohan Kallickal 
39376733b39aSJayamohan Kallickal 	if (task->sc) {
39386733b39aSJayamohan Kallickal 		if (io_task->psgl_handle) {
39396733b39aSJayamohan Kallickal 			spin_lock(&phba->io_sgl_lock);
39406733b39aSJayamohan Kallickal 			free_io_sgl_handle(phba, io_task->psgl_handle);
39416733b39aSJayamohan Kallickal 			spin_unlock(&phba->io_sgl_lock);
39426733b39aSJayamohan Kallickal 			io_task->psgl_handle = NULL;
39436733b39aSJayamohan Kallickal 		}
39446733b39aSJayamohan Kallickal 	} else {
39451227633aSMike Christie 		if (task->hdr &&
39461227633aSMike Christie 		   ((task->hdr->opcode & ISCSI_OPCODE_MASK) == ISCSI_OP_LOGIN))
39476733b39aSJayamohan Kallickal 			return;
39486733b39aSJayamohan Kallickal 		if (io_task->psgl_handle) {
39496733b39aSJayamohan Kallickal 			spin_lock(&phba->mgmt_sgl_lock);
39506733b39aSJayamohan Kallickal 			free_mgmt_sgl_handle(phba, io_task->psgl_handle);
39516733b39aSJayamohan Kallickal 			spin_unlock(&phba->mgmt_sgl_lock);
39526733b39aSJayamohan Kallickal 			io_task->psgl_handle = NULL;
39536733b39aSJayamohan Kallickal 		}
39546733b39aSJayamohan Kallickal 	}
39556733b39aSJayamohan Kallickal }
39566733b39aSJayamohan Kallickal 
39576733b39aSJayamohan Kallickal static int beiscsi_iotask(struct iscsi_task *task, struct scatterlist *sg,
39586733b39aSJayamohan Kallickal 			  unsigned int num_sg, unsigned int xferlen,
39596733b39aSJayamohan Kallickal 			  unsigned int writedir)
39606733b39aSJayamohan Kallickal {
39616733b39aSJayamohan Kallickal 
39626733b39aSJayamohan Kallickal 	struct beiscsi_io_task *io_task = task->dd_data;
39636733b39aSJayamohan Kallickal 	struct iscsi_conn *conn = task->conn;
39646733b39aSJayamohan Kallickal 	struct beiscsi_conn *beiscsi_conn = conn->dd_data;
39656733b39aSJayamohan Kallickal 	struct beiscsi_hba *phba = beiscsi_conn->phba;
39666733b39aSJayamohan Kallickal 	struct iscsi_wrb *pwrb = NULL;
39676733b39aSJayamohan Kallickal 	unsigned int doorbell = 0;
39686733b39aSJayamohan Kallickal 
39696733b39aSJayamohan Kallickal 	pwrb = io_task->pwrb_handle->pwrb;
39706733b39aSJayamohan Kallickal 	io_task->cmd_bhs->iscsi_hdr.exp_statsn = 0;
39716733b39aSJayamohan Kallickal 	io_task->bhs_len = sizeof(struct be_cmd_bhs);
39726733b39aSJayamohan Kallickal 
39736733b39aSJayamohan Kallickal 	if (writedir) {
39746733b39aSJayamohan Kallickal 		memset(&io_task->cmd_bhs->iscsi_data_pdu, 0, 48);
39756733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_pdu_data_out, itt,
39766733b39aSJayamohan Kallickal 			      &io_task->cmd_bhs->iscsi_data_pdu,
39776733b39aSJayamohan Kallickal 			      (unsigned int)io_task->cmd_bhs->iscsi_hdr.itt);
39786733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_pdu_data_out, opcode,
39796733b39aSJayamohan Kallickal 			      &io_task->cmd_bhs->iscsi_data_pdu,
39806733b39aSJayamohan Kallickal 			      ISCSI_OPCODE_SCSI_DATA_OUT);
39816733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_pdu_data_out, final_bit,
39826733b39aSJayamohan Kallickal 			      &io_task->cmd_bhs->iscsi_data_pdu, 1);
3983bfead3b2SJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_wrb, type, pwrb,
3984bfead3b2SJayamohan Kallickal 			      INI_WR_CMD);
39856733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_wrb, dsp, pwrb, 1);
39866733b39aSJayamohan Kallickal 	} else {
3987bfead3b2SJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_wrb, type, pwrb,
3988bfead3b2SJayamohan Kallickal 			      INI_RD_CMD);
39896733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_wrb, dsp, pwrb, 0);
39906733b39aSJayamohan Kallickal 	}
39916733b39aSJayamohan Kallickal 	memcpy(&io_task->cmd_bhs->iscsi_data_pdu.
39926733b39aSJayamohan Kallickal 	       dw[offsetof(struct amap_pdu_data_out, lun) / 32],
3993516f43a2SAndy Grover 	       &io_task->cmd_bhs->iscsi_hdr.lun, sizeof(struct scsi_lun));
39946733b39aSJayamohan Kallickal 
39956733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_wrb, lun, pwrb,
3996516f43a2SAndy Grover 		      cpu_to_be16(*(unsigned short *)&io_task->cmd_bhs->iscsi_hdr.lun));
39976733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_wrb, r2t_exp_dtl, pwrb, xferlen);
39986733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_wrb, wrb_idx, pwrb,
39996733b39aSJayamohan Kallickal 		      io_task->pwrb_handle->wrb_index);
40006733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_wrb, cmdsn_itt, pwrb,
40016733b39aSJayamohan Kallickal 		      be32_to_cpu(task->cmdsn));
40026733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_wrb, sgl_icd_idx, pwrb,
40036733b39aSJayamohan Kallickal 		      io_task->psgl_handle->sgl_index);
40046733b39aSJayamohan Kallickal 
40056733b39aSJayamohan Kallickal 	hwi_write_sgl(pwrb, sg, num_sg, io_task);
40066733b39aSJayamohan Kallickal 
40076733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_wrb, ptr2nextwrb, pwrb,
40086733b39aSJayamohan Kallickal 		      io_task->pwrb_handle->nxt_wrb_index);
40096733b39aSJayamohan Kallickal 	be_dws_le_to_cpu(pwrb, sizeof(struct iscsi_wrb));
40106733b39aSJayamohan Kallickal 
40116733b39aSJayamohan Kallickal 	doorbell |= beiscsi_conn->beiscsi_conn_cid & DB_WRB_POST_CID_MASK;
40126733b39aSJayamohan Kallickal 	doorbell |= (io_task->pwrb_handle->wrb_index &
40136733b39aSJayamohan Kallickal 		     DB_DEF_PDU_WRB_INDEX_MASK) << DB_DEF_PDU_WRB_INDEX_SHIFT;
40146733b39aSJayamohan Kallickal 	doorbell |= 1 << DB_DEF_PDU_NUM_POSTED_SHIFT;
40156733b39aSJayamohan Kallickal 
40166733b39aSJayamohan Kallickal 	iowrite32(doorbell, phba->db_va + DB_TXULP0_OFFSET);
40176733b39aSJayamohan Kallickal 	return 0;
40186733b39aSJayamohan Kallickal }
40196733b39aSJayamohan Kallickal 
40206733b39aSJayamohan Kallickal static int beiscsi_mtask(struct iscsi_task *task)
40216733b39aSJayamohan Kallickal {
4022dafab8e0SJayamohan Kallickal 	struct beiscsi_io_task *io_task = task->dd_data;
40236733b39aSJayamohan Kallickal 	struct iscsi_conn *conn = task->conn;
40246733b39aSJayamohan Kallickal 	struct beiscsi_conn *beiscsi_conn = conn->dd_data;
40256733b39aSJayamohan Kallickal 	struct beiscsi_hba *phba = beiscsi_conn->phba;
40266733b39aSJayamohan Kallickal 	struct iscsi_wrb *pwrb = NULL;
40276733b39aSJayamohan Kallickal 	unsigned int doorbell = 0;
4028dafab8e0SJayamohan Kallickal 	unsigned int cid;
40296733b39aSJayamohan Kallickal 
4030bfead3b2SJayamohan Kallickal 	cid = beiscsi_conn->beiscsi_conn_cid;
40316733b39aSJayamohan Kallickal 	pwrb = io_task->pwrb_handle->pwrb;
4032caf818f1SJayamohan Kallickal 	memset(pwrb, 0, sizeof(*pwrb));
40336733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_wrb, cmdsn_itt, pwrb,
40346733b39aSJayamohan Kallickal 		      be32_to_cpu(task->cmdsn));
40356733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_wrb, wrb_idx, pwrb,
40366733b39aSJayamohan Kallickal 		      io_task->pwrb_handle->wrb_index);
40376733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_wrb, sgl_icd_idx, pwrb,
40386733b39aSJayamohan Kallickal 		      io_task->psgl_handle->sgl_index);
4039dafab8e0SJayamohan Kallickal 
40406733b39aSJayamohan Kallickal 	switch (task->hdr->opcode & ISCSI_OPCODE_MASK) {
40416733b39aSJayamohan Kallickal 	case ISCSI_OP_LOGIN:
4042bfead3b2SJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_wrb, type, pwrb,
4043bfead3b2SJayamohan Kallickal 			      TGT_DM_CMD);
40446733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_wrb, dmsg, pwrb, 0);
40456733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_wrb, cmdsn_itt, pwrb, 1);
40466733b39aSJayamohan Kallickal 		hwi_write_buffer(pwrb, task);
40476733b39aSJayamohan Kallickal 		break;
40486733b39aSJayamohan Kallickal 	case ISCSI_OP_NOOP_OUT:
40491390b01bSJayamohan Kallickal 		if (task->hdr->ttt != ISCSI_RESERVED_TAG) {
40501390b01bSJayamohan Kallickal 			AMAP_SET_BITS(struct amap_iscsi_wrb, type, pwrb,
40511390b01bSJayamohan Kallickal 				      TGT_DM_CMD);
40521390b01bSJayamohan Kallickal 			AMAP_SET_BITS(struct amap_iscsi_wrb, cmdsn_itt,
40531390b01bSJayamohan Kallickal 				      pwrb, 0);
4054685e16fdSJayamohan Kallickal 			AMAP_SET_BITS(struct amap_iscsi_wrb, dmsg, pwrb, 1);
40551390b01bSJayamohan Kallickal 		} else {
4056bfead3b2SJayamohan Kallickal 			AMAP_SET_BITS(struct amap_iscsi_wrb, type, pwrb,
4057bfead3b2SJayamohan Kallickal 				      INI_RD_CMD);
4058685e16fdSJayamohan Kallickal 			AMAP_SET_BITS(struct amap_iscsi_wrb, dmsg, pwrb, 0);
40591390b01bSJayamohan Kallickal 		}
40606733b39aSJayamohan Kallickal 		hwi_write_buffer(pwrb, task);
40616733b39aSJayamohan Kallickal 		break;
40626733b39aSJayamohan Kallickal 	case ISCSI_OP_TEXT:
4063bfead3b2SJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_wrb, type, pwrb,
4064b30c6dabSJayamohan Kallickal 			      TGT_DM_CMD);
40650ecb0b45SJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_wrb, dmsg, pwrb, 0);
40666733b39aSJayamohan Kallickal 		hwi_write_buffer(pwrb, task);
40676733b39aSJayamohan Kallickal 		break;
40686733b39aSJayamohan Kallickal 	case ISCSI_OP_SCSI_TMFUNC:
4069bfead3b2SJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_wrb, type, pwrb,
4070bfead3b2SJayamohan Kallickal 			      INI_TMF_CMD);
40716733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_wrb, dmsg, pwrb, 0);
40726733b39aSJayamohan Kallickal 		hwi_write_buffer(pwrb, task);
40736733b39aSJayamohan Kallickal 		break;
40746733b39aSJayamohan Kallickal 	case ISCSI_OP_LOGOUT:
40756733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_wrb, dmsg, pwrb, 0);
40766733b39aSJayamohan Kallickal 		AMAP_SET_BITS(struct amap_iscsi_wrb, type, pwrb,
40776733b39aSJayamohan Kallickal 			      HWH_TYPE_LOGOUT);
40786733b39aSJayamohan Kallickal 		hwi_write_buffer(pwrb, task);
40796733b39aSJayamohan Kallickal 		break;
40806733b39aSJayamohan Kallickal 
40816733b39aSJayamohan Kallickal 	default:
40826733b39aSJayamohan Kallickal 		SE_DEBUG(DBG_LVL_1, "opcode =%d Not supported\n",
40836733b39aSJayamohan Kallickal 			 task->hdr->opcode & ISCSI_OPCODE_MASK);
40846733b39aSJayamohan Kallickal 		return -EINVAL;
40856733b39aSJayamohan Kallickal 	}
40866733b39aSJayamohan Kallickal 
40876733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_wrb, r2t_exp_dtl, pwrb,
408851a46250SJayamohan Kallickal 		      task->data_count);
40896733b39aSJayamohan Kallickal 	AMAP_SET_BITS(struct amap_iscsi_wrb, ptr2nextwrb, pwrb,
40906733b39aSJayamohan Kallickal 		      io_task->pwrb_handle->nxt_wrb_index);
40916733b39aSJayamohan Kallickal 	be_dws_le_to_cpu(pwrb, sizeof(struct iscsi_wrb));
40926733b39aSJayamohan Kallickal 
4093bfead3b2SJayamohan Kallickal 	doorbell |= cid & DB_WRB_POST_CID_MASK;
40946733b39aSJayamohan Kallickal 	doorbell |= (io_task->pwrb_handle->wrb_index &
40956733b39aSJayamohan Kallickal 		     DB_DEF_PDU_WRB_INDEX_MASK) << DB_DEF_PDU_WRB_INDEX_SHIFT;
40966733b39aSJayamohan Kallickal 	doorbell |= 1 << DB_DEF_PDU_NUM_POSTED_SHIFT;
40976733b39aSJayamohan Kallickal 	iowrite32(doorbell, phba->db_va + DB_TXULP0_OFFSET);
40986733b39aSJayamohan Kallickal 	return 0;
40996733b39aSJayamohan Kallickal }
41006733b39aSJayamohan Kallickal 
41016733b39aSJayamohan Kallickal static int beiscsi_task_xmit(struct iscsi_task *task)
41026733b39aSJayamohan Kallickal {
41036733b39aSJayamohan Kallickal 	struct beiscsi_io_task *io_task = task->dd_data;
41046733b39aSJayamohan Kallickal 	struct scsi_cmnd *sc = task->sc;
41056733b39aSJayamohan Kallickal 	struct scatterlist *sg;
41066733b39aSJayamohan Kallickal 	int num_sg;
41076733b39aSJayamohan Kallickal 	unsigned int  writedir = 0, xferlen = 0;
41086733b39aSJayamohan Kallickal 
41096733b39aSJayamohan Kallickal 	if (!sc)
41106733b39aSJayamohan Kallickal 		return beiscsi_mtask(task);
41116733b39aSJayamohan Kallickal 
41126733b39aSJayamohan Kallickal 	io_task->scsi_cmnd = sc;
41136733b39aSJayamohan Kallickal 	num_sg = scsi_dma_map(sc);
41146733b39aSJayamohan Kallickal 	if (num_sg < 0) {
41156733b39aSJayamohan Kallickal 		SE_DEBUG(DBG_LVL_1, " scsi_dma_map Failed\n")
41166733b39aSJayamohan Kallickal 		return num_sg;
41176733b39aSJayamohan Kallickal 	}
41186733b39aSJayamohan Kallickal 	xferlen = scsi_bufflen(sc);
41196733b39aSJayamohan Kallickal 	sg = scsi_sglist(sc);
41206733b39aSJayamohan Kallickal 	if (sc->sc_data_direction == DMA_TO_DEVICE) {
41216733b39aSJayamohan Kallickal 		writedir = 1;
41226733b39aSJayamohan Kallickal 		SE_DEBUG(DBG_LVL_4, "task->imm_count=0x%08x\n",
41236733b39aSJayamohan Kallickal 			 task->imm_count);
41246733b39aSJayamohan Kallickal 	} else
41256733b39aSJayamohan Kallickal 		writedir = 0;
41266733b39aSJayamohan Kallickal 	return beiscsi_iotask(task, sg, num_sg, xferlen, writedir);
41276733b39aSJayamohan Kallickal }
41286733b39aSJayamohan Kallickal 
412925602c97SJayamohan Kallickal static void beiscsi_quiesce(struct beiscsi_hba *phba)
41306733b39aSJayamohan Kallickal {
4131bfead3b2SJayamohan Kallickal 	struct hwi_controller *phwi_ctrlr;
4132bfead3b2SJayamohan Kallickal 	struct hwi_context_memory *phwi_context;
4133bfead3b2SJayamohan Kallickal 	struct be_eq_obj *pbe_eq;
4134bfead3b2SJayamohan Kallickal 	unsigned int i, msix_vec;
4135e9b91193SJayamohan Kallickal 	u8 *real_offset = 0;
4136e9b91193SJayamohan Kallickal 	u32 value = 0;
41376733b39aSJayamohan Kallickal 
4138bfead3b2SJayamohan Kallickal 	phwi_ctrlr = phba->phwi_ctrlr;
4139bfead3b2SJayamohan Kallickal 	phwi_context = phwi_ctrlr->phwi_ctxt;
41406733b39aSJayamohan Kallickal 	hwi_disable_intr(phba);
4141bfead3b2SJayamohan Kallickal 	if (phba->msix_enabled) {
4142bfead3b2SJayamohan Kallickal 		for (i = 0; i <= phba->num_cpus; i++) {
4143bfead3b2SJayamohan Kallickal 			msix_vec = phba->msix_entries[i].vector;
4144bfead3b2SJayamohan Kallickal 			free_irq(msix_vec, &phwi_context->be_eq[i]);
41458fcfb210SJayamohan Kallickal 			kfree(phba->msi_name[i]);
4146bfead3b2SJayamohan Kallickal 		}
4147bfead3b2SJayamohan Kallickal 	} else
41486733b39aSJayamohan Kallickal 		if (phba->pcidev->irq)
41496733b39aSJayamohan Kallickal 			free_irq(phba->pcidev->irq, phba);
4150bfead3b2SJayamohan Kallickal 	pci_disable_msix(phba->pcidev);
41516733b39aSJayamohan Kallickal 	destroy_workqueue(phba->wq);
41526733b39aSJayamohan Kallickal 	if (blk_iopoll_enabled)
4153bfead3b2SJayamohan Kallickal 		for (i = 0; i < phba->num_cpus; i++) {
4154bfead3b2SJayamohan Kallickal 			pbe_eq = &phwi_context->be_eq[i];
4155bfead3b2SJayamohan Kallickal 			blk_iopoll_disable(&pbe_eq->iopoll);
4156bfead3b2SJayamohan Kallickal 		}
41576733b39aSJayamohan Kallickal 
41586733b39aSJayamohan Kallickal 	beiscsi_clean_port(phba);
41596733b39aSJayamohan Kallickal 	beiscsi_free_mem(phba);
4160e9b91193SJayamohan Kallickal 	real_offset = (u8 *)phba->csr_va + MPU_EP_SEMAPHORE;
4161e9b91193SJayamohan Kallickal 
4162e9b91193SJayamohan Kallickal 	value = readl((void *)real_offset);
4163e9b91193SJayamohan Kallickal 
4164e9b91193SJayamohan Kallickal 	if (value & 0x00010000) {
4165e9b91193SJayamohan Kallickal 		value &= 0xfffeffff;
4166e9b91193SJayamohan Kallickal 		writel(value, (void *)real_offset);
4167e9b91193SJayamohan Kallickal 	}
41686733b39aSJayamohan Kallickal 	beiscsi_unmap_pci_function(phba);
41696733b39aSJayamohan Kallickal 	pci_free_consistent(phba->pcidev,
41706733b39aSJayamohan Kallickal 			    phba->ctrl.mbox_mem_alloced.size,
41716733b39aSJayamohan Kallickal 			    phba->ctrl.mbox_mem_alloced.va,
41726733b39aSJayamohan Kallickal 			    phba->ctrl.mbox_mem_alloced.dma);
417325602c97SJayamohan Kallickal }
417425602c97SJayamohan Kallickal 
417525602c97SJayamohan Kallickal static void beiscsi_remove(struct pci_dev *pcidev)
417625602c97SJayamohan Kallickal {
417725602c97SJayamohan Kallickal 
417825602c97SJayamohan Kallickal 	struct beiscsi_hba *phba = NULL;
417925602c97SJayamohan Kallickal 
418025602c97SJayamohan Kallickal 	phba = pci_get_drvdata(pcidev);
418125602c97SJayamohan Kallickal 	if (!phba) {
418225602c97SJayamohan Kallickal 		dev_err(&pcidev->dev, "beiscsi_remove called with no phba\n");
418325602c97SJayamohan Kallickal 		return;
418425602c97SJayamohan Kallickal 	}
418525602c97SJayamohan Kallickal 
418625602c97SJayamohan Kallickal 	beiscsi_quiesce(phba);
41870b1d3cbfSJayamohan Kallickal 	iscsi_boot_destroy_kset(phba->boot_kset);
41886733b39aSJayamohan Kallickal 	iscsi_host_remove(phba->shost);
41896733b39aSJayamohan Kallickal 	pci_dev_put(phba->pcidev);
41906733b39aSJayamohan Kallickal 	iscsi_host_free(phba->shost);
41918dce69ffSJayamohan Kallickal 	pci_disable_device(pcidev);
41926733b39aSJayamohan Kallickal }
41936733b39aSJayamohan Kallickal 
419425602c97SJayamohan Kallickal static void beiscsi_shutdown(struct pci_dev *pcidev)
419525602c97SJayamohan Kallickal {
419625602c97SJayamohan Kallickal 
419725602c97SJayamohan Kallickal 	struct beiscsi_hba *phba = NULL;
419825602c97SJayamohan Kallickal 
419925602c97SJayamohan Kallickal 	phba = (struct beiscsi_hba *)pci_get_drvdata(pcidev);
420025602c97SJayamohan Kallickal 	if (!phba) {
420125602c97SJayamohan Kallickal 		dev_err(&pcidev->dev, "beiscsi_shutdown called with no phba\n");
420225602c97SJayamohan Kallickal 		return;
420325602c97SJayamohan Kallickal 	}
420425602c97SJayamohan Kallickal 
420525602c97SJayamohan Kallickal 	beiscsi_quiesce(phba);
42068dce69ffSJayamohan Kallickal 	pci_disable_device(pcidev);
420725602c97SJayamohan Kallickal }
420825602c97SJayamohan Kallickal 
4209bfead3b2SJayamohan Kallickal static void beiscsi_msix_enable(struct beiscsi_hba *phba)
4210bfead3b2SJayamohan Kallickal {
4211bfead3b2SJayamohan Kallickal 	int i, status;
4212bfead3b2SJayamohan Kallickal 
4213bfead3b2SJayamohan Kallickal 	for (i = 0; i <= phba->num_cpus; i++)
4214bfead3b2SJayamohan Kallickal 		phba->msix_entries[i].entry = i;
4215bfead3b2SJayamohan Kallickal 
4216bfead3b2SJayamohan Kallickal 	status = pci_enable_msix(phba->pcidev, phba->msix_entries,
4217bfead3b2SJayamohan Kallickal 				 (phba->num_cpus + 1));
4218bfead3b2SJayamohan Kallickal 	if (!status)
4219bfead3b2SJayamohan Kallickal 		phba->msix_enabled = true;
4220bfead3b2SJayamohan Kallickal 
4221bfead3b2SJayamohan Kallickal 	return;
4222bfead3b2SJayamohan Kallickal }
4223bfead3b2SJayamohan Kallickal 
42246733b39aSJayamohan Kallickal static int __devinit beiscsi_dev_probe(struct pci_dev *pcidev,
42256733b39aSJayamohan Kallickal 				const struct pci_device_id *id)
42266733b39aSJayamohan Kallickal {
42276733b39aSJayamohan Kallickal 	struct beiscsi_hba *phba = NULL;
4228bfead3b2SJayamohan Kallickal 	struct hwi_controller *phwi_ctrlr;
4229bfead3b2SJayamohan Kallickal 	struct hwi_context_memory *phwi_context;
4230bfead3b2SJayamohan Kallickal 	struct be_eq_obj *pbe_eq;
4231238f6b72SJayamohan Kallickal 	int ret, num_cpus, i;
4232e9b91193SJayamohan Kallickal 	u8 *real_offset = 0;
4233e9b91193SJayamohan Kallickal 	u32 value = 0;
42346733b39aSJayamohan Kallickal 
42356733b39aSJayamohan Kallickal 	ret = beiscsi_enable_pci(pcidev);
42366733b39aSJayamohan Kallickal 	if (ret < 0) {
423782284c09SDan Carpenter 		dev_err(&pcidev->dev, "beiscsi_dev_probe-"
42386733b39aSJayamohan Kallickal 			" Failed to enable pci device\n");
42396733b39aSJayamohan Kallickal 		return ret;
42406733b39aSJayamohan Kallickal 	}
42416733b39aSJayamohan Kallickal 
42426733b39aSJayamohan Kallickal 	phba = beiscsi_hba_alloc(pcidev);
42436733b39aSJayamohan Kallickal 	if (!phba) {
42446733b39aSJayamohan Kallickal 		dev_err(&pcidev->dev, "beiscsi_dev_probe-"
42456733b39aSJayamohan Kallickal 			" Failed in beiscsi_hba_alloc\n");
42466733b39aSJayamohan Kallickal 		goto disable_pci;
42476733b39aSJayamohan Kallickal 	}
42486733b39aSJayamohan Kallickal 
4249f98c96b0SJayamohan Kallickal 	switch (pcidev->device) {
4250f98c96b0SJayamohan Kallickal 	case BE_DEVICE_ID1:
4251f98c96b0SJayamohan Kallickal 	case OC_DEVICE_ID1:
4252f98c96b0SJayamohan Kallickal 	case OC_DEVICE_ID2:
4253f98c96b0SJayamohan Kallickal 		phba->generation = BE_GEN2;
4254f98c96b0SJayamohan Kallickal 		break;
4255f98c96b0SJayamohan Kallickal 	case BE_DEVICE_ID2:
4256f98c96b0SJayamohan Kallickal 	case OC_DEVICE_ID3:
4257f98c96b0SJayamohan Kallickal 		phba->generation = BE_GEN3;
4258f98c96b0SJayamohan Kallickal 		break;
4259f98c96b0SJayamohan Kallickal 	default:
4260f98c96b0SJayamohan Kallickal 		phba->generation = 0;
4261f98c96b0SJayamohan Kallickal 	}
4262f98c96b0SJayamohan Kallickal 
4263bfead3b2SJayamohan Kallickal 	if (enable_msix)
4264bfead3b2SJayamohan Kallickal 		num_cpus = find_num_cpus();
4265bfead3b2SJayamohan Kallickal 	else
4266bfead3b2SJayamohan Kallickal 		num_cpus = 1;
4267bfead3b2SJayamohan Kallickal 	phba->num_cpus = num_cpus;
4268bfead3b2SJayamohan Kallickal 	SE_DEBUG(DBG_LVL_8, "num_cpus = %d\n", phba->num_cpus);
4269bfead3b2SJayamohan Kallickal 
4270bfead3b2SJayamohan Kallickal 	if (enable_msix)
4271bfead3b2SJayamohan Kallickal 		beiscsi_msix_enable(phba);
42726733b39aSJayamohan Kallickal 	ret = be_ctrl_init(phba, pcidev);
42736733b39aSJayamohan Kallickal 	if (ret) {
42746733b39aSJayamohan Kallickal 		shost_printk(KERN_ERR, phba->shost, "beiscsi_dev_probe-"
42756733b39aSJayamohan Kallickal 				"Failed in be_ctrl_init\n");
42766733b39aSJayamohan Kallickal 		goto hba_free;
42776733b39aSJayamohan Kallickal 	}
42786733b39aSJayamohan Kallickal 
4279e9b91193SJayamohan Kallickal 	if (!num_hba) {
4280e9b91193SJayamohan Kallickal 		real_offset = (u8 *)phba->csr_va + MPU_EP_SEMAPHORE;
4281e9b91193SJayamohan Kallickal 		value = readl((void *)real_offset);
4282e9b91193SJayamohan Kallickal 		if (value & 0x00010000) {
4283e9b91193SJayamohan Kallickal 			gcrashmode++;
4284e9b91193SJayamohan Kallickal 			shost_printk(KERN_ERR, phba->shost,
4285e9b91193SJayamohan Kallickal 				"Loading Driver in crashdump mode\n");
4286e5285860SJayamohan Kallickal 			ret = beiscsi_cmd_reset_function(phba);
4287e9b91193SJayamohan Kallickal 			if (ret) {
4288e9b91193SJayamohan Kallickal 				shost_printk(KERN_ERR, phba->shost,
4289e9b91193SJayamohan Kallickal 					"Reset Failed. Aborting Crashdump\n");
4290e9b91193SJayamohan Kallickal 				goto hba_free;
4291e9b91193SJayamohan Kallickal 			}
4292e9b91193SJayamohan Kallickal 			ret = be_chk_reset_complete(phba);
4293e9b91193SJayamohan Kallickal 			if (ret) {
4294e9b91193SJayamohan Kallickal 				shost_printk(KERN_ERR, phba->shost,
4295e9b91193SJayamohan Kallickal 					"Failed to get out of reset."
4296e9b91193SJayamohan Kallickal 					"Aborting Crashdump\n");
4297e9b91193SJayamohan Kallickal 				goto hba_free;
4298e9b91193SJayamohan Kallickal 			}
4299e9b91193SJayamohan Kallickal 		} else {
4300e9b91193SJayamohan Kallickal 			value |= 0x00010000;
4301e9b91193SJayamohan Kallickal 			writel(value, (void *)real_offset);
4302e9b91193SJayamohan Kallickal 			num_hba++;
4303e9b91193SJayamohan Kallickal 		}
4304e9b91193SJayamohan Kallickal 	}
4305e9b91193SJayamohan Kallickal 
43066733b39aSJayamohan Kallickal 	spin_lock_init(&phba->io_sgl_lock);
43076733b39aSJayamohan Kallickal 	spin_lock_init(&phba->mgmt_sgl_lock);
43086733b39aSJayamohan Kallickal 	spin_lock_init(&phba->isr_lock);
43097da50879SJayamohan Kallickal 	ret = mgmt_get_fw_config(&phba->ctrl, phba);
43107da50879SJayamohan Kallickal 	if (ret != 0) {
43117da50879SJayamohan Kallickal 		shost_printk(KERN_ERR, phba->shost,
43127da50879SJayamohan Kallickal 			     "Error getting fw config\n");
43137da50879SJayamohan Kallickal 		goto free_port;
43147da50879SJayamohan Kallickal 	}
43157da50879SJayamohan Kallickal 	phba->shost->max_id = phba->fw_config.iscsi_cid_count;
43166733b39aSJayamohan Kallickal 	beiscsi_get_params(phba);
4317aa874f07SJayamohan Kallickal 	phba->shost->can_queue = phba->params.ios_per_ctrl;
43186733b39aSJayamohan Kallickal 	ret = beiscsi_init_port(phba);
43196733b39aSJayamohan Kallickal 	if (ret < 0) {
43206733b39aSJayamohan Kallickal 		shost_printk(KERN_ERR, phba->shost, "beiscsi_dev_probe-"
43216733b39aSJayamohan Kallickal 			     "Failed in beiscsi_init_port\n");
43226733b39aSJayamohan Kallickal 		goto free_port;
43236733b39aSJayamohan Kallickal 	}
43246733b39aSJayamohan Kallickal 
4325756d29c8SJayamohan Kallickal 	for (i = 0; i < MAX_MCC_CMD ; i++) {
4326756d29c8SJayamohan Kallickal 		init_waitqueue_head(&phba->ctrl.mcc_wait[i + 1]);
4327756d29c8SJayamohan Kallickal 		phba->ctrl.mcc_tag[i] = i + 1;
4328756d29c8SJayamohan Kallickal 		phba->ctrl.mcc_numtag[i + 1] = 0;
4329756d29c8SJayamohan Kallickal 		phba->ctrl.mcc_tag_available++;
4330756d29c8SJayamohan Kallickal 	}
4331756d29c8SJayamohan Kallickal 
4332756d29c8SJayamohan Kallickal 	phba->ctrl.mcc_alloc_index = phba->ctrl.mcc_free_index = 0;
4333756d29c8SJayamohan Kallickal 
43346733b39aSJayamohan Kallickal 	snprintf(phba->wq_name, sizeof(phba->wq_name), "beiscsi_q_irq%u",
43356733b39aSJayamohan Kallickal 		 phba->shost->host_no);
4336278274d5STejun Heo 	phba->wq = alloc_workqueue(phba->wq_name, WQ_MEM_RECLAIM, 1);
43376733b39aSJayamohan Kallickal 	if (!phba->wq) {
43386733b39aSJayamohan Kallickal 		shost_printk(KERN_ERR, phba->shost, "beiscsi_dev_probe-"
43396733b39aSJayamohan Kallickal 				"Failed to allocate work queue\n");
43406733b39aSJayamohan Kallickal 		goto free_twq;
43416733b39aSJayamohan Kallickal 	}
43426733b39aSJayamohan Kallickal 
43436733b39aSJayamohan Kallickal 	INIT_WORK(&phba->work_cqs, beiscsi_process_all_cqs);
43446733b39aSJayamohan Kallickal 
4345bfead3b2SJayamohan Kallickal 	phwi_ctrlr = phba->phwi_ctrlr;
4346bfead3b2SJayamohan Kallickal 	phwi_context = phwi_ctrlr->phwi_ctxt;
43476733b39aSJayamohan Kallickal 	if (blk_iopoll_enabled) {
4348bfead3b2SJayamohan Kallickal 		for (i = 0; i < phba->num_cpus; i++) {
4349bfead3b2SJayamohan Kallickal 			pbe_eq = &phwi_context->be_eq[i];
4350bfead3b2SJayamohan Kallickal 			blk_iopoll_init(&pbe_eq->iopoll, be_iopoll_budget,
4351bfead3b2SJayamohan Kallickal 					be_iopoll);
4352bfead3b2SJayamohan Kallickal 			blk_iopoll_enable(&pbe_eq->iopoll);
43536733b39aSJayamohan Kallickal 		}
4354bfead3b2SJayamohan Kallickal 	}
43556733b39aSJayamohan Kallickal 	ret = beiscsi_init_irqs(phba);
43566733b39aSJayamohan Kallickal 	if (ret < 0) {
43576733b39aSJayamohan Kallickal 		shost_printk(KERN_ERR, phba->shost, "beiscsi_dev_probe-"
43586733b39aSJayamohan Kallickal 			     "Failed to beiscsi_init_irqs\n");
43596733b39aSJayamohan Kallickal 		goto free_blkenbld;
43606733b39aSJayamohan Kallickal 	}
4361238f6b72SJayamohan Kallickal 	hwi_enable_intr(phba);
4362f457a46fSMike Christie 
4363f457a46fSMike Christie 	if (beiscsi_setup_boot_info(phba))
4364f457a46fSMike Christie 		/*
4365f457a46fSMike Christie 		 * log error but continue, because we may not be using
4366f457a46fSMike Christie 		 * iscsi boot.
4367f457a46fSMike Christie 		 */
4368f457a46fSMike Christie 		shost_printk(KERN_ERR, phba->shost, "Could not set up "
4369f457a46fSMike Christie 			     "iSCSI boot info.");
4370f457a46fSMike Christie 
43716733b39aSJayamohan Kallickal 	SE_DEBUG(DBG_LVL_8, "\n\n\n SUCCESS - DRIVER LOADED\n\n\n");
43726733b39aSJayamohan Kallickal 	return 0;
43736733b39aSJayamohan Kallickal 
43746733b39aSJayamohan Kallickal free_blkenbld:
43756733b39aSJayamohan Kallickal 	destroy_workqueue(phba->wq);
43766733b39aSJayamohan Kallickal 	if (blk_iopoll_enabled)
4377bfead3b2SJayamohan Kallickal 		for (i = 0; i < phba->num_cpus; i++) {
4378bfead3b2SJayamohan Kallickal 			pbe_eq = &phwi_context->be_eq[i];
4379bfead3b2SJayamohan Kallickal 			blk_iopoll_disable(&pbe_eq->iopoll);
4380bfead3b2SJayamohan Kallickal 		}
43816733b39aSJayamohan Kallickal free_twq:
43826733b39aSJayamohan Kallickal 	beiscsi_clean_port(phba);
43836733b39aSJayamohan Kallickal 	beiscsi_free_mem(phba);
43846733b39aSJayamohan Kallickal free_port:
4385e9b91193SJayamohan Kallickal 	real_offset = (u8 *)phba->csr_va + MPU_EP_SEMAPHORE;
4386e9b91193SJayamohan Kallickal 
4387e9b91193SJayamohan Kallickal 	value = readl((void *)real_offset);
4388e9b91193SJayamohan Kallickal 
4389e9b91193SJayamohan Kallickal 	if (value & 0x00010000) {
4390e9b91193SJayamohan Kallickal 		value &= 0xfffeffff;
4391e9b91193SJayamohan Kallickal 		writel(value, (void *)real_offset);
4392e9b91193SJayamohan Kallickal 	}
4393e9b91193SJayamohan Kallickal 
43946733b39aSJayamohan Kallickal 	pci_free_consistent(phba->pcidev,
43956733b39aSJayamohan Kallickal 			    phba->ctrl.mbox_mem_alloced.size,
43966733b39aSJayamohan Kallickal 			    phba->ctrl.mbox_mem_alloced.va,
43976733b39aSJayamohan Kallickal 			   phba->ctrl.mbox_mem_alloced.dma);
43986733b39aSJayamohan Kallickal 	beiscsi_unmap_pci_function(phba);
43996733b39aSJayamohan Kallickal hba_free:
4400238f6b72SJayamohan Kallickal 	if (phba->msix_enabled)
4401238f6b72SJayamohan Kallickal 		pci_disable_msix(phba->pcidev);
44026733b39aSJayamohan Kallickal 	iscsi_host_remove(phba->shost);
44036733b39aSJayamohan Kallickal 	pci_dev_put(phba->pcidev);
44046733b39aSJayamohan Kallickal 	iscsi_host_free(phba->shost);
44056733b39aSJayamohan Kallickal disable_pci:
44066733b39aSJayamohan Kallickal 	pci_disable_device(pcidev);
44076733b39aSJayamohan Kallickal 	return ret;
44086733b39aSJayamohan Kallickal }
44096733b39aSJayamohan Kallickal 
44106733b39aSJayamohan Kallickal struct iscsi_transport beiscsi_iscsi_transport = {
44116733b39aSJayamohan Kallickal 	.owner = THIS_MODULE,
44126733b39aSJayamohan Kallickal 	.name = DRV_NAME,
44139db0fb3aSJayamohan Kallickal 	.caps = CAP_RECOVERY_L0 | CAP_HDRDGST | CAP_TEXT_NEGO |
44146733b39aSJayamohan Kallickal 		CAP_MULTI_R2T | CAP_DATADGST | CAP_DATA_PATH_OFFLOAD,
44156733b39aSJayamohan Kallickal 	.create_session = beiscsi_session_create,
44166733b39aSJayamohan Kallickal 	.destroy_session = beiscsi_session_destroy,
44176733b39aSJayamohan Kallickal 	.create_conn = beiscsi_conn_create,
44186733b39aSJayamohan Kallickal 	.bind_conn = beiscsi_conn_bind,
44196733b39aSJayamohan Kallickal 	.destroy_conn = iscsi_conn_teardown,
44203128c6c7SMike Christie 	.attr_is_visible = be2iscsi_attr_is_visible,
44216733b39aSJayamohan Kallickal 	.set_param = beiscsi_set_param,
4422c7f7fd5bSMike Christie 	.get_conn_param = iscsi_conn_get_param,
44236733b39aSJayamohan Kallickal 	.get_session_param = iscsi_session_get_param,
44246733b39aSJayamohan Kallickal 	.get_host_param = beiscsi_get_host_param,
44256733b39aSJayamohan Kallickal 	.start_conn = beiscsi_conn_start,
4426fa95d206SMike Christie 	.stop_conn = iscsi_conn_stop,
44276733b39aSJayamohan Kallickal 	.send_pdu = iscsi_conn_send_pdu,
44286733b39aSJayamohan Kallickal 	.xmit_task = beiscsi_task_xmit,
44296733b39aSJayamohan Kallickal 	.cleanup_task = beiscsi_cleanup_task,
44306733b39aSJayamohan Kallickal 	.alloc_pdu = beiscsi_alloc_pdu,
44316733b39aSJayamohan Kallickal 	.parse_pdu_itt = beiscsi_parse_pdu,
44326733b39aSJayamohan Kallickal 	.get_stats = beiscsi_conn_get_stats,
4433c7f7fd5bSMike Christie 	.get_ep_param = beiscsi_ep_get_param,
44346733b39aSJayamohan Kallickal 	.ep_connect = beiscsi_ep_connect,
44356733b39aSJayamohan Kallickal 	.ep_poll = beiscsi_ep_poll,
44366733b39aSJayamohan Kallickal 	.ep_disconnect = beiscsi_ep_disconnect,
44376733b39aSJayamohan Kallickal 	.session_recovery_timedout = iscsi_session_recovery_timedout,
44386733b39aSJayamohan Kallickal };
44396733b39aSJayamohan Kallickal 
44406733b39aSJayamohan Kallickal static struct pci_driver beiscsi_pci_driver = {
44416733b39aSJayamohan Kallickal 	.name = DRV_NAME,
44426733b39aSJayamohan Kallickal 	.probe = beiscsi_dev_probe,
44436733b39aSJayamohan Kallickal 	.remove = beiscsi_remove,
444425602c97SJayamohan Kallickal 	.shutdown = beiscsi_shutdown,
44456733b39aSJayamohan Kallickal 	.id_table = beiscsi_pci_id_table
44466733b39aSJayamohan Kallickal };
44476733b39aSJayamohan Kallickal 
4448bfead3b2SJayamohan Kallickal 
44496733b39aSJayamohan Kallickal static int __init beiscsi_module_init(void)
44506733b39aSJayamohan Kallickal {
44516733b39aSJayamohan Kallickal 	int ret;
44526733b39aSJayamohan Kallickal 
44536733b39aSJayamohan Kallickal 	beiscsi_scsi_transport =
44546733b39aSJayamohan Kallickal 			iscsi_register_transport(&beiscsi_iscsi_transport);
44556733b39aSJayamohan Kallickal 	if (!beiscsi_scsi_transport) {
44566733b39aSJayamohan Kallickal 		SE_DEBUG(DBG_LVL_1,
44576733b39aSJayamohan Kallickal 			 "beiscsi_module_init - Unable to  register beiscsi"
44586733b39aSJayamohan Kallickal 			 "transport.\n");
4459f55a24f2SJayamohan Kallickal 		return -ENOMEM;
44606733b39aSJayamohan Kallickal 	}
44616733b39aSJayamohan Kallickal 	SE_DEBUG(DBG_LVL_8, "In beiscsi_module_init, tt=%p\n",
44626733b39aSJayamohan Kallickal 		 &beiscsi_iscsi_transport);
44636733b39aSJayamohan Kallickal 
44646733b39aSJayamohan Kallickal 	ret = pci_register_driver(&beiscsi_pci_driver);
44656733b39aSJayamohan Kallickal 	if (ret) {
44666733b39aSJayamohan Kallickal 		SE_DEBUG(DBG_LVL_1,
44676733b39aSJayamohan Kallickal 			 "beiscsi_module_init - Unable to  register"
44686733b39aSJayamohan Kallickal 			 "beiscsi pci driver.\n");
44696733b39aSJayamohan Kallickal 		goto unregister_iscsi_transport;
44706733b39aSJayamohan Kallickal 	}
44716733b39aSJayamohan Kallickal 	return 0;
44726733b39aSJayamohan Kallickal 
44736733b39aSJayamohan Kallickal unregister_iscsi_transport:
44746733b39aSJayamohan Kallickal 	iscsi_unregister_transport(&beiscsi_iscsi_transport);
44756733b39aSJayamohan Kallickal 	return ret;
44766733b39aSJayamohan Kallickal }
44776733b39aSJayamohan Kallickal 
44786733b39aSJayamohan Kallickal static void __exit beiscsi_module_exit(void)
44796733b39aSJayamohan Kallickal {
44806733b39aSJayamohan Kallickal 	pci_unregister_driver(&beiscsi_pci_driver);
44816733b39aSJayamohan Kallickal 	iscsi_unregister_transport(&beiscsi_iscsi_transport);
44826733b39aSJayamohan Kallickal }
44836733b39aSJayamohan Kallickal 
44846733b39aSJayamohan Kallickal module_init(beiscsi_module_init);
44856733b39aSJayamohan Kallickal module_exit(beiscsi_module_exit);
4486