From: Nicholas Bellinger <nab@xxxxxxxxxxxxxxx> This patch adds support for qla2xxx series target mode using a new target fabric module API based on SCST qla2x00t LLD code using a 8.02.01-k4 version, and refactors 80% of the qla2x00t module code into qla2xxx LLD code at qla2x_target.c using modern 8.03.04-k0 and v4.0 target/configfs infrastructure presented as a seperate patch to tcm_qla2xxx.ko This patch introduces a new target fabric module API in qla2x_tgt_def.h here: struct qla_target_template { int (*handle_cmd)(scsi_qla_host_t *, struct q2t_cmd *, uint32_t, uint32_t, int, int, int); int (*handle_data)(struct q2t_cmd *); int (*handle_tmr)(struct q2t_mgmt_cmd *, uint32_t, uint8_t); void (*free_cmd)(struct q2t_cmd *); void (*free_session)(struct q2t_sess *); int (*check_initiator_node_acl)(scsi_qla_host_t *, void *, uint8_t *, uint16_t); struct q2t_sess *(*find_sess_by_loop_id)(scsi_qla_host_t *, const uint16_t); struct q2t_sess *(*find_sess_by_s_id)(scsi_qla_host_t *, const uint8_t *); }; This is called via scsi_qla_host_t->hw->qla2x_tmpl within both existing qla2xxx LLD and new qla2x_target.c code to process LLD internal target mode operations and tcm_qla2xxx fabric module specific operations for callers within qla2x_target.c. There are still a handful of TODO items including proper FC SRR support (service retransmission request) and TMRs currently using hardcoded LUN=0, but the main pieces are up and running, and properly handling nexus reset and tcm_qla2xxx module shutdown+restart w/o having to reload qla2xxx.ko Signed-off-by: Nicholas A. Bellinger <nab@xxxxxxxxxxxxxxx> --- drivers/scsi/qla2xxx/qla2x_target.c | 5060 ++++++++++++++++++++++++++++++++++ drivers/scsi/qla2xxx/qla2x_target.h | 290 ++ drivers/scsi/qla2xxx/qla2x_tgt.h | 140 + drivers/scsi/qla2xxx/qla2x_tgt_def.h | 717 +++++ 4 files changed, 6207 insertions(+), 0 deletions(-) create mode 100644 drivers/scsi/qla2xxx/qla2x_target.c create mode 100644 drivers/scsi/qla2xxx/qla2x_target.h create mode 100644 drivers/scsi/qla2xxx/qla2x_tgt.h create mode 100644 drivers/scsi/qla2xxx/qla2x_tgt_def.h diff --git a/drivers/scsi/qla2xxx/qla2x_target.c b/drivers/scsi/qla2xxx/qla2x_target.c new file mode 100644 index 0000000..59a8885 --- /dev/null +++ b/drivers/scsi/qla2xxx/qla2x_target.c @@ -0,0 +1,5060 @@ +/* + * qla2x_target.c SCSI LLD infrastructure for QLogic 22xx/23xx/24xx/25xx + * + * based on qla2x00t.c code: + * + * Copyright (C) 2004 - 2010 Vladislav Bolkhovitin <vst@xxxxxxxx> + * Copyright (C) 2004 - 2005 Leonid Stoljar + * Copyright (C) 2006 Nathaniel Clark <nate@xxxxxxxxxx> + * Copyright (C) 2006 - 2010 ID7 Ltd. + * + * Forward port and refactoring to modern qla2xxx and target/configfs + * + * Copyright (C) 2010 Nicholas A. Bellinger <nab@xxxxxxxxxx> + * + * This program is free software; you can redistribute it and/or + * modify it under the terms of the GNU General Public License + * as published by the Free Software Foundation, version 2 + * of the License. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + */ + +#include <linux/module.h> +#include <linux/init.h> +#include <linux/types.h> +#include <linux/version.h> +#include <linux/blkdev.h> +#include <linux/interrupt.h> +#include <scsi/scsi.h> +#include <scsi/scsi_host.h> +#include <linux/pci.h> +#include <linux/delay.h> +#include <linux/list.h> +#include <asm/unaligned.h> +#include <target/target_core_base.h> +#include <target/target_core_transport.h> +#include <target/target_core_fabric_ops.h> +#include <target/target_core_tmr.h> + +#include "qla_def.h" +#include "qla2x_tgt.h" +#include "qla2x_target.h" + +/* + * From scsi/fc/fc_fcp.h + */ +enum fcp_resp_rsp_codes { + FCP_TMF_CMPL = 0, + FCP_DATA_LEN_INVALID = 1, + FCP_CMND_FIELDS_INVALID = 2, + FCP_DATA_PARAM_MISMATCH = 3, + FCP_TMF_REJECTED = 4, + FCP_TMF_FAILED = 5, + FCP_TMF_INVALID_LUN = 9, +}; + +/* + * fc_pri_ta from scsi/fc/fc_fcp.h + */ +#define FCP_PTA_SIMPLE 0 /* simple task attribute */ +#define FCP_PTA_HEADQ 1 /* head of queue task attribute */ +#define FCP_PTA_ORDERED 2 /* ordered task attribute */ +#define FCP_PTA_ACA 4 /* auto. contigent allegiance */ +#define FCP_PTA_MASK 7 /* mask for task attribute field */ +#define FCP_PRI_SHIFT 3 /* priority field starts in bit 3 */ +#define FCP_PRI_RESVD_MASK 0x80 /* reserved bits in priority field */ + +/* + * This driver calls qla2x00_req_pkt() and qla2x00_issue_marker(), which + * must be called under HW lock and could unlock/lock it inside. + * It isn't an issue, since in the current implementation on the time when + * those functions are called: + * + * - Either context is IRQ and only IRQ handler can modify HW data, + * including rings related fields, + * + * - Or access to target mode variables from struct q2t_tgt doesn't + * cross those functions boundaries, except tgt_stop, which + * additionally protected by irq_cmd_count. + */ + +#if 0 +#define TRACE_DBG(x...) printk(KERN_INFO x) +#else +#define TRACE_DBG(x...) +#endif + +#if 0 +#define TRACE_MGMT_DBG(x...) printk(KERN_INFO x) +#else +#define TRACE_MGMT_DBG(x...) +#endif + +#if 0 +#define TRACE_SCSI(x...) printk(KERN_INFO x) +#else +#define TRACE_SCSI(x...) +#endif + +#if 0 +#define TRACE_SG(x...) printk(KERN_INFO x) +#else +#define TRACE_SG(x...) +#endif + +#if 0 +#define TRACE_MGMT(x...) printk(KERN_INFO x) +#else +#define TRACE_MGMT(x...) +#endif + +#define TRACE_BUFFER(x, buff, len) + +static int __q24_xmit_response(struct q2t_cmd *, int, uint8_t); + +/* Predefs for callbacks handed to qla2xxx(target) */ +static void q24_atio_pkt(scsi_qla_host_t *ha, atio7_entry_t *pkt); +static void q2t_response_pkt(scsi_qla_host_t *ha, response_t *pkt); +static int q2t_issue_task_mgmt(struct q2t_sess *sess, uint32_t lun, + int lun_size, int fn, void *iocb, int flags); +static void q2x_send_term_exchange(scsi_qla_host_t *ha, struct q2t_cmd *cmd, + atio_entry_t *atio, int ha_locked); +static void q24_send_term_exchange(scsi_qla_host_t *ha, struct q2t_cmd *cmd, + atio7_entry_t *atio, int ha_locked); +static void q2t_reject_free_srr_imm(scsi_qla_host_t *ha, struct srr_imm *imm, + int ha_lock); +static int q2t_cut_cmd_data_head(struct q2t_cmd *cmd, unsigned int offset); +static void q2t_clear_tgt_db(struct q2t_tgt *tgt, bool local_only); +static int q2t_unreg_sess(struct q2t_sess *sess); + + +/* + * Global Variables + */ + +static struct kmem_cache *q2t_cmd_cachep; +static struct kmem_cache *q2t_mgmt_cmd_cachep; +static mempool_t *q2t_mgmt_cmd_mempool; + +static DECLARE_RWSEM(q2t_unreg_rwsem); + +/* ha->hardware_lock supposed to be held on entry */ +static inline void q2t_sess_get(struct q2t_sess *sess) +{ + sess->sess_ref++; + TRACE_DBG("sess %p, new sess_ref %d\n", sess, sess->sess_ref); +} + +/* ha->hardware_lock supposed to be held on entry */ +static inline void q2t_sess_put(struct q2t_sess *sess) +{ + TRACE_DBG("sess %p, new sess_ref %d\n", sess, sess->sess_ref-1); + BUG_ON(sess->sess_ref == 0); + + sess->sess_ref--; + if (sess->sess_ref == 0) + q2t_unreg_sess(sess); +} + +/* ha->hardware_lock supposed to be held on entry (to protect tgt->sess_list) */ +static struct q2t_sess *q2t_find_sess_by_port_name( + struct q2t_tgt *tgt, + const uint8_t *port_name) +{ + struct q2t_sess *sess; + + list_for_each_entry(sess, &tgt->sess_list, sess_list_entry) { + if ((sess->port_name[0] == port_name[0]) && + (sess->port_name[1] == port_name[1]) && + (sess->port_name[2] == port_name[2]) && + (sess->port_name[3] == port_name[3]) && + (sess->port_name[4] == port_name[4]) && + (sess->port_name[5] == port_name[5]) && + (sess->port_name[6] == port_name[6]) && + (sess->port_name[7] == port_name[7])) + return sess; + } + + return NULL; +} + + +/* ha->hardware_lock supposed to be held on entry */ +static inline request_t *q2t_req_pkt(scsi_qla_host_t *vha) +{ + return qla2x00_req_pkt(vha); +} + +/* Might release hw lock, then reaquire!! */ +static inline int q2t_issue_marker(scsi_qla_host_t *vha, int vha_locked) +{ + /* Send marker if required */ + if (unlikely(vha->marker_needed != 0)) { + int rc = qla2x00_issue_marker(vha, vha_locked); + if (rc != QLA_SUCCESS) { + printk(KERN_ERR "qla2x00t(%d): issue_marker() " + "failed\n", vha->vp_idx); + } + return rc; + } + return QLA_SUCCESS; +} + +static inline +scsi_qla_host_t *q2t_find_host_by_d_id(scsi_qla_host_t *vha, uint8_t *d_id) +{ + struct qla_hw_data *ha = vha->hw; + + if ((vha->d_id.b.area != d_id[1]) || (vha->d_id.b.domain != d_id[0])) + return NULL; + + if (vha->d_id.b.al_pa == d_id[2]) + return vha; + + if (IS_FWI2_CAPABLE(ha)) { + uint8_t vp_idx; + BUG_ON(ha->tgt_vp_map == NULL); + vp_idx = ha->tgt_vp_map[d_id[2]].idx; + if (likely(test_bit(vp_idx, ha->vp_idx_map))) + return ha->tgt_vp_map[vp_idx].vha; + } + + return NULL; +} + +static inline +scsi_qla_host_t *q2t_find_host_by_vp_idx(scsi_qla_host_t *vha, uint16_t vp_idx) +{ + struct qla_hw_data *ha = vha->hw; + + if (vha->vp_idx == vp_idx) + return vha; + + if (IS_FWI2_CAPABLE(ha)) { + BUG_ON(ha->tgt_vp_map == NULL); + if (likely(test_bit(vp_idx, ha->vp_idx_map))) + return ha->tgt_vp_map[vp_idx].vha; + } + + return NULL; +} + +void q24_atio_pkt_all_vps(scsi_qla_host_t *vha, atio7_entry_t *atio) +{ + struct qla_hw_data *ha = vha->hw; + + switch (atio->entry_type) { + case ATIO_TYPE7: + { + scsi_qla_host_t *host = q2t_find_host_by_d_id(vha, atio->fcp_hdr.d_id); + if (unlikely(NULL == host)) { + printk(KERN_ERR "qla2x00t(%d): Received ATIO_TYPE7 " + "with unknown d_id %x:%x:%x\n", vha->vp_idx, + atio->fcp_hdr.d_id[0], atio->fcp_hdr.d_id[1], + atio->fcp_hdr.d_id[2]); + break; + } + q24_atio_pkt(host, atio); + break; + } + + case IMMED_NOTIFY_TYPE: + { + scsi_qla_host_t *host = vha; + + if (IS_FWI2_CAPABLE(ha)) { + notify24xx_entry_t *entry = (notify24xx_entry_t *)atio; + if ((entry->vp_index != 0xFF) && + (entry->nport_handle != 0xFFFF)) { + host = q2t_find_host_by_vp_idx(vha, + entry->vp_index); + if (unlikely(!host)) { + printk(KERN_ERR "qla2x00t(%d): Received " + "ATIO (IMMED_NOTIFY_TYPE) " + "with unknown vp_index %d\n", + vha->vp_idx, entry->vp_index); + break; + } + } + } + q24_atio_pkt(host, atio); + break; + } + + default: + printk(KERN_ERR "qla2x00t(%d): Received unknown ATIO atio " + "type %x\n", vha->vp_idx, atio->entry_type); + break; + } + + return; +} + +void q2t_response_pkt_all_vps(scsi_qla_host_t *vha, response_t *pkt) +{ + struct qla_hw_data *ha = vha->hw; + + switch (pkt->entry_type) { + case CTIO_TYPE7: + { + ctio7_fw_entry_t *entry = (ctio7_fw_entry_t *)pkt; + scsi_qla_host_t *host = q2t_find_host_by_vp_idx(vha, + entry->vp_index); + if (unlikely(!host)) { + printk(KERN_ERR "qla2x00t(%d): Response pkt (CTIO_TYPE7) " + "received, with unknown vp_index %d\n", + vha->vp_idx, entry->vp_index); + break; + } + q2t_response_pkt(host, pkt); + break; + } + + case IMMED_NOTIFY_TYPE: + { + scsi_qla_host_t *host = vha; + if (IS_FWI2_CAPABLE(ha)) { + notify24xx_entry_t *entry = (notify24xx_entry_t *)pkt; + host = q2t_find_host_by_vp_idx(vha, entry->vp_index); + if (unlikely(!host)) { + printk(KERN_ERR "qla2x00t(%d): Response pkt " + "(IMMED_NOTIFY_TYPE) received, " + "with unknown vp_index %d\n", + vha->vp_idx, entry->vp_index); + break; + } + } + q2t_response_pkt(host, pkt); + break; + } + + case NOTIFY_ACK_TYPE: + { + scsi_qla_host_t *host = vha; + if (IS_FWI2_CAPABLE(ha)) { + nack24xx_entry_t *entry = (nack24xx_entry_t *)pkt; + if (0xFF != entry->vp_index) { + host = q2t_find_host_by_vp_idx(vha, + entry->vp_index); + if (unlikely(!host)) { + printk(KERN_ERR "qla2x00t(%d): Response " + "pkt (NOTIFY_ACK_TYPE) " + "received, with unknown " + "vp_index %d\n", vha->vp_idx, + entry->vp_index); + break; + } + } + } + q2t_response_pkt(host, pkt); + break; + } + + case ABTS_RECV_24XX: + { + abts24_recv_entry_t *entry = (abts24_recv_entry_t *)pkt; + scsi_qla_host_t *host = q2t_find_host_by_vp_idx(vha, + entry->vp_index); + if (unlikely(!host)) { + printk(KERN_ERR "qla2x00t(%d): Response pkt " + "(ABTS_RECV_24XX) received, with unknown " + "vp_index %d\n", vha->vp_idx, entry->vp_index); + break; + } + q2t_response_pkt(host, pkt); + break; + } + + case ABTS_RESP_24XX: + { + abts24_resp_entry_t *entry = (abts24_resp_entry_t *)pkt; + scsi_qla_host_t *host = q2t_find_host_by_vp_idx(vha, + entry->vp_index); + if (unlikely(!host)) { + printk(KERN_ERR "qla2x00t(%d): Response pkt " + "(ABTS_RECV_24XX) received, with unknown " + "vp_index %d\n", vha->vp_idx, entry->vp_index); + break; + } + q2t_response_pkt(host, pkt); + break; + } + + default: + q2t_response_pkt(vha, pkt); + break; + } + +} + + +/* ha->hardware_lock supposed to be held on entry */ +static void q2t_free_session_done(struct q2t_sess *sess) +{ + struct q2t_tgt *tgt; + scsi_qla_host_t *vha = sess->vha; + struct qla_hw_data *ha = vha->hw; + + tgt = sess->tgt; + /* + * Release the target session for FC Nexus from fabric module code. + */ + if (sess->se_sess != NULL) + ha->qla2x_tmpl->free_session(sess); + + TRACE_MGMT_DBG("Unregistration of sess %p finished\n", sess); + + kfree(sess); + + if (!tgt) + return; + + TRACE_DBG("empty(sess_list) %d sess_count %d\n", + list_empty(&tgt->sess_list), tgt->sess_count); + + ha = tgt->ha; + /* + * We need to protect against race, when tgt is freed before or + * inside wake_up() + */ + tgt->sess_count--; + if (tgt->sess_count == 0) + wake_up_all(&tgt->waitQ); +} + +/* ha->hardware_lock supposed to be held on entry */ +static int q2t_unreg_sess(struct q2t_sess *sess) +{ + int res = 1; + + BUG_ON(sess == NULL); + BUG_ON(sess->sess_ref != 0); + + list_del(&sess->sess_list_entry); + + if (sess->deleted) + list_del(&sess->del_list_entry); + + printk(KERN_INFO "qla2x00t(%d): %ssession for loop_id %d deleted\n", + sess->vha->vp_idx, sess->local ? "local " : "", + sess->loop_id); + + q2t_free_session_done(sess); + + return res; +} + +/* ha->hardware_lock supposed to be held on entry */ +static int q2t_reset(scsi_qla_host_t *vha, void *iocb, int mcmd) +{ + struct qla_hw_data *ha = vha->hw; + struct q2t_sess *sess = NULL; + uint16_t lun = 0, loop_id; + int res = 0; + uint8_t s_id[3]; + + memset(&s_id, 0, 3); + + if (IS_FWI2_CAPABLE(ha)) { + notify24xx_entry_t *n = (notify24xx_entry_t *)iocb; + loop_id = le16_to_cpu(n->nport_handle); + s_id[0] = n->port_id[0]; + s_id[1] = n->port_id[1]; + s_id[2] = n->port_id[2]; + } else + loop_id = GET_TARGET_ID(ha, (notify_entry_t *)iocb); + + if (loop_id == 0xFFFF) { +#warning FIXME: Re-enable Global event handling.. +#if 0 + /* Global event */ + printk("Processing q2t_reset with loop_id=0xffff global event............\n"); + atomic_inc(&ha->q2t_tgt->tgt_global_resets_count); + q2t_clear_tgt_db(ha->q2t_tgt, 1); + if (!list_empty(&ha->q2t_tgt->sess_list)) { + sess = list_entry(ha->q2t_tgt->sess_list.next, + typeof(*sess), sess_list_entry); + switch (mcmd) { + case Q2T_NEXUS_LOSS_SESS: + mcmd = Q2T_NEXUS_LOSS; + break; + case Q2T_ABORT_ALL_SESS: + mcmd = Q2T_ABORT_ALL; + break; + case Q2T_NEXUS_LOSS: + case Q2T_ABORT_ALL: + break; + default: + printk(KERN_ERR "qla2x00t(%d): Not allowed " + "command %x in %s", vha->vp_idx, + mcmd, __func__); + sess = NULL; + break; + } + } else + sess = NULL; +#endif + } else { + sess = ha->qla2x_tmpl->find_sess_by_loop_id(vha, loop_id); + } + + TRACE_DBG("Using sess for q2t_reset: %p\n", sess); + if (!sess) { + res = -ESRCH; + ha->q2t_tgt->tm_to_unknown = 1; + return res; + } + + printk(KERN_INFO "scsi(%ld): resetting (session %p from port " + "%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x, " + "mcmd %x, loop_id %d)\n", vha->host_no, sess, + sess->port_name[0], sess->port_name[1], + sess->port_name[2], sess->port_name[3], + sess->port_name[4], sess->port_name[5], + sess->port_name[6], sess->port_name[7], + mcmd, loop_id); + + return q2t_issue_task_mgmt(sess, lun, sizeof(lun), mcmd, + iocb, Q24_MGMT_SEND_NACK); +} + +/* ha->hardware_lock supposed to be held on entry */ +static void q2t_schedule_sess_for_deletion(struct q2t_sess *sess) +{ + struct q2t_tgt *tgt = sess->tgt; + uint32_t dev_loss_tmo = tgt->ha->port_down_retry_count + 5; + bool schedule; + + if (sess->deleted) + return; + /* + * If the list is empty, then, most likely, the work isn't + * scheduled. + */ + schedule = list_empty(&tgt->del_sess_list); + + TRACE_DBG("Scheduling sess %p for deletion (schedule %d)", sess, + schedule); + list_add_tail(&sess->del_list_entry, &tgt->del_sess_list); + sess->deleted = 1; + sess->expires = jiffies + dev_loss_tmo * HZ; + + printk(KERN_INFO "qla2x00t(%d): session for port %02x:%02x:%02x:" + "%02x:%02x:%02x:%02x:%02x (loop ID %d) scheduled for " + "deletion in %d secs\n", sess->vha->vp_idx, + sess->port_name[0], sess->port_name[1], + sess->port_name[2], sess->port_name[3], + sess->port_name[4], sess->port_name[5], + sess->port_name[6], sess->port_name[7], + sess->loop_id, dev_loss_tmo); + + if (schedule) + schedule_delayed_work(&tgt->sess_del_work, + jiffies - sess->expires); +} + +/* ha->hardware_lock supposed to be held on entry */ +static void q2t_clear_tgt_db(struct q2t_tgt *tgt, bool local_only) +{ + struct q2t_sess *sess, *sess_tmp; + + list_for_each_entry_safe(sess, sess_tmp, &tgt->sess_list, + sess_list_entry) { + if (local_only) { + if (!sess->local) + continue; + q2t_schedule_sess_for_deletion(sess); + } else + q2t_sess_put(sess); + } + + /* At this point tgt could be already dead */ +} + +static int q24_get_loop_id(scsi_qla_host_t *vha, const uint8_t *s_id, + uint16_t *loop_id) +{ + struct qla_hw_data *ha = vha->hw; + dma_addr_t gid_list_dma; + struct gid_list_info *gid_list; + char *id_iter; + int res, rc, i; + uint16_t entries; + + gid_list = dma_alloc_coherent(&ha->pdev->dev, GID_LIST_SIZE, + &gid_list_dma, GFP_KERNEL); + if (!gid_list) { + printk(KERN_ERR "qla2x00t(%d): DMA Alloc failed of %zd\n", + vha->vp_idx, GID_LIST_SIZE); + return -ENOMEM; + } + + /* Get list of logged in devices */ + rc = qla2x00_get_id_list(vha, gid_list, gid_list_dma, &entries); + if (rc != QLA_SUCCESS) { + printk(KERN_ERR "qla2x00t(%d): get_id_list() failed: %x\n", + vha->vp_idx, rc); + res = -1; + goto out_free_id_list; + } + + id_iter = (char *)gid_list; + res = -1; + for (i = 0; i < entries; i++) { + struct gid_list_info *gid = (struct gid_list_info *)id_iter; + if ((gid->al_pa == s_id[2]) && + (gid->area == s_id[1]) && + (gid->domain == s_id[0])) { + *loop_id = le16_to_cpu(gid->loop_id); + res = 0; + break; + } + id_iter += ha->gid_list_info_size; + } + +out_free_id_list: + dma_free_coherent(&ha->pdev->dev, GID_LIST_SIZE, gid_list, gid_list_dma); + + return res; +} + +static bool q2t_check_fcport_exist(scsi_qla_host_t *vha, struct q2t_sess *sess) +{ + struct qla_hw_data *ha = vha->hw; + bool res, found = false; + int rc, i; + uint16_t loop_id = 0xFFFF; /* to eliminate compiler's warning */ + uint16_t entries; + void *pmap; + int pmap_len; + fc_port_t *fcport; + int global_resets; + +retry: + global_resets = atomic_read(&ha->q2t_tgt->tgt_global_resets_count); + + rc = qla2x00_get_node_name_list(vha, &pmap, &pmap_len); + if (rc != QLA_SUCCESS) { + res = false; + goto out; + } + + if (IS_FWI2_CAPABLE(ha)) { + struct qla_port24_data *pmap24 = pmap; + + entries = pmap_len/sizeof(*pmap24); + + for (i = 0; i < entries; ++i) { + if ((sess->port_name[0] == pmap24[i].port_name[0]) && + (sess->port_name[1] == pmap24[i].port_name[1]) && + (sess->port_name[2] == pmap24[i].port_name[2]) && + (sess->port_name[3] == pmap24[i].port_name[3]) && + (sess->port_name[4] == pmap24[i].port_name[4]) && + (sess->port_name[5] == pmap24[i].port_name[5]) && + (sess->port_name[6] == pmap24[i].port_name[6]) && + (sess->port_name[7] == pmap24[i].port_name[7])) { + loop_id = le16_to_cpu(pmap24[i].loop_id); + found = true; + break; + } + } + } else { + struct qla_port23_data *pmap2x = pmap; + + entries = pmap_len/sizeof(*pmap2x); + + for (i = 0; i < entries; ++i) { + if ((sess->port_name[0] == pmap2x[i].port_name[0]) && + (sess->port_name[1] == pmap2x[i].port_name[1]) && + (sess->port_name[2] == pmap2x[i].port_name[2]) && + (sess->port_name[3] == pmap2x[i].port_name[3]) && + (sess->port_name[4] == pmap2x[i].port_name[4]) && + (sess->port_name[5] == pmap2x[i].port_name[5]) && + (sess->port_name[6] == pmap2x[i].port_name[6]) && + (sess->port_name[7] == pmap2x[i].port_name[7])) { + loop_id = le16_to_cpu(pmap2x[i].loop_id); + found = true; + break; + } + } + } + + kfree(pmap); + + if (!found) { + res = false; + goto out; + } + + printk(KERN_INFO "q2t_check_fcport_exist(): loop_id %d", loop_id); + + fcport = kzalloc(sizeof(*fcport), GFP_KERNEL); + if (fcport == NULL) { + printk(KERN_ERR "qla2x00t(%d): Allocation of tmp FC port failed", + vha->vp_idx); + res = false; + goto out; + } + + fcport->loop_id = loop_id; + + rc = qla2x00_get_port_database(vha, fcport, 0); + if (rc != QLA_SUCCESS) { + printk(KERN_ERR "qla2x00t(%d): Failed to retrieve fcport " + "information -- get_port_database() returned %x " + "(loop_id=0x%04x)", vha->vp_idx, rc, loop_id); + res = false; + goto out_free_fcport; + } + + if (global_resets != atomic_read(&ha->q2t_tgt->tgt_global_resets_count)) { + TRACE_MGMT_DBG("qla2x00t(%d): global reset during session " + "discovery (counter was %d, new %d), retrying", + vha->vp_idx, global_resets, + atomic_read(&ha->q2t_tgt->tgt_global_resets_count)); + goto retry; + } + + TRACE_MGMT_DBG("Updating sess %p s_id %x:%x:%x, " + "loop_id %d) to d_id %x:%x:%x, loop_id %d", sess, + sess->s_id.b.domain, sess->s_id.b.al_pa, + sess->s_id.b.area, sess->loop_id, fcport->d_id.b.domain, + fcport->d_id.b.al_pa, fcport->d_id.b.area, fcport->loop_id); + + sess->s_id = fcport->d_id; + sess->loop_id = fcport->loop_id; + sess->conf_compl_supported = fcport->conf_compl_supported; + + res = true; + +out_free_fcport: + kfree(fcport); + +out: + return res; +} + +/* ha->hardware_lock supposed to be held on entry */ +static void q2t_undelete_sess(struct q2t_sess *sess) +{ + BUG_ON(!sess->deleted); + + list_del(&sess->del_list_entry); + sess->deleted = 0; +} + +static void q2t_del_sess_work_fn(struct delayed_work *work) +{ + struct q2t_tgt *tgt = container_of(work, struct q2t_tgt, + sess_del_work); + scsi_qla_host_t *vha = tgt->vha; + struct qla_hw_data *ha = vha->hw; + struct q2t_sess *sess; + unsigned long flags; + + spin_lock_irqsave(&ha->hardware_lock, flags); + while (!list_empty(&tgt->del_sess_list)) { + sess = list_entry(tgt->del_sess_list.next, typeof(*sess), + del_list_entry); + if (time_after_eq(jiffies, sess->expires)) { + bool cancel; + + q2t_undelete_sess(sess); + + spin_unlock_irqrestore(&ha->hardware_lock, flags); + cancel = q2t_check_fcport_exist(vha, sess); + spin_lock_irqsave(&ha->hardware_lock, flags); + + if (cancel) { + if (sess->deleted) { + /* + * sess was again deleted while we were + * discovering it + */ + continue; + } + + printk(KERN_INFO "qla2x00t(%d): cancel deletion of " + "session for port %02x:%02x:%02x:%02x:%02x:" + "%02x:%02x:%02x (loop ID %d), because it isn't" + " deleted by firmware", vha->vp_idx, + sess->port_name[0], sess->port_name[1], + sess->port_name[2], sess->port_name[3], + sess->port_name[4], sess->port_name[5], + sess->port_name[6], sess->port_name[7], + sess->loop_id); + } else { + TRACE_MGMT_DBG("Timeout: sess %p about to be " + "deleted\n", sess); + q2t_sess_put(sess); + } + } else { + schedule_delayed_work(&tgt->sess_del_work, + jiffies - sess->expires); + break; + } + } + spin_unlock_irqrestore(&ha->hardware_lock, flags); +} + +/* + * Adds an extra ref to allow to drop hw lock after adding sess to the list. + * Caller must put it. + */ +static struct q2t_sess *q2t_create_sess( + scsi_qla_host_t *vha, + fc_port_t *fcport, + bool local) +{ + struct qla_hw_data *ha = vha->hw; + struct q2t_sess *sess; + unsigned char be_sid[3]; + + /* Check to avoid double sessions */ +#if 0 + spin_lock_irq(&ha->hardware_lock); + list_for_each_entry(sess, &tgt->sess_list, sess_list_entry) { + if ((sess->port_name[0] == fcport->port_name[0]) && + (sess->port_name[1] == fcport->port_name[1]) && + (sess->port_name[2] == fcport->port_name[2]) && + (sess->port_name[3] == fcport->port_name[3]) && + (sess->port_name[4] == fcport->port_name[4]) && + (sess->port_name[5] == fcport->port_name[5]) && + (sess->port_name[6] == fcport->port_name[6]) && + (sess->port_name[7] == fcport->port_name[7])) { + TRACE_MGMT_DBG("Double sess %p found (s_id %x:%x:%x, " + "loop_id %d), updating to d_id %x:%x:%x, " + "loop_id %d", sess, sess->s_id.b.domain, + sess->s_id.b.al_pa, sess->s_id.b.area, + sess->loop_id, fcport->d_id.b.domain, + fcport->d_id.b.al_pa, fcport->d_id.b.area, + fcport->loop_id); + + if (sess->deleted) + q2t_undelete_sess(sess); + + q2t_sess_get(sess); + sess->s_id = fcport->d_id; + sess->loop_id = fcport->loop_id; + sess->conf_compl_supported = fcport->conf_compl_supported; + if (sess->local && !local) + sess->local = 0; + spin_unlock_irq(&ha->hardware_lock); + goto out; + } + } + spin_unlock_irq(&ha->hardware_lock); +#endif + /* We are under tgt_mutex, so a new sess can't be added behind us */ + + sess = kzalloc(sizeof(*sess), GFP_KERNEL); + if (!sess) { + printk(KERN_ERR "qla2x00t(%u): session allocation failed, " + "all commands from port %02x:%02x:%02x:%02x:" + "%02x:%02x:%02x:%02x will be refused", vha->vp_idx, + fcport->port_name[0], fcport->port_name[1], + fcport->port_name[2], fcport->port_name[3], + fcport->port_name[4], fcport->port_name[5], + fcport->port_name[6], fcport->port_name[7]); + + return NULL; + } + + sess->sess_ref = 2; /* plus 1 extra ref, see above */ + sess->tgt = ha->q2t_tgt; + sess->vha = vha; + + sess->s_id = fcport->d_id; + sess->loop_id = fcport->loop_id; + sess->local = local; + + TRACE_MGMT_DBG("Adding sess %p to tgt %p via ->set_sess_by_s_id()\n", + sess, ha->q2t_tgt); + + be_sid[0] = sess->s_id.b.domain; + be_sid[1] = sess->s_id.b.area; + be_sid[2] = sess->s_id.b.al_pa; + /* + * Determine if this fc_port->port_name is allowed to access + * target mode using explict NodeACLs+MappedLUNs, or using + * TPG demo mode. If this is successful a target mode FC nexus + * is created. + */ + if (ha->qla2x_tmpl->check_initiator_node_acl(vha, sess, &be_sid[0], + fcport->loop_id) < 0) { + kfree(sess); + return NULL; + } + + sess->conf_compl_supported = fcport->conf_compl_supported; + BUILD_BUG_ON(sizeof(sess->port_name) != sizeof(fcport->port_name)); + memcpy(sess->port_name, fcport->port_name, sizeof(sess->port_name)); + + spin_lock_irq(&ha->hardware_lock); + list_add_tail(&sess->sess_list_entry, &ha->q2t_tgt->sess_list); + ha->q2t_tgt->sess_count++; + spin_unlock_irq(&ha->hardware_lock); + + printk(KERN_INFO "qla2x00t(%d): %ssession for wwn %02x:%02x:%02x:%02x:" + "%02x:%02x:%02x:%02x (loop_id %d, s_id %x:%x:%x, confirmed" + " completion %ssupported) added\n", vha->vp_idx, local ? + "local " : "", fcport->port_name[0], fcport->port_name[1], + fcport->port_name[2], fcport->port_name[3], fcport->port_name[4], + fcport->port_name[5], fcport->port_name[6], fcport->port_name[7], + fcport->loop_id, sess->s_id.b.domain, sess->s_id.b.area, + sess->s_id.b.al_pa, sess->conf_compl_supported ? "" : "not "); + + return sess; +} + +/* + * Called from drivers/scsi/qla2xxx/qla_init.c:qla2x00_reg_remote_port() + */ +void q2t_fc_port_added(scsi_qla_host_t *vha, fc_port_t *fcport) +{ + struct qla_hw_data *ha = vha->hw; + struct q2t_tgt *tgt = ha->q2t_tgt; + struct q2t_sess *sess; + unsigned char s_id[3]; + + if (!tgt || (fcport->port_type != FCT_INITIATOR)) + return; +#warning FIXME: Convert to atomic_t + if (tgt->tgt_stop) + return; + + spin_lock_irq(&ha->hardware_lock); + sess = q2t_find_sess_by_port_name(tgt, fcport->port_name); + if (!sess) { + spin_unlock_irq(&ha->hardware_lock); + + memset(&s_id, 0, 3); + s_id[0] = fcport->d_id.b.domain; + s_id[1] = fcport->d_id.b.area; + s_id[2] = fcport->d_id.b.al_pa; + + mutex_lock(&ha->tgt_mutex); + sess = q2t_create_sess(vha, fcport, false); + mutex_unlock(&ha->tgt_mutex); + + spin_lock_irq(&ha->hardware_lock); + if (sess != NULL) + q2t_sess_put(sess); /* put the extra creation ref */ + } else { + if (sess->deleted) { + q2t_undelete_sess(sess); + + printk(KERN_INFO "qla2x00t(%u): %ssession for port %02x:" + "%02x:%02x:%02x:%02x:%02x:%02x:%02x (loop ID %d) " + "reappeared\n", vha->vp_idx, + sess->local ? "local " : "", sess->port_name[0], + sess->port_name[1], sess->port_name[2], + sess->port_name[3], sess->port_name[4], + sess->port_name[5], sess->port_name[6], + sess->port_name[7], sess->loop_id); + + TRACE_MGMT_DBG("Reappeared sess %p\n", sess); + } + sess->s_id = fcport->d_id; + sess->loop_id = fcport->loop_id; + sess->conf_compl_supported = fcport->conf_compl_supported; + } + + if (sess->local) { + printk(KERN_INFO "qla2x00t(%u): local session for " + "port %02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x " + "(loop ID %d) became global\n", vha->vp_idx, + fcport->port_name[0], fcport->port_name[1], + fcport->port_name[2], fcport->port_name[3], + fcport->port_name[4], fcport->port_name[5], + fcport->port_name[6], fcport->port_name[7], + sess->loop_id); + sess->local = 0; + } + spin_unlock_irq(&ha->hardware_lock); +} + +void q2t_fc_port_deleted(scsi_qla_host_t *vha, fc_port_t *fcport) +{ + struct qla_hw_data *ha = vha->hw; + struct q2t_tgt *tgt = ha->q2t_tgt; + struct q2t_sess *sess; + + if (!tgt || (fcport->port_type != FCT_INITIATOR)) + return; +#warning FIXME: Convert to atomic_t + if (tgt->tgt_stop) + return; + + spin_lock_irq(&ha->hardware_lock); + sess = q2t_find_sess_by_port_name(tgt, fcport->port_name); + if (!sess) { + spin_unlock_irq(&ha->hardware_lock); + return; + } + + TRACE_MGMT_DBG("q2t_fc_port_deleted %p", sess); + + sess->local = 1; + q2t_schedule_sess_for_deletion(sess); + spin_unlock_irq(&ha->hardware_lock); +} + +static inline int test_tgt_sess_count(struct q2t_tgt *tgt) +{ + struct qla_hw_data *ha = tgt->ha; + unsigned long flags; + int res; + /* + * We need to protect against race, when tgt is freed before or + * inside wake_up() + */ + spin_lock_irqsave(&ha->hardware_lock, flags); + TRACE_DBG("tgt %p, empty(sess_list)=%d sess_count=%d\n", + tgt, list_empty(&tgt->sess_list), tgt->sess_count); + res = (tgt->sess_count == 0); + spin_unlock_irqrestore(&ha->hardware_lock, flags); + + return res; +} + +/* Called by tcm_qla2xxx configfs code */ +void q2t_target_stop(struct q2t_tgt *tgt) +{ + scsi_qla_host_t *vha = tgt->vha; + struct qla_hw_data *ha = tgt->ha; + + if (tgt->tgt_stop || tgt->tgt_stopped) { + printk(KERN_ERR "Already in tgt->tgt_stop or tgt_stopped state\n"); + dump_stack(); + return; + } + + TRACE_DBG("Stopping target for host %ld(%p)\n", vha->host_no, vha); + + /* + * Mutex needed to sync with q2t_fc_port_[added,deleted]. + * Lock is needed, because we still can get an incoming packet. + */ + + mutex_lock(&ha->tgt_mutex); + spin_lock_irq(&ha->hardware_lock); + tgt->tgt_stop = 1; + q2t_clear_tgt_db(tgt, false); + spin_unlock_irq(&ha->hardware_lock); + mutex_unlock(&ha->tgt_mutex); + + cancel_delayed_work_sync(&tgt->sess_del_work); + + TRACE_MGMT_DBG("Waiting for sess works (tgt %p)", tgt); + spin_lock_irq(&tgt->sess_work_lock); + while (!list_empty(&tgt->sess_works_list)) { + spin_unlock_irq(&tgt->sess_work_lock); + flush_scheduled_work(); + spin_lock_irq(&tgt->sess_work_lock); + } + spin_unlock_irq(&tgt->sess_work_lock); + + TRACE_MGMT_DBG("Waiting for tgt %p: list_empty(sess_list)=%d " + "sess_count=%d\n", tgt, list_empty(&tgt->sess_list), + tgt->sess_count); + + wait_event(tgt->waitQ, test_tgt_sess_count(tgt)); + + /* Big hammer */ + if (!ha->host_shutting_down && qla_tgt_mode_enabled(vha)) + qla2x00_disable_tgt_mode(vha); + + /* Wait for sessions to clear out (just in case) */ + wait_event(tgt->waitQ, test_tgt_sess_count(tgt)); + + TRACE_MGMT_DBG("Waiting for %d IRQ commands to complete (tgt %p)", + tgt->irq_cmd_count, tgt); + + mutex_lock(&ha->tgt_mutex); + spin_lock_irq(&ha->hardware_lock); + while (tgt->irq_cmd_count != 0) { + spin_unlock_irq(&ha->hardware_lock); + udelay(2); + spin_lock_irq(&ha->hardware_lock); + } + tgt->tgt_stop = 0; + tgt->tgt_stopped = 1; + spin_unlock_irq(&ha->hardware_lock); + mutex_unlock(&ha->tgt_mutex); + + TRACE_MGMT_DBG("Stop of tgt %p finished", tgt); +} +EXPORT_SYMBOL(q2t_target_stop); + +int q2t_target_release(struct q2t_tgt *tgt) +{ + struct qla_hw_data *ha = tgt->ha; + + if ((ha->q2t_tgt != NULL) && !tgt->tgt_stopped) + q2t_target_stop(tgt); + + ha->q2t_tgt = NULL; + + TRACE_MGMT_DBG("Release of tgt %p finished\n", tgt); + + kfree(tgt); + return 0; +} +EXPORT_SYMBOL(q2t_target_release); + +/* ha->hardware_lock supposed to be held on entry */ +static int q2t_sched_sess_work(struct q2t_tgt *tgt, int type, + const void *param, unsigned int param_size) +{ + struct q2t_sess_work_param *prm; + unsigned long flags; + + prm = kzalloc(sizeof(*prm), GFP_ATOMIC); + if (!prm ) { + printk(KERN_ERR "qla2x00t(%d): Unable to create session " + "work, command will be refused", 0); + return -ENOMEM; + } + + TRACE_MGMT_DBG("Scheduling work (type %d, prm %p) to find session for " + "param %p (size %d, tgt %p)\n", type, prm, param, param_size, tgt); + + BUG_ON(param_size > (sizeof(*prm) - + offsetof(struct q2t_sess_work_param, cmd))); + + prm->type = type; + memcpy(&prm->cmd, param, param_size); + + spin_lock_irqsave(&tgt->sess_work_lock, flags); + if (!tgt->sess_works_pending) + tgt->tm_to_unknown = 0; + list_add_tail(&prm->sess_works_list_entry, &tgt->sess_works_list); + tgt->sess_works_pending = 1; + spin_unlock_irqrestore(&tgt->sess_work_lock, flags); + + schedule_work(&tgt->sess_work); + + return 0; +} + +/* + * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire + */ +static void q2x_modify_command_count(scsi_qla_host_t *vha, int cmd_count, + int imm_count) +{ + struct qla_hw_data *ha = vha->hw; + modify_lun_entry_t *pkt; + + printk(KERN_INFO "Sending MODIFY_LUN (ha=%p, cmd=%d, imm=%d)\n", + ha, cmd_count, imm_count); + + /* Sending marker isn't necessary, since we called from ISR */ + + pkt = (modify_lun_entry_t *)q2t_req_pkt(vha); + if (!pkt) { + printk(KERN_ERR "qla2x00t(%d): %s failed: unable to allocate " + "request packet\n", vha->vp_idx, __func__); + return; + } + + ha->q2t_tgt->modify_lun_expected++; + + pkt->entry_type = MODIFY_LUN_TYPE; + pkt->entry_count = 1; + if (cmd_count < 0) { + pkt->operators = MODIFY_LUN_CMD_SUB; /* Subtract from command count */ + pkt->command_count = -cmd_count; + } else if (cmd_count > 0) { + pkt->operators = MODIFY_LUN_CMD_ADD; /* Add to command count */ + pkt->command_count = cmd_count; + } + + if (imm_count < 0) { + pkt->operators |= MODIFY_LUN_IMM_SUB; + pkt->immed_notify_count = -imm_count; + } else if (imm_count > 0) { + pkt->operators |= MODIFY_LUN_IMM_ADD; + pkt->immed_notify_count = imm_count; + } + + pkt->timeout = 0; /* Use default */ + + TRACE_BUFFER("MODIFY LUN packet data", pkt, REQUEST_ENTRY_SIZE); + + qla2x00_isp_cmd(vha, vha->req); +} + +/* + * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire + */ +static void q2x_send_notify_ack(scsi_qla_host_t *vha, notify_entry_t *iocb, + uint32_t add_flags, uint16_t resp_code, int resp_code_valid, + uint16_t srr_flags, uint16_t srr_reject_code, uint8_t srr_explan) +{ + struct qla_hw_data *ha = vha->hw; + nack_entry_t *ntfy; + + TRACE_DBG("Sending NOTIFY_ACK (ha=%p)\n", ha); + + /* Send marker if required */ + if (q2t_issue_marker(vha, 1) != QLA_SUCCESS) + return; + + ntfy = (nack_entry_t *)q2t_req_pkt(vha); + if (!ntfy) { + printk(KERN_ERR "qla2x00t(%d): %s failed: unable to allocate " + "request packet\n", vha->vp_idx, __func__); + return; + } + + if (ha->q2t_tgt != NULL) + ha->q2t_tgt->notify_ack_expected++; + + ntfy->entry_type = NOTIFY_ACK_TYPE; + ntfy->entry_count = 1; + SET_TARGET_ID(ha, ntfy->target, GET_TARGET_ID(ha, iocb)); + ntfy->status = iocb->status; + ntfy->task_flags = iocb->task_flags; + ntfy->seq_id = iocb->seq_id; + /* Do not increment here, the chip isn't decrementing */ + /* ntfy->flags = __constant_cpu_to_le16(NOTIFY_ACK_RES_COUNT); */ + ntfy->flags |= cpu_to_le16(add_flags); + ntfy->srr_rx_id = iocb->srr_rx_id; + ntfy->srr_rel_offs = iocb->srr_rel_offs; + ntfy->srr_ui = iocb->srr_ui; + ntfy->srr_flags = cpu_to_le16(srr_flags); + ntfy->srr_reject_code = cpu_to_le16(srr_reject_code); + ntfy->srr_reject_code_expl = srr_explan; + ntfy->ox_id = iocb->ox_id; + + if (resp_code_valid) { + ntfy->resp_code = cpu_to_le16(resp_code); + ntfy->flags |= __constant_cpu_to_le16( + NOTIFY_ACK_TM_RESP_CODE_VALID); + } + + TRACE_SCSI("qla2x00t(%d): Sending Notify Ack Seq %#x -> I %#x " + "St %#x RC %#x\n", vha->vp_idx, + le16_to_cpu(iocb->seq_id), GET_TARGET_ID(ha, iocb), + le16_to_cpu(iocb->status), le16_to_cpu(ntfy->resp_code)); + TRACE_BUFFER("Notify Ack packet data", ntfy, REQUEST_ENTRY_SIZE); + + qla2x00_isp_cmd(vha, vha->req); +} + +/* + * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire + */ +static void q24_send_abts_resp(scsi_qla_host_t *vha, + const abts24_recv_entry_t *abts, uint32_t status, bool ids_reversed) +{ + struct qla_hw_data *ha = vha->hw; + abts24_resp_entry_t *resp; + uint32_t f_ctl; + uint8_t *p; + + TRACE_DBG("Sending task mgmt ABTS response (ha=%p, atio=%p, " + "status=%x\n", ha, abts, status); + + /* Send marker if required */ + if (q2t_issue_marker(vha, 1) != QLA_SUCCESS) + return; + + resp = (abts24_resp_entry_t *)q2t_req_pkt(vha); + if (!resp) { + printk(KERN_ERR "qla2x00t(%d): %s failed: unable to allocate " + "request packet", vha->vp_idx, __func__); + return; + } + + resp->entry_type = ABTS_RESP_24XX; + resp->entry_count = 1; + resp->nport_handle = abts->nport_handle; + resp->vp_index = vha->vp_idx; + resp->sof_type = abts->sof_type; + resp->exchange_address = abts->exchange_address; + resp->fcp_hdr_le = abts->fcp_hdr_le; + f_ctl = __constant_cpu_to_le32(F_CTL_EXCH_CONTEXT_RESP | + F_CTL_LAST_SEQ | F_CTL_END_SEQ | + F_CTL_SEQ_INITIATIVE); + p = (uint8_t *)&f_ctl; + resp->fcp_hdr_le.f_ctl[0] = *p++; + resp->fcp_hdr_le.f_ctl[1] = *p++; + resp->fcp_hdr_le.f_ctl[2] = *p; + if (ids_reversed) { + resp->fcp_hdr_le.d_id[0] = abts->fcp_hdr_le.d_id[0]; + resp->fcp_hdr_le.d_id[1] = abts->fcp_hdr_le.d_id[1]; + resp->fcp_hdr_le.d_id[2] = abts->fcp_hdr_le.d_id[2]; + resp->fcp_hdr_le.s_id[0] = abts->fcp_hdr_le.s_id[0]; + resp->fcp_hdr_le.s_id[1] = abts->fcp_hdr_le.s_id[1]; + resp->fcp_hdr_le.s_id[2] = abts->fcp_hdr_le.s_id[2]; + } else { + resp->fcp_hdr_le.d_id[0] = abts->fcp_hdr_le.s_id[0]; + resp->fcp_hdr_le.d_id[1] = abts->fcp_hdr_le.s_id[1]; + resp->fcp_hdr_le.d_id[2] = abts->fcp_hdr_le.s_id[2]; + resp->fcp_hdr_le.s_id[0] = abts->fcp_hdr_le.d_id[0]; + resp->fcp_hdr_le.s_id[1] = abts->fcp_hdr_le.d_id[1]; + resp->fcp_hdr_le.s_id[2] = abts->fcp_hdr_le.d_id[2]; + } + resp->exchange_addr_to_abort = abts->exchange_addr_to_abort; + if (status == FCP_TMF_CMPL) { + resp->fcp_hdr_le.r_ctl = R_CTL_BASIC_LINK_SERV | R_CTL_B_ACC; + resp->payload.ba_acct.seq_id_valid = SEQ_ID_INVALID; + resp->payload.ba_acct.low_seq_cnt = 0x0000; + resp->payload.ba_acct.high_seq_cnt = 0xFFFF; + resp->payload.ba_acct.ox_id = abts->fcp_hdr_le.ox_id; + resp->payload.ba_acct.rx_id = abts->fcp_hdr_le.rx_id; + } else { + resp->fcp_hdr_le.r_ctl = R_CTL_BASIC_LINK_SERV | R_CTL_B_RJT; + resp->payload.ba_rjt.reason_code = + BA_RJT_REASON_CODE_UNABLE_TO_PERFORM; + /* Other bytes are zero */ + } + + TRACE_BUFFER("ABTS RESP packet data", resp, REQUEST_ENTRY_SIZE); + + ha->q2t_tgt->abts_resp_expected++; + + qla2x00_isp_cmd(vha, vha->req); +} + +/* + * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire + */ +static void q24_retry_term_exchange(scsi_qla_host_t *vha, + abts24_resp_fw_entry_t *entry) +{ + ctio7_status1_entry_t *ctio; + + TRACE_DBG("Sending retry TERM EXCH CTIO7 (ha=%p)\n", vha->hw); + + /* Send marker if required */ + if (q2t_issue_marker(vha, 1) != QLA_SUCCESS) + return; + + ctio = (ctio7_status1_entry_t *)q2t_req_pkt(vha); + if (ctio == NULL) { + printk(KERN_ERR "qla2x00t(%d): %s failed: unable to allocate " + "request packet\n", vha->vp_idx, __func__); + return; + } + + /* + * We've got on entrance firmware's response on by us generated + * ABTS response. So, in it ID fields are reversed. + */ + + ctio->common.entry_type = CTIO_TYPE7; + ctio->common.entry_count = 1; + ctio->common.nport_handle = entry->nport_handle; + ctio->common.handle = Q2T_SKIP_HANDLE | CTIO_COMPLETION_HANDLE_MARK; + ctio->common.timeout = __constant_cpu_to_le16(Q2T_TIMEOUT); + ctio->common.vp_index = vha->vp_idx; + ctio->common.initiator_id[0] = entry->fcp_hdr_le.d_id[0]; + ctio->common.initiator_id[1] = entry->fcp_hdr_le.d_id[1]; + ctio->common.initiator_id[2] = entry->fcp_hdr_le.d_id[2]; + ctio->common.exchange_addr = entry->exchange_addr_to_abort; + ctio->flags = __constant_cpu_to_le16(CTIO7_FLAGS_STATUS_MODE_1 | CTIO7_FLAGS_TERMINATE); + ctio->ox_id = entry->fcp_hdr_le.ox_id; + + TRACE_BUFFER("CTIO7 retry TERM EXCH packet data", ctio, REQUEST_ENTRY_SIZE); + + qla2x00_isp_cmd(vha, vha->req); + + q24_send_abts_resp(vha, (abts24_recv_entry_t *)entry, + FCP_TMF_CMPL, true); +} + +/* ha->hardware_lock supposed to be held on entry */ +static int __q24_handle_abts(scsi_qla_host_t *vha, abts24_recv_entry_t *abts, + struct q2t_sess *sess) +{ + struct qla_hw_data *ha = vha->hw; + struct q2t_mgmt_cmd *mcmd; + uint32_t lun; + int rc; + + TRACE_MGMT_DBG("qla2x00t(%d): task abort (tag=%d)\n", vha->vp_idx, + abts->exchange_addr_to_abort); + + mcmd = mempool_alloc(q2t_mgmt_cmd_mempool, GFP_ATOMIC); + if (mcmd == NULL) { + printk(KERN_ERR "qla2x00t(%d): %s: Allocation of ABORT cmd failed", + vha->vp_idx, __func__); + return -ENOMEM; + } + memset(mcmd, 0, sizeof(*mcmd)); + + mcmd->sess = sess; + memcpy(&mcmd->orig_iocb.abts, abts, sizeof(mcmd->orig_iocb.abts)); + +#warning FIXME: Hardcoded LUN for __q24_handle_abts() + lun = 0; + + rc = ha->qla2x_tmpl->handle_tmr(mcmd, lun, ABORT_TASK); + if (rc != 0) { + printk(KERN_ERR "qla2x00t(%d): qla2x_tmpl->handle_tmr()" + " failed: %d", vha->vp_idx, rc); + mempool_free(mcmd, q2t_mgmt_cmd_mempool); + return -EFAULT; + } + + return 0; +} + +/* + * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire + */ +static void q24_handle_abts(scsi_qla_host_t *vha, abts24_recv_entry_t *abts) +{ + struct qla_hw_data *ha = vha->hw; + struct q2t_sess *sess; + uint32_t tag = abts->exchange_addr_to_abort, s_id; + int rc; + + if (le32_to_cpu(abts->fcp_hdr_le.parameter) & ABTS_PARAM_ABORT_SEQ) { + printk(KERN_ERR "qla2x00t(%d): ABTS: Abort Sequence not " + "supported\n", vha->vp_idx); + q24_send_abts_resp(vha, abts, FCP_TMF_REJECTED, false); + return; + } + + if (tag == ATIO_EXCHANGE_ADDRESS_UNKNOWN) { + TRACE_MGMT_DBG("qla2x00t(%d): ABTS: Unknown Exchange " + "Address received\n", vha->vp_idx); + q24_send_abts_resp(vha, abts, FCP_TMF_REJECTED, false); + return; + } + + TRACE_MGMT_DBG("qla2x00t(%d): task abort (s_id=%x:%x:%x, " + "tag=%d, param=%x)\n", vha->vp_idx, abts->fcp_hdr_le.s_id[2], + abts->fcp_hdr_le.s_id[1], abts->fcp_hdr_le.s_id[0], tag, + le32_to_cpu(abts->fcp_hdr_le.parameter)); + + memset(&s_id, 0, 3); + s_id = (abts->fcp_hdr_le.s_id[0] << 16) | (abts->fcp_hdr_le.s_id[1] << 8) | + abts->fcp_hdr_le.s_id[2]; + + sess = ha->qla2x_tmpl->find_sess_by_s_id(vha, (unsigned char *)&s_id); + if (!sess) { + TRACE_MGMT_DBG("qla2x00t(%d): task abort for unexisting " + "session\n", vha->vp_idx); + rc = q2t_sched_sess_work(ha->q2t_tgt, Q2T_SESS_WORK_ABORT, + abts, sizeof(*abts)); + if (rc != 0) { + ha->q2t_tgt->tm_to_unknown = 1; + q24_send_abts_resp(vha, abts, FCP_TMF_REJECTED, false); + } + return; + } + + rc = __q24_handle_abts(vha, abts, sess); + if (rc != 0) { + printk(KERN_ERR "qla2x00t(%d): __q24_handle_abts() failed: %d\n", + vha->vp_idx, rc); + q24_send_abts_resp(vha, abts, FCP_TMF_REJECTED, false); + return; + } +} + +/* + * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire + */ +static void q24_send_task_mgmt_ctio(scsi_qla_host_t *ha, + struct q2t_mgmt_cmd *mcmd, uint32_t resp_code) +{ + const atio7_entry_t *atio = &mcmd->orig_iocb.atio7; + ctio7_status1_entry_t *ctio; + + TRACE_DBG("Sending task mgmt CTIO7 (ha=%p, atio=%p, resp_code=%x\n", + ha, atio, resp_code); + + /* Send marker if required */ + if (q2t_issue_marker(ha, 1) != QLA_SUCCESS) + return; + + ctio = (ctio7_status1_entry_t *)q2t_req_pkt(ha); + if (ctio == NULL) { + printk(KERN_ERR "qla2x00t(%d): %s failed: unable to allocate " + "request packet\n", ha->vp_idx, __func__); + return; + } + + ctio->common.entry_type = CTIO_TYPE7; + ctio->common.entry_count = 1; + ctio->common.handle = Q2T_SKIP_HANDLE | CTIO_COMPLETION_HANDLE_MARK; + ctio->common.nport_handle = mcmd->sess->loop_id; + ctio->common.timeout = __constant_cpu_to_le16(Q2T_TIMEOUT); + ctio->common.vp_index = ha->vp_idx; + ctio->common.initiator_id[0] = atio->fcp_hdr.s_id[2]; + ctio->common.initiator_id[1] = atio->fcp_hdr.s_id[1]; + ctio->common.initiator_id[2] = atio->fcp_hdr.s_id[0]; + ctio->common.exchange_addr = atio->exchange_addr; + ctio->flags = (atio->attr << 9) | __constant_cpu_to_le16( + CTIO7_FLAGS_STATUS_MODE_1 | CTIO7_FLAGS_SEND_STATUS); + ctio->ox_id = swab16(atio->fcp_hdr.ox_id); + ctio->scsi_status = __constant_cpu_to_le16(SS_RESPONSE_INFO_LEN_VALID); + ctio->response_len = __constant_cpu_to_le16(8); + ((uint32_t *)ctio->sense_data)[0] = cpu_to_be32(resp_code); + + TRACE_BUFFER("CTIO7 TASK MGMT packet data", ctio, REQUEST_ENTRY_SIZE); + + qla2x00_isp_cmd(ha, ha->req); +} + +/* + * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire + */ +static void q24_send_notify_ack(scsi_qla_host_t *vha, + notify24xx_entry_t *iocb, uint16_t srr_flags, + uint8_t srr_reject_code, uint8_t srr_explan) +{ + struct qla_hw_data *ha = vha->hw; + nack24xx_entry_t *nack; + + TRACE_DBG("Sending NOTIFY_ACK24 (ha=%p)\n", ha); + + /* Send marker if required */ + if (q2t_issue_marker(vha, 1) != QLA_SUCCESS) + return; + + if (ha->q2t_tgt != NULL) + ha->q2t_tgt->notify_ack_expected++; + + nack = (nack24xx_entry_t *)q2t_req_pkt(vha); + if (!nack) { + printk(KERN_ERR "qla2x00t(%d): %s failed: unable to allocate " + "request packet\n", vha->vp_idx, __func__); + return; + } + + nack->entry_type = NOTIFY_ACK_TYPE; + nack->entry_count = 1; + nack->nport_handle = iocb->nport_handle; + if (le16_to_cpu(iocb->status) == IMM_NTFY_ELS) { + nack->flags = iocb->flags & + __constant_cpu_to_le32(NOTIFY24XX_FLAGS_PUREX_IOCB); + } + nack->srr_rx_id = iocb->srr_rx_id; + nack->status = iocb->status; + nack->status_subcode = iocb->status_subcode; + nack->exchange_address = iocb->exchange_address; + nack->srr_rel_offs = iocb->srr_rel_offs; + nack->srr_ui = iocb->srr_ui; + nack->srr_flags = cpu_to_le16(srr_flags); + nack->srr_reject_code = srr_reject_code; + nack->srr_reject_code_expl = srr_explan; + nack->ox_id = iocb->ox_id; + nack->vp_index = iocb->vp_index; + + TRACE_SCSI("qla2x00t(%d): Sending 24xx Notify Ack %d\n", + vha->vp_idx, nack->status); + TRACE_BUFFER("24xx Notify Ack packet data", nack, sizeof(*nack)); + + qla2x00_isp_cmd(vha, vha->req); +} + +/* callback from target fabric module code */ +void q2t_xmit_tm_rsp(struct q2t_mgmt_cmd *mcmd) +{ + scsi_qla_host_t *vha; + struct qla_hw_data *ha; + unsigned long flags; + + TRACE_MGMT_DBG("TM response mcmd (%p) status %#x state %#x", mcmd, + mcmd->se_tmr_req->response, mcmd->flags); + + vha = mcmd->sess->vha; + ha = vha->hw; + + spin_lock_irqsave(&ha->hardware_lock, flags); + if (IS_FWI2_CAPABLE(ha)) { + if (mcmd->flags == Q24_MGMT_SEND_NACK) { + q24_send_notify_ack(vha, + &mcmd->orig_iocb.notify_entry24, 0, 0, 0); + } else { + if (mcmd->se_tmr_req->function == ABORT_TASK) + q24_send_abts_resp(vha, &mcmd->orig_iocb.abts, + mcmd->fc_tm_rsp, false); + else + q24_send_task_mgmt_ctio(vha, mcmd, mcmd->fc_tm_rsp); + } + } else { + q2x_send_notify_ack(vha, &mcmd->orig_iocb.notify_entry, 0, + mcmd->fc_tm_rsp, 1, 0, 0, 0); + } + spin_unlock_irqrestore(&ha->hardware_lock, flags); + + mempool_free(mcmd, q2t_mgmt_cmd_mempool); +} +EXPORT_SYMBOL(q2t_xmit_tm_rsp); + +/* No locks */ +static int q2t_pci_map_calc_cnt(struct q2t_prm *prm) +{ + BUG_ON(prm->cmd->sg_cnt == 0); + + prm->sg = (struct scatterlist *)prm->cmd->sg; + prm->seg_cnt = pci_map_sg(prm->tgt->ha->pdev, prm->cmd->sg, + prm->cmd->sg_cnt, prm->cmd->dma_data_direction); + if (unlikely(prm->seg_cnt == 0)) + goto out_err; + + prm->cmd->sg_mapped = 1; + + /* + * If greater than four sg entries then we need to allocate + * the continuation entries + */ + if (prm->seg_cnt > prm->tgt->datasegs_per_cmd) { + prm->req_cnt += (uint16_t)(prm->seg_cnt - + prm->tgt->datasegs_per_cmd) / + prm->tgt->datasegs_per_cont; + if (((uint16_t)(prm->seg_cnt - prm->tgt->datasegs_per_cmd)) % + prm->tgt->datasegs_per_cont) + prm->req_cnt++; + } + + TRACE_DBG("seg_cnt=%d, req_cnt=%d\n", prm->seg_cnt, prm->req_cnt); + return 0; + +out_err: + printk(KERN_ERR "qla2x00t(%d): PCI mapping failed: sg_cnt=%d", + 0, prm->cmd->sg_cnt); + return -1; +} + +static inline void q2t_unmap_sg(scsi_qla_host_t *vha, struct q2t_cmd *cmd) +{ + struct qla_hw_data *ha = vha->hw; + + BUG_ON(!cmd->sg_mapped); + pci_unmap_sg(ha->pdev, cmd->sg, cmd->sg_cnt, cmd->dma_data_direction); + cmd->sg_mapped = 0; +} + +static int q2t_check_reserve_free_req(scsi_qla_host_t *vha, uint32_t req_cnt) +{ + struct qla_hw_data *ha = vha->hw; + device_reg_t __iomem *reg = ha->iobase; + uint32_t cnt; + + if (vha->req->cnt < (req_cnt + 2)) { + if (IS_FWI2_CAPABLE(ha)) + cnt = (uint16_t)RD_REG_DWORD( + ®->isp24.req_q_out); + else + cnt = qla2x00_debounce_register( + ISP_REQ_Q_OUT(ha, ®->isp)); + TRACE_DBG("Request ring circled: cnt=%d, " + "vha->->ring_index=%d, vha->req->cnt=%d, req_cnt=%d\n", + cnt, vha->req->ring_index, vha->req->cnt, req_cnt); + if (vha->req->ring_index < cnt) + vha->req->cnt = cnt - vha->req->ring_index; + else + vha->req->cnt = vha->req->length - + (vha->req->ring_index - cnt); + } + + if (unlikely(vha->req->cnt < (req_cnt + 2))) { + printk(KERN_INFO "qla2x00t(%d): There is no room in the " + "request ring: vha->req->ring_index=%d, vha->req->cnt=%d, " + "req_cnt=%d\n", vha->vp_idx, vha->req->ring_index, + vha->req->cnt, req_cnt); + return -ENOMEM; + } + vha->req->cnt -= req_cnt; + + return 0; +} + +/* + * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire + */ +static inline void *q2t_get_req_pkt(scsi_qla_host_t *vha) +{ + /* Adjust ring index. */ + vha->req->ring_index++; + if (vha->req->ring_index == vha->req->length) { + vha->req->ring_index = 0; + vha->req->ring_ptr = vha->req->ring; + } else { + vha->req->ring_ptr++; + } + return (cont_entry_t *)vha->req->ring_ptr; +} + +/* ha->hardware_lock supposed to be held on entry */ +static inline uint32_t q2t_make_handle(scsi_qla_host_t *vha) +{ + struct qla_hw_data *ha = vha->hw; + uint32_t h; + + h = ha->current_handle; + /* always increment cmd handle */ + do { + ++h; + if (h > MAX_OUTSTANDING_COMMANDS) + h = 1; /* 0 is Q2T_NULL_HANDLE */ + if (h == ha->current_handle) { + printk(KERN_INFO "qla2x00t(%d): Ran out of " + "empty cmd slots in ha %p\n", vha->vp_idx, ha); + h = Q2T_NULL_HANDLE; + break; + } + } while ((h == Q2T_NULL_HANDLE) || + (h == Q2T_SKIP_HANDLE) || + (ha->cmds[h-1] != NULL)); + + if (h != Q2T_NULL_HANDLE) + ha->current_handle = h; + + return h; +} + +/* ha->hardware_lock supposed to be held on entry */ +static void q2x_build_ctio_pkt(struct q2t_prm *prm, scsi_qla_host_t *vha) +{ + uint32_t h; + ctio_entry_t *pkt; + struct qla_hw_data *ha = vha->hw; + + pkt = (ctio_entry_t *)vha->req->ring_ptr; + prm->pkt = pkt; + memset(pkt, 0, sizeof(*pkt)); + + if (prm->tgt->tgt_enable_64bit_addr) + pkt->common.entry_type = CTIO_A64_TYPE; + else + pkt->common.entry_type = CONTINUE_TGT_IO_TYPE; + + pkt->common.entry_count = (uint8_t)prm->req_cnt; + + h = q2t_make_handle(vha); + if (h != Q2T_NULL_HANDLE) + ha->cmds[h-1] = prm->cmd; + + pkt->common.handle = h | CTIO_COMPLETION_HANDLE_MARK; + pkt->common.timeout = __constant_cpu_to_le16(Q2T_TIMEOUT); + + /* Set initiator ID */ + h = GET_TARGET_ID(ha, &prm->cmd->atio.atio2x); + SET_TARGET_ID(ha, pkt->common.target, h); + + pkt->common.rx_id = prm->cmd->atio.atio2x.rx_id; + pkt->common.relative_offset = cpu_to_le32(prm->cmd->offset); + + TRACE_SCSI("qla2x00t(%d): handle(se_cmd) -> %08x, " + "timeout %d L %#x -> I %#x E %#x\n", vha->vp_idx, + pkt->common.handle, Q2T_TIMEOUT, + le16_to_cpu(prm->cmd->atio.atio2x.lun), + GET_TARGET_ID(ha, &pkt->common), pkt->common.rx_id); +} + +/* ha->hardware_lock supposed to be held on entry */ +static int q24_build_ctio_pkt(struct q2t_prm *prm, scsi_qla_host_t *vha) +{ + uint32_t h; + ctio7_status0_entry_t *pkt; + struct qla_hw_data *ha = vha->hw; + atio7_entry_t *atio = &prm->cmd->atio.atio7; + + pkt = (ctio7_status0_entry_t *)vha->req->ring_ptr; + prm->pkt = pkt; + memset(pkt, 0, sizeof(*pkt)); + + pkt->common.entry_type = CTIO_TYPE7; + pkt->common.entry_count = (uint8_t)prm->req_cnt; + pkt->common.vp_index = vha->vp_idx; + + h = q2t_make_handle(vha); + if (unlikely(h == Q2T_NULL_HANDLE)) { + /* + * CTIO type 7 from the firmware doesn't provide a way to + * know the initiator's LOOP ID, hence we can't find + * the session and, so, the command. + */ + dump_stack(); + return -ENOMEM; + } else + ha->cmds[h-1] = prm->cmd; + + pkt->common.handle = h | CTIO_COMPLETION_HANDLE_MARK; + pkt->common.nport_handle = prm->cmd->loop_id; + pkt->common.timeout = __constant_cpu_to_le16(Q2T_TIMEOUT); + pkt->common.initiator_id[0] = atio->fcp_hdr.s_id[2]; + pkt->common.initiator_id[1] = atio->fcp_hdr.s_id[1]; + pkt->common.initiator_id[2] = atio->fcp_hdr.s_id[0]; + pkt->common.exchange_addr = atio->exchange_addr; + pkt->flags |= (atio->attr << 9); + pkt->ox_id = swab16(atio->fcp_hdr.ox_id); + pkt->relative_offset = cpu_to_le32(prm->cmd->offset); + + TRACE_SCSI("qla2x00t(%d): handle(cmd) -> %08x, " + "timeout %d, ox_id %#x\n", vha->vp_idx, pkt->common.handle, + Q2T_TIMEOUT, le16_to_cpu(pkt->ox_id)); + return 0; +} + +/* + * ha->hardware_lock supposed to be held on entry. We have already made sure + * that there is sufficient amount of request entries to not drop it. + */ +static void q2t_load_cont_data_segments(struct q2t_prm *prm, scsi_qla_host_t *vha) +{ + int cnt; + uint32_t *dword_ptr; + int enable_64bit_addressing = prm->tgt->tgt_enable_64bit_addr; + + /* Build continuation packets */ + while (prm->seg_cnt > 0) { + cont_a64_entry_t *cont_pkt64 = + (cont_a64_entry_t *)q2t_get_req_pkt(vha); + + /* + * Make sure that from cont_pkt64 none of + * 64-bit specific fields used for 32-bit + * addressing. Cast to (cont_entry_t *) for + * that. + */ + + memset(cont_pkt64, 0, sizeof(*cont_pkt64)); + + cont_pkt64->entry_count = 1; + cont_pkt64->sys_define = 0; + + if (enable_64bit_addressing) { + cont_pkt64->entry_type = CONTINUE_A64_TYPE; + dword_ptr = + (uint32_t *)&cont_pkt64->dseg_0_address; + } else { + cont_pkt64->entry_type = CONTINUE_TYPE; + dword_ptr = + (uint32_t *)&((cont_entry_t *) + cont_pkt64)->dseg_0_address; + } + + /* Load continuation entry data segments */ + for (cnt = 0; + cnt < prm->tgt->datasegs_per_cont && prm->seg_cnt; + cnt++, prm->seg_cnt--) { + *dword_ptr++ = + cpu_to_le32(pci_dma_lo32 + (sg_dma_address(prm->sg))); + if (enable_64bit_addressing) { + *dword_ptr++ = + cpu_to_le32(pci_dma_hi32 + (sg_dma_address + (prm->sg))); + } + *dword_ptr++ = cpu_to_le32(sg_dma_len(prm->sg)); + + TRACE_SG("S/G Segment Cont. phys_addr=%llx:%llx, len=%d", + (long long unsigned int)pci_dma_hi32(sg_dma_address(prm->sg)), + (long long unsigned int)pci_dma_lo32(sg_dma_address(prm->sg)), + (int)sg_dma_len(prm->sg)); + + prm->sg++; + } + + TRACE_BUFFER("Continuation packet data", + cont_pkt64, REQUEST_ENTRY_SIZE); + } +} + +/* + * ha->hardware_lock supposed to be held on entry. We have already made sure + * that there is sufficient amount of request entries to not drop it. + */ +static void q2x_load_data_segments(struct q2t_prm *prm, scsi_qla_host_t *vha) +{ + int cnt; + uint32_t *dword_ptr; + int enable_64bit_addressing = prm->tgt->tgt_enable_64bit_addr; + ctio_common_entry_t *pkt = (ctio_common_entry_t *)prm->pkt; + + TRACE_SCSI("iocb->scsi_status=%x, iocb->flags=%x\n", + le16_to_cpu(pkt->scsi_status), le16_to_cpu(pkt->flags)); + + pkt->transfer_length = cpu_to_le32(prm->cmd->bufflen); + + /* Setup packet address segment pointer */ + dword_ptr = pkt->dseg_0_address; + + if (prm->seg_cnt == 0) { + /* No data transfer */ + *dword_ptr++ = 0; + *dword_ptr = 0; + + TRACE_BUFFER("No data, CTIO packet data", pkt, + REQUEST_ENTRY_SIZE); + return; + } + + /* Set total data segment count */ + pkt->dseg_count = cpu_to_le16(prm->seg_cnt); + + /* If scatter gather */ + TRACE_SG("%s", "Building S/G data segments..."); + /* Load command entry data segments */ + for (cnt = 0; + (cnt < prm->tgt->datasegs_per_cmd) && prm->seg_cnt; + cnt++, prm->seg_cnt--) { + *dword_ptr++ = + cpu_to_le32(pci_dma_lo32(sg_dma_address(prm->sg))); + if (enable_64bit_addressing) { + *dword_ptr++ = + cpu_to_le32(pci_dma_hi32 + (sg_dma_address(prm->sg))); + } + *dword_ptr++ = cpu_to_le32(sg_dma_len(prm->sg)); + + TRACE_SG("S/G Segment phys_addr=%llx:%llx, len=%d\n", + (long long unsigned int)pci_dma_hi32(sg_dma_address(prm->sg)), + (long long unsigned int)pci_dma_lo32(sg_dma_address(prm->sg)), + (int)sg_dma_len(prm->sg)); + + prm->sg++; + } + + TRACE_BUFFER("Scatter/gather, CTIO packet data", pkt, + REQUEST_ENTRY_SIZE); + + q2t_load_cont_data_segments(prm, vha); +} + +/* + * ha->hardware_lock supposed to be held on entry. We have already made sure + * that there is sufficient amount of request entries to not drop it. + */ +static void q24_load_data_segments(struct q2t_prm *prm, scsi_qla_host_t *vha) +{ + int cnt; + uint32_t *dword_ptr; + int enable_64bit_addressing = prm->tgt->tgt_enable_64bit_addr; + ctio7_status0_entry_t *pkt = (ctio7_status0_entry_t *)prm->pkt; + + TRACE_DBG("iocb->scsi_status=%x, iocb->flags=%x\n", + le16_to_cpu(pkt->scsi_status), le16_to_cpu(pkt->flags)); + + pkt->transfer_length = cpu_to_le32(prm->cmd->bufflen); + + /* Setup packet address segment pointer */ + dword_ptr = pkt->dseg_0_address; + + if (prm->seg_cnt == 0) { + /* No data transfer */ + *dword_ptr++ = 0; + *dword_ptr = 0; + + TRACE_BUFFER("No data, CTIO7 packet data", pkt, + REQUEST_ENTRY_SIZE); + return; + } + + /* Set total data segment count */ + pkt->common.dseg_count = cpu_to_le16(prm->seg_cnt); + + /* If scatter gather */ + TRACE_SG("%s", "Building S/G data segments..."); + /* Load command entry data segments */ + for (cnt = 0; + (cnt < prm->tgt->datasegs_per_cmd) && prm->seg_cnt; + cnt++, prm->seg_cnt--) { + *dword_ptr++ = + cpu_to_le32(pci_dma_lo32(sg_dma_address(prm->sg))); + if (enable_64bit_addressing) { + *dword_ptr++ = + cpu_to_le32(pci_dma_hi32( + sg_dma_address(prm->sg))); + } + *dword_ptr++ = cpu_to_le32(sg_dma_len(prm->sg)); + + TRACE_SG("S/G Segment phys_addr=%llx:%llx, len=%d\n", + (long long unsigned int)pci_dma_hi32(sg_dma_address( + prm->sg)), + (long long unsigned int)pci_dma_lo32(sg_dma_address( + prm->sg)), + (int)sg_dma_len(prm->sg)); + + prm->sg++; + } + + q2t_load_cont_data_segments(prm, vha); +} + +static inline int q2t_has_data(struct q2t_cmd *cmd) +{ + return cmd->bufflen > 0; +} + +/* + * Called without ha->hardware_lock held + */ +static int q2t_pre_xmit_response(struct q2t_cmd *cmd, struct q2t_prm *prm, + int xmit_type, uint8_t scsi_status, uint32_t *full_req_cnt) +{ + struct q2t_tgt *tgt = cmd->tgt; + scsi_qla_host_t *vha = tgt->vha; + struct qla_hw_data *ha = vha->hw; + struct se_cmd *se_cmd = &cmd->se_cmd; + + if (unlikely(cmd->aborted)) { + TRACE_MGMT_DBG("qla2x00t(%d): terminating exchange " + "for aborted cmd=%p (se_cmd=%p, tag=%d)", + vha->vp_idx, cmd, se_cmd, cmd->tag); + + cmd->state = Q2T_STATE_ABORTED; + + if (IS_FWI2_CAPABLE(ha)) + q24_send_term_exchange(vha, cmd, &cmd->atio.atio7, 0); + else + q2x_send_term_exchange(vha, cmd, &cmd->atio.atio2x, 0); + /* !! At this point cmd could be already freed !! */ + return Q2T_PRE_XMIT_RESP_CMD_ABORTED; + } + + TRACE_SCSI("qla2x00t(%d): tag=%u\n", vha->vp_idx, cmd->tag); + + prm->cmd = cmd; + prm->tgt = tgt; + prm->rq_result = scsi_status; + prm->sense_buffer = &cmd->sense_buffer[0]; + prm->sense_buffer_len = TRANSPORT_SENSE_BUFFER; + prm->sg = NULL; + prm->seg_cnt = -1; + prm->req_cnt = 1; + prm->add_status_pkt = 0; + + TRACE_DBG("rq_result=%x, xmit_type=%x\n", prm->rq_result, xmit_type); + if (prm->rq_result != 0) + TRACE_BUFFER("Sense", prm->sense_buffer, prm->sense_buffer_len); + + /* Send marker if required */ + if (q2t_issue_marker(vha, 0) != QLA_SUCCESS) + return -EFAULT; + + TRACE_DBG("CTIO start: vha(%d)\n", vha->vp_idx); + + if ((xmit_type & Q2T_XMIT_DATA) && q2t_has_data(cmd)) { + if (q2t_pci_map_calc_cnt(prm) != 0) + return -EAGAIN; + } + + *full_req_cnt = prm->req_cnt; + + if (se_cmd->se_cmd_flags & SCF_UNDERFLOW_BIT) { + prm->residual = se_cmd->residual_count; + TRACE_DBG("Residual underflow: %d (tag %d, " + "op %x, bufflen %d, rq_result %x)\n", + prm->residual, cmd->tag, + T_TASK(se_cmd)->t_task_cdb[0], cmd->bufflen, + prm->rq_result); + prm->rq_result |= SS_RESIDUAL_UNDER; + } else if (se_cmd->se_cmd_flags & SCF_OVERFLOW_BIT) { + prm->residual = se_cmd->residual_count; + TRACE_DBG("Residual overflow: %d (tag %d, " + "op %x, bufflen %d, rq_result %x)\n", + prm->residual, cmd->tag, + T_TASK(se_cmd)->t_task_cdb[0], cmd->bufflen, + prm->rq_result); + prm->rq_result |= SS_RESIDUAL_OVER; + prm->residual = -prm->residual; + } + + if (xmit_type & Q2T_XMIT_STATUS) { + /* + * If Q2T_XMIT_DATA is not set, add_status_pkt will be ignored + * in *xmit_response() below + */ + if (q2t_has_data(cmd)) { + if (Q2T_SENSE_VALID(prm->sense_buffer) || + (IS_FWI2_CAPABLE(ha) && + (prm->rq_result != 0))) { + prm->add_status_pkt = 1; + (*full_req_cnt)++; + } + } + } + + TRACE_DBG("req_cnt=%d, full_req_cnt=%d, add_status_pkt=%d\n", + prm->req_cnt, *full_req_cnt, prm->add_status_pkt); + + return 0; +} + +static inline int q2t_need_explicit_conf(struct qla_hw_data *ha, + struct q2t_cmd *cmd, int sending_sense) +{ + if (ha->enable_class_2) + return 0; + + if (sending_sense) + return cmd->conf_compl_supported; + else + return ha->enable_explicit_conf && cmd->conf_compl_supported; +} + +static void q2x_init_ctio_ret_entry(ctio_ret_entry_t *ctio_m1, + struct q2t_prm *prm, scsi_qla_host_t *vha) +{ + struct qla_hw_data *ha = vha->hw; + + prm->sense_buffer_len = min((uint32_t)prm->sense_buffer_len, + (uint32_t)sizeof(ctio_m1->sense_data)); + + ctio_m1->flags = __constant_cpu_to_le16(OF_SSTS | OF_FAST_POST | + OF_NO_DATA | OF_SS_MODE_1); + ctio_m1->flags |= __constant_cpu_to_le16(OF_INC_RC); + if (q2t_need_explicit_conf(ha, prm->cmd, 0)) { + ctio_m1->flags |= __constant_cpu_to_le16(OF_EXPL_CONF | + OF_CONF_REQ); + } + ctio_m1->scsi_status = cpu_to_le16(prm->rq_result); + ctio_m1->residual = cpu_to_le32(prm->residual); + if (Q2T_SENSE_VALID(prm->sense_buffer)) { + if (q2t_need_explicit_conf(ha, prm->cmd, 1)) { + ctio_m1->flags |= __constant_cpu_to_le16(OF_EXPL_CONF | + OF_CONF_REQ); + } + ctio_m1->scsi_status |= __constant_cpu_to_le16( + SS_SENSE_LEN_VALID); + ctio_m1->sense_length = cpu_to_le16(prm->sense_buffer_len); + memcpy(ctio_m1->sense_data, prm->sense_buffer, + prm->sense_buffer_len); + } else { + memset(ctio_m1->sense_data, 0, sizeof(ctio_m1->sense_data)); + ctio_m1->sense_length = 0; + } + + /* Sense with len > 26, is it possible ??? */ + + return; +} + +static int __q2x_xmit_response(struct q2t_cmd *cmd, int xmit_type, uint8_t scsi_status) +{ + scsi_qla_host_t *vha = cmd->vha; + struct qla_hw_data *ha = vha->hw; + struct q2t_prm prm; + ctio_common_entry_t *pkt; + unsigned long flags; + uint32_t full_req_cnt = 0; + int res; + + memset(&prm, 0, sizeof(prm)); + + res = q2t_pre_xmit_response(cmd, &prm, xmit_type, scsi_status, &full_req_cnt); + if (unlikely(res != 0)) { + if (res == Q2T_PRE_XMIT_RESP_CMD_ABORTED) + return 0; + + return res; + } + + spin_lock_irqsave(&ha->hardware_lock, flags); + + /* Does F/W have an IOCBs for this request */ + res = q2t_check_reserve_free_req(vha, full_req_cnt); + if (unlikely(res != 0) && (xmit_type & Q2T_XMIT_DATA)) + goto out_unmap_unlock; + + q2x_build_ctio_pkt(&prm, cmd->vha); + pkt = (ctio_common_entry_t *)prm.pkt; + + if (q2t_has_data(cmd) && (xmit_type & Q2T_XMIT_DATA)) { + pkt->flags |= __constant_cpu_to_le16(OF_FAST_POST | OF_DATA_IN); + pkt->flags |= __constant_cpu_to_le16(OF_INC_RC); + + q2x_load_data_segments(&prm, vha); + + if (prm.add_status_pkt == 0) { + if (xmit_type & Q2T_XMIT_STATUS) { + pkt->scsi_status = cpu_to_le16(prm.rq_result); + pkt->residual = cpu_to_le32(prm.residual); + pkt->flags |= __constant_cpu_to_le16(OF_SSTS); + if (q2t_need_explicit_conf(ha, cmd, 0)) { + pkt->flags |= __constant_cpu_to_le16( + OF_EXPL_CONF | + OF_CONF_REQ); + } + } + } else { + /* + * We have already made sure that there is sufficient + * amount of request entries to not drop HW lock in + * req_pkt(). + */ + ctio_ret_entry_t *ctio_m1 = + (ctio_ret_entry_t *)q2t_get_req_pkt(vha); + + TRACE_DBG("%s", "Building additional status packet"); + + memcpy(ctio_m1, pkt, sizeof(*ctio_m1)); + ctio_m1->entry_count = 1; + ctio_m1->dseg_count = 0; + + /* Real finish is ctio_m1's finish */ + pkt->handle |= CTIO_INTERMEDIATE_HANDLE_MARK; + pkt->flags &= ~__constant_cpu_to_le16(OF_INC_RC); + + q2x_init_ctio_ret_entry(ctio_m1, &prm, cmd->vha); + TRACE_BUFFER("Status CTIO packet data", ctio_m1, + REQUEST_ENTRY_SIZE); + } + } else + q2x_init_ctio_ret_entry((ctio_ret_entry_t *)pkt, &prm, cmd->vha); + + cmd->state = Q2T_STATE_PROCESSED; /* Mid-level is done processing */ + + TRACE_DBG("Xmitting CTIO7 response pkt for 2xxx: %p scsi_status:" + " 0x%02x\n", pkt, scsi_status); + + qla2x00_isp_cmd(vha, vha->req); + spin_unlock_irqrestore(&ha->hardware_lock, flags); + + return 0; + +out_unmap_unlock: + if (cmd->sg_mapped) + q2t_unmap_sg(vha, cmd); + spin_unlock_irqrestore(&ha->hardware_lock, flags); + + return res; +} + +#ifdef CONFIG_QLA_TGT_DEBUG_SRR +/* + * Original taken from the XFS code + */ +static unsigned long q2t_srr_random(void) +{ + static int Inited; + static unsigned long RandomValue; + static DEFINE_SPINLOCK(lock); + /* cycles pseudo-randomly through all values between 1 and 2^31 - 2 */ + register long rv; + register long lo; + register long hi; + unsigned long flags; + + spin_lock_irqsave(&lock, flags); + if (!Inited) { + RandomValue = jiffies; + Inited = 1; + } + rv = RandomValue; + hi = rv / 127773; + lo = rv % 127773; + rv = 16807 * lo - 2836 * hi; + if (rv <= 0) + rv += 2147483647; + RandomValue = rv; + spin_unlock_irqrestore(&lock, flags); + return rv; +} + +static void q2t_check_srr_debug(struct q2t_cmd *cmd, int *xmit_type) +{ +#if 0 /* This is not a real status packets lost, so it won't lead to SRR */ + if ((*xmit_type & Q2T_XMIT_STATUS) && (q2t_srr_random() % 200) == 50) { + *xmit_type &= ~Q2T_XMIT_STATUS; + TRACE_MGMT_DBG("Dropping cmd %p (tag %d) status", cmd, + cmd->tag); + } +#endif + + if (q2t_has_data(cmd) && (cmd->sg_cnt > 1) && + ((q2t_srr_random() % 100) == 20)) { + int i, leave = 0; + unsigned int tot_len = 0; + + while (leave == 0) + leave = q2t_srr_random() % cmd->sg_cnt; + + for (i = 0; i < leave; i++) + tot_len += cmd->sg[i].length; + + TRACE_MGMT_DBG("Cutting cmd %p (tag %d) buffer tail to len %d, " + "sg_cnt %d (cmd->bufflen %d, cmd->sg_cnt %d)", cmd, + cmd->tag, tot_len, leave, cmd->bufflen, cmd->sg_cnt); + + cmd->bufflen = tot_len; + cmd->sg_cnt = leave; + } + + if (q2t_has_data(cmd) && ((q2t_srr_random() % 100) == 70)) { + unsigned int offset = q2t_srr_random() % cmd->bufflen; + + TRACE_MGMT_DBG("Cutting cmd %p (tag %d) buffer head " + "to offset %d (cmd->bufflen %d)", cmd, cmd->tag, + offset, cmd->bufflen); + if (offset == 0) + *xmit_type &= ~Q2T_XMIT_DATA; + else if (q2t_cut_cmd_data_head(cmd, offset)) { + TRACE_MGMT_DBG("q2t_cut_cmd_data_head() failed (tag %d)", + cmd->tag); + } + } +} +#else +static inline void q2t_check_srr_debug(struct q2t_cmd *cmd, int *xmit_type) {} +#endif + +int q2x_xmit_response(struct q2t_cmd *cmd, int xmit_type, uint8_t scsi_status) +{ +#if 0 + q2t_check_srr_debug(cmd, &xmit_type); +#endif + + TRACE_DBG("is_send_status=%d, cmd->bufflen=%d, cmd->sg_cnt=%d, " + "cmd->dma_data_direction=%d", (xmit_type & Q2T_XMIT_STATUS) ? + 1 : 0, cmd->bufflen, cmd->sg_cnt, cmd->dma_data_direction); + + return (IS_FWI2_CAPABLE(cmd->tgt->ha)) ? + __q24_xmit_response(cmd, xmit_type, scsi_status) : + __q2x_xmit_response(cmd, xmit_type, scsi_status); +} +EXPORT_SYMBOL(q2x_xmit_response); + +static void q24_init_ctio_ret_entry(ctio7_status0_entry_t *ctio, + struct q2t_prm *prm) +{ + ctio7_status1_entry_t *ctio1; + + prm->sense_buffer_len = min((uint32_t)prm->sense_buffer_len, + (uint32_t)sizeof(ctio1->sense_data)); + ctio->flags |= __constant_cpu_to_le16(CTIO7_FLAGS_SEND_STATUS); + if (q2t_need_explicit_conf(prm->tgt->ha, prm->cmd, 0)) { + ctio->flags |= __constant_cpu_to_le16( + CTIO7_FLAGS_EXPLICIT_CONFORM | + CTIO7_FLAGS_CONFORM_REQ); + } + ctio->residual = cpu_to_le32(prm->residual); + ctio->scsi_status = cpu_to_le16(prm->rq_result); + if (Q2T_SENSE_VALID(prm->sense_buffer)) { + int i; + + ctio1 = (ctio7_status1_entry_t *)ctio; + if (q2t_need_explicit_conf(prm->tgt->ha, prm->cmd, 1)) { + ctio1->flags |= __constant_cpu_to_le16( + CTIO7_FLAGS_EXPLICIT_CONFORM | + CTIO7_FLAGS_CONFORM_REQ); + } + ctio1->flags &= ~__constant_cpu_to_le16(CTIO7_FLAGS_STATUS_MODE_0); + ctio1->flags |= __constant_cpu_to_le16(CTIO7_FLAGS_STATUS_MODE_1); + ctio1->scsi_status |= __constant_cpu_to_le16(SS_SENSE_LEN_VALID); + ctio1->sense_length = cpu_to_le16(prm->sense_buffer_len); + for (i = 0; i < prm->sense_buffer_len/4; i++) + ((uint32_t *)ctio1->sense_data)[i] = + cpu_to_be32(((uint32_t *)prm->sense_buffer)[i]); +#if 0 + if (unlikely((prm->sense_buffer_len % 4) != 0)) { + static int q; + if (q < 10) { + printk(KERN_INFO "qla2x00t(%d): %d bytes of sense " + "lost", prm->tgt->ha->vp_idx, + prm->sense_buffer_len % 4); + q++; + } + } +#endif + } else { + ctio1 = (ctio7_status1_entry_t *)ctio; + ctio1->flags &= ~__constant_cpu_to_le16(CTIO7_FLAGS_STATUS_MODE_0); + ctio1->flags |= __constant_cpu_to_le16(CTIO7_FLAGS_STATUS_MODE_1); + ctio1->sense_length = 0; + memset(ctio1->sense_data, 0, sizeof(ctio1->sense_data)); + } + + /* Sense with len > 24, is it possible ??? */ +} + +/* + * Callback to setup response of xmit_type of Q2T_XMIT_DATA and * Q2T_XMIT_STATUS + * for >= 24xx silicon + */ +static int __q24_xmit_response(struct q2t_cmd *cmd, int xmit_type, uint8_t scsi_status) +{ + scsi_qla_host_t *vha = cmd->vha; + struct qla_hw_data *ha = vha->hw; + ctio7_status0_entry_t *pkt; + struct q2t_prm prm; + uint32_t full_req_cnt = 0; + unsigned long flags; + int res; + + memset(&prm, 0, sizeof(prm)); + + res = q2t_pre_xmit_response(cmd, &prm, xmit_type, scsi_status, &full_req_cnt); + if (unlikely(res != 0)) { + if (res == Q2T_PRE_XMIT_RESP_CMD_ABORTED) + return 0; + + return res; + } + + spin_lock_irqsave(&ha->hardware_lock, flags); + + /* Does F/W have an IOCBs for this request */ + res = q2t_check_reserve_free_req(vha, full_req_cnt); + if (unlikely(res != 0) && (xmit_type & Q2T_XMIT_DATA)) + goto out_unmap_unlock; + + res = q24_build_ctio_pkt(&prm, vha); + if (unlikely(res != 0)) + goto out_unmap_unlock; + + + pkt = (ctio7_status0_entry_t *)prm.pkt; + + if (q2t_has_data(cmd) && (xmit_type & Q2T_XMIT_DATA)) { + pkt->flags |= __constant_cpu_to_le16(CTIO7_FLAGS_DATA_IN | + CTIO7_FLAGS_STATUS_MODE_0); + + q24_load_data_segments(&prm, vha); + + if (prm.add_status_pkt == 0) { + if (xmit_type & Q2T_XMIT_STATUS) { + pkt->scsi_status = cpu_to_le16(prm.rq_result); + pkt->residual = cpu_to_le32(prm.residual); + pkt->flags |= __constant_cpu_to_le16( + CTIO7_FLAGS_SEND_STATUS); + if (q2t_need_explicit_conf(ha, cmd, 0)) { + pkt->flags |= __constant_cpu_to_le16( + CTIO7_FLAGS_EXPLICIT_CONFORM | + CTIO7_FLAGS_CONFORM_REQ); + } + } + + } else { + /* + * We have already made sure that there is sufficient + * amount of request entries to not drop HW lock in + * req_pkt(). + */ + ctio7_status1_entry_t *ctio = + (ctio7_status1_entry_t *)q2t_get_req_pkt(vha); + + TRACE_DBG("Building additional status packet\n"); + + memcpy(ctio, pkt, sizeof(*ctio)); + ctio->common.entry_count = 1; + ctio->common.dseg_count = 0; + ctio->flags &= ~__constant_cpu_to_le16( + CTIO7_FLAGS_DATA_IN); + + /* Real finish is ctio_m1's finish */ + pkt->common.handle |= CTIO_INTERMEDIATE_HANDLE_MARK; + pkt->flags |= __constant_cpu_to_le16( + CTIO7_FLAGS_DONT_RET_CTIO); + q24_init_ctio_ret_entry((ctio7_status0_entry_t *)ctio, + &prm); + printk("Status CTIO7: %p\n", ctio); + } + } else + q24_init_ctio_ret_entry(pkt, &prm); + + + cmd->state = Q2T_STATE_PROCESSED; /* Mid-level is done processing */ + + TRACE_DBG("Xmitting CTIO7 response pkt for 24xx: %p scsi_status:" + " 0x%02x\n", pkt, scsi_status); + + qla2x00_isp_cmd(vha, vha->req); + spin_unlock_irqrestore(&ha->hardware_lock, flags); + + return 0; + +out_unmap_unlock: + if (cmd->sg_mapped) + q2t_unmap_sg(vha, cmd); + spin_unlock_irqrestore(&ha->hardware_lock, flags); + + return res; +} + +int q2t_rdy_to_xfer(struct q2t_cmd *cmd) +{ + scsi_qla_host_t *vha = cmd->vha; + struct qla_hw_data *ha = vha->hw; + struct q2t_tgt *tgt = cmd->tgt; + struct q2t_prm prm; + void *p; + unsigned long flags; + int res = 0; + + memset(&prm, 0, sizeof(prm)); + prm.cmd = cmd; + prm.tgt = tgt; + prm.sg = NULL; + prm.req_cnt = 1; + + /* Send marker if required */ + if (q2t_issue_marker(vha, 0) != QLA_SUCCESS) + return -EIO; + + TRACE_DBG("CTIO_start: vha(%d)", (int)vha->vp_idx); + + /* Calculate number of entries and segments required */ + if (q2t_pci_map_calc_cnt(&prm) != 0) + return -ENOMEM; + + spin_lock_irqsave(&ha->hardware_lock, flags); + + /* Does F/W have an IOCBs for this request */ + res = q2t_check_reserve_free_req(vha, prm.req_cnt); + if (res != 0) + goto out_unlock_free_unmap; + + if (IS_FWI2_CAPABLE(ha)) { + ctio7_status0_entry_t *pkt; + res = q24_build_ctio_pkt(&prm, vha); + if (unlikely(res != 0)) + goto out_unlock_free_unmap; + pkt = (ctio7_status0_entry_t *)prm.pkt; + pkt->flags |= __constant_cpu_to_le16(CTIO7_FLAGS_DATA_OUT | + CTIO7_FLAGS_STATUS_MODE_0); + q24_load_data_segments(&prm, vha); + p = pkt; + } else { + ctio_common_entry_t *pkt; + q2x_build_ctio_pkt(&prm, vha); + pkt = (ctio_common_entry_t *)prm.pkt; + pkt->flags = __constant_cpu_to_le16(OF_FAST_POST | OF_DATA_OUT); + q2x_load_data_segments(&prm, vha); + p = pkt; + } + + cmd->state = Q2T_STATE_NEED_DATA; + + TRACE_BUFFER("Xfering", p, REQUEST_ENTRY_SIZE); + + qla2x00_isp_cmd(vha, vha->req); + spin_unlock_irqrestore(&ha->hardware_lock, flags); + + return res; + +out_unlock_free_unmap: + if (cmd->sg_mapped) + q2t_unmap_sg(vha, cmd); + spin_unlock_irqrestore(&ha->hardware_lock, flags); + + return res; +} +EXPORT_SYMBOL(q2t_rdy_to_xfer); + +/* If hardware_lock held on entry, might drop it, then reaquire */ +static void q2x_send_term_exchange(scsi_qla_host_t *vha, struct q2t_cmd *cmd, + atio_entry_t *atio, int ha_locked) +{ + struct qla_hw_data *ha = vha->hw; + ctio_ret_entry_t *ctio; + unsigned long flags = 0; /* to stop compiler's warning */ + int do_tgt_cmd_done = 0; + + TRACE_DBG("Sending TERM EXCH CTIO (ha=%p)\n", ha); + + /* Send marker if required */ + if (q2t_issue_marker(vha, ha_locked) != QLA_SUCCESS) + return; + + if (!ha_locked) + spin_lock_irqsave(&ha->hardware_lock, flags); + + ctio = (ctio_ret_entry_t *)q2t_req_pkt(vha); + if (ctio == NULL) { + printk(KERN_ERR "qla2x00t(%d): %s failed: unable to allocate " + "request packet\n", vha->vp_idx, __func__); + goto out_unlock; + } + + ctio->entry_type = CTIO_RET_TYPE; + ctio->entry_count = 1; + if (cmd != NULL) { + if (cmd->state < Q2T_STATE_PROCESSED) { + printk(KERN_ERR "qla2x00t(%d): Terminating cmd %p with " + "incorrect state %d\n", vha->vp_idx, cmd, + cmd->state); + } else + do_tgt_cmd_done = 1; + } + ctio->handle = Q2T_SKIP_HANDLE | CTIO_COMPLETION_HANDLE_MARK; + + /* Set IDs */ + SET_TARGET_ID(ha, ctio->target, GET_TARGET_ID(ha, atio)); + ctio->rx_id = atio->rx_id; + + /* Most likely, it isn't needed */ + ctio->residual = atio->data_length; + if (ctio->residual != 0) + ctio->scsi_status |= SS_RESIDUAL_UNDER; + + ctio->flags = __constant_cpu_to_le16(OF_FAST_POST | OF_TERM_EXCH | + OF_NO_DATA | OF_SS_MODE_1); + ctio->flags |= __constant_cpu_to_le16(OF_INC_RC); + + TRACE_BUFFER("CTIO TERM EXCH packet data", ctio, REQUEST_ENTRY_SIZE); + + qla2x00_isp_cmd(vha, vha->req); + +out_unlock: + if (!ha_locked) + spin_unlock_irqrestore(&ha->hardware_lock, flags); + + if (do_tgt_cmd_done) { + if (!ha_locked && !in_interrupt()) + msleep(250); /* just in case */ + + ha->qla2x_tmpl->free_cmd(cmd); + } +} + +/* If hardware_lock held on entry, might drop it, then reaquire */ +static void q24_send_term_exchange(scsi_qla_host_t *vha, struct q2t_cmd *cmd, + atio7_entry_t *atio, int ha_locked) +{ + struct qla_hw_data *ha = vha->hw; + ctio7_status1_entry_t *ctio; + unsigned long flags = 0; /* to stop compiler's warning */ + int do_tgt_cmd_done = 0; + + TRACE_DBG("Sending TERM EXCH CTIO7 (ha=%p)\n", ha); + + /* Send marker if required */ + if (q2t_issue_marker(vha, ha_locked) != QLA_SUCCESS) + return; + + if (!ha_locked) + spin_lock_irqsave(&ha->hardware_lock, flags); + + ctio = (ctio7_status1_entry_t *)q2t_req_pkt(vha); + if (ctio == NULL) { + printk(KERN_ERR "qla2x00t(%d): %s failed: unable to allocate " + "request packet\n", vha->vp_idx, __func__); + goto out_unlock; + } + + ctio->common.entry_type = CTIO_TYPE7; + ctio->common.entry_count = 1; + if (cmd != NULL) { + ctio->common.nport_handle = cmd->loop_id; + if (cmd->state < Q2T_STATE_PROCESSED) { + printk(KERN_ERR "qla2x00t(%d): Terminating cmd %p with " + "incorrect state %d\n", vha->vp_idx, cmd, + cmd->state); + } else + do_tgt_cmd_done = 1; + } else + ctio->common.nport_handle = CTIO7_NHANDLE_UNRECOGNIZED; + ctio->common.handle = Q2T_SKIP_HANDLE | CTIO_COMPLETION_HANDLE_MARK; + ctio->common.timeout = __constant_cpu_to_le16(Q2T_TIMEOUT); + ctio->common.vp_index = vha->vp_idx; + ctio->common.initiator_id[0] = atio->fcp_hdr.s_id[2]; + ctio->common.initiator_id[1] = atio->fcp_hdr.s_id[1]; + ctio->common.initiator_id[2] = atio->fcp_hdr.s_id[0]; + ctio->common.exchange_addr = atio->exchange_addr; + ctio->flags = (atio->attr << 9) | __constant_cpu_to_le16( + CTIO7_FLAGS_STATUS_MODE_1 | CTIO7_FLAGS_TERMINATE); + ctio->ox_id = swab16(atio->fcp_hdr.ox_id); + + /* Most likely, it isn't needed */ + ctio->residual = get_unaligned((uint32_t *) + &atio->fcp_cmnd.add_cdb[atio->fcp_cmnd.add_cdb_len]); + if (ctio->residual != 0) + ctio->scsi_status |= SS_RESIDUAL_UNDER; + + TRACE_BUFFER("CTIO7 TERM EXCH packet data", ctio, REQUEST_ENTRY_SIZE); + + qla2x00_isp_cmd(vha, vha->req); + +out_unlock: + if (!ha_locked) + spin_unlock_irqrestore(&ha->hardware_lock, flags); + + if (do_tgt_cmd_done) { + if (!ha_locked && !in_interrupt()) + msleep(250); /* just in case */ + + ha->qla2x_tmpl->free_cmd(cmd); + } +} + +void q2t_free_cmd(struct q2t_cmd *cmd) +{ + BUG_ON(cmd->sg_mapped); + + if (unlikely(cmd->free_sg)) + kfree(cmd->sg); + kmem_cache_free(q2t_cmd_cachep, cmd); +} +EXPORT_SYMBOL(q2t_free_cmd); + +/* ha->hardware_lock supposed to be held on entry */ +static int q2t_prepare_srr_ctio(scsi_qla_host_t *vha, struct q2t_cmd *cmd, + void *ctio) +{ + struct srr_ctio *sc; + struct qla_hw_data *ha = vha->hw; + struct q2t_tgt *tgt = ha->q2t_tgt; + struct srr_imm *imm; + + tgt->ctio_srr_id++; + + TRACE_MGMT_DBG("qla2x00t(%d): CTIO with SRR " + "status received\n", vha->vp_idx); + + if (!ctio) { + printk(KERN_ERR "qla2x00t(%d): SRR CTIO, " + "but ctio is NULL\n", vha->vp_idx); + return EINVAL; + } + + dump_stack(); + + sc = kzalloc(sizeof(*sc), GFP_ATOMIC); + if (sc != NULL) { + sc->cmd = cmd; + /* IRQ is already OFF */ + spin_lock(&tgt->srr_lock); + sc->srr_id = tgt->ctio_srr_id; + list_add_tail(&sc->srr_list_entry, + &tgt->srr_ctio_list); + TRACE_MGMT_DBG("CTIO SRR %p added (id %d)\n", + sc, sc->srr_id); + if (tgt->imm_srr_id == tgt->ctio_srr_id) { + int found = 0; + list_for_each_entry(imm, &tgt->srr_imm_list, + srr_list_entry) { + if (imm->srr_id == sc->srr_id) { + found = 1; + break; + } + } + if (found) { + TRACE_MGMT_DBG("%s", "Scheduling srr work\n"); + schedule_work(&tgt->srr_work); + } else { + printk(KERN_ERR "qla2x00t(%d): imm_srr_id " + "== ctio_srr_id (%d), but there is no " + "corresponding SRR IMM, deleting CTIO " + "SRR %p\n", vha->vp_idx, tgt->ctio_srr_id, + sc); + list_del(&sc->srr_list_entry); + spin_unlock(&tgt->srr_lock); + + kfree(sc); + return -EINVAL; + } + } + spin_unlock(&tgt->srr_lock); + } else { + struct srr_imm *ti; + + printk(KERN_ERR "qla2x00t(%d): Unable to allocate SRR CTIO entry\n", + vha->vp_idx); + spin_lock(&tgt->srr_lock); + list_for_each_entry_safe(imm, ti, &tgt->srr_imm_list, + srr_list_entry) { + if (imm->srr_id == tgt->ctio_srr_id) { + TRACE_MGMT_DBG("IMM SRR %p deleted " + "(id %d)\n", imm, imm->srr_id); + list_del(&imm->srr_list_entry); + q2t_reject_free_srr_imm(vha, imm, 1); + } + } + spin_unlock(&tgt->srr_lock); + + return -ENOMEM; + } + + return 0; +} + +/* + * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire + */ +static int q2t_term_ctio_exchange(scsi_qla_host_t *vha, void *ctio, + struct q2t_cmd *cmd, uint32_t status) +{ + struct qla_hw_data *ha = vha->hw; + int term = 0; + + if (IS_FWI2_CAPABLE(ha)) { + if (ctio != NULL) { + ctio7_fw_entry_t *c = (ctio7_fw_entry_t *)ctio; + term = !(c->flags & + __constant_cpu_to_le16(OF_TERM_EXCH)); + } else + term = 1; + if (term) { + q24_send_term_exchange(vha, cmd, + &cmd->atio.atio7, 1); + } + } else { + if (status != CTIO_SUCCESS) + q2x_modify_command_count(vha, 1, 0); +#if 0 /* seems, it isn't needed */ + if (ctio != NULL) { + ctio_common_entry_t *c = (ctio_common_entry_t *)ctio; + term = !(c->flags & + __constant_cpu_to_le16( + CTIO7_FLAGS_TERMINATE)); + } else + term = 1; + if (term) { + q2x_send_term_exchange(vha, cmd, + &cmd->atio.atio2x, 1); + } +#endif + } + return term; +} + +/* ha->hardware_lock supposed to be held on entry */ +static inline struct q2t_cmd *q2t_get_cmd(scsi_qla_host_t *vha, uint32_t handle) +{ + struct qla_hw_data *ha = vha->hw; + + handle--; + if (ha->cmds[handle] != NULL) { + struct q2t_cmd *cmd = ha->cmds[handle]; + ha->cmds[handle] = NULL; + return cmd; + } else + return NULL; +} + +/* ha->hardware_lock supposed to be held on entry */ +static struct q2t_cmd *q2t_ctio_to_cmd(scsi_qla_host_t *vha, uint32_t handle, + void *ctio) +{ + struct qla_hw_data *ha = vha->hw; + struct q2t_cmd *cmd = NULL; + + /* Clear out internal marks */ + handle &= ~(CTIO_COMPLETION_HANDLE_MARK | CTIO_INTERMEDIATE_HANDLE_MARK); + + if (handle != Q2T_NULL_HANDLE) { + if (unlikely(handle == Q2T_SKIP_HANDLE)) { + TRACE_DBG("%s", "SKIP_HANDLE CTIO\n"); + return NULL; + } + /* handle-1 is actually used */ + if (unlikely(handle > MAX_OUTSTANDING_COMMANDS)) { + printk(KERN_ERR "qla2x00t(%d): Wrong handle %x " + "received\n", vha->vp_idx, handle); + return NULL; + } + cmd = q2t_get_cmd(vha, handle); + if (unlikely(cmd == NULL)) { + printk(KERN_WARNING "qla2x00t(%d): Suspicious: unable to " + "find the command with handle %x\n", + vha->vp_idx, handle); + return NULL; + } + } else if (ctio != NULL) { + struct q2t_sess *sess; + int tag; + uint16_t loop_id; + + if (IS_FWI2_CAPABLE(ha)) { + /* We can't get loop ID from CTIO7 */ + printk(KERN_ERR "qla2x00t(%d): Wrong CTIO received: " + "QLA24xx doesn't support NULL handles\n", + vha->vp_idx); + return NULL; + } else { + ctio_common_entry_t *c = (ctio_common_entry_t *)ctio; + loop_id = GET_TARGET_ID(ha, c); + tag = c->rx_id; + } + + sess = ha->qla2x_tmpl->find_sess_by_loop_id(vha, loop_id); + if (!sess) { + printk(KERN_WARNING "qla2x00t(%d): Suspicious: " + "ctio_completion for non-existing session " + "(loop_id %d, tag %d)\n", + vha->vp_idx, loop_id, tag); + return NULL; + } + } + + return cmd; +} + +/* + * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire + */ +static void q2t_do_ctio_completion(scsi_qla_host_t *vha, uint32_t handle, + uint32_t status, void *ctio) +{ + struct qla_hw_data *ha = vha->hw; + struct se_cmd *se_cmd; + struct target_core_fabric_ops *tfo; + struct q2t_cmd *cmd; + + TRACE_SCSI("qla2x00t(%d): handle(ctio %p status %#x) <- %08x\n", + vha->vp_idx, ctio, status, handle); + + if (handle & CTIO_INTERMEDIATE_HANDLE_MARK) { + /* That could happen only in case of an error/reset/abort */ + if (status != CTIO_SUCCESS) { + TRACE_MGMT_DBG("Intermediate CTIO received (status %x)\n", + status); + } + return; + } + + cmd = q2t_ctio_to_cmd(vha, handle, ctio); + if (cmd == NULL) { + if (status != CTIO_SUCCESS) + q2t_term_ctio_exchange(vha, ctio, NULL, status); + return; + } + se_cmd = &cmd->se_cmd; + tfo = se_cmd->se_tfo; + + if (cmd->sg_mapped) + q2t_unmap_sg(vha, cmd); + + if (unlikely(status != CTIO_SUCCESS)) { + switch (status & 0xFFFF) { + case CTIO_LIP_RESET: + case CTIO_TARGET_RESET: + case CTIO_ABORTED: + case CTIO_TIMEOUT: + case CTIO_INVALID_RX_ID: + /* They are OK */ + printk(KERN_INFO "qla2x00t(%d): CTIO with " + "status %#x received, state %x, se_cmd %p, " + "(LIP_RESET=e, ABORTED=2, TARGET_RESET=17, " + "TIMEOUT=b, INVALID_RX_ID=8)\n", vha->vp_idx, + status, cmd->state, se_cmd); + break; + + case CTIO_PORT_LOGGED_OUT: + case CTIO_PORT_UNAVAILABLE: + printk(KERN_INFO "qla2x00t(%d): CTIO with PORT LOGGED " + "OUT (29) or PORT UNAVAILABLE (28) status %x " + "received (state %x, se_cmd %p)\n", + vha->vp_idx, status, cmd->state, se_cmd); + break; + + case CTIO_SRR_RECEIVED: + printk(KERN_INFO "qla2x00t(%d): CTIO with SRR_RECEIVED" + " status %x received (state %x, se_cmd %p)\n", + vha->vp_idx, status, cmd->state, se_cmd); + if (q2t_prepare_srr_ctio(vha, cmd, ctio) != 0) + break; + else + return; + + default: + printk(KERN_ERR "qla2x00t(%d): CTIO with error status " + "0x%x received (state %x, se_cmd %p\n", + vha->vp_idx, status, cmd->state, se_cmd); + break; + } + + if (cmd->state != Q2T_STATE_NEED_DATA) + if (q2t_term_ctio_exchange(vha, ctio, cmd, status)) + return; + } + + if (cmd->state == Q2T_STATE_PROCESSED) { + TRACE_DBG("Command %p finished\n", cmd); + } else if (cmd->state == Q2T_STATE_NEED_DATA) { + int rx_status = 0; + + cmd->state = Q2T_STATE_DATA_IN; + + if (unlikely(status != CTIO_SUCCESS)) + rx_status = -EIO; + else + cmd->write_data_transferred = 1; + + TRACE_DBG("Data received, context %x, rx_status %d\n", + 0x0, rx_status); + + ha->qla2x_tmpl->handle_data(cmd); + return; + } else if (cmd->state == Q2T_STATE_ABORTED) { + TRACE_MGMT_DBG("Aborted command %p (tag %d) finished\n", cmd, + cmd->tag); + } else { + printk(KERN_ERR "qla2x00t(%d): A command in state (%d) should " + "not return a CTIO complete\n", vha->vp_idx, cmd->state); + } + + if (unlikely(status != CTIO_SUCCESS)) { + TRACE_MGMT_DBG("%s", "Finishing failed CTIO\n"); + dump_stack(); + } + + ha->qla2x_tmpl->free_cmd(cmd); +} + +/* ha->hardware_lock supposed to be held on entry */ +/* called via callback from qla2xxx */ +void q2x_ctio_completion(scsi_qla_host_t *vha, uint32_t handle) +{ + struct qla_hw_data *ha = vha->hw; + struct q2t_tgt *tgt = ha->q2t_tgt; + + if (likely(tgt == NULL)) { + TRACE_DBG("CTIO, but target mode not enabled (ha %d %p handle " + "%#x)", vha->vp_idx, ha, handle); + return; + } + + tgt->irq_cmd_count++; + q2t_do_ctio_completion(vha, handle, CTIO_SUCCESS, NULL); + tgt->irq_cmd_count--; +} + +static inline int q2t_get_fcp_task_attr(uint8_t task_codes) +{ + int fcp_task_attr; + + switch (task_codes) { + case ATIO_SIMPLE_QUEUE: + fcp_task_attr = FCP_PTA_SIMPLE; + break; + case ATIO_HEAD_OF_QUEUE: + fcp_task_attr = FCP_PTA_HEADQ; + break; + case ATIO_ORDERED_QUEUE: + fcp_task_attr = FCP_PTA_ORDERED; + break; + case ATIO_ACA_QUEUE: + fcp_task_attr = FCP_PTA_ACA; + break; + case ATIO_UNTAGGED: + fcp_task_attr = FCP_PTA_SIMPLE; + break; + default: + printk(KERN_WARNING "qla2x00t: unknown task code %x, use " + "ORDERED instead\n", task_codes); + fcp_task_attr = FCP_PTA_ORDERED; + break; + } + + return fcp_task_attr; +} + +/* ha->hardware_lock supposed to be held on entry */ +static int q2x_send_cmd_to_target(scsi_qla_host_t *vha, struct q2t_cmd *cmd) +{ + atio_entry_t *atio = &cmd->atio.atio2x; + uint32_t data_length; + int fcp_task_attr, data_dir, bidi = 0, ret; + uint16_t lun; + + /* make it be in network byte order */ + lun = swab16(le16_to_cpu(atio->lun)); + cmd->tag = atio->rx_id; + + if ((atio->execution_codes & (ATIO_EXEC_READ | ATIO_EXEC_WRITE)) == + (ATIO_EXEC_READ | ATIO_EXEC_WRITE)) { + bidi = 1; + data_dir = DMA_TO_DEVICE; + } else if (atio->execution_codes & ATIO_EXEC_READ) + data_dir = DMA_FROM_DEVICE; + else if (atio->execution_codes & ATIO_EXEC_WRITE) + data_dir = DMA_TO_DEVICE; + else + data_dir = DMA_NONE; + + fcp_task_attr = q2t_get_fcp_task_attr(atio->task_codes); + data_length = le32_to_cpu(atio->data_length); + + TRACE_SCSI("qla2x00t: START q2x command: %p lun: 0x%04x" + " (tag %d)\n", cmd, lun, cmd->tag); + /* + * Dispatch command to tcm_qla2xxx fabric module code + */ + ret = vha->hw->qla2x_tmpl->handle_cmd(vha, cmd, lun, data_length, + fcp_task_attr, data_dir, bidi); + return ret; +} + +/* ha->hardware_lock supposed to be held on entry */ +static int q24_send_cmd_to_target(scsi_qla_host_t *vha, struct q2t_cmd *cmd) +{ + atio7_entry_t *atio = &cmd->atio.atio7; + uint32_t lun, data_length; + int fcp_task_attr, data_dir, bidi = 0, ret; + + cmd->tag = atio->exchange_addr; + lun = atio->fcp_cmnd.lun; + + if (atio->fcp_cmnd.rddata && atio->fcp_cmnd.wrdata) { + bidi = 1; + data_dir = DMA_TO_DEVICE; + } else if (atio->fcp_cmnd.rddata) + data_dir = DMA_FROM_DEVICE; + else if (atio->fcp_cmnd.wrdata) + data_dir = DMA_TO_DEVICE; + else + data_dir = DMA_NONE; + + fcp_task_attr = q2t_get_fcp_task_attr(atio->fcp_cmnd.task_attr); + data_length = be32_to_cpu(get_unaligned((uint32_t *) + &atio->fcp_cmnd.add_cdb[atio->fcp_cmnd.add_cdb_len])); + + TRACE_SCSI("qla2x00t: START q24 Command %p lun: 0x%08x" + " (tag %d)\n", cmd, lun, cmd->tag); + /* + * Dispatch command to tcm_qla2xxx fabric module code + */ + ret = vha->hw->qla2x_tmpl->handle_cmd(vha, cmd, lun, data_length, + fcp_task_attr, data_dir, bidi); + return ret; +} + +/* ha->hardware_lock supposed to be held on entry */ +static int q2t_send_cmd_to_target(scsi_qla_host_t *vha, + struct q2t_cmd *cmd, struct q2t_sess *sess) +{ + struct qla_hw_data *ha = vha->hw; + + cmd->sess = sess; + cmd->loop_id = sess->loop_id; + cmd->conf_compl_supported = sess->conf_compl_supported; + + return (IS_FWI2_CAPABLE(ha)) ? q24_send_cmd_to_target(vha, cmd) : + q2x_send_cmd_to_target(vha, cmd); +} + +/* ha->hardware_lock supposed to be held on entry */ +static int q2t_handle_cmd_for_atio(scsi_qla_host_t *vha, atio_t *atio) +{ + struct qla_hw_data *ha = vha->hw; + struct q2t_tgt *tgt = ha->q2t_tgt; + struct q2t_sess *sess; + struct q2t_cmd *cmd; + int res = 0; + + if (unlikely(tgt->tgt_stop)) { + TRACE_MGMT_DBG("New command while device %p is shutting " + "down\n", tgt); + return -EFAULT; + } + + cmd = kmem_cache_zalloc(q2t_cmd_cachep, GFP_ATOMIC); + if (!cmd) { + printk(KERN_INFO "qla2x00t(%d): Allocation of cmd " + "failed\n", vha->vp_idx); + return -ENOMEM; + } + + memcpy(&cmd->atio.atio2x, atio, sizeof(*atio)); + cmd->state = Q2T_STATE_NEW; + cmd->tgt = ha->q2t_tgt; + cmd->vha = vha; + + if (IS_FWI2_CAPABLE(ha)) { + atio7_entry_t *a = (atio7_entry_t *)atio; + sess = ha->qla2x_tmpl->find_sess_by_s_id(vha, a->fcp_hdr.s_id); + if (unlikely(!sess)) { + TRACE_MGMT_DBG("qla2x00t(%d): Unable to find " + "wwn login (s_id %x:%x:%x), trying to create " + "it manually\n", vha->vp_idx, + a->fcp_hdr.s_id[0], a->fcp_hdr.s_id[1], + a->fcp_hdr.s_id[2]); + goto out_sched; + } + } else { + sess = ha->qla2x_tmpl->find_sess_by_loop_id(vha, + GET_TARGET_ID(ha, (atio_entry_t *)atio)); + if (unlikely(!sess)) { + TRACE_MGMT_DBG("qla2x00t(%d): Unable to find " + "wwn login (loop_id=%d), trying to create it " + "manually\n", vha->vp_idx, + GET_TARGET_ID(ha, (atio_entry_t *)atio)); + goto out_sched; + } + } + + res = q2t_send_cmd_to_target(vha, cmd, sess); + if (unlikely(res != 0)) + goto out_free_cmd; + + return res; + +out_free_cmd: + q2t_free_cmd(cmd); + return res; + +out_sched: + if (atio->entry_count > 1) { + TRACE_MGMT_DBG("Dropping multy entry cmd %p\n", cmd); + res = -EBUSY; + goto out_free_cmd; + } + res = q2t_sched_sess_work(tgt, Q2T_SESS_WORK_CMD, &cmd, sizeof(cmd)); + if (res != 0) + q2t_free_cmd(cmd); + + return res; +} + +/* ha->hardware_lock supposed to be held on entry */ +static int q2t_issue_task_mgmt(struct q2t_sess *sess, uint32_t lun, + int lun_size, int fn, void *iocb, int flags) +{ + scsi_qla_host_t *vha = sess->vha; + struct qla_hw_data *ha = vha->hw; + struct q2t_mgmt_cmd *mcmd; + int res; + uint8_t tmr_func; + + mcmd = mempool_alloc(q2t_mgmt_cmd_mempool, GFP_ATOMIC); + if (!mcmd) { + printk(KERN_ERR "qla2x00t(%d): Allocation of management " + "command failed, some commands and their data could " + "leak\n", vha->vp_idx); + return -ENOMEM; + } + memset(mcmd, 0, sizeof(*mcmd)); + mcmd->sess = sess; + + if (iocb) { + memcpy(&mcmd->orig_iocb.notify_entry, iocb, + sizeof(mcmd->orig_iocb.notify_entry)); + } + mcmd->tmr_func = fn; + mcmd->flags = flags; + + switch (fn) { + case Q2T_CLEAR_ACA: + TRACE_MGMT("qla2x00t(%d): CLEAR_ACA received\n", + sess->vha->vp_idx); + tmr_func = CLEAR_ACA; + break; + + case Q2T_TARGET_RESET: + TRACE_MGMT("qla2x00t(%d): TARGET_RESET received\n", + sess->vha->vp_idx); + tmr_func = TARGET_WARM_RESET; + break; + + case Q2T_LUN_RESET: + TRACE_MGMT("qla2x00t(%d): LUN_RESET received\n", + sess->vha->vp_idx); + tmr_func = LUN_RESET; + break; + + case Q2T_CLEAR_TS: + TRACE_MGMT("qla2x00t(%d): CLEAR_TS received\n", + sess->vha->vp_idx); + tmr_func = CLEAR_TASK_SET; + break; + + case Q2T_ABORT_TS: + TRACE_MGMT("qla2x00t(%d): ABORT_TS received\n", + sess->vha->vp_idx); + tmr_func = ABORT_TASK_SET; + break; +#if 0 + case Q2T_ABORT_ALL: + TRACE_MGMT("qla2x00t(%d): Doing ABORT_ALL_TASKS\n", + sess->vha->vp_idx); + tmr_func = 0; + break; + + case Q2T_ABORT_ALL_SESS: + TRACE_MGMT("qla2x00t(%d): Doing ABORT_ALL_TASKS_SESS\n", + sess->vha->vp_idx); + tmr_func = 0; + break; + + case Q2T_NEXUS_LOSS_SESS: + TRACE_MGMT("qla2x00t(%d): Doing NEXUS_LOSS_SESS\n", + sess->vha->vp_idx); + tmr_func = 0; + break; + + case Q2T_NEXUS_LOSS: + TRACE_MGMT("qla2x00t(%d): Doing NEXUS_LOSS\n", + sess->vha->vp_idx); + tmr_func = 0; + break; +#endif + default: + printk(KERN_ERR "qla2x00t(%d): Unknown task mgmt fn 0x%x\n", + sess->vha->vp_idx, fn); + mempool_free(mcmd, q2t_mgmt_cmd_mempool); + return -ENOSYS; + } + + res = ha->qla2x_tmpl->handle_tmr(mcmd, lun, tmr_func); + if (res != 0) { + printk(KERN_ERR "qla2x00t(%d): qla2x_tmpl->handle_tmr() failed: %d\n", + sess->vha->vp_idx, res); + mempool_free(mcmd, q2t_mgmt_cmd_mempool); + return -EFAULT; + } + + return 0; +} + +/* ha->hardware_lock supposed to be held on entry */ +static int q2t_handle_task_mgmt(scsi_qla_host_t *vha, void *iocb) +{ + struct qla_hw_data *ha = vha->hw; + struct q2t_tgt *tgt; + struct q2t_sess *sess; + uint32_t lun; + int lun_size, fn, res = 0; + + tgt = ha->q2t_tgt; + if (IS_FWI2_CAPABLE(ha)) { + atio7_entry_t *a = (atio7_entry_t *)iocb; + + lun = a->fcp_cmnd.lun; + lun_size = sizeof(a->fcp_cmnd.lun); + fn = a->fcp_cmnd.task_mgmt_flags; + sess = ha->qla2x_tmpl->find_sess_by_s_id(vha, + a->fcp_hdr.s_id); + } else { + notify_entry_t *n = (notify_entry_t *)iocb; + /* make it be in network byte order */ + lun = swab16(le16_to_cpu(n->lun)); + lun_size = sizeof(lun); + fn = n->task_flags >> IMM_NTFY_TASK_MGMT_SHIFT; + sess = ha->qla2x_tmpl->find_sess_by_loop_id(vha, + GET_TARGET_ID(ha, n)); + } + + if (!sess) { + TRACE_MGMT_DBG("qla2x00t(%d): task mgmt fn 0x%x for " + "non-existant session\n", vha->vp_idx, fn); + res = q2t_sched_sess_work(tgt, Q2T_SESS_WORK_TM, iocb, + IS_FWI2_CAPABLE(ha) ? sizeof(atio7_entry_t) : + sizeof(notify_entry_t)); + if (res != 0) + tgt->tm_to_unknown = 1; + + return res; + } + + return q2t_issue_task_mgmt(sess, lun, lun_size, fn, iocb, 0); +} + +/* ha->hardware_lock supposed to be held on entry */ +static int __q2t_abort_task(scsi_qla_host_t *vha, notify_entry_t *iocb, + struct q2t_sess *sess) +{ + struct qla_hw_data *ha = vha->hw; + struct q2t_mgmt_cmd *mcmd; + uint32_t lun; + int rc; + uint16_t tag; + + mcmd = mempool_alloc(q2t_mgmt_cmd_mempool, GFP_ATOMIC); + if (mcmd == NULL) { + printk(KERN_ERR "qla2x00t(%d): %s: Allocation of ABORT" + " cmd failed\n", vha->vp_idx, __func__); + return -ENOMEM; + } + memset(mcmd, 0, sizeof(*mcmd)); + + mcmd->sess = sess; + memcpy(&mcmd->orig_iocb.notify_entry, iocb, + sizeof(mcmd->orig_iocb.notify_entry)); + + tag = le16_to_cpu(iocb->seq_id); +#warning FIXME: Hardcoded LUN for __q2t_abort_task + lun = 0; + rc = ha->qla2x_tmpl->handle_tmr(mcmd, lun, ABORT_TASK); + if (rc != 0) { + printk(KERN_ERR "qla2x00t(%d): qla2x_tmpl->handle_tmr()" + " failed: %d\n", vha->vp_idx, rc); + mempool_free(mcmd, q2t_mgmt_cmd_mempool); + return -EFAULT; + } + + return 0; +} + +/* ha->hardware_lock supposed to be held on entry */ +static int q2t_abort_task(scsi_qla_host_t *vha, notify_entry_t *iocb) +{ + struct qla_hw_data *ha = vha->hw; + struct q2t_sess *sess; + int loop_id, res; + + loop_id = GET_TARGET_ID(ha, iocb); + + sess = ha->qla2x_tmpl->find_sess_by_loop_id(vha, loop_id); + if (sess == NULL) { + TRACE_MGMT_DBG("qla2x00t(%d): task abort for unexisting " + "session\n", vha->vp_idx); + res = q2t_sched_sess_work(sess->tgt, Q2T_SESS_WORK_ABORT, + iocb, sizeof(*iocb)); + if (res != 0) + sess->tgt->tm_to_unknown = 1; + + return res; + } + + return __q2t_abort_task(vha, iocb, sess); +} + +/* + * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire + */ +static int q24_handle_els(scsi_qla_host_t *vha, notify24xx_entry_t *iocb) +{ + struct qla_hw_data *ha = vha->hw; + int res = 0; + + TRACE_MGMT_DBG("qla2x00t(%d): Port ID: 0x%02x:%02x:%02x ELS opcode:" + " 0x%02x\n", vha->vp_idx, iocb->port_id[0], + iocb->port_id[1], iocb->port_id[2], iocb->status_subcode); + + switch (iocb->status_subcode) { + case ELS_PLOGI: + case ELS_FLOGI: + case ELS_PRLI: + case ELS_LOGO: + case ELS_PRLO: + res = q2t_reset(vha, iocb, Q2T_NEXUS_LOSS_SESS); + break; + case ELS_PDISC: + case ELS_ADISC: + { + struct q2t_tgt *tgt = ha->q2t_tgt; + if (tgt->link_reinit_iocb_pending) { + q24_send_notify_ack(vha, &tgt->link_reinit_iocb, 0, 0, 0); + tgt->link_reinit_iocb_pending = 0; + } + res = 1; /* send notify ack */ + break; + } + + default: + printk(KERN_ERR "qla2x00t(%d): Unsupported ELS command %x " + "received\n", vha->vp_idx, iocb->status_subcode); + res = q2t_reset(vha, iocb, Q2T_NEXUS_LOSS_SESS); + break; + } + + return res; +} + +static int q2t_cut_cmd_data_head(struct q2t_cmd *cmd, unsigned int offset) +{ + int res = 0; + int cnt, first_sg, first_page = 0, first_page_offs = 0, i; + unsigned int l; + int cur_dst, cur_src; + struct scatterlist *sg; + size_t bufflen = 0; + + first_sg = -1; + cnt = 0; + l = 0; + for (i = 0; i < cmd->sg_cnt; i++) { + l += cmd->sg[i].length; + if (l > offset) { + int sg_offs = l - cmd->sg[i].length; + first_sg = i; + if (cmd->sg[i].offset == 0) { + first_page_offs = offset % PAGE_SIZE; + first_page = (offset - sg_offs) >> PAGE_SHIFT; + } else { + TRACE_SG("i=%d, sg[i].offset=%d, " + "sg_offs=%d", i, cmd->sg[i].offset, sg_offs); + if ((cmd->sg[i].offset + sg_offs) > offset) { + first_page_offs = offset - sg_offs; + first_page = 0; + } else { + int sec_page_offs = sg_offs + + (PAGE_SIZE - cmd->sg[i].offset); + first_page_offs = sec_page_offs % PAGE_SIZE; + first_page = 1 + + ((offset - sec_page_offs) >> + PAGE_SHIFT); + } + } + cnt = cmd->sg_cnt - i + (first_page_offs != 0); + break; + } + } + if (first_sg == -1) { + printk(KERN_ERR "qla2x00t(%d): Wrong offset %d, buf length %d", + cmd->vha->vp_idx, offset, cmd->bufflen); + return -EINVAL; + } + + TRACE_SG("offset=%d, first_sg=%d, first_page=%d, " + "first_page_offs=%d, cmd->bufflen=%d, cmd->sg_cnt=%d", offset, + first_sg, first_page, first_page_offs, cmd->bufflen, + cmd->sg_cnt); + + sg = kzalloc(cnt * sizeof(sg[0]), GFP_KERNEL); + if (sg == NULL) { + printk(KERN_ERR "qla2x00t(%d): Unable to allocate cut " + "SG (len %zd)", cmd->vha->vp_idx, + cnt * sizeof(sg[0])); + return -ENOMEM; + } + sg_init_table(sg, cnt); + + cur_dst = 0; + cur_src = first_sg; + if (first_page_offs != 0) { + int fpgs; + sg_set_page(&sg[cur_dst], &sg_page(&cmd->sg[cur_src])[first_page], + PAGE_SIZE - first_page_offs, first_page_offs); + bufflen += sg[cur_dst].length; + TRACE_SG("cur_dst=%d, cur_src=%d, sg[].page=%p, " + "sg[].offset=%d, sg[].length=%d, bufflen=%zu", + cur_dst, cur_src, sg_page(&sg[cur_dst]), sg[cur_dst].offset, + sg[cur_dst].length, bufflen); + cur_dst++; + + fpgs = (cmd->sg[cur_src].length >> PAGE_SHIFT) + + ((cmd->sg[cur_src].length & ~PAGE_MASK) != 0); + first_page++; + if (fpgs > first_page) { + sg_set_page(&sg[cur_dst], + &sg_page(&cmd->sg[cur_src])[first_page], + cmd->sg[cur_src].length - PAGE_SIZE*first_page, + 0); + TRACE_SG("fpgs=%d, cur_dst=%d, cur_src=%d, " + "sg[].page=%p, sg[].length=%d, bufflen=%zu", + fpgs, cur_dst, cur_src, sg_page(&sg[cur_dst]), + sg[cur_dst].length, bufflen); + bufflen += sg[cur_dst].length; + cur_dst++; + } + cur_src++; + } + + while (cur_src < cmd->sg_cnt) { + sg_set_page(&sg[cur_dst], sg_page(&cmd->sg[cur_src]), + cmd->sg[cur_src].length, cmd->sg[cur_src].offset); + TRACE_SG("cur_dst=%d, cur_src=%d, " + "sg[].page=%p, sg[].length=%d, sg[].offset=%d, " + "bufflen=%zu", cur_dst, cur_src, sg_page(&sg[cur_dst]), + sg[cur_dst].length, sg[cur_dst].offset, bufflen); + bufflen += sg[cur_dst].length; + cur_dst++; + cur_src++; + } + + if (cmd->free_sg) + kfree(cmd->sg); + + cmd->sg = sg; + cmd->free_sg = 1; + cmd->sg_cnt = cur_dst; + cmd->bufflen = bufflen; + cmd->offset += offset; + + return res; +} + +static inline int q2t_srr_adjust_data(struct q2t_cmd *cmd, + uint32_t srr_rel_offs, int *xmit_type) +{ + int res = 0; + int rel_offs; + + rel_offs = srr_rel_offs - cmd->offset; + TRACE_MGMT_DBG("srr_rel_offs=%d, rel_offs=%d", srr_rel_offs, rel_offs); + + *xmit_type = Q2T_XMIT_ALL; + + if (rel_offs < 0) { + printk(KERN_ERR "qla2x00t(%d): SRR rel_offs (%d) " + "< 0", cmd->vha->vp_idx, rel_offs); + res = -1; + } else if (rel_offs == cmd->bufflen) + *xmit_type = Q2T_XMIT_STATUS; + else if (rel_offs > 0) + res = q2t_cut_cmd_data_head(cmd, rel_offs); + + return res; +} + +/* No locks, thread context */ +#warning FIXME: q24_handle_srr +static void q24_handle_srr(scsi_qla_host_t *vha, struct srr_ctio *sctio, + struct srr_imm *imm) +{ + notify24xx_entry_t *ntfy = &imm->imm.notify_entry24; + struct qla_hw_data *ha = vha->hw; + struct q2t_cmd *cmd = sctio->cmd; + struct se_cmd *se_cmd = &cmd->se_cmd; + + TRACE_MGMT_DBG("SRR cmd %p, srr_ui %x\n", cmd, ntfy->srr_ui); + + switch (ntfy->srr_ui) { + case SRR_IU_STATUS: + spin_lock_irq(&ha->hardware_lock); + q24_send_notify_ack(vha, ntfy, + NOTIFY_ACK_SRR_FLAGS_ACCEPT, 0, 0); + spin_unlock_irq(&ha->hardware_lock); + __q24_xmit_response(cmd, Q2T_XMIT_STATUS, se_cmd->scsi_status); + break; + case SRR_IU_DATA_IN: +#if 0 + cmd->bufflen = 0; + if (q2t_has_data(cmd)) { + uint32_t offset; + int xmit_type; + offset = le32_to_cpu(imm->imm.notify_entry24.srr_rel_offs); + if (q2t_srr_adjust_data(cmd, offset, &xmit_type) != 0) + goto out_reject; + spin_lock_irq(&ha->hardware_lock); + q24_send_notify_ack(vha, ntfy, + NOTIFY_ACK_SRR_FLAGS_ACCEPT, 0, 0); + spin_unlock_irq(&ha->hardware_lock); + __q24_xmit_response(cmd, xmit_type, se_cmd->scsi_status); + } else { + printk(KERN_ERR "qla2x00t(%d): SRR for in data for cmd " + "without them (tag %d, SCSI status %d), " + "reject", vha->vp_idx, cmd->tag, + cmd->se_cmd.scsi_status); + goto out_reject; + } +#else + printk("q24 SRR_IU_DATA_IN, rejecting\n"); + dump_stack(); + goto out_reject; +#endif + break; + case SRR_IU_DATA_OUT: +#if 0 + cmd->bufflen = 0; + cmd->sg = NULL; + cmd->sg_cnt = 0; + if (q2t_has_data(cmd)) { + uint32_t offset; + int xmit_type; + offset = le32_to_cpu(imm->imm.notify_entry24.srr_rel_offs); + if (q2t_srr_adjust_data(cmd, offset, &xmit_type) != 0) + goto out_reject; + spin_lock_irq(&ha->hardware_lock); + q24_send_notify_ack(vha, ntfy, + NOTIFY_ACK_SRR_FLAGS_ACCEPT, 0, 0); + spin_unlock_irq(&ha->hardware_lock); + if (xmit_type & Q2T_XMIT_DATA) + __q2t_rdy_to_xfer(cmd); + } else { + printk(KERN_ERR "qla2x00t(%d): SRR for out data for cmd " + "without them (tag %d, SCSI status %d), " + "reject", vha->vp_idx, cmd->tag, + cmd->se_cmd.scsi_status); + goto out_reject; + } +#else + printk("q24 SRR_IU_DATA_OUT, rejecting\n"); + dump_stack(); + goto out_reject; +#endif + break; + default: + printk(KERN_ERR "qla2x00t(%d): Unknown srr_ui value %x", + vha->vp_idx, ntfy->srr_ui); + goto out_reject; + } + + return; + +out_reject: + spin_lock_irq(&ha->hardware_lock); + q24_send_notify_ack(vha, ntfy, NOTIFY_ACK_SRR_FLAGS_REJECT, + NOTIFY_ACK_SRR_REJECT_REASON_UNABLE_TO_PERFORM, + NOTIFY_ACK_SRR_FLAGS_REJECT_EXPL_NO_EXPL); + if (cmd->state == Q2T_STATE_NEED_DATA) { + cmd->state = Q2T_STATE_DATA_IN; + dump_stack(); + } else + q24_send_term_exchange(vha, cmd, &cmd->atio.atio7, 1); + spin_unlock_irq(&ha->hardware_lock); +} + +/* No locks, thread context */ +static void q2x_handle_srr(scsi_qla_host_t *vha, struct srr_ctio *sctio, + struct srr_imm *imm) +{ + notify_entry_t *ntfy = &imm->imm.notify_entry; + struct qla_hw_data *ha = vha->hw; + struct q2t_cmd *cmd = sctio->cmd; + struct se_cmd *se_cmd = &cmd->se_cmd; + + TRACE_MGMT_DBG("SRR cmd %p, srr_ui %x\n", cmd, ntfy->srr_ui); + + switch (ntfy->srr_ui) { + case SRR_IU_STATUS: + spin_lock_irq(&ha->hardware_lock); + q2x_send_notify_ack(vha, ntfy, 0, 0, 0, + NOTIFY_ACK_SRR_FLAGS_ACCEPT, 0, 0); + spin_unlock_irq(&ha->hardware_lock); + __q2x_xmit_response(cmd, Q2T_XMIT_STATUS, se_cmd->scsi_status); + break; + case SRR_IU_DATA_IN: +#if 0 + cmd->bufflen = 0; + if (q2t_has_data(cmd)) { + uint32_t offset; + int xmit_type; + offset = le32_to_cpu(imm->imm.notify_entry.srr_rel_offs); + if (q2t_srr_adjust_data(cmd, offset, &xmit_type) != 0) + goto out_reject; + spin_lock_irq(&ha->hardware_lock); + q2x_send_notify_ack(vha, ntfy, 0, 0, 0, + NOTIFY_ACK_SRR_FLAGS_ACCEPT, 0, 0); + spin_unlock_irq(&ha->hardware_lock); + __q2x_xmit_response(cmd, xmit_type); + } else { + printk(KERN_ERR "qla2x00t(%d): SRR for in data for cmd " + "without them (tag %d, SCSI status %d), " + "reject", vha->vp_idx, cmd->tag, + cmd->se_cmd.scsi_status); + goto out_reject; + } +#else + printk("q2x SRR_IU_DATA_IN:\n"); + dump_stack(); +#endif + break; + case SRR_IU_DATA_OUT: +#if 0 + cmd->bufflen = 0; + cmd->sg = NULL; + cmd->sg_cnt = 0; + if (q2t_has_data(cmd)) { + uint32_t offset; + int xmit_type; + offset = le32_to_cpu(imm->imm.notify_entry.srr_rel_offs); + if (q2t_srr_adjust_data(cmd, offset, &xmit_type) != 0) + goto out_reject; + spin_lock_irq(&ha->hardware_lock); + q2x_send_notify_ack(vha, ntfy, 0, 0, 0, + NOTIFY_ACK_SRR_FLAGS_ACCEPT, 0, 0); + spin_unlock_irq(&ha->hardware_lock); + if (xmit_type & Q2T_XMIT_DATA) + __q2t_rdy_to_xfer(cmd); + } else { + printk(KERN_ERR "qla2x00t(%d): SRR for out data for cmd " + "without them (tag %d, SCSI status %d), " + "reject", vha->vp_idx, cmd->tag, + cmd->se_cmd.scsi_status); + goto out_reject; + } +#else + printk("q2x SRR_IU_DATA_OUT:\n"); + dump_stack(); +#endif + break; + default: + printk(KERN_ERR "qla2x00t(%d): Unknown srr_ui value %x", + vha->vp_idx, ntfy->srr_ui); + goto out_reject; + } + + return; + +out_reject: + spin_lock_irq(&ha->hardware_lock); + q2x_send_notify_ack(vha, ntfy, 0, 0, 0, NOTIFY_ACK_SRR_FLAGS_REJECT, + NOTIFY_ACK_SRR_REJECT_REASON_UNABLE_TO_PERFORM, + NOTIFY_ACK_SRR_FLAGS_REJECT_EXPL_NO_EXPL); + if (cmd->state == Q2T_STATE_NEED_DATA) { + cmd->state = Q2T_STATE_DATA_IN; + dump_stack(); + } else + q2x_send_term_exchange(vha, cmd, &cmd->atio.atio2x, 1); + spin_unlock_irq(&ha->hardware_lock); +} + +static void q2t_reject_free_srr_imm(scsi_qla_host_t *vha, struct srr_imm *imm, + int ha_locked) +{ + struct qla_hw_data *ha = vha->hw; + + if (!ha_locked) + spin_lock_irq(&ha->hardware_lock); + + if (IS_FWI2_CAPABLE(ha)) { + q24_send_notify_ack(vha, &imm->imm.notify_entry24, + NOTIFY_ACK_SRR_FLAGS_REJECT, + NOTIFY_ACK_SRR_REJECT_REASON_UNABLE_TO_PERFORM, + NOTIFY_ACK_SRR_FLAGS_REJECT_EXPL_NO_EXPL); + } else { + q2x_send_notify_ack(vha, &imm->imm.notify_entry, + 0, 0, 0, NOTIFY_ACK_SRR_FLAGS_REJECT, + NOTIFY_ACK_SRR_REJECT_REASON_UNABLE_TO_PERFORM, + NOTIFY_ACK_SRR_FLAGS_REJECT_EXPL_NO_EXPL); + } + + if (!ha_locked) + spin_unlock_irq(&ha->hardware_lock); + + kfree(imm); +} + +#warning FIXME: q2t_handle_srr_work() +static void q2t_handle_srr_work(struct work_struct *work) +{ + struct q2t_tgt *tgt = container_of(work, struct q2t_tgt, srr_work); + scsi_qla_host_t *vha = NULL; + struct qla_hw_data *ha = tgt->ha; + struct srr_ctio *sctio; + + TRACE_MGMT_DBG("Entering SRR work (tgt %p)\n", tgt); + +restart: + spin_lock_irq(&tgt->srr_lock); + list_for_each_entry(sctio, &tgt->srr_ctio_list, srr_list_entry) { + struct srr_imm *imm, *i, *ti; + struct q2t_cmd *cmd; + struct se_cmd *se_cmd; + + imm = NULL; + list_for_each_entry_safe(i, ti, &tgt->srr_imm_list, + srr_list_entry) { + if (i->srr_id == sctio->srr_id) { + list_del(&i->srr_list_entry); + if (imm) { + printk(KERN_ERR "qla2x00t(%d): There must " + "be only one IMM SRR per CTIO SRR " + "(IMM SRR %p, id %d, CTIO %p\n", + vha->vp_idx, i, i->srr_id, sctio); + q2t_reject_free_srr_imm(vha, i, 0); + } else + imm = i; + } + } + + TRACE_MGMT_DBG("IMM SRR %p, CTIO SRR %p (id %d)\n", imm, sctio, + sctio->srr_id); + + if (imm == NULL) { + TRACE_MGMT_DBG("Not found matching IMM for SRR CTIO " + "(id %d)\n", sctio->srr_id); + continue; + } else + list_del(&sctio->srr_list_entry); + + spin_unlock_irq(&tgt->srr_lock); + + cmd = sctio->cmd; + vha = cmd->vha; +#if 0 + /* Restore the originals, except bufflen */ + cmd->offset = 0; + if (cmd->free_sg) { + kfree(cmd->sg); + cmd->free_sg = 0; + } + cmd->sg = NULL; + cmd->sg_cnt = 0; + + se_cmd = &cmd->se_cmd; + + TRACE_MGMT_DBG("SRR cmd %p (se_cmd %p, tag %d, op %x), " + "sg_cnt=%d, offset=%d", cmd, &cmd->se_cmd, + cmd->tag, T_TASK(se_cmd)->t_task_cdb[0], cmd->sg_cnt, + cmd->offset); +#else + dump_stack(); +#endif + if (IS_FWI2_CAPABLE(ha)) + q24_handle_srr(vha, sctio, imm); + else + q2x_handle_srr(vha, sctio, imm); + + kfree(imm); + kfree(sctio); + goto restart; + } + spin_unlock_irq(&tgt->srr_lock); +} + +/* ha->hardware_lock supposed to be held on entry */ +static void q2t_prepare_srr_imm(scsi_qla_host_t *vha, void *iocb) +{ + struct srr_imm *imm; + struct qla_hw_data *ha = vha->hw; + struct q2t_tgt *tgt = ha->q2t_tgt; + notify_entry_t *iocb2x = (notify_entry_t *)iocb; + notify24xx_entry_t *iocb24 = (notify24xx_entry_t *)iocb; + struct srr_ctio *sctio; + + tgt->imm_srr_id++; + + TRACE_MGMT_DBG("qla2x00t(%d): SRR received\n", vha->vp_idx); + + imm = kzalloc(sizeof(*imm), GFP_ATOMIC); + if (imm != NULL) { + memcpy(&imm->imm.notify_entry, iocb, + sizeof(imm->imm.notify_entry)); + + /* IRQ is already OFF */ + spin_lock(&tgt->srr_lock); + imm->srr_id = tgt->imm_srr_id; + list_add_tail(&imm->srr_list_entry, + &tgt->srr_imm_list); + TRACE_MGMT_DBG("IMM NTFY SRR %p added (id %d, ui %x)\n", imm, + imm->srr_id, iocb24->srr_ui); + if (tgt->imm_srr_id == tgt->ctio_srr_id) { + int found = 0; + list_for_each_entry(sctio, &tgt->srr_ctio_list, + srr_list_entry) { + if (sctio->srr_id == imm->srr_id) { + found = 1; + break; + } + } + if (found) { + TRACE_MGMT_DBG("%s", "Scheduling srr work\n"); + schedule_work(&tgt->srr_work); + } else { + TRACE_MGMT_DBG("qla2x00t(%d): imm_srr_id " + "== ctio_srr_id (%d), but there is no " + "corresponding SRR CTIO, deleting IMM " + "SRR %p\n", vha->vp_idx, tgt->ctio_srr_id, + imm); + list_del(&imm->srr_list_entry); + + kfree(imm); + + spin_unlock(&tgt->srr_lock); + goto out_reject; + } + } + spin_unlock(&tgt->srr_lock); + } else { + struct srr_ctio *ts; + + printk(KERN_ERR "qla2x00t(%d): Unable to allocate SRR IMM " + "entry, SRR request will be rejected\n", vha->vp_idx); + + /* IRQ is already OFF */ + spin_lock(&tgt->srr_lock); + list_for_each_entry_safe(sctio, ts, &tgt->srr_ctio_list, + srr_list_entry) { + if (sctio->srr_id == tgt->imm_srr_id) { + TRACE_MGMT_DBG("CTIO SRR %p deleted " + "(id %d)\n", sctio, sctio->srr_id); + list_del(&sctio->srr_list_entry); + if (IS_FWI2_CAPABLE(ha)) { + q24_send_term_exchange(vha, sctio->cmd, + &sctio->cmd->atio.atio7, 1); + } else { + q2x_send_term_exchange(vha, sctio->cmd, + &sctio->cmd->atio.atio2x, 1); + } + kfree(sctio); + } + } + spin_unlock(&tgt->srr_lock); + goto out_reject; + } + + return; + +out_reject: + if (IS_FWI2_CAPABLE(ha)) { + q24_send_notify_ack(vha, iocb24, + NOTIFY_ACK_SRR_FLAGS_REJECT, + NOTIFY_ACK_SRR_REJECT_REASON_UNABLE_TO_PERFORM, + NOTIFY_ACK_SRR_FLAGS_REJECT_EXPL_NO_EXPL); + } else { + q2x_send_notify_ack(vha, iocb2x, + 0, 0, 0, NOTIFY_ACK_SRR_FLAGS_REJECT, + NOTIFY_ACK_SRR_REJECT_REASON_UNABLE_TO_PERFORM, + NOTIFY_ACK_SRR_FLAGS_REJECT_EXPL_NO_EXPL); + } +} + +/* + * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire + */ +static void q2t_handle_imm_notify(scsi_qla_host_t *vha, void *iocb) +{ + struct qla_hw_data *ha = vha->hw; + notify_entry_t *iocb2x = (notify_entry_t *)iocb; + notify24xx_entry_t *iocb24 = (notify24xx_entry_t *)iocb; + uint32_t add_flags = 0; + int send_notify_ack = 1; + uint16_t status; + + status = le16_to_cpu(iocb2x->status); + TRACE_BUFFER("IMMED Notify Coming Up", + iocb, sizeof(*iocb2x)); + + switch (status) { + case IMM_NTFY_LIP_RESET: + { + if (IS_FWI2_CAPABLE(ha)) { + TRACE_MGMT_DBG("qla2x00t(%d): LIP reset (loop %#x), " + "subcode %x\n", vha->vp_idx, + le16_to_cpu(iocb24->nport_handle), + iocb24->status_subcode); + } else { + TRACE_MGMT_DBG("qla2x00t(%d): LIP reset (I %#x)\n", + vha->vp_idx, GET_TARGET_ID(ha, iocb2x)); + /* set the Clear LIP reset event flag */ + add_flags |= NOTIFY_ACK_CLEAR_LIP_RESET; + } + if (q2t_reset(vha, iocb, Q2T_ABORT_ALL) == 0) + send_notify_ack = 0; + break; + } + + case IMM_NTFY_LIP_LINK_REINIT: + { + struct q2t_tgt *tgt = ha->q2t_tgt; + TRACE_MGMT_DBG("qla2x00t(%d): LINK REINIT (loop %#x, " + "subcode %x)\n", vha->vp_idx, + le16_to_cpu(iocb24->nport_handle), + iocb24->status_subcode); + if (tgt->link_reinit_iocb_pending) + q24_send_notify_ack(vha, &tgt->link_reinit_iocb, 0, 0, 0); + memcpy(&tgt->link_reinit_iocb, iocb24, sizeof(*iocb24)); + tgt->link_reinit_iocb_pending = 1; + /* + * QLogic requires to wait after LINK REINIT for possible + * PDISC or ADISC ELS commands + */ + send_notify_ack = 0; + break; + } + + case IMM_NTFY_PORT_LOGOUT: + if (IS_FWI2_CAPABLE(ha)) { + TRACE_MGMT_DBG("qla2x00t(%d): Port logout (loop " + "%#x, subcode %x)\n", vha->vp_idx, + le16_to_cpu(iocb24->nport_handle), + iocb24->status_subcode); + } else { + TRACE_MGMT_DBG("qla2x00t(%d): Port logout (S " + "%08x -> L %#x)\n", vha->vp_idx, + le16_to_cpu(iocb2x->seq_id), + le16_to_cpu(iocb2x->lun)); + } + if (q2t_reset(vha, iocb, Q2T_NEXUS_LOSS_SESS) == 0) + send_notify_ack = 0; + /* The sessions will be cleared in the callback, if needed */ + break; + + case IMM_NTFY_GLBL_TPRLO: + TRACE_MGMT_DBG("qla2x00t(%d): Global TPRLO (%x)\n", + vha->vp_idx, status); + if (q2t_reset(vha, iocb, Q2T_NEXUS_LOSS) == 0) + send_notify_ack = 0; + /* The sessions will be cleared in the callback, if needed */ + break; + + case IMM_NTFY_PORT_CONFIG: + TRACE_MGMT_DBG("qla2x00t(%d): Port config changed (%x)\n", + vha->vp_idx, status); + if (q2t_reset(vha, iocb, Q2T_ABORT_ALL) == 0) + send_notify_ack = 0; + /* The sessions will be cleared in the callback, if needed */ + break; + + case IMM_NTFY_GLBL_LOGO: + printk(KERN_WARNING "qla2x00t(%d): Link failure detected\n", + vha->vp_idx); + /* I_T nexus loss */ + if (q2t_reset(vha, iocb, Q2T_NEXUS_LOSS) == 0) + send_notify_ack = 0; + break; + + case IMM_NTFY_IOCB_OVERFLOW: + printk(KERN_ERR "qla2x00t(%d): Cannot provide requested " + "capability (IOCB overflowed the immediate notify " + "resource count)\n", vha->vp_idx); + break; + + case IMM_NTFY_ABORT_TASK: + TRACE_MGMT_DBG("qla2x00t(%d): Abort Task (S %08x I %#x -> " + "L %#x)\n", vha->vp_idx, le16_to_cpu(iocb2x->seq_id), + GET_TARGET_ID(ha, iocb2x), le16_to_cpu(iocb2x->lun)); + if (q2t_abort_task(vha, iocb2x) == 0) + send_notify_ack = 0; + break; + + case IMM_NTFY_RESOURCE: + printk(KERN_ERR "qla2x00t(%d): Out of resources, host %ld\n", + vha->vp_idx, vha->host_no); + break; + + case IMM_NTFY_MSG_RX: + TRACE_MGMT_DBG("qla2x00t(%d): Immediate notify task %x\n", + vha->vp_idx, iocb2x->task_flags); + if (q2t_handle_task_mgmt(vha, iocb2x) == 0) + send_notify_ack = 0; + break; + + case IMM_NTFY_ELS: + if (q24_handle_els(vha, iocb24) == 0) + send_notify_ack = 0; + break; + + case IMM_NTFY_SRR: + q2t_prepare_srr_imm(vha, iocb); + send_notify_ack = 0; + break; + + default: + printk(KERN_ERR "qla2x00t(%d): Received unknown immediate " + "notify status %x\n", vha->vp_idx, status); + break; + } + + if (send_notify_ack) { + if (IS_FWI2_CAPABLE(ha)) + q24_send_notify_ack(vha, iocb24, 0, 0, 0); + else + q2x_send_notify_ack(vha, iocb2x, add_flags, 0, 0, 0, + 0, 0); + } +} + +/* + * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire + */ +static void q2x_send_busy(scsi_qla_host_t *vha, atio_entry_t *atio) +{ + struct qla_hw_data *ha = vha->hw; + ctio_ret_entry_t *ctio; + + /* Sending marker isn't necessary, since we called from ISR */ + + ctio = (ctio_ret_entry_t *)q2t_req_pkt(vha); + if (!ctio) { + printk(KERN_ERR "qla2x00t(%d): %s failed: unable to allocate " + "request packet", vha->vp_idx, __func__); + return; + } + + ctio->entry_type = CTIO_RET_TYPE; + ctio->entry_count = 1; + ctio->handle = Q2T_SKIP_HANDLE | CTIO_COMPLETION_HANDLE_MARK; + ctio->scsi_status = __constant_cpu_to_le16(SAM_STAT_BUSY); + ctio->residual = atio->data_length; + if (ctio->residual != 0) + ctio->scsi_status |= SS_RESIDUAL_UNDER; + + /* Set IDs */ + SET_TARGET_ID(ha, ctio->target, GET_TARGET_ID(ha, atio)); + ctio->rx_id = atio->rx_id; + + ctio->flags = __constant_cpu_to_le16(OF_SSTS | OF_FAST_POST | + OF_NO_DATA | OF_SS_MODE_1); + ctio->flags |= __constant_cpu_to_le16(OF_INC_RC); + /* + * CTIO from fw w/o se_cmd doesn't provide enough info to retry it, + * if the explicit conformation is used. + */ + + TRACE_BUFFER("CTIO BUSY packet data", ctio, REQUEST_ENTRY_SIZE); + + qla2x00_isp_cmd(vha, vha->req); +} + +/* + * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire + */ +static void q24_send_busy(scsi_qla_host_t *vha, atio7_entry_t *atio, + uint16_t status) +{ + struct qla_hw_data *ha = vha->hw; + ctio7_status1_entry_t *ctio; + struct q2t_sess *sess; + + sess = ha->qla2x_tmpl->find_sess_by_s_id(vha, atio->fcp_hdr.s_id); + if (!sess) { + q24_send_term_exchange(vha, NULL, atio, 1); + return; + } + + /* Sending marker isn't necessary, since we called from ISR */ + + ctio = (ctio7_status1_entry_t *)q2t_req_pkt(vha); + if (!ctio) { + printk(KERN_ERR "qla2x00t(%d): %s failed: unable to allocate " + "request packet", vha->vp_idx, __func__); + return; + } + + ctio->common.entry_type = CTIO_TYPE7; + ctio->common.entry_count = 1; + ctio->common.handle = Q2T_SKIP_HANDLE | CTIO_COMPLETION_HANDLE_MARK; + ctio->common.nport_handle = sess->loop_id; + ctio->common.timeout = __constant_cpu_to_le16(Q2T_TIMEOUT); + ctio->common.vp_index = vha->vp_idx; + ctio->common.initiator_id[0] = atio->fcp_hdr.s_id[2]; + ctio->common.initiator_id[1] = atio->fcp_hdr.s_id[1]; + ctio->common.initiator_id[2] = atio->fcp_hdr.s_id[0]; + ctio->common.exchange_addr = atio->exchange_addr; + ctio->flags = (atio->attr << 9) | __constant_cpu_to_le16( + CTIO7_FLAGS_STATUS_MODE_1 | CTIO7_FLAGS_SEND_STATUS | + CTIO7_FLAGS_DONT_RET_CTIO); + /* + * CTIO from fw w/o se_cmd doesn't provide enough info to retry it, + * if the explicit conformation is used. + */ + ctio->ox_id = swab16(atio->fcp_hdr.ox_id); + ctio->scsi_status = cpu_to_le16(status); + ctio->residual = get_unaligned((uint32_t *) + &atio->fcp_cmnd.add_cdb[atio->fcp_cmnd.add_cdb_len]); + if (ctio->residual != 0) + ctio->scsi_status |= SS_RESIDUAL_UNDER; + + TRACE_BUFFER("CTIO7 BUSY packet data", ctio, REQUEST_ENTRY_SIZE); + + qla2x00_isp_cmd(vha, vha->req); +} + +/* ha->hardware_lock supposed to be held on entry */ +/* called via callback from qla2xxx */ +static void q24_atio_pkt(scsi_qla_host_t *vha, atio7_entry_t *atio) +{ + struct qla_hw_data *ha = vha->hw; + struct q2t_tgt *tgt = ha->q2t_tgt; + int rc; + + if (unlikely(tgt == NULL)) { + TRACE_MGMT_DBG("ATIO pkt, but no tgt (ha %p)", ha); + return; + } + + TRACE_SCSI("qla2x00t(%d): ATIO pkt %p: type %02x count %02x", + vha->vp_idx, atio, atio->entry_type, atio->entry_count); + + /* + * In tgt_stop mode we also should allow all requests to pass. + * Otherwise, some commands can stuck. + */ + + tgt->irq_cmd_count++; + + switch (atio->entry_type) { + case ATIO_TYPE7: + TRACE_DBG("ATIO_TYPE7 instance %d, lun %Lx, read/write %d/%d, " + "add_cdb_len %d, data_length %04x, s_id %x:%x:%x\n", + vha->vp_idx, atio->fcp_cmnd.lun, atio->fcp_cmnd.rddata, + atio->fcp_cmnd.wrdata, atio->fcp_cmnd.add_cdb_len, + be32_to_cpu(get_unaligned((uint32_t *) + &atio->fcp_cmnd.add_cdb[atio->fcp_cmnd.add_cdb_len])), + atio->fcp_hdr.s_id[0], atio->fcp_hdr.s_id[1], + atio->fcp_hdr.s_id[2]); + TRACE_BUFFER("Incoming ATIO7 packet data", atio, + REQUEST_ENTRY_SIZE); +#if 0 + TRACE_SCSI("FCP CDB", atio->fcp_cmnd.cdb, + sizeof(atio->fcp_cmnd.cdb)); +#endif + if (unlikely(atio->exchange_addr == + ATIO_EXCHANGE_ADDRESS_UNKNOWN)) { + printk(KERN_INFO "qla2x00t(%d): ATIO_TYPE7 " + "received with UNKNOWN exchange address, " + "sending QUEUE_FULL\n", vha->vp_idx); + q24_send_busy(vha, atio, SAM_STAT_TASK_SET_FULL); + break; + } + if (likely(atio->fcp_cmnd.task_mgmt_flags == 0)) + rc = q2t_handle_cmd_for_atio(vha, (atio_t *)atio); + else + rc = q2t_handle_task_mgmt(vha, atio); + if (unlikely(rc != 0)) { + if (rc == -ESRCH) { +#if 1 /* With TERM EXCHANGE some FC cards refuse to boot */ + q24_send_busy(vha, atio, SAM_STAT_BUSY); +#else + q24_send_term_exchange(vha, NULL, atio, 1); +#endif + } else { + printk(KERN_INFO "qla2x00t(%d): Unable to send " + "command to target, sending BUSY status\n", + vha->vp_idx); + q24_send_busy(vha, atio, SAM_STAT_BUSY); + } + } + break; + + case IMMED_NOTIFY_TYPE: + { + notify_entry_t *pkt = (notify_entry_t *)atio; + if (unlikely(pkt->entry_status != 0)) { + printk(KERN_ERR "qla2x00t(%d): Received ATIO packet %x " + "with error status %x\n", vha->vp_idx, + pkt->entry_type, pkt->entry_status); + break; + } + TRACE_DBG("%s", "IMMED_NOTIFY ATIO"); + q2t_handle_imm_notify(vha, pkt); + break; + } + + default: + printk(KERN_ERR "qla2x00t(%d): Received unknown ATIO atio " + "type %x\n", vha->vp_idx, atio->entry_type); + break; + } + + tgt->irq_cmd_count--; +} + +/* ha->hardware_lock supposed to be held on entry */ +/* called via callback from qla2xxx */ +static void q2t_response_pkt(scsi_qla_host_t *vha, response_t *pkt) +{ + struct qla_hw_data *ha = vha->hw; + struct q2t_tgt *tgt = ha->q2t_tgt; + + if (unlikely(tgt == NULL)) { + printk(KERN_ERR "qla2x00t(%d): Response pkt %x received, but no " + "tgt (ha %p)\n", vha->vp_idx, pkt->entry_type, ha); + return; + } + + TRACE_SCSI("qla2x00t(%d): response pkt %p: T %02x C %02x S %02x " + "handle %#x\n", vha->vp_idx, pkt, pkt->entry_type, + pkt->entry_count, pkt->entry_status, pkt->handle); + + /* + * In tgt_stop mode we also should allow all requests to pass. + * Otherwise, some commands can stuck. + */ + + if (unlikely(pkt->entry_status != 0)) { + printk(KERN_ERR "qla2x00t(%d): Received response packet %x " + "with error status %x\n", vha->vp_idx, pkt->entry_type, + pkt->entry_status); + switch (pkt->entry_type) { + case ACCEPT_TGT_IO_TYPE: + case IMMED_NOTIFY_TYPE: + case ABTS_RECV_24XX: + return; + default: + break; + } + } + + tgt->irq_cmd_count++; + + switch (pkt->entry_type) { + case CTIO_TYPE7: + { + ctio7_fw_entry_t *entry = (ctio7_fw_entry_t *)pkt; + TRACE_DBG("CTIO_TYPE7: instance %d\n", vha->vp_idx); + TRACE_BUFFER("Incoming CTIO7 packet data", entry, + REQUEST_ENTRY_SIZE); + q2t_do_ctio_completion(vha, entry->handle, + le16_to_cpu(entry->status)|(pkt->entry_status << 16), + entry); + break; + } + + case ACCEPT_TGT_IO_TYPE: + { + atio_entry_t *atio; + int rc; + atio = (atio_entry_t *)pkt; + TRACE_DBG("ACCEPT_TGT_IO instance %d status %04x " + "lun %04x read/write %d data_length %04x " + "target_id %02x rx_id %04x\n ", + vha->vp_idx, le16_to_cpu(atio->status), + le16_to_cpu(atio->lun), + atio->execution_codes, + le32_to_cpu(atio->data_length), + GET_TARGET_ID(ha, atio), atio->rx_id); + TRACE_BUFFER("Incoming ATIO packet data", atio, + REQUEST_ENTRY_SIZE); + if (atio->status != __constant_cpu_to_le16(ATIO_CDB_VALID)) { + printk(KERN_ERR "qla2x00t(%d): ATIO with error " + "status %x received\n", vha->vp_idx, + le16_to_cpu(atio->status)); + break; + } + TRACE_BUFFER("Incoming ATIO packet data", atio, REQUEST_ENTRY_SIZE); + TRACE_SCSI("FCP CDB: 0x%02x, sizeof(cdb): %lu", atio->cdb[0], + (unsigned long int)sizeof(atio->cdb)); + + rc = q2t_handle_cmd_for_atio(vha, (atio_t *)atio); + if (unlikely(rc != 0)) { + if (rc == -ESRCH) { +#if 1 /* With TERM EXCHANGE some FC cards refuse to boot */ + q2x_send_busy(vha, atio); +#else + q2x_send_term_exchange(vha, NULL, atio, 1); +#endif + } else { + printk(KERN_INFO "qla2x00t(%d): Unable to send " + "command to target, sending BUSY status\n", + vha->vp_idx); + q2x_send_busy(vha, atio); + } + } + } + break; + + case CONTINUE_TGT_IO_TYPE: + { + ctio_common_entry_t *entry = (ctio_common_entry_t *)pkt; + TRACE_DBG("CONTINUE_TGT_IO: instance %d\n", vha->vp_idx); + TRACE_BUFFER("Incoming CTIO packet data", entry, + REQUEST_ENTRY_SIZE); + q2t_do_ctio_completion(vha, entry->handle, + le16_to_cpu(entry->status)|(pkt->entry_status << 16), + entry); + break; + } + + case CTIO_A64_TYPE: + { + ctio_common_entry_t *entry = (ctio_common_entry_t *)pkt; + TRACE_DBG("CTIO_A64: instance %d\n", vha->vp_idx); + TRACE_BUFFER("Incoming CTIO_A64 packet data", entry, + REQUEST_ENTRY_SIZE); + q2t_do_ctio_completion(vha, entry->handle, + le16_to_cpu(entry->status)|(pkt->entry_status << 16), + entry); + break; + } + + case IMMED_NOTIFY_TYPE: + TRACE_DBG("%s", "IMMED_NOTIFY\n"); + q2t_handle_imm_notify(vha, (notify_entry_t *)pkt); + break; + + case NOTIFY_ACK_TYPE: + if (tgt->notify_ack_expected > 0) { + nack_entry_t *entry = (nack_entry_t *)pkt; + TRACE_DBG("NOTIFY_ACK seq %08x status %x\n", + le16_to_cpu(entry->seq_id), + le16_to_cpu(entry->status)); + TRACE_BUFFER("Incoming NOTIFY_ACK packet data", pkt, + RESPONSE_ENTRY_SIZE); + tgt->notify_ack_expected--; + if (entry->status != __constant_cpu_to_le16(NOTIFY_ACK_SUCCESS)) { + printk(KERN_ERR "qla2x00t(%d): NOTIFY_ACK " + "failed %x\n", vha->vp_idx, + le16_to_cpu(entry->status)); + } + } else { + printk(KERN_ERR "qla2x00t(%d): Unexpected NOTIFY_ACK " + "received\n", vha->vp_idx); + } + break; + + case ABTS_RECV_24XX: + TRACE_DBG("ABTS_RECV_24XX: instance %d\n", vha->vp_idx); + TRACE_BUFFER("Incoming ABTS_RECV " + "packet data", pkt, REQUEST_ENTRY_SIZE); + q24_handle_abts(vha, (abts24_recv_entry_t *)pkt); + break; + + case ABTS_RESP_24XX: + if (tgt->abts_resp_expected > 0) { + abts24_resp_fw_entry_t *entry = + (abts24_resp_fw_entry_t *)pkt; + TRACE_DBG("ABTS_RESP_24XX: compl_status %x\n", + entry->compl_status); + TRACE_BUFFER("Incoming ABTS_RESP " + "packet data", pkt, REQUEST_ENTRY_SIZE); + tgt->abts_resp_expected--; + if (le16_to_cpu(entry->compl_status) != ABTS_RESP_COMPL_SUCCESS) { + if ((entry->error_subcode1 == 0x1E) && + (entry->error_subcode2 == 0)) { + /* + * We've got a race here: aborted exchange not + * terminated, i.e. response for the aborted + * command was sent between the abort request + * was received and processed. Unfortunately, + * the firmware has a silly requirement that + * all aborted exchanges must be explicitely + * terminated, otherwise it refuses to send + * responses for the abort requests. So, we + * have to (re)terminate the exchange and + * retry the abort response. + */ + q24_retry_term_exchange(vha, entry); + } else + printk(KERN_ERR "qla2x00t(%d): ABTS_RESP_24XX " + "failed %x (subcode %x:%x)", vha->vp_idx, + entry->compl_status, entry->error_subcode1, + entry->error_subcode2); + } + } else { + printk(KERN_ERR "qla2x00t(%d): Unexpected ABTS_RESP_24XX " + "received\n", vha->vp_idx); + } + break; + + case MODIFY_LUN_TYPE: + if (tgt->modify_lun_expected > 0) { + modify_lun_entry_t *entry = (modify_lun_entry_t *)pkt; + TRACE_DBG("MODIFY_LUN %x, imm %c%d, cmd %c%d", + entry->status, + (entry->operators & MODIFY_LUN_IMM_ADD) ? '+' + : (entry->operators & MODIFY_LUN_IMM_SUB) ? '-' + : ' ', + entry->immed_notify_count, + (entry->operators & MODIFY_LUN_CMD_ADD) ? '+' + : (entry->operators & MODIFY_LUN_CMD_SUB) ? '-' + : ' ', + entry->command_count); + tgt->modify_lun_expected--; + if (entry->status != MODIFY_LUN_SUCCESS) { + printk(KERN_ERR "qla2x00t(%d): MODIFY_LUN " + "failed %x\n", vha->vp_idx, + entry->status); + } + } else { + printk(KERN_ERR "qla2x00t(%d): Unexpected MODIFY_LUN " + "received\n", (ha != NULL) ? vha->vp_idx : -1); + } + break; + + case ENABLE_LUN_TYPE: + { + elun_entry_t *entry = (elun_entry_t *)pkt; + TRACE_DBG("ENABLE_LUN %x imm %u cmd %u \n", + entry->status, entry->immed_notify_count, + entry->command_count); + if (entry->status == ENABLE_LUN_ALREADY_ENABLED) { + TRACE_DBG("LUN is already enabled: %#x\n", + entry->status); + entry->status = ENABLE_LUN_SUCCESS; + } else if (entry->status == ENABLE_LUN_RC_NONZERO) { + TRACE_DBG("ENABLE_LUN succeeded, but with " + "error: %#x\n", entry->status); + entry->status = ENABLE_LUN_SUCCESS; + } else if (entry->status != ENABLE_LUN_SUCCESS) { + printk(KERN_ERR "qla2x00t(%d): ENABLE_LUN " + "failed %x\n", vha->vp_idx, entry->status); + qla_clear_tgt_mode(vha); + } /* else success */ + break; + } + + default: + printk(KERN_ERR "qla2x00t(%d): Received unknown response pkt " + "type %x\n", vha->vp_idx, pkt->entry_type); + break; + } + + tgt->irq_cmd_count--; +} + +/* + * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire + */ +void q2t_async_event(uint16_t code, scsi_qla_host_t *vha, uint16_t *mailbox) +{ + struct qla_hw_data *ha = vha->hw; + struct q2t_tgt *tgt = ha->q2t_tgt; + int reason_code; + + if (unlikely(tgt == NULL)) { + TRACE_DBG("ASYNC EVENT %#x, but no tgt (ha %p)", code, ha); + return; + } + + /* + * In tgt_stop mode we also should allow all requests to pass. + * Otherwise, some commands can stuck. + */ + + tgt->irq_cmd_count++; + + switch (code) { + case MBA_RESET: /* Reset */ + case MBA_SYSTEM_ERR: /* System Error */ + case MBA_REQ_TRANSFER_ERR: /* Request Transfer Error */ + case MBA_RSP_TRANSFER_ERR: /* Response Transfer Error */ + case MBA_ATIO_TRANSFER_ERR: /* ATIO Queue Transfer Error */ + TRACE_MGMT_DBG("qla2x00t(%d): System error async event %#x " + "occured", vha->vp_idx, code); + break; + + case MBA_LOOP_UP: + { + TRACE_MGMT_DBG("qla2x00t(%d): Async LOOP_UP occured " + "(m[1]=%x, m[2]=%x, m[3]=%x, m[4]=%x)", vha->vp_idx, + le16_to_cpu(mailbox[1]), le16_to_cpu(mailbox[2]), + le16_to_cpu(mailbox[3]), le16_to_cpu(mailbox[4])); + if (tgt->link_reinit_iocb_pending) { + q24_send_notify_ack(vha, &tgt->link_reinit_iocb, 0, 0, 0); + tgt->link_reinit_iocb_pending = 0; + } + break; + } + + case MBA_LIP_OCCURRED: + case MBA_LOOP_DOWN: + case MBA_LIP_RESET: + case MBA_RSCN_UPDATE: + TRACE_MGMT_DBG("qla2x00t(%d): Async event %#x occured " + "(m[1]=%x, m[2]=%x, m[3]=%x, m[4]=%x)", vha->vp_idx, + code, le16_to_cpu(mailbox[1]), le16_to_cpu(mailbox[2]), + le16_to_cpu(mailbox[3]), le16_to_cpu(mailbox[4])); + break; + + case MBA_PORT_UPDATE: + TRACE_MGMT_DBG("qla2x00t(%d): Port update async event %#x " + "occured: updating the ports database (m[1]=%x, m[2]=%x, " + "m[3]=%x, m[4]=%x)", vha->vp_idx, code, + le16_to_cpu(mailbox[1]), le16_to_cpu(mailbox[2]), + le16_to_cpu(mailbox[3]), le16_to_cpu(mailbox[4])); + reason_code = le16_to_cpu(mailbox[2]); + if (reason_code == 0x4) + TRACE_MGMT_DBG("Async MB 2: Got PLOGI Complete\n"); + else if (reason_code == 0x7) + TRACE_MGMT_DBG("Async MB 2: Port Logged Out\n"); + break; + + default: + TRACE_MGMT_DBG("qla2x00t(%d): Async event %#x occured: " + "ignore (m[1]=%x, m[2]=%x, m[3]=%x, m[4]=%x)", + vha->vp_idx, code, + le16_to_cpu(mailbox[1]), le16_to_cpu(mailbox[2]), + le16_to_cpu(mailbox[3]), le16_to_cpu(mailbox[4])); + break; + } + + tgt->irq_cmd_count--; +} + +static fc_port_t *q2t_get_port_database(scsi_qla_host_t *vha, + const uint8_t *s_id, uint16_t loop_id) +{ + fc_port_t *fcport; + int rc; + + fcport = kzalloc(sizeof(*fcport), GFP_KERNEL); + if (!fcport) { + printk(KERN_ERR "qla2x00t(%d): Allocation of tmp FC port failed", + vha->vp_idx); + return NULL; + } + + TRACE_MGMT_DBG("loop_id %d", loop_id); + + fcport->loop_id = loop_id; + + rc = qla2x00_get_port_database(vha, fcport, 0); + if (rc != QLA_SUCCESS) { + printk(KERN_ERR "qla2x00t(%d): Failed to retrieve fcport " + "information -- get_port_database() returned %x " + "(loop_id=0x%04x)", vha->vp_idx, rc, loop_id); + kfree(fcport); + return NULL; + } + + return fcport; +} + +/* Must be called under tgt_mutex */ +static struct q2t_sess *q2t_make_local_sess(scsi_qla_host_t *vha, + uint8_t *s_id, uint16_t loop_id) +{ + struct qla_hw_data *ha = vha->hw; + struct q2t_sess *sess = NULL; + fc_port_t *fcport = NULL; + int rc, global_resets; + +retry: + global_resets = atomic_read(&ha->q2t_tgt->tgt_global_resets_count); + + if (IS_FWI2_CAPABLE(ha)) { + rc = q24_get_loop_id(vha, s_id, &loop_id); + if (rc != 0) { + if ((s_id[0] == 0xFF) && + (s_id[1] == 0xFC)) { + /* + * This is Domain Controller, so it should be + * OK to drop SCSI commands from it. + */ + TRACE_MGMT_DBG("Unable to find initiator with " + "S_ID %x:%x:%x", s_id[0], s_id[1], + s_id[2]); + } else + printk(KERN_ERR "qla2x00t(%d): Unable to find " + "initiator with S_ID %x:%x:%x", + vha->vp_idx, s_id[0], s_id[1], + s_id[2]); + return NULL; + } + } + + fcport = q2t_get_port_database(vha, s_id, loop_id); + if (!fcport) + return NULL; + + if (global_resets != atomic_read(&ha->q2t_tgt->tgt_global_resets_count)) { + TRACE_MGMT_DBG("qla2x00t(%d): global reset during session " + "discovery (counter was %d, new %d), retrying", + vha->vp_idx, global_resets, + atomic_read(&ha->q2t_tgt->tgt_global_resets_count)); + goto retry; + } + + sess = q2t_create_sess(vha, fcport, true); + + kfree(fcport); + return sess; +} + +static void q2t_exec_sess_work(struct q2t_tgt *tgt, + struct q2t_sess_work_param *prm) +{ + scsi_qla_host_t *vha = tgt->vha; + struct qla_hw_data *ha = vha->hw; + struct q2t_sess *sess = NULL; + uint32_t be_s_id; + uint8_t *s_id = NULL; /* to hide compiler warnings */ + int rc, loop_id = -1; /* to hide compiler warnings */ + + TRACE_MGMT_DBG("q2t_exec_sess_work() processing -> prm %p\n", prm); + + spin_lock_irq(&ha->hardware_lock); + + if (tgt->tgt_stop) + goto send; + + switch (prm->type) { + case Q2T_SESS_WORK_CMD: + { + struct q2t_cmd *cmd = prm->cmd; + if (IS_FWI2_CAPABLE(ha)) { + atio7_entry_t *a = (atio7_entry_t *)&cmd->atio; + s_id = a->fcp_hdr.s_id; + } else + loop_id = GET_TARGET_ID(ha, (atio_entry_t *)&cmd->atio); + break; + } + case Q2T_SESS_WORK_ABORT: + if (IS_FWI2_CAPABLE(ha)) { + be_s_id = (prm->abts.fcp_hdr_le.s_id[0] << 16) | + (prm->abts.fcp_hdr_le.s_id[1] << 8) | + prm->abts.fcp_hdr_le.s_id[2]; + + sess = ha->qla2x_tmpl->find_sess_by_s_id(vha, + (unsigned char *)&be_s_id); + goto after_find; + } else + loop_id = GET_TARGET_ID(ha, &prm->tm_iocb); + break; + case Q2T_SESS_WORK_TM: + if (IS_FWI2_CAPABLE(ha)) + s_id = prm->tm_iocb2.fcp_hdr.s_id; + else + loop_id = GET_TARGET_ID(ha, &prm->tm_iocb); + break; + default: + BUG_ON(1); + break; + } + + if (IS_FWI2_CAPABLE(ha)) + sess = ha->qla2x_tmpl->find_sess_by_s_id(vha, s_id); + else + sess = ha->qla2x_tmpl->find_sess_by_loop_id(vha, loop_id); + +after_find: + if (sess != NULL) { + TRACE_MGMT_DBG("sess %p found\n", sess); + q2t_sess_get(sess); + } else { + spin_unlock_irq(&ha->hardware_lock); + + mutex_lock(&ha->tgt_mutex); + sess = q2t_make_local_sess(vha, s_id, loop_id); + mutex_unlock(&ha->tgt_mutex); + + spin_lock_irq(&ha->hardware_lock); + /* sess has got an extra creation ref */ + } + +send: + if ((sess == NULL) || tgt->tgt_stop) + goto out_term; + + switch (prm->type) { + case Q2T_SESS_WORK_CMD: + { + struct q2t_cmd *cmd = prm->cmd; + if (tgt->tm_to_unknown) { + /* + * Cmd might be already aborted behind us, so be safe + * and abort it. It should be OK, initiator will retry + * it. + */ + goto out_term; + } + rc = q2t_send_cmd_to_target(vha, cmd, sess); + break; + } + case Q2T_SESS_WORK_ABORT: + if (IS_FWI2_CAPABLE(ha)) + rc = __q24_handle_abts(vha, &prm->abts, sess); + else + rc = __q2t_abort_task(vha, &prm->tm_iocb, sess); + break; + case Q2T_SESS_WORK_TM: + { + uint32_t lun; + int lun_size, fn; + void *iocb; + + if (IS_FWI2_CAPABLE(ha)) { + atio7_entry_t *a = &prm->tm_iocb2; + iocb = a; + lun = a->fcp_cmnd.lun; + lun_size = sizeof(a->fcp_cmnd.lun); + fn = a->fcp_cmnd.task_mgmt_flags; + } else { + notify_entry_t *n = &prm->tm_iocb; + iocb = n; + /* make it be in network byte order */ + lun = swab16(le16_to_cpu(n->lun)); + lun_size = sizeof(lun); + fn = n->task_flags >> IMM_NTFY_TASK_MGMT_SHIFT; + } + rc = q2t_issue_task_mgmt(sess, lun, lun_size, fn, iocb, 0); + break; + } + default: + BUG_ON(1); + break; + } + + if (rc != 0) + goto out_term; + + if (sess != NULL) + q2t_sess_put(sess); + + spin_unlock_irq(&ha->hardware_lock); + return; + +out_term: + switch (prm->type) { + case Q2T_SESS_WORK_CMD: + { + struct q2t_cmd *cmd = prm->cmd; + TRACE_MGMT_DBG("Terminating work cmd %p", cmd); + /* + * cmd has not sent to target yet, so pass NULL as the second + * argument + */ + if (IS_FWI2_CAPABLE(ha)) + q24_send_term_exchange(vha, NULL, &cmd->atio.atio7, 1); + else + q2x_send_term_exchange(vha, NULL, &cmd->atio.atio2x, 1); + q2t_free_cmd(cmd); + break; + } + case Q2T_SESS_WORK_ABORT: + if (IS_FWI2_CAPABLE(ha)) + q24_send_abts_resp(vha, &prm->abts, + FCP_TMF_REJECTED, false); + else + q2x_send_notify_ack(vha, &prm->tm_iocb, 0, + 0, 0, 0, 0, 0); + break; + case Q2T_SESS_WORK_TM: + if (IS_FWI2_CAPABLE(ha)) + q24_send_term_exchange(vha, NULL, &prm->tm_iocb2, 1); + else + q2x_send_notify_ack(vha, &prm->tm_iocb, 0, + 0, 0, 0, 0, 0); + break; + default: + BUG_ON(1); + break; + } + if (sess != NULL) + q2t_sess_put(sess); + + spin_unlock_irq(&ha->hardware_lock); +} + +static void q2t_sess_work_fn(struct work_struct *work) +{ + struct q2t_tgt *tgt = container_of(work, struct q2t_tgt, sess_work); + scsi_qla_host_t *vha = tgt->vha; + struct qla_hw_data *ha = vha->hw; + + TRACE_MGMT_DBG("Sess work (tgt %p)", tgt); + + spin_lock_irq(&tgt->sess_work_lock); + while (!list_empty(&tgt->sess_works_list)) { + struct q2t_sess_work_param *prm = list_entry( + tgt->sess_works_list.next, typeof(*prm), + sess_works_list_entry); + + /* + * This work can be scheduled on several CPUs at time, so we + * must delete the entry to eliminate double processing + */ + list_del(&prm->sess_works_list_entry); + + spin_unlock_irq(&tgt->sess_work_lock); + + q2t_exec_sess_work(tgt, prm); + + spin_lock_irq(&tgt->sess_work_lock); + + kfree(prm); + } + spin_unlock_irq(&tgt->sess_work_lock); + + spin_lock_irq(&ha->hardware_lock); + spin_lock(&tgt->sess_work_lock); + if (list_empty(&tgt->sess_works_list)) { + tgt->sess_works_pending = 0; + tgt->tm_to_unknown = 0; + } + spin_unlock(&tgt->sess_work_lock); + spin_unlock_irq(&ha->hardware_lock); +} + +/* Must be called under tgt_host_action_mutex */ +int q2t_add_target(struct qla_hw_data *ha, scsi_qla_host_t *base_vha) +{ + struct q2t_tgt *tgt; + int sg_tablesize; + + TRACE_DBG("Registering target for host %ld(%p)", base_vha->host_no, ha); + + BUG_ON((ha->q2t_tgt != NULL) || (ha->qla2x_tmpl != NULL)); + + tgt = kzalloc(sizeof(struct q2t_tgt), GFP_KERNEL); + if (!tgt) { + printk(KERN_ERR "Unable to allocate struct q2t_tgt\n"); + return -ENOMEM; + } + + tgt->ha = ha; + tgt->vha = base_vha; + init_waitqueue_head(&tgt->waitQ); + INIT_LIST_HEAD(&tgt->sess_list); + INIT_LIST_HEAD(&tgt->del_sess_list); + INIT_DELAYED_WORK(&tgt->sess_del_work, + (void (*)(struct work_struct *))q2t_del_sess_work_fn); + spin_lock_init(&tgt->sess_work_lock); + INIT_WORK(&tgt->sess_work, q2t_sess_work_fn); + INIT_LIST_HEAD(&tgt->sess_works_list); + spin_lock_init(&tgt->srr_lock); + INIT_LIST_HEAD(&tgt->srr_ctio_list); + INIT_LIST_HEAD(&tgt->srr_imm_list); + INIT_WORK(&tgt->srr_work, q2t_handle_srr_work); + atomic_set(&tgt->tgt_global_resets_count, 0); + + ha->q2t_tgt = tgt; + + if (IS_FWI2_CAPABLE(ha)) { + printk(KERN_INFO "qla2x00t(%d): using 64 Bit PCI " + "addressing", base_vha->vp_idx); + tgt->tgt_enable_64bit_addr = 1; + /* 3 is reserved */ + sg_tablesize = + QLA_MAX_SG_24XX(base_vha->req->length - 3); + tgt->datasegs_per_cmd = DATASEGS_PER_COMMAND_24XX; + tgt->datasegs_per_cont = DATASEGS_PER_CONT_24XX; + } else { + if (ha->flags.enable_64bit_addressing) { + printk(KERN_INFO "qla2x00t(%d): 64 Bit PCI " + "addressing enabled", base_vha->vp_idx); + tgt->tgt_enable_64bit_addr = 1; + /* 3 is reserved */ + sg_tablesize = + QLA_MAX_SG64(base_vha->req->length - 3); + tgt->datasegs_per_cmd = DATASEGS_PER_COMMAND64; + tgt->datasegs_per_cont = DATASEGS_PER_CONT64; + } else { + printk(KERN_INFO "qla2x00t(%d): Using 32 Bit " + "PCI addressing", base_vha->vp_idx); + sg_tablesize = + QLA_MAX_SG32(base_vha->req->length - 3); + tgt->datasegs_per_cmd = DATASEGS_PER_COMMAND32; + tgt->datasegs_per_cont = DATASEGS_PER_CONT32; + } + } + + return 0; +} + +/* Must be called under tgt_host_action_mutex */ +int q2t_remove_target(struct qla_hw_data *ha, scsi_qla_host_t *vha) +{ + if (!ha->q2t_tgt) { + printk(KERN_ERR "qla2x00t(%d): Can't remove " + "existing target", vha->vp_idx); + return 0; + } + + TRACE_DBG("Unregistering target for host %ld(%p)", vha->host_no, ha); + q2t_target_release(ha->q2t_tgt); + + return 0; +} + +int q2t_init(void) +{ + BUILD_BUG_ON(sizeof(atio7_entry_t) != sizeof(atio_entry_t)); + + q2t_cmd_cachep = NULL; + q2t_mgmt_cmd_cachep = NULL; + q2t_mgmt_cmd_mempool = NULL; + + q2t_cmd_cachep = kmem_cache_create("q2t_cmd_cachep", + sizeof(struct q2t_cmd), __alignof__(struct q2t_cmd), + 0, NULL); + if (!q2t_cmd_cachep) { + printk(KERN_ERR "kmem_cache_create for q2t_cmd_cachep failed\n"); + return -ENOMEM; + } + + q2t_mgmt_cmd_cachep = kmem_cache_create("q2t_mgmt_cmd_cachep", + sizeof(struct q2t_mgmt_cmd), __alignof__(struct q2t_mgmt_cmd), + 0, NULL); + if (!q2t_mgmt_cmd_cachep) { + printk(KERN_ERR "kmem_cache_create for q2t_mgmt_cmd_cachep failed\n"); + kmem_cache_destroy(q2t_cmd_cachep); + return -ENOMEM; + } + + q2t_mgmt_cmd_mempool = mempool_create(25, mempool_alloc_slab, + mempool_free_slab, q2t_mgmt_cmd_cachep); + if (!q2t_mgmt_cmd_mempool) { + printk(KERN_ERR "mempool_create for q2t_mgmt_cmd_mempool failed\n"); + kmem_cache_destroy(q2t_mgmt_cmd_cachep); + kmem_cache_destroy(q2t_cmd_cachep); + return -ENOMEM; + } + + return 0; +} + +void q2t_exit(void) +{ + if (q2t_mgmt_cmd_mempool != NULL) + mempool_destroy(q2t_mgmt_cmd_mempool); + if (q2t_mgmt_cmd_cachep != NULL) + kmem_cache_destroy(q2t_mgmt_cmd_cachep); + if (q2t_cmd_cachep != NULL) + kmem_cache_destroy(q2t_cmd_cachep); +} diff --git a/drivers/scsi/qla2xxx/qla2x_target.h b/drivers/scsi/qla2xxx/qla2x_target.h new file mode 100644 index 0000000..4d38f05 --- /dev/null +++ b/drivers/scsi/qla2xxx/qla2x_target.h @@ -0,0 +1,290 @@ +/* + * qla2x_target.h SCSI LLD infrastructure for QLogic 22xx/23xx/24xx/25xx + * + * based on qla2x00t.h code: + * + * Copyright (C) 2004 - 2010 Vladislav Bolkhovitin <vst@xxxxxxxx> + * Copyright (C) 2004 - 2005 Leonid Stoljar + * Copyright (C) 2006 Nathaniel Clark <nate@xxxxxxxxxx> + * Copyright (C) 2006 - 2010 ID7 Ltd. + * + * Forward port and refactoring to modern qla2xxx and target/configfs + * + * Copyright (C) 2010 Nicholas A. Bellinger <nab@xxxxxxxxxx> + * + * This program is free software; you can redistribute it and/or + * modify it under the terms of the GNU General Public License + * as published by the Free Software Foundation, version 2 + * of the License. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + */ + +#ifndef __QLA2X00T_H +#define __QLA2X00T_H + +#include "qla2x_tgt_def.h" + +#define Q2T_TIMEOUT 10 /* in seconds */ + +#define Q2T_MAX_HW_PENDING_TIME 60 /* in seconds */ + +/* Immediate notify status constants */ +#define IMM_NTFY_LIP_RESET 0x000E +#define IMM_NTFY_LIP_LINK_REINIT 0x000F +#define IMM_NTFY_IOCB_OVERFLOW 0x0016 +#define IMM_NTFY_ABORT_TASK 0x0020 +#define IMM_NTFY_PORT_LOGOUT 0x0029 +#define IMM_NTFY_PORT_CONFIG 0x002A +#define IMM_NTFY_GLBL_TPRLO 0x002D +#define IMM_NTFY_GLBL_LOGO 0x002E +#define IMM_NTFY_RESOURCE 0x0034 +#define IMM_NTFY_MSG_RX 0x0036 +#define IMM_NTFY_SRR 0x0045 +#define IMM_NTFY_ELS 0x0046 + +/* Immediate notify task flags */ +#define IMM_NTFY_TASK_MGMT_SHIFT 8 + +#define Q2T_CLEAR_ACA 0x40 +#define Q2T_TARGET_RESET 0x20 +#define Q2T_LUN_RESET 0x10 +#define Q2T_CLEAR_TS 0x04 +#define Q2T_ABORT_TS 0x02 +#define Q2T_ABORT_ALL_SESS 0xFFFF +#define Q2T_ABORT_ALL 0xFFFE +#define Q2T_NEXUS_LOSS_SESS 0xFFFD +#define Q2T_NEXUS_LOSS 0xFFFC + +/* Notify Acknowledge flags */ +#define NOTIFY_ACK_RES_COUNT BIT_8 +#define NOTIFY_ACK_CLEAR_LIP_RESET BIT_5 +#define NOTIFY_ACK_TM_RESP_CODE_VALID BIT_4 + +/* Command's states */ +#define Q2T_STATE_NEW 0 /* New command and target processing it */ +#define Q2T_STATE_NEED_DATA 1 /* target needs data to continue */ +#define Q2T_STATE_DATA_IN 2 /* Data arrived and target is processing */ +#define Q2T_STATE_PROCESSED 3 /* target done processing */ +#define Q2T_STATE_ABORTED 4 /* Command aborted */ + +/* Special handles */ +#define Q2T_NULL_HANDLE 0 +#define Q2T_SKIP_HANDLE (0xFFFFFFFF & ~CTIO_COMPLETION_HANDLE_MARK) + +/* ATIO task_codes field */ +#define ATIO_SIMPLE_QUEUE 0 +#define ATIO_HEAD_OF_QUEUE 1 +#define ATIO_ORDERED_QUEUE 2 +#define ATIO_ACA_QUEUE 4 +#define ATIO_UNTAGGED 5 + +/* TM failed response codes, see FCP (9.4.11 FCP_RSP_INFO) */ +#define FC_TM_SUCCESS 0 +#define FC_TM_BAD_FCP_DATA 1 +#define FC_TM_BAD_CMD 2 +#define FC_TM_FCP_DATA_MISMATCH 3 +#define FC_TM_REJECT 4 +#define FC_TM_FAILED 5 + +/* + * Error code of q2t_pre_xmit_response() meaning that cmd's exchange was + * terminated, so no more actions is needed and success should be returned + * to target. + */ +#define Q2T_PRE_XMIT_RESP_CMD_ABORTED 0x1717 + +#if (BITS_PER_LONG > 32) || defined(CONFIG_HIGHMEM64G) +#define pci_dma_lo32(a) (a & 0xffffffff) +#define pci_dma_hi32(a) ((((a) >> 16)>>16) & 0xffffffff) +#else +#define pci_dma_lo32(a) (a & 0xffffffff) +#define pci_dma_hi32(a) 0 +#endif + +#define Q2T_SENSE_VALID(sense) ((sense != NULL) && \ + (((const uint8_t *)(sense))[0] & 0x70) == 0x70) + +struct q2t_tgt { + struct scsi_qla_host *vha; + struct qla_hw_data *ha; + + /* + * To sync between IRQ handlers and q2t_target_release(). Needed, + * because req_pkt() can drop/reaquire HW lock inside. Protected by + * HW lock. + */ + int irq_cmd_count; + + int datasegs_per_cmd, datasegs_per_cont; + + /* Target's flags, serialized by pha->hardware_lock */ + unsigned int tgt_enable_64bit_addr:1; /* 64-bits PCI addressing enabled */ + unsigned int link_reinit_iocb_pending:1; + unsigned int tm_to_unknown:1; /* TM to unknown session was sent */ + unsigned int sess_works_pending:1; /* there are sess_work entries */ + + /* + * Protected by tgt_mutex AND hardware_lock for writing and tgt_mutex + * OR hardware_lock for reading. + */ + int tgt_stop; /* the target mode driver is being stopped */ + int tgt_stopped; /* the target mode driver has been stopped */ + + /* Count of sessions refering q2t_tgt. Protected by hardware_lock. */ + int sess_count; + + /* Protected by hardware_lock. Addition also protected by tgt_mutex. */ + struct list_head sess_list; + + /* Protected by hardware_lock */ + struct list_head del_sess_list; + struct delayed_work sess_del_work; + + spinlock_t sess_work_lock; + struct list_head sess_works_list; + struct work_struct sess_work; + + notify24xx_entry_t link_reinit_iocb; + wait_queue_head_t waitQ; + int notify_ack_expected; + int abts_resp_expected; + int modify_lun_expected; + + int ctio_srr_id; + int imm_srr_id; + spinlock_t srr_lock; + struct list_head srr_ctio_list; + struct list_head srr_imm_list; + struct work_struct srr_work; + + atomic_t tgt_global_resets_count; + + struct list_head tgt_list_entry; +}; + +/* + * Equivilant to IT Nexus (Initiator-Target) + */ +struct q2t_sess { + uint16_t loop_id; + port_id_t s_id; + + unsigned int conf_compl_supported:1; + unsigned int deleted:1; + unsigned int local:1; + + struct se_session *se_sess; + scsi_qla_host_t *vha; + struct q2t_tgt *tgt; + + int sess_ref; /* protected by hardware_lock */ + + struct list_head sess_list_entry; + unsigned long expires; + struct list_head del_list_entry; + + uint8_t port_name[WWN_SIZE]; +}; + +struct q2t_cmd { + struct q2t_sess *sess; + int state; + struct se_cmd se_cmd; + /* Sense buffer that will be mapped into outgoing status */ + unsigned char sense_buffer[TRANSPORT_SENSE_BUFFER]; + + unsigned int conf_compl_supported:1;/* to save extra sess dereferences */ + unsigned int sg_mapped:1; + unsigned int free_sg:1; + unsigned int aborted:1; /* Needed in case of SRR */ + unsigned int write_data_transferred:1; + + struct scatterlist *sg; /* cmd data buffer SG vector */ + int sg_cnt; /* SG segments count */ + int bufflen; /* cmd buffer length */ + int offset; + uint32_t tag; + dma_addr_t dma_handle; + enum dma_data_direction dma_data_direction; + + uint16_t loop_id; /* to save extra sess dereferences */ + struct q2t_tgt *tgt; /* to save extra sess dereferences */ + scsi_qla_host_t *vha; + + union { + atio7_entry_t atio7; + atio_entry_t atio2x; + } __attribute__((packed)) atio; +}; + +struct q2t_sess_work_param { + struct list_head sess_works_list_entry; + +#define Q2T_SESS_WORK_CMD 0 +#define Q2T_SESS_WORK_ABORT 1 +#define Q2T_SESS_WORK_TM 2 + int type; + + union { + struct q2t_cmd *cmd; + abts24_recv_entry_t abts; + notify_entry_t tm_iocb; + atio7_entry_t tm_iocb2; + }; +}; + +struct q2t_mgmt_cmd { + uint8_t tmr_func; + uint8_t fc_tm_rsp; + struct q2t_sess *sess; + struct se_cmd se_cmd; + struct se_tmr_req *se_tmr_req; + unsigned int flags; +#define Q24_MGMT_SEND_NACK 1 + union { + atio7_entry_t atio7; + notify_entry_t notify_entry; + notify24xx_entry_t notify_entry24; + abts24_recv_entry_t abts; + } __attribute__((packed)) orig_iocb; +}; + +struct q2t_prm { + struct q2t_cmd *cmd; + struct q2t_tgt *tgt; + void *pkt; + struct scatterlist *sg; /* cmd data buffer SG vector */ + int seg_cnt; + int req_cnt; + uint16_t rq_result; + uint16_t scsi_status; + unsigned char *sense_buffer; + int sense_buffer_len; + int residual; + int add_status_pkt; +}; + +struct srr_imm { + struct list_head srr_list_entry; + int srr_id; + union { + notify_entry_t notify_entry; + notify24xx_entry_t notify_entry24; + } __attribute__((packed)) imm; +}; + +struct srr_ctio { + struct list_head srr_list_entry; + int srr_id; + struct q2t_cmd *cmd; +}; + +#define Q2T_XMIT_DATA 1 +#define Q2T_XMIT_STATUS 2 +#define Q2T_XMIT_ALL (Q2T_XMIT_STATUS|Q2T_XMIT_DATA) + +#endif /* __QLA2X00T_H */ diff --git a/drivers/scsi/qla2xxx/qla2x_tgt.h b/drivers/scsi/qla2xxx/qla2x_tgt.h new file mode 100644 index 0000000..16f524d --- /dev/null +++ b/drivers/scsi/qla2xxx/qla2x_tgt.h @@ -0,0 +1,140 @@ +/* + * qla2x_tgt.h + * + * Copyright (C) 2004 - 2010 Vladislav Bolkhovitin <vst@xxxxxxxx> + * Copyright (C) 2004 - 2005 Leonid Stoljar + * Copyright (C) 2006 Nathaniel Clark <nate@xxxxxxxxxx> + * Copyright (C) 2007 - 2010 ID7 Ltd. + * + * Forward port and refactoring to modern qla2xxx and target/configfs + * + * Copyright (C) 2010 Nicholas A. Bellinger <nab@xxxxxxxxxx> + * + * Additional file for the target driver support. + * + * This program is free software; you can redistribute it and/or + * modify it under the terms of the GNU General Public License + * as published by the Free Software Foundation; either version 2 + * of the License, or (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + */ +/* + * This should be included only from within qla2xxx module. + */ + + +#ifndef __QLA2X_TGT_H +#define __QLA2X_TGT_H + +#include <linux/version.h> + +#include "qla2x_tgt_def.h" + +extern request_t *qla2x00_req_pkt(scsi_qla_host_t *ha); + +extern struct qla_tgt_data qla_target; + +void qla_set_tgt_mode(scsi_qla_host_t *ha); +void qla_clear_tgt_mode(scsi_qla_host_t *ha); + +static inline bool qla_tgt_mode_enabled(scsi_qla_host_t *ha) +{ + return ha->host->active_mode & MODE_TARGET; +} + +static inline bool qla_ini_mode_enabled(scsi_qla_host_t *ha) +{ + return ha->host->active_mode & MODE_INITIATOR; +} + +static inline void qla_reverse_ini_mode(scsi_qla_host_t *ha) +{ + if (ha->host->active_mode & MODE_INITIATOR) + ha->host->active_mode &= ~MODE_INITIATOR; + else + ha->host->active_mode |= MODE_INITIATOR; +} + +/********************************************************************\ + * ISP Queue types left out of new QLogic driver (from old version) +\********************************************************************/ + +/* + * qla2x00_do_en_dis_lun + * Issue enable or disable LUN entry IOCB. + * + * Input: + * ha = adapter block pointer. + * + * Caller MUST have hardware lock held. This function might release it, + * then reaquire. + */ +static inline void +__qla2x00_send_enable_lun(scsi_qla_host_t *vha, int enable) +{ + elun_entry_t *pkt; + struct qla_hw_data *ha = vha->hw; + + BUG_ON(IS_FWI2_CAPABLE(ha)); + + pkt = (elun_entry_t *)qla2x00_alloc_iocbs(vha, 0); + if (pkt != NULL) { + pkt->entry_type = ENABLE_LUN_TYPE; + if (enable) { + pkt->command_count = QLA2X00_COMMAND_COUNT_INIT; + pkt->immed_notify_count = QLA2X00_IMMED_NOTIFY_COUNT_INIT; + pkt->timeout = 0xffff; + } else { + pkt->command_count = 0; + pkt->immed_notify_count = 0; + pkt->timeout = 0; + } + DEBUG2(printk(KERN_DEBUG + "scsi%lu:ENABLE_LUN IOCB imm %u cmd %u timeout %u\n", + vha->host_no, pkt->immed_notify_count, + pkt->command_count, pkt->timeout)); + + /* Issue command to ISP */ + qla2x00_isp_cmd(vha, vha->req); + + } else + qla_clear_tgt_mode(vha); +#if defined(QL_DEBUG_LEVEL_2) || defined(QL_DEBUG_LEVEL_3) + if (!pkt) + printk(KERN_ERR "%s: **** FAILED ****\n", __func__); +#endif + + return; +} + +/* + * qla2x00_send_enable_lun + * Issue enable LUN entry IOCB. + * + * Input: + * ha = adapter block pointer. + * enable = enable/disable flag. + */ +static inline void +qla2x00_send_enable_lun(scsi_qla_host_t *vha, bool enable) +{ + struct qla_hw_data *ha = vha->hw; + + if (!IS_FWI2_CAPABLE(ha)) { + unsigned long flags; + spin_lock_irqsave(&ha->hardware_lock, flags); + __qla2x00_send_enable_lun(vha, enable); + spin_unlock_irqrestore(&ha->hardware_lock, flags); + } +} + +extern int q2t_add_target(struct qla_hw_data *, scsi_qla_host_t *); + +extern void q2t_fc_port_added(scsi_qla_host_t *, fc_port_t *); +extern void q2t_fc_port_deleted(scsi_qla_host_t *, fc_port_t *); + +#endif /* __QLA2X_TGT_H */ diff --git a/drivers/scsi/qla2xxx/qla2x_tgt_def.h b/drivers/scsi/qla2xxx/qla2x_tgt_def.h new file mode 100644 index 0000000..cadb444 --- /dev/null +++ b/drivers/scsi/qla2xxx/qla2x_tgt_def.h @@ -0,0 +1,717 @@ +/* + * qla2x_tgt_def.h + * + * Copyright (C) 2004 - 2010 Vladislav Bolkhovitin <vst@xxxxxxxx> + * Copyright (C) 2004 - 2005 Leonid Stoljar + * Copyright (C) 2006 Nathaniel Clark <nate@xxxxxxxxxx> + * Copyright (C) 2007 - 2010 ID7 Ltd. + * + * Forward port and refactoring to modern qla2xxx and target/configfs + * + * Copyright (C) 2010 Nicholas A. Bellinger <nab@xxxxxxxxxx> + * + * Additional file for the target driver support. + * + * This program is free software; you can redistribute it and/or + * modify it under the terms of the GNU General Public License + * as published by the Free Software Foundation; either version 2 + * of the License, or (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + */ +/* + * This is the global def file that is useful for including from the + * target portion. + */ + +#ifndef __QLA2X_TGT_DEF_H +#define __QLA2X_TGT_DEF_H + +#include "qla_def.h" + +/* + * Must be changed on any change in any initiator visible interfaces or + * data in the target add-on + */ +#define QLA2X_TARGET_MAGIC 269 + +/* + * Must be changed on any change in any target visible interfaces or + * data in the initiator + */ +#define QLA2X_INITIATOR_MAGIC 57222 + +#define QLA2X_INI_MODE_STR_EXCLUSIVE "exclusive" +#define QLA2X_INI_MODE_STR_DISABLED "disabled" +#define QLA2X_INI_MODE_STR_ENABLED "enabled" + +#define QLA2X_INI_MODE_EXCLUSIVE 0 +#define QLA2X_INI_MODE_DISABLED 1 +#define QLA2X_INI_MODE_ENABLED 2 + +#define QLA2X00_COMMAND_COUNT_INIT 250 +#define QLA2X00_IMMED_NOTIFY_COUNT_INIT 250 + +/* + * Used to mark which completion handles (for RIO Status's) are for CTIO's + * vs. regular (non-target) info. This is checked for in + * qla2x00_process_response_queue() to see if a handle coming back in a + * multi-complete should come to the tgt driver or be handled there by qla2xxx + */ +#define CTIO_COMPLETION_HANDLE_MARK BIT_29 +#if (CTIO_COMPLETION_HANDLE_MARK <= MAX_OUTSTANDING_COMMANDS) +#error "Hackish CTIO_COMPLETION_HANDLE_MARK no longer larger than MAX_OUTSTANDING_COMMANDS" +#endif +#define HANDLE_IS_CTIO_COMP(h) (h & CTIO_COMPLETION_HANDLE_MARK) + +/* Used to mark CTIO as intermediate */ +#define CTIO_INTERMEDIATE_HANDLE_MARK BIT_30 + +#ifndef OF_SS_MODE_0 +/* + * ISP target entries - Flags bit definitions. + */ +#define OF_SS_MODE_0 0 +#define OF_SS_MODE_1 1 +#define OF_SS_MODE_2 2 +#define OF_SS_MODE_3 3 + +#define OF_EXPL_CONF BIT_5 /* Explicit Confirmation Requested */ +#define OF_DATA_IN BIT_6 /* Data in to initiator */ + /* (data from target to initiator) */ +#define OF_DATA_OUT BIT_7 /* Data out from initiator */ + /* (data from initiator to target) */ +#define OF_NO_DATA (BIT_7 | BIT_6) +#define OF_INC_RC BIT_8 /* Increment command resource count */ +#define OF_FAST_POST BIT_9 /* Enable mailbox fast posting. */ +#define OF_CONF_REQ BIT_13 /* Confirmation Requested */ +#define OF_TERM_EXCH BIT_14 /* Terminate exchange */ +#define OF_SSTS BIT_15 /* Send SCSI status */ +#endif + +#ifndef DATASEGS_PER_COMMAND32 +#define DATASEGS_PER_COMMAND32 3 +#define DATASEGS_PER_CONT32 7 +#define QLA_MAX_SG32(ql) \ + (((ql) > 0) ? (DATASEGS_PER_COMMAND32 + DATASEGS_PER_CONT32*((ql) - 1)) : 0) + +#define DATASEGS_PER_COMMAND64 2 +#define DATASEGS_PER_CONT64 5 +#define QLA_MAX_SG64(ql) \ + (((ql) > 0) ? (DATASEGS_PER_COMMAND64 + DATASEGS_PER_CONT64*((ql) - 1)) : 0) +#endif + +#ifndef DATASEGS_PER_COMMAND_24XX +#define DATASEGS_PER_COMMAND_24XX 1 +#define DATASEGS_PER_CONT_24XX 5 +#define QLA_MAX_SG_24XX(ql) \ + (min(1270, ((ql) > 0) ? (DATASEGS_PER_COMMAND_24XX + DATASEGS_PER_CONT_24XX*((ql) - 1)) : 0)) +#endif + +/********************************************************************\ + * ISP Queue types left out of new QLogic driver (from old version) +\********************************************************************/ + +#ifndef ENABLE_LUN_TYPE +#define ENABLE_LUN_TYPE 0x0B /* Enable LUN entry. */ +/* + * ISP queue - enable LUN entry structure definition. + */ +typedef struct { + uint8_t entry_type; /* Entry type. */ + uint8_t entry_count; /* Entry count. */ + uint8_t sys_define; /* System defined. */ + uint8_t entry_status; /* Entry Status. */ + uint32_t sys_define_2; /* System defined. */ + uint8_t reserved_8; + uint8_t reserved_1; + uint16_t reserved_2; + uint32_t reserved_3; + uint8_t status; + uint8_t reserved_4; + uint8_t command_count; /* Number of ATIOs allocated. */ + uint8_t immed_notify_count; /* Number of Immediate Notify entries allocated. */ + uint16_t reserved_5; + uint16_t timeout; /* 0 = 30 seconds, 0xFFFF = disable */ + uint16_t reserved_6[20]; +} __attribute__((packed)) elun_entry_t; +#define ENABLE_LUN_SUCCESS 0x01 +#define ENABLE_LUN_RC_NONZERO 0x04 +#define ENABLE_LUN_INVALID_REQUEST 0x06 +#define ENABLE_LUN_ALREADY_ENABLED 0x3E +#endif + +#ifndef MODIFY_LUN_TYPE +#define MODIFY_LUN_TYPE 0x0C /* Modify LUN entry. */ +/* + * ISP queue - modify LUN entry structure definition. + */ +typedef struct { + uint8_t entry_type; /* Entry type. */ + uint8_t entry_count; /* Entry count. */ + uint8_t sys_define; /* System defined. */ + uint8_t entry_status; /* Entry Status. */ + uint32_t sys_define_2; /* System defined. */ + uint8_t reserved_8; + uint8_t reserved_1; + uint8_t operators; + uint8_t reserved_2; + uint32_t reserved_3; + uint8_t status; + uint8_t reserved_4; + uint8_t command_count; /* Number of ATIOs allocated. */ + uint8_t immed_notify_count; /* Number of Immediate Notify */ + /* entries allocated. */ + uint16_t reserved_5; + uint16_t timeout; /* 0 = 30 seconds, 0xFFFF = disable */ + uint16_t reserved_7[20]; +} __attribute__((packed)) modify_lun_entry_t; +#define MODIFY_LUN_SUCCESS 0x01 +#define MODIFY_LUN_CMD_ADD BIT_0 +#define MODIFY_LUN_CMD_SUB BIT_1 +#define MODIFY_LUN_IMM_ADD BIT_2 +#define MODIFY_LUN_IMM_SUB BIT_3 +#endif + +#define GET_TARGET_ID(ha, iocb) ((HAS_EXTENDED_IDS(ha)) \ + ? le16_to_cpu((iocb)->target.extended) \ + : (uint16_t)(iocb)->target.id.standard) + +#ifndef IMMED_NOTIFY_TYPE +#define IMMED_NOTIFY_TYPE 0x0D /* Immediate notify entry. */ +/* + * ISP queue - immediate notify entry structure definition. + */ +typedef struct { + uint8_t entry_type; /* Entry type. */ + uint8_t entry_count; /* Entry count. */ + uint8_t sys_define; /* System defined. */ + uint8_t entry_status; /* Entry Status. */ + uint32_t sys_define_2; /* System defined. */ + target_id_t target; + uint16_t lun; + uint8_t target_id; + uint8_t reserved_1; + uint16_t status_modifier; + uint16_t status; + uint16_t task_flags; + uint16_t seq_id; + uint16_t srr_rx_id; + uint32_t srr_rel_offs; + uint16_t srr_ui; +#define SRR_IU_DATA_IN 0x1 +#define SRR_IU_DATA_OUT 0x5 +#define SRR_IU_STATUS 0x7 + uint16_t srr_ox_id; + uint8_t reserved_2[30]; + uint16_t ox_id; +} __attribute__((packed)) notify_entry_t; +#endif + +#ifndef NOTIFY_ACK_TYPE +#define NOTIFY_ACK_TYPE 0x0E /* Notify acknowledge entry. */ +/* + * ISP queue - notify acknowledge entry structure definition. + */ +typedef struct { + uint8_t entry_type; /* Entry type. */ + uint8_t entry_count; /* Entry count. */ + uint8_t sys_define; /* System defined. */ + uint8_t entry_status; /* Entry Status. */ + uint32_t sys_define_2; /* System defined. */ + target_id_t target; + uint8_t target_id; + uint8_t reserved_1; + uint16_t flags; + uint16_t resp_code; + uint16_t status; + uint16_t task_flags; + uint16_t seq_id; + uint16_t srr_rx_id; + uint32_t srr_rel_offs; + uint16_t srr_ui; + uint16_t srr_flags; + uint16_t srr_reject_code; + uint8_t srr_reject_vendor_uniq; + uint8_t srr_reject_code_expl; + uint8_t reserved_2[26]; + uint16_t ox_id; +} __attribute__((packed)) nack_entry_t; +#define NOTIFY_ACK_SRR_FLAGS_ACCEPT 0 +#define NOTIFY_ACK_SRR_FLAGS_REJECT 1 + +#define NOTIFY_ACK_SRR_REJECT_REASON_UNABLE_TO_PERFORM 0x9 + +#define NOTIFY_ACK_SRR_FLAGS_REJECT_EXPL_NO_EXPL 0 +#define NOTIFY_ACK_SRR_FLAGS_REJECT_EXPL_UNABLE_TO_SUPPLY_DATA 0x2a + +#define NOTIFY_ACK_SUCCESS 0x01 +#endif + +#ifndef ACCEPT_TGT_IO_TYPE +#define ACCEPT_TGT_IO_TYPE 0x16 /* Accept target I/O entry. */ +/* + * ISP queue - Accept Target I/O (ATIO) entry structure definition. + */ +typedef struct { + uint8_t entry_type; /* Entry type. */ + uint8_t entry_count; /* Entry count. */ + uint8_t sys_define; /* System defined. */ + uint8_t entry_status; /* Entry Status. */ + uint32_t sys_define_2; /* System defined. */ + target_id_t target; + uint16_t rx_id; + uint16_t flags; + uint16_t status; + uint8_t command_ref; + uint8_t task_codes; + uint8_t task_flags; + uint8_t execution_codes; + uint8_t cdb[MAX_CMDSZ]; + uint32_t data_length; + uint16_t lun; + uint8_t initiator_port_name[WWN_SIZE]; /* on qla23xx */ + uint16_t reserved_32[6]; + uint16_t ox_id; +} __attribute__((packed)) atio_entry_t; +#endif + +#ifndef CONTINUE_TGT_IO_TYPE +#define CONTINUE_TGT_IO_TYPE 0x17 +/* + * ISP queue - Continue Target I/O (CTIO) entry for status mode 0 + * structure definition. + */ +typedef struct { + uint8_t entry_type; /* Entry type. */ + uint8_t entry_count; /* Entry count. */ + uint8_t sys_define; /* System defined. */ + uint8_t entry_status; /* Entry Status. */ + uint32_t handle; /* System defined handle */ + target_id_t target; + uint16_t rx_id; + uint16_t flags; + uint16_t status; + uint16_t timeout; /* 0 = 30 seconds, 0xFFFF = disable */ + uint16_t dseg_count; /* Data segment count. */ + uint32_t relative_offset; + uint32_t residual; + uint16_t reserved_1[3]; + uint16_t scsi_status; + uint32_t transfer_length; + uint32_t dseg_0_address[0]; +} __attribute__((packed)) ctio_common_entry_t; +#define ATIO_PATH_INVALID 0x07 +#define ATIO_CANT_PROV_CAP 0x16 +#define ATIO_CDB_VALID 0x3D + +#define ATIO_EXEC_READ BIT_1 +#define ATIO_EXEC_WRITE BIT_0 +#endif + +#ifndef CTIO_A64_TYPE +#define CTIO_A64_TYPE 0x1F +typedef struct { + ctio_common_entry_t common; + uint32_t dseg_0_address; /* Data segment 0 address. */ + uint32_t dseg_0_length; /* Data segment 0 length. */ + uint32_t dseg_1_address; /* Data segment 1 address. */ + uint32_t dseg_1_length; /* Data segment 1 length. */ + uint32_t dseg_2_address; /* Data segment 2 address. */ + uint32_t dseg_2_length; /* Data segment 2 length. */ +} __attribute__((packed)) ctio_entry_t; +#define CTIO_SUCCESS 0x01 +#define CTIO_ABORTED 0x02 +#define CTIO_INVALID_RX_ID 0x08 +#define CTIO_TIMEOUT 0x0B +#define CTIO_LIP_RESET 0x0E +#define CTIO_TARGET_RESET 0x17 +#define CTIO_PORT_UNAVAILABLE 0x28 +#define CTIO_PORT_LOGGED_OUT 0x29 +#define CTIO_PORT_CONF_CHANGED 0x2A +#define CTIO_SRR_RECEIVED 0x45 + +#endif + +#ifndef CTIO_RET_TYPE +#define CTIO_RET_TYPE 0x17 /* CTIO return entry */ +/* + * ISP queue - CTIO returned entry structure definition. + */ +typedef struct { + uint8_t entry_type; /* Entry type. */ + uint8_t entry_count; /* Entry count. */ + uint8_t sys_define; /* System defined. */ + uint8_t entry_status; /* Entry Status. */ + uint32_t handle; /* System defined handle. */ + target_id_t target; + uint16_t rx_id; + uint16_t flags; + uint16_t status; + uint16_t timeout; /* 0 = 30 seconds, 0xFFFF = disable */ + uint16_t dseg_count; /* Data segment count. */ + uint32_t relative_offset; + uint32_t residual; + uint16_t reserved_1[2]; + uint16_t sense_length; + uint16_t scsi_status; + uint16_t response_length; + uint8_t sense_data[26]; +} __attribute__((packed)) ctio_ret_entry_t; +#endif + +#define ATIO_TYPE7 0x06 /* Accept target I/O entry for 24xx */ + +typedef struct { + uint8_t r_ctl; + uint8_t d_id[3]; + uint8_t cs_ctl; + uint8_t s_id[3]; + uint8_t type; + uint8_t f_ctl[3]; + uint8_t seq_id; + uint8_t df_ctl; + uint16_t seq_cnt; + uint16_t ox_id; + uint16_t rx_id; + uint32_t parameter; +} __attribute__((packed)) fcp_hdr_t; + +typedef struct { + uint8_t d_id[3]; + uint8_t r_ctl; + uint8_t s_id[3]; + uint8_t cs_ctl; + uint8_t f_ctl[3]; + uint8_t type; + uint16_t seq_cnt; + uint8_t df_ctl; + uint8_t seq_id; + uint16_t rx_id; + uint16_t ox_id; + uint32_t parameter; +} __attribute__((packed)) fcp_hdr_le_t; + +#define F_CTL_EXCH_CONTEXT_RESP BIT_23 +#define F_CTL_SEQ_CONTEXT_RESIP BIT_22 +#define F_CTL_LAST_SEQ BIT_20 +#define F_CTL_END_SEQ BIT_19 +#define F_CTL_SEQ_INITIATIVE BIT_16 + +#define R_CTL_BASIC_LINK_SERV 0x80 +#define R_CTL_B_ACC 0x4 +#define R_CTL_B_RJT 0x5 + +typedef struct { + uint64_t lun; + uint8_t cmnd_ref; + uint8_t task_attr:3; + uint8_t reserved:5; + uint8_t task_mgmt_flags; +#define FCP_CMND_TASK_MGMT_CLEAR_ACA 6 +#define FCP_CMND_TASK_MGMT_TARGET_RESET 5 +#define FCP_CMND_TASK_MGMT_LU_RESET 4 +#define FCP_CMND_TASK_MGMT_CLEAR_TASK_SET 2 +#define FCP_CMND_TASK_MGMT_ABORT_TASK_SET 1 + uint8_t wrdata:1; + uint8_t rddata:1; + uint8_t add_cdb_len:6; + uint8_t cdb[16]; + /* + * add_cdb is optional and can absent from atio7_fcp_cmnd_t. Size 4 only to + * make sizeof(atio7_fcp_cmnd_t) be as expected by BUILD_BUG_ON() in + * q2t_init(). + */ + uint8_t add_cdb[4]; + /* uint32_t data_length; */ +} __attribute__((packed)) atio7_fcp_cmnd_t; + +/* + * ISP queue - Accept Target I/O (ATIO) type 7 entry for 24xx structure + * definition. + */ +typedef struct { + uint8_t entry_type; /* Entry type. */ + uint8_t entry_count; /* Entry count. */ + uint8_t fcp_cmnd_len_low; + uint8_t fcp_cmnd_len_high:4; + uint8_t attr:4; + uint32_t exchange_addr; +#define ATIO_EXCHANGE_ADDRESS_UNKNOWN 0xFFFFFFFF + fcp_hdr_t fcp_hdr; + atio7_fcp_cmnd_t fcp_cmnd; +} __attribute__((packed)) atio7_entry_t; + +#define CTIO_TYPE7 0x12 /* Continue target I/O entry (for 24xx) */ + +/* + * ISP queue - Continue Target I/O (ATIO) type 7 entry (for 24xx) structure + * definition. + */ + +typedef struct { + uint8_t entry_type; /* Entry type. */ + uint8_t entry_count; /* Entry count. */ + uint8_t sys_define; /* System defined. */ + uint8_t entry_status; /* Entry Status. */ + uint32_t handle; /* System defined handle */ + uint16_t nport_handle; +#define CTIO7_NHANDLE_UNRECOGNIZED 0xFFFF + uint16_t timeout; + uint16_t dseg_count; /* Data segment count. */ + uint8_t vp_index; + uint8_t add_flags; + uint8_t initiator_id[3]; + uint8_t reserved; + uint32_t exchange_addr; +} __attribute__((packed)) ctio7_common_entry_t; + +typedef struct { + ctio7_common_entry_t common; + uint16_t reserved1; + uint16_t flags; + uint32_t residual; + uint16_t ox_id; + uint16_t scsi_status; + uint32_t relative_offset; + uint32_t reserved2; + uint32_t transfer_length; + uint32_t reserved3; + uint32_t dseg_0_address[2]; /* Data segment 0 address. */ + uint32_t dseg_0_length; /* Data segment 0 length. */ +} __attribute__((packed)) ctio7_status0_entry_t; + +typedef struct { + ctio7_common_entry_t common; + uint16_t sense_length; + uint16_t flags; + uint32_t residual; + uint16_t ox_id; + uint16_t scsi_status; + uint16_t response_len; + uint16_t reserved; + uint8_t sense_data[24]; +} __attribute__((packed)) ctio7_status1_entry_t; + +typedef struct { + uint8_t entry_type; /* Entry type. */ + uint8_t entry_count; /* Entry count. */ + uint8_t sys_define; /* System defined. */ + uint8_t entry_status; /* Entry Status. */ + uint32_t handle; /* System defined handle */ + uint16_t status; + uint16_t timeout; + uint16_t dseg_count; /* Data segment count. */ + uint8_t vp_index; + uint8_t reserved1[5]; + uint32_t exchange_address; + uint16_t reserved2; + uint16_t flags; + uint32_t residual; + uint16_t ox_id; + uint16_t reserved3; + uint32_t relative_offset; + uint8_t reserved4[24]; +} __attribute__((packed)) ctio7_fw_entry_t; + +/* CTIO7 flags values */ +#define CTIO7_FLAGS_SEND_STATUS BIT_15 +#define CTIO7_FLAGS_TERMINATE BIT_14 +#define CTIO7_FLAGS_CONFORM_REQ BIT_13 +#define CTIO7_FLAGS_DONT_RET_CTIO BIT_8 +#define CTIO7_FLAGS_STATUS_MODE_0 0 +#define CTIO7_FLAGS_STATUS_MODE_1 BIT_6 +#define CTIO7_FLAGS_EXPLICIT_CONFORM BIT_5 +#define CTIO7_FLAGS_CONFIRM_SATISF BIT_4 +#define CTIO7_FLAGS_DSD_PTR BIT_2 +#define CTIO7_FLAGS_DATA_IN BIT_1 +#define CTIO7_FLAGS_DATA_OUT BIT_0 + +/* + * ISP queue - immediate notify entry structure definition for 24xx. + */ +typedef struct { + uint8_t entry_type; /* Entry type. */ + uint8_t entry_count; /* Entry count. */ + uint8_t sys_define; /* System defined. */ + uint8_t entry_status; /* Entry Status. */ + uint32_t reserved; + uint16_t nport_handle; + uint16_t reserved_2; + uint16_t flags; +#define NOTIFY24XX_FLAGS_GLOBAL_TPRLO BIT_1 +#define NOTIFY24XX_FLAGS_PUREX_IOCB BIT_0 + uint16_t srr_rx_id; + uint16_t status; + uint8_t status_subcode; + uint8_t reserved_3; + uint32_t exchange_address; + uint32_t srr_rel_offs; + uint16_t srr_ui; + uint16_t srr_ox_id; + uint8_t reserved_4[19]; + uint8_t vp_index; + uint32_t reserved_5; + uint8_t port_id[3]; + uint8_t reserved_6; + uint16_t reserved_7; + uint16_t ox_id; +} __attribute__((packed)) notify24xx_entry_t; + +#define ELS_PLOGI 0x3 +#define ELS_FLOGI 0x4 +#define ELS_LOGO 0x5 +#define ELS_PRLI 0x20 +#define ELS_PRLO 0x21 +#define ELS_TPRLO 0x24 +#define ELS_PDISC 0x50 +#define ELS_ADISC 0x52 + +/* + * ISP queue - notify acknowledge entry structure definition for 24xx. + */ +typedef struct { + uint8_t entry_type; /* Entry type. */ + uint8_t entry_count; /* Entry count. */ + uint8_t sys_define; /* System defined. */ + uint8_t entry_status; /* Entry Status. */ + uint32_t handle; + uint16_t nport_handle; + uint16_t reserved_1; + uint16_t flags; + uint16_t srr_rx_id; + uint16_t status; + uint8_t status_subcode; + uint8_t reserved_3; + uint32_t exchange_address; + uint32_t srr_rel_offs; + uint16_t srr_ui; + uint16_t srr_flags; + uint8_t reserved_4[19]; + uint8_t vp_index; + uint8_t srr_reject_vendor_uniq; + uint8_t srr_reject_code_expl; + uint8_t srr_reject_code; + uint8_t reserved_5[7]; + uint16_t ox_id; +} __attribute__((packed)) nack24xx_entry_t; + +/* + * ISP queue - ABTS received/response entries structure definition for 24xx. + */ +#define ABTS_RECV_24XX 0x54 /* ABTS received (for 24xx) */ +#define ABTS_RESP_24XX 0x55 /* ABTS responce (for 24xx) */ + +typedef struct { + uint8_t entry_type; /* Entry type. */ + uint8_t entry_count; /* Entry count. */ + uint8_t sys_define; /* System defined. */ + uint8_t entry_status; /* Entry Status. */ + uint8_t reserved_1[6]; + uint16_t nport_handle; + uint8_t reserved_2[2]; + uint8_t vp_index; + uint8_t reserved_3:4; + uint8_t sof_type:4; + uint32_t exchange_address; + fcp_hdr_le_t fcp_hdr_le; + uint8_t reserved_4[16]; + uint32_t exchange_addr_to_abort; +} __attribute__((packed)) abts24_recv_entry_t; + +#define ABTS_PARAM_ABORT_SEQ BIT_0 + +typedef struct { + uint16_t reserved; + uint8_t seq_id_last; + uint8_t seq_id_valid; +#define SEQ_ID_VALID 0x80 +#define SEQ_ID_INVALID 0x00 + uint16_t rx_id; + uint16_t ox_id; + uint16_t high_seq_cnt; + uint16_t low_seq_cnt; +} __attribute__((packed)) ba_acc_le_t; + +typedef struct { + uint8_t vendor_uniq; + uint8_t reason_expl; + uint8_t reason_code; +#define BA_RJT_REASON_CODE_INVALID_COMMAND 0x1 +#define BA_RJT_REASON_CODE_UNABLE_TO_PERFORM 0x9 + uint8_t reserved; +} __attribute__((packed)) ba_rjt_le_t; + +typedef struct { + uint8_t entry_type; /* Entry type. */ + uint8_t entry_count; /* Entry count. */ + uint8_t sys_define; /* System defined. */ + uint8_t entry_status; /* Entry Status. */ + uint32_t handle; + uint16_t reserved_1; + uint16_t nport_handle; + uint16_t control_flags; +#define ABTS_CONTR_FLG_TERM_EXCHG BIT_0 + uint8_t vp_index; + uint8_t reserved_3:4; + uint8_t sof_type:4; + uint32_t exchange_address; + fcp_hdr_le_t fcp_hdr_le; + union { + ba_acc_le_t ba_acct; + ba_rjt_le_t ba_rjt; + } __attribute__((packed)) payload; + uint32_t reserved_4; + uint32_t exchange_addr_to_abort; +} __attribute__((packed)) abts24_resp_entry_t; + +typedef struct { + uint8_t entry_type; /* Entry type. */ + uint8_t entry_count; /* Entry count. */ + uint8_t sys_define; /* System defined. */ + uint8_t entry_status; /* Entry Status. */ + uint32_t handle; + uint16_t compl_status; +#define ABTS_RESP_COMPL_SUCCESS 0 +#define ABTS_RESP_COMPL_SUBCODE_ERROR 0x31 + uint16_t nport_handle; + uint16_t reserved_1; + uint8_t reserved_2; + uint8_t reserved_3:4; + uint8_t sof_type:4; + uint32_t exchange_address; + fcp_hdr_le_t fcp_hdr_le; + uint8_t reserved_4[8]; + uint32_t error_subcode1; +#define ABTS_RESP_SUBCODE_ERR_ABORTED_EXCH_NOT_TERM 0x1E + uint32_t error_subcode2; + uint32_t exchange_addr_to_abort; +} __attribute__((packed)) abts24_resp_fw_entry_t; + +/********************************************************************\ + * Type Definitions used by initiator & target halves +\********************************************************************/ + +struct q2t_mgmt_cmd; +struct q2t_sess; + +struct qla_target_template { + + int (*handle_cmd)(scsi_qla_host_t *, struct q2t_cmd *, uint32_t, uint32_t, int, int, int); + int (*handle_data)(struct q2t_cmd *); + int (*handle_tmr)(struct q2t_mgmt_cmd *, uint32_t, uint8_t); + void (*free_cmd)(struct q2t_cmd *); + void (*free_session)(struct q2t_sess *); + + int (*check_initiator_node_acl)(scsi_qla_host_t *, void *, uint8_t *, uint16_t); + struct q2t_sess *(*find_sess_by_loop_id)(scsi_qla_host_t *, const uint16_t); + struct q2t_sess *(*find_sess_by_s_id)(scsi_qla_host_t *, const uint8_t *); +}; + +int qla2x00_wait_for_loop_ready(scsi_qla_host_t *); +int qla2x00_wait_for_hba_online(scsi_qla_host_t *); + +#endif /* __QLA2X_TGT_DEF_H */ -- 1.7.3.3 -- To unsubscribe from this list: send the line "unsubscribe linux-scsi" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html