Quelle  efct_scsi.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0
/*
 * Copyright (C) 2021 Broadcom. All Rights Reserved. The term
 * “Broadcom” refers to Broadcom Inc. and/or its subsidiaries.
 */

#include "efct_driver.h"
#include "efct_hw.h"

#define enable_tsend_auto_resp(efct) 1
#define enable_treceive_auto_resp(efct) 0

#define SCSI_IOFMT "[%04x][i:%04x t:%04x h:%04x]"

#define scsi_io_printf(io, fmt, ...) \
 efc_log_debug(io->efct, "[%s]" SCSI_IOFMT fmt, \
  io->node->display_name, io->instance_index,\
  io->init_task_tag, io->tgt_task_tag, io->hw_tag, ##__VA_ARGS__)

#define EFCT_LOG_ENABLE_SCSI_TRACE(efct)                \
  (((efct) != NULL) ? (((efct)->logmask & (1U << 2)) != 0) : 0)

#define scsi_io_trace(io, fmt, ...) \
 do { \
  if (EFCT_LOG_ENABLE_SCSI_TRACE(io->efct)) \
   scsi_io_printf(io, fmt, ##__VA_ARGS__); \
 } while (0)

struct efct_io *
efct_scsi_io_alloc(struct efct_node *node)
{
 struct efct *efct;
 struct efct_xport *xport;
 struct efct_io *io;
 unsigned long flags;

 efct = node->efct;

 xport = efct->xport;

 io = efct_io_pool_io_alloc(efct->xport->io_pool);
 if (!io) {
  efc_log_err(efct, "IO alloc Failed\n");
  atomic_add_return(1, &xport->io_alloc_failed_count);
  return NULL;
 }

 /* initialize refcount */
 kref_init(&io->ref);
 io->release = _efct_scsi_io_free;

 /* set generic fields */
 io->efct = efct;
 io->node = node;
 kref_get(&node->ref);

 /* set type and name */
 io->io_type = EFCT_IO_TYPE_IO;
 io->display_name = "scsi_io";

 io->cmd_ini = false;
 io->cmd_tgt = true;

 /* Add to node's active_ios list */
 INIT_LIST_HEAD(&io->list_entry);
 spin_lock_irqsave(&node->active_ios_lock, flags);
 list_add(&io->list_entry, &node->active_ios);

 spin_unlock_irqrestore(&node->active_ios_lock, flags);

 return io;
}

void
_efct_scsi_io_free(struct kref *arg)
{
 struct efct_io *io = container_of(arg, struct efct_io, ref);
 struct efct *efct = io->efct;
 struct efct_node *node = io->node;
 unsigned long flags = 0;

 scsi_io_trace(io, "freeing io 0x%p %s\n", io, io->display_name);

 if (io->io_free) {
  efc_log_err(efct, "IO already freed.\n");
  return;
 }

 spin_lock_irqsave(&node->active_ios_lock, flags);
 list_del_init(&io->list_entry);
 spin_unlock_irqrestore(&node->active_ios_lock, flags);

 kref_put(&node->ref, node->release);
 io->node = NULL;
 efct_io_pool_io_free(efct->xport->io_pool, io);
}

void
efct_scsi_io_free(struct efct_io *io)
{
 scsi_io_trace(io, "freeing io 0x%p %s\n", io, io->display_name);
 WARN_ON(!refcount_read(&io->ref.refcount));
 kref_put(&io->ref, io->release);
}

static void
efct_target_io_cb(struct efct_hw_io *hio, u32 length, int status,
    u32 ext_status, void *app)
{
 u32 flags = 0;
 struct efct_io *io = app;
 struct efct *efct;
 enum efct_scsi_io_status scsi_stat = EFCT_SCSI_STATUS_GOOD;
 efct_scsi_io_cb_t cb;

 if (!io || !io->efct) {
  pr_err("%s: IO can not be NULL\n", __func__);
  return;
 }

 scsi_io_trace(io, "status x%x ext_status x%x\n", status, ext_status);

 efct = io->efct;

 io->transferred += length;

 if (!io->scsi_tgt_cb) {
  efct_scsi_check_pending(efct);
  return;
 }

 /* Call target server completion */
 cb = io->scsi_tgt_cb;

 /* Clear the callback before invoking the callback */
 io->scsi_tgt_cb = NULL;

 /* if status was good, and auto-good-response was set,
 * then callback target-server with IO_CMPL_RSP_SENT,
 * otherwise send IO_CMPL
 */
 if (status == 0 && io->auto_resp)
  flags |= EFCT_SCSI_IO_CMPL_RSP_SENT;
 else
  flags |= EFCT_SCSI_IO_CMPL;

 switch (status) {
 case SLI4_FC_WCQE_STATUS_SUCCESS:
  scsi_stat = EFCT_SCSI_STATUS_GOOD;
  break;
 case SLI4_FC_WCQE_STATUS_DI_ERROR:
  if (ext_status & SLI4_FC_DI_ERROR_GE)
   scsi_stat = EFCT_SCSI_STATUS_DIF_GUARD_ERR;
  else if (ext_status & SLI4_FC_DI_ERROR_AE)
   scsi_stat = EFCT_SCSI_STATUS_DIF_APP_TAG_ERROR;
  else if (ext_status & SLI4_FC_DI_ERROR_RE)
   scsi_stat = EFCT_SCSI_STATUS_DIF_REF_TAG_ERROR;
  else
   scsi_stat = EFCT_SCSI_STATUS_DIF_UNKNOWN_ERROR;
  break;
 case SLI4_FC_WCQE_STATUS_LOCAL_REJECT:
  switch (ext_status) {
  case SLI4_FC_LOCAL_REJECT_INVALID_RELOFFSET:
  case SLI4_FC_LOCAL_REJECT_ABORT_REQUESTED:
   scsi_stat = EFCT_SCSI_STATUS_ABORTED;
   break;
  case SLI4_FC_LOCAL_REJECT_INVALID_RPI:
   scsi_stat = EFCT_SCSI_STATUS_NEXUS_LOST;
   break;
  case SLI4_FC_LOCAL_REJECT_NO_XRI:
   scsi_stat = EFCT_SCSI_STATUS_NO_IO;
   break;
  default:
   /*we have seen 0x0d(TX_DMA_FAILED err)*/
   scsi_stat = EFCT_SCSI_STATUS_ERROR;
   break;
  }
  break;

 case SLI4_FC_WCQE_STATUS_TARGET_WQE_TIMEOUT:
  /* target IO timed out */
  scsi_stat = EFCT_SCSI_STATUS_TIMEDOUT_AND_ABORTED;
  break;

 case SLI4_FC_WCQE_STATUS_SHUTDOWN:
  /* Target IO cancelled by HW */
  scsi_stat = EFCT_SCSI_STATUS_SHUTDOWN;
  break;

 default:
  scsi_stat = EFCT_SCSI_STATUS_ERROR;
  break;
 }

 cb(io, scsi_stat, flags, io->scsi_tgt_cb_arg);

 efct_scsi_check_pending(efct);
}

static int
efct_scsi_build_sgls(struct efct_hw *hw, struct efct_hw_io *hio,
       struct efct_scsi_sgl *sgl, u32 sgl_count,
       enum efct_hw_io_type type)
{
 int rc;
 u32 i;
 struct efct *efct = hw->os;

 /* Initialize HW SGL */
 rc = efct_hw_io_init_sges(hw, hio, type);
 if (rc) {
  efc_log_err(efct, "efct_hw_io_init_sges failed: %d\n", rc);
  return -EIO;
 }

 for (i = 0; i < sgl_count; i++) {
  /* Add data SGE */
  rc = efct_hw_io_add_sge(hw, hio, sgl[i].addr, sgl[i].len);
  if (rc) {
   efc_log_err(efct, "add sge failed cnt=%d rc=%d\n",
        sgl_count, rc);
   return rc;
  }
 }

 return 0;
}

static void efc_log_sgl(struct efct_io *io)
{
 struct efct_hw_io *hio = io->hio;
 struct sli4_sge *data = NULL;
 u32 *dword = NULL;
 u32 i;
 u32 n_sge;

 scsi_io_trace(io, "def_sgl at 0x%x 0x%08x\n",
        upper_32_bits(hio->def_sgl.phys),
        lower_32_bits(hio->def_sgl.phys));
 n_sge = (hio->sgl == &hio->def_sgl) ? hio->n_sge : hio->def_sgl_count;
 for (i = 0, data = hio->def_sgl.virt; i < n_sge; i++, data++) {
  dword = (u32 *)data;

  scsi_io_trace(io, "SGL %2d 0x%08x 0x%08x 0x%08x 0x%08x\n",
         i, dword[0], dword[1], dword[2], dword[3]);

  if (dword[2] & (1U << 31))
   break;
 }
}

static void
efct_scsi_check_pending_async_cb(struct efct_hw *hw, int status,
     u8 *mqe, void *arg)
{
 struct efct_io *io = arg;

 if (io) {
  efct_hw_done_t cb = io->hw_cb;

  if (!io->hw_cb)
   return;

  io->hw_cb = NULL;
  (cb)(io->hio, 0, SLI4_FC_WCQE_STATUS_DISPATCH_ERROR, 0, io);
 }
}

static int
efct_scsi_io_dispatch_hw_io(struct efct_io *io, struct efct_hw_io *hio)
{
 int rc = 0;
 struct efct *efct = io->efct;

 /* Got a HW IO;
 * update ini/tgt_task_tag with HW IO info and dispatch
 */
 io->hio = hio;
 if (io->cmd_tgt)
  io->tgt_task_tag = hio->indicator;
 else if (io->cmd_ini)
  io->init_task_tag = hio->indicator;
 io->hw_tag = hio->reqtag;

 hio->eq = io->hw_priv;

 /* Copy WQ steering */
 switch (io->wq_steering) {
 case EFCT_SCSI_WQ_STEERING_CLASS >> EFCT_SCSI_WQ_STEERING_SHIFT:
  hio->wq_steering = EFCT_HW_WQ_STEERING_CLASS;
  break;
 case EFCT_SCSI_WQ_STEERING_REQUEST >> EFCT_SCSI_WQ_STEERING_SHIFT:
  hio->wq_steering = EFCT_HW_WQ_STEERING_REQUEST;
  break;
 case EFCT_SCSI_WQ_STEERING_CPU >> EFCT_SCSI_WQ_STEERING_SHIFT:
  hio->wq_steering = EFCT_HW_WQ_STEERING_CPU;
  break;
 }

 switch (io->io_type) {
 case EFCT_IO_TYPE_IO:
  rc = efct_scsi_build_sgls(&efct->hw, io->hio,
       io->sgl, io->sgl_count, io->hio_type);
  if (rc)
   break;

  if (EFCT_LOG_ENABLE_SCSI_TRACE(efct))
   efc_log_sgl(io);

  if (io->app_id)
   io->iparam.fcp_tgt.app_id = io->app_id;

  io->iparam.fcp_tgt.vpi = io->node->vpi;
  io->iparam.fcp_tgt.rpi = io->node->rpi;
  io->iparam.fcp_tgt.s_id = io->node->port_fc_id;
  io->iparam.fcp_tgt.d_id = io->node->node_fc_id;
  io->iparam.fcp_tgt.xmit_len = io->wire_len;

  rc = efct_hw_io_send(&io->efct->hw, io->hio_type, io->hio,
         &io->iparam, io->hw_cb, io);
  break;
 default:
  scsi_io_printf(io, "Unknown IO type=%d\n", io->io_type);
  rc = -EIO;
  break;
 }
 return rc;
}

static int
efct_scsi_io_dispatch_no_hw_io(struct efct_io *io)
{
 int rc;

 switch (io->io_type) {
 case EFCT_IO_TYPE_ABORT: {
  struct efct_hw_io *hio_to_abort = NULL;

  hio_to_abort = io->io_to_abort->hio;

  if (!hio_to_abort) {
   /*
 * If "IO to abort" does not have an
 * associated HW IO, immediately make callback with
 * success. The command must have been sent to
 * the backend, but the data phase has not yet
 * started, so we don't have a HW IO.
 *
 * Note: since the backend shims should be
 * taking a reference on io_to_abort, it should not
 * be possible to have been completed and freed by
 * the backend before the abort got here.
 */
   scsi_io_printf(io, "IO: not active\n");
   ((efct_hw_done_t)io->hw_cb)(io->hio, 0,
     SLI4_FC_WCQE_STATUS_SUCCESS, 0, io);
   rc = 0;
   break;
  }

  /* HW IO is valid, abort it */
  scsi_io_printf(io, "aborting\n");
  rc = efct_hw_io_abort(&io->efct->hw, hio_to_abort,
          io->send_abts, io->hw_cb, io);
  if (rc) {
   int status = SLI4_FC_WCQE_STATUS_SUCCESS;
   efct_hw_done_t cb = io->hw_cb;

   if (rc != -ENOENT && rc != -EINPROGRESS) {
    status = -1;
    scsi_io_printf(io, "Failed to abort IO rc=%d\n",
            rc);
   }
   cb(io->hio, 0, status, 0, io);
   rc = 0;
  }

  break;
 }
 default:
  scsi_io_printf(io, "Unknown IO type=%d\n", io->io_type);
  rc = -EIO;
  break;
 }
 return rc;
}

static struct efct_io *
efct_scsi_dispatch_pending(struct efct *efct)
{
 struct efct_xport *xport = efct->xport;
 struct efct_io *io = NULL;
 struct efct_hw_io *hio;
 unsigned long flags = 0;
 int status;

 spin_lock_irqsave(&xport->io_pending_lock, flags);

 if (!list_empty(&xport->io_pending_list)) {
  io = list_first_entry(&xport->io_pending_list, struct efct_io,
          io_pending_link);
  list_del_init(&io->io_pending_link);
 }

 if (!io) {
  spin_unlock_irqrestore(&xport->io_pending_lock, flags);
  return NULL;
 }

 if (io->io_type == EFCT_IO_TYPE_ABORT) {
  hio = NULL;
 } else {
  hio = efct_hw_io_alloc(&efct->hw);
  if (!hio) {
   /*
 * No HW IO available.Put IO back on
 * the front of pending list
 */
   list_add(&xport->io_pending_list, &io->io_pending_link);
   io = NULL;
  } else {
   hio->eq = io->hw_priv;
  }
 }

 /* Must drop the lock before dispatching the IO */
 spin_unlock_irqrestore(&xport->io_pending_lock, flags);

 if (!io)
  return NULL;

 /*
 * We pulled an IO off the pending list,
 * and either got an HW IO or don't need one
 */
 atomic_sub_return(1, &xport->io_pending_count);
 if (!hio)
  status = efct_scsi_io_dispatch_no_hw_io(io);
 else
  status = efct_scsi_io_dispatch_hw_io(io, hio);
 if (status) {
  /*
 * Invoke the HW callback, but do so in the
 * separate execution context,provided by the
 * NOP mailbox completion processing context
 * by using efct_hw_async_call()
 */
  if (efct_hw_async_call(&efct->hw,
           efct_scsi_check_pending_async_cb, io)) {
   efc_log_debug(efct, "call hw async failed\n");
  }
 }

 return io;
}

void
efct_scsi_check_pending(struct efct *efct)
{
 struct efct_xport *xport = efct->xport;
 struct efct_io *io = NULL;
 int count = 0;
 unsigned long flags = 0;
 int dispatch = 0;

 /* Guard against recursion */
 if (atomic_add_return(1, &xport->io_pending_recursing)) {
  /* This function is already running.  Decrement and return. */
  atomic_sub_return(1, &xport->io_pending_recursing);
  return;
 }

 while (efct_scsi_dispatch_pending(efct))
  count++;

 if (count) {
  atomic_sub_return(1, &xport->io_pending_recursing);
  return;
 }

 /*
 * If nothing was removed from the list,
 * we might be in a case where we need to abort an
 * active IO and the abort is on the pending list.
 * Look for an abort we can dispatch.
 */

 spin_lock_irqsave(&xport->io_pending_lock, flags);

 list_for_each_entry(io, &xport->io_pending_list, io_pending_link) {
  if (io->io_type == EFCT_IO_TYPE_ABORT && io->io_to_abort->hio) {
   /* This IO has a HW IO, so it is
 * active.  Dispatch the abort.
 */
   dispatch = 1;
   list_del_init(&io->io_pending_link);
   atomic_sub_return(1, &xport->io_pending_count);
   break;
  }
 }

 spin_unlock_irqrestore(&xport->io_pending_lock, flags);

 if (dispatch) {
  if (efct_scsi_io_dispatch_no_hw_io(io)) {
   if (efct_hw_async_call(&efct->hw,
    efct_scsi_check_pending_async_cb, io)) {
    efc_log_debug(efct, "hw async failed\n");
   }
  }
 }

 atomic_sub_return(1, &xport->io_pending_recursing);
}

int
efct_scsi_io_dispatch(struct efct_io *io, void *cb)
{
 struct efct_hw_io *hio;
 struct efct *efct = io->efct;
 struct efct_xport *xport = efct->xport;
 unsigned long flags = 0;

 io->hw_cb = cb;

 /*
 * if this IO already has a HW IO, then this is either
 * not the first phase of the IO. Send it to the HW.
 */
 if (io->hio)
  return efct_scsi_io_dispatch_hw_io(io, io->hio);

 /*
 * We don't already have a HW IO associated with the IO. First check
 * the pending list. If not empty, add IO to the tail and process the
 * pending list.
 */
 spin_lock_irqsave(&xport->io_pending_lock, flags);
 if (!list_empty(&xport->io_pending_list)) {
  /*
 * If this is a low latency request,
 * the put at the front of the IO pending
 * queue, otherwise put it at the end of the queue.
 */
  if (io->low_latency) {
   INIT_LIST_HEAD(&io->io_pending_link);
   list_add(&xport->io_pending_list, &io->io_pending_link);
  } else {
   INIT_LIST_HEAD(&io->io_pending_link);
   list_add_tail(&io->io_pending_link,
          &xport->io_pending_list);
  }
  spin_unlock_irqrestore(&xport->io_pending_lock, flags);
  atomic_add_return(1, &xport->io_pending_count);
  atomic_add_return(1, &xport->io_total_pending);

  /* process pending list */
  efct_scsi_check_pending(efct);
  return 0;
 }
 spin_unlock_irqrestore(&xport->io_pending_lock, flags);

 /*
 * We don't have a HW IO associated with the IO and there's nothing
 * on the pending list. Attempt to allocate a HW IO and dispatch it.
 */
 hio = efct_hw_io_alloc(&io->efct->hw);
 if (!hio) {
  /* Couldn't get a HW IO. Save this IO on the pending list */
  spin_lock_irqsave(&xport->io_pending_lock, flags);
  INIT_LIST_HEAD(&io->io_pending_link);
  list_add_tail(&io->io_pending_link, &xport->io_pending_list);
  spin_unlock_irqrestore(&xport->io_pending_lock, flags);

  atomic_add_return(1, &xport->io_total_pending);
  atomic_add_return(1, &xport->io_pending_count);
  return 0;
 }

 /* We successfully allocated a HW IO; dispatch to HW */
 return efct_scsi_io_dispatch_hw_io(io, hio);
}

int
efct_scsi_io_dispatch_abort(struct efct_io *io, void *cb)
{
 struct efct *efct = io->efct;
 struct efct_xport *xport = efct->xport;
 unsigned long flags = 0;

 io->hw_cb = cb;

 /*
 * For aborts, we don't need a HW IO, but we still want
 * to pass through the pending list to preserve ordering.
 * Thus, if the pending list is not empty, add this abort
 * to the pending list and process the pending list.
 */
 spin_lock_irqsave(&xport->io_pending_lock, flags);
 if (!list_empty(&xport->io_pending_list)) {
  INIT_LIST_HEAD(&io->io_pending_link);
  list_add_tail(&io->io_pending_link, &xport->io_pending_list);
  spin_unlock_irqrestore(&xport->io_pending_lock, flags);
  atomic_add_return(1, &xport->io_pending_count);
  atomic_add_return(1, &xport->io_total_pending);

  /* process pending list */
  efct_scsi_check_pending(efct);
  return 0;
 }
 spin_unlock_irqrestore(&xport->io_pending_lock, flags);

 /* nothing on pending list, dispatch abort */
 return efct_scsi_io_dispatch_no_hw_io(io);
}

static inline int
efct_scsi_xfer_data(struct efct_io *io, u32 flags,
      struct efct_scsi_sgl *sgl, u32 sgl_count, u64 xwire_len,
      enum efct_hw_io_type type, int enable_ar,
      efct_scsi_io_cb_t cb, void *arg)
{
 struct efct *efct;
 size_t residual = 0;

 io->sgl_count = sgl_count;

 efct = io->efct;

 scsi_io_trace(io, "%s wire_len %llu\n",
        (type == EFCT_HW_IO_TARGET_READ) ? "send" : "recv",
        xwire_len);

 io->hio_type = type;

 io->scsi_tgt_cb = cb;
 io->scsi_tgt_cb_arg = arg;

 residual = io->exp_xfer_len - io->transferred;
 io->wire_len = (xwire_len < residual) ? xwire_len : residual;
 residual = (xwire_len - io->wire_len);

 memset(&io->iparam, 0, sizeof(io->iparam));
 io->iparam.fcp_tgt.ox_id = io->init_task_tag;
 io->iparam.fcp_tgt.offset = io->transferred;
 io->iparam.fcp_tgt.cs_ctl = io->cs_ctl;
 io->iparam.fcp_tgt.timeout = io->timeout;

 /* if this is the last data phase and there is no residual, enable
 * auto-good-response
 */
 if (enable_ar && (flags & EFCT_SCSI_LAST_DATAPHASE) && residual == 0 &&
     ((io->transferred + io->wire_len) == io->exp_xfer_len) &&
     (!(flags & EFCT_SCSI_NO_AUTO_RESPONSE))) {
  io->iparam.fcp_tgt.flags |= SLI4_IO_AUTO_GOOD_RESPONSE;
  io->auto_resp = true;
 } else {
  io->auto_resp = false;
 }

 /* save this transfer length */
 io->xfer_req = io->wire_len;

 /* Adjust the transferred count to account for overrun
 * when the residual is calculated in efct_scsi_send_resp
 */
 io->transferred += residual;

 /* Adjust the SGL size if there is overrun */

 if (residual) {
  struct efct_scsi_sgl  *sgl_ptr = &io->sgl[sgl_count - 1];

  while (residual) {
   size_t len = sgl_ptr->len;

   if (len > residual) {
    sgl_ptr->len = len - residual;
    residual = 0;
   } else {
    sgl_ptr->len = 0;
    residual -= len;
    io->sgl_count--;
   }
   sgl_ptr--;
  }
 }

 /* Set latency and WQ steering */
 io->low_latency = (flags & EFCT_SCSI_LOW_LATENCY) != 0;
 io->wq_steering = (flags & EFCT_SCSI_WQ_STEERING_MASK) >>
    EFCT_SCSI_WQ_STEERING_SHIFT;
 io->wq_class = (flags & EFCT_SCSI_WQ_CLASS_MASK) >>
    EFCT_SCSI_WQ_CLASS_SHIFT;

 if (efct->xport) {
  struct efct_xport *xport = efct->xport;

  if (type == EFCT_HW_IO_TARGET_READ) {
   xport->fcp_stats.input_requests++;
   xport->fcp_stats.input_bytes += xwire_len;
  } else if (type == EFCT_HW_IO_TARGET_WRITE) {
   xport->fcp_stats.output_requests++;
   xport->fcp_stats.output_bytes += xwire_len;
  }
 }
 return efct_scsi_io_dispatch(io, efct_target_io_cb);
}

int
efct_scsi_send_rd_data(struct efct_io *io, u32 flags,
         struct efct_scsi_sgl *sgl, u32 sgl_count, u64 len,
         efct_scsi_io_cb_t cb, void *arg)
{
 return efct_scsi_xfer_data(io, flags, sgl, sgl_count,
       len, EFCT_HW_IO_TARGET_READ,
       enable_tsend_auto_resp(io->efct), cb, arg);
}

int
efct_scsi_recv_wr_data(struct efct_io *io, u32 flags,
         struct efct_scsi_sgl *sgl, u32 sgl_count, u64 len,
         efct_scsi_io_cb_t cb, void *arg)
{
 return efct_scsi_xfer_data(io, flags, sgl, sgl_count, len,
       EFCT_HW_IO_TARGET_WRITE,
       enable_treceive_auto_resp(io->efct), cb, arg);
}

int
efct_scsi_send_resp(struct efct_io *io, u32 flags,
      struct efct_scsi_cmd_resp *rsp,
      efct_scsi_io_cb_t cb, void *arg)
{
 struct efct *efct;
 int residual;
 /* Always try auto resp */
 bool auto_resp = true;
 u8 scsi_status = 0;
 u16 scsi_status_qualifier = 0;
 u8 *sense_data = NULL;
 u32 sense_data_length = 0;

 efct = io->efct;

 if (rsp) {
  scsi_status = rsp->scsi_status;
  scsi_status_qualifier = rsp->scsi_status_qualifier;
  sense_data = rsp->sense_data;
  sense_data_length = rsp->sense_data_length;
  residual = rsp->residual;
 } else {
  residual = io->exp_xfer_len - io->transferred;
 }

 io->wire_len = 0;
 io->hio_type = EFCT_HW_IO_TARGET_RSP;

 io->scsi_tgt_cb = cb;
 io->scsi_tgt_cb_arg = arg;

 memset(&io->iparam, 0, sizeof(io->iparam));
 io->iparam.fcp_tgt.ox_id = io->init_task_tag;
 io->iparam.fcp_tgt.offset = 0;
 io->iparam.fcp_tgt.cs_ctl = io->cs_ctl;
 io->iparam.fcp_tgt.timeout = io->timeout;

 /* Set low latency queueing request */
 io->low_latency = (flags & EFCT_SCSI_LOW_LATENCY) != 0;
 io->wq_steering = (flags & EFCT_SCSI_WQ_STEERING_MASK) >>
    EFCT_SCSI_WQ_STEERING_SHIFT;
 io->wq_class = (flags & EFCT_SCSI_WQ_CLASS_MASK) >>
    EFCT_SCSI_WQ_CLASS_SHIFT;

 if (scsi_status != 0 || residual || sense_data_length) {
  struct fcp_resp_with_ext *fcprsp = io->rspbuf.virt;
  u8 *sns_data;

  if (!fcprsp) {
   efc_log_err(efct, "NULL response buffer\n");
   return -EIO;
  }

  sns_data = (u8 *)io->rspbuf.virt + sizeof(*fcprsp);

  auto_resp = false;

  memset(fcprsp, 0, sizeof(*fcprsp));

  io->wire_len += sizeof(*fcprsp);

  fcprsp->resp.fr_status = scsi_status;
  fcprsp->resp.fr_retry_delay =
   cpu_to_be16(scsi_status_qualifier);

  /* set residual status if necessary */
  if (residual != 0) {
   /* FCP: if data transferred is less than the
 * amount expected, then this is an underflow.
 * If data transferred would have been greater
 * than the amount expected this is an overflow
 */
   if (residual > 0) {
    fcprsp->resp.fr_flags |= FCP_RESID_UNDER;
    fcprsp->ext.fr_resid = cpu_to_be32(residual);
   } else {
    fcprsp->resp.fr_flags |= FCP_RESID_OVER;
    fcprsp->ext.fr_resid = cpu_to_be32(-residual);
   }
  }

  if (EFCT_SCSI_SNS_BUF_VALID(sense_data) && sense_data_length) {
   if (sense_data_length > SCSI_SENSE_BUFFERSIZE) {
    efc_log_err(efct, "Sense exceeds max size.\n");
    return -EIO;
   }

   fcprsp->resp.fr_flags |= FCP_SNS_LEN_VAL;
   memcpy(sns_data, sense_data, sense_data_length);
   fcprsp->ext.fr_sns_len = cpu_to_be32(sense_data_length);
   io->wire_len += sense_data_length;
  }

  io->sgl[0].addr = io->rspbuf.phys;
  io->sgl[0].dif_addr = 0;
  io->sgl[0].len = io->wire_len;
  io->sgl_count = 1;
 }

 if (auto_resp)
  io->iparam.fcp_tgt.flags |= SLI4_IO_AUTO_GOOD_RESPONSE;

 return efct_scsi_io_dispatch(io, efct_target_io_cb);
}

static int
efct_target_bls_resp_cb(struct efct_hw_io *hio, u32 length, int status,
   u32 ext_status, void *app)
{
 struct efct_io *io = app;
 struct efct *efct;
 enum efct_scsi_io_status bls_status;

 efct = io->efct;

 /* BLS isn't really a "SCSI" concept, but use SCSI status */
 if (status) {
  io_error_log(io, "s=%#x x=%#x\n", status, ext_status);
  bls_status = EFCT_SCSI_STATUS_ERROR;
 } else {
  bls_status = EFCT_SCSI_STATUS_GOOD;
 }

 if (io->bls_cb) {
  efct_scsi_io_cb_t bls_cb = io->bls_cb;
  void *bls_cb_arg = io->bls_cb_arg;

  io->bls_cb = NULL;
  io->bls_cb_arg = NULL;

  /* invoke callback */
  bls_cb(io, bls_status, 0, bls_cb_arg);
 }

 efct_scsi_check_pending(efct);
 return 0;
}

static int
efct_target_send_bls_resp(struct efct_io *io,
     efct_scsi_io_cb_t cb, void *arg)
{
 struct efct_node *node = io->node;
 struct sli_bls_params *bls = &io->iparam.bls;
 struct efct *efct = node->efct;
 struct fc_ba_acc *acc;
 int rc;

 /* fill out IO structure with everything needed to send BA_ACC */
 memset(&io->iparam, 0, sizeof(io->iparam));
 bls->ox_id = io->init_task_tag;
 bls->rx_id = io->abort_rx_id;
 bls->vpi = io->node->vpi;
 bls->rpi = io->node->rpi;
 bls->s_id = U32_MAX;
 bls->d_id = io->node->node_fc_id;
 bls->rpi_registered = true;

 acc = (void *)bls->payload;
 acc->ba_ox_id = cpu_to_be16(bls->ox_id);
 acc->ba_rx_id = cpu_to_be16(bls->rx_id);
 acc->ba_high_seq_cnt = cpu_to_be16(U16_MAX);

 /* generic io fields have already been populated */

 /* set type and BLS-specific fields */
 io->io_type = EFCT_IO_TYPE_BLS_RESP;
 io->display_name = "bls_rsp";
 io->hio_type = EFCT_HW_BLS_ACC;
 io->bls_cb = cb;
 io->bls_cb_arg = arg;

 /* dispatch IO */
 rc = efct_hw_bls_send(efct, FC_RCTL_BA_ACC, bls,
         efct_target_bls_resp_cb, io);
 return rc;
}

static int efct_bls_send_rjt_cb(struct efct_hw_io *hio, u32 length, int status,
    u32 ext_status, void *app)
{
 struct efct_io *io = app;

 efct_scsi_io_free(io);
 return 0;
}

struct efct_io *
efct_bls_send_rjt(struct efct_io *io, struct fc_frame_header *hdr)
{
 struct efct_node *node = io->node;
 struct sli_bls_params *bls = &io->iparam.bls;
 struct efct *efct = node->efct;
 struct fc_ba_rjt *acc;
 int rc;

 /* fill out BLS Response-specific fields */
 io->io_type = EFCT_IO_TYPE_BLS_RESP;
 io->display_name = "ba_rjt";
 io->hio_type = EFCT_HW_BLS_RJT;
 io->init_task_tag = be16_to_cpu(hdr->fh_ox_id);

 /* fill out iparam fields */
 memset(&io->iparam, 0, sizeof(io->iparam));
 bls->ox_id = be16_to_cpu(hdr->fh_ox_id);
 bls->rx_id = be16_to_cpu(hdr->fh_rx_id);
 bls->vpi = io->node->vpi;
 bls->rpi = io->node->rpi;
 bls->s_id = U32_MAX;
 bls->d_id = io->node->node_fc_id;
 bls->rpi_registered = true;

 acc = (void *)bls->payload;
 acc->br_reason = ELS_RJT_UNAB;
 acc->br_explan = ELS_EXPL_NONE;

 rc = efct_hw_bls_send(efct, FC_RCTL_BA_RJT, bls, efct_bls_send_rjt_cb,
         io);
 if (rc) {
  efc_log_err(efct, "efct_scsi_io_dispatch() failed: %d\n", rc);
  efct_scsi_io_free(io);
  io = NULL;
 }
 return io;
}

int
efct_scsi_send_tmf_resp(struct efct_io *io,
   enum efct_scsi_tmf_resp rspcode,
   u8 addl_rsp_info[3],
   efct_scsi_io_cb_t cb, void *arg)
{
 int rc;
 struct {
  struct fcp_resp_with_ext rsp_ext;
  struct fcp_resp_rsp_info info;
 } *fcprsp;
 u8 fcp_rspcode;

 io->wire_len = 0;

 switch (rspcode) {
 case EFCT_SCSI_TMF_FUNCTION_COMPLETE:
  fcp_rspcode = FCP_TMF_CMPL;
  break;
 case EFCT_SCSI_TMF_FUNCTION_SUCCEEDED:
 case EFCT_SCSI_TMF_FUNCTION_IO_NOT_FOUND:
  fcp_rspcode = FCP_TMF_CMPL;
  break;
 case EFCT_SCSI_TMF_FUNCTION_REJECTED:
  fcp_rspcode = FCP_TMF_REJECTED;
  break;
 case EFCT_SCSI_TMF_INCORRECT_LOGICAL_UNIT_NUMBER:
  fcp_rspcode = FCP_TMF_INVALID_LUN;
  break;
 case EFCT_SCSI_TMF_SERVICE_DELIVERY:
  fcp_rspcode = FCP_TMF_FAILED;
  break;
 default:
  fcp_rspcode = FCP_TMF_REJECTED;
  break;
 }

 io->hio_type = EFCT_HW_IO_TARGET_RSP;

 io->scsi_tgt_cb = cb;
 io->scsi_tgt_cb_arg = arg;

 if (io->tmf_cmd == EFCT_SCSI_TMF_ABORT_TASK) {
  rc = efct_target_send_bls_resp(io, cb, arg);
  return rc;
 }

 /* populate the FCP TMF response */
 fcprsp = io->rspbuf.virt;
 memset(fcprsp, 0, sizeof(*fcprsp));

 fcprsp->rsp_ext.resp.fr_flags |= FCP_SNS_LEN_VAL;

 if (addl_rsp_info) {
  memcpy(fcprsp->info._fr_resvd, addl_rsp_info,
         sizeof(fcprsp->info._fr_resvd));
 }
 fcprsp->info.rsp_code = fcp_rspcode;

 io->wire_len = sizeof(*fcprsp);

 fcprsp->rsp_ext.ext.fr_rsp_len =
   cpu_to_be32(sizeof(struct fcp_resp_rsp_info));

 io->sgl[0].addr = io->rspbuf.phys;
 io->sgl[0].dif_addr = 0;
 io->sgl[0].len = io->wire_len;
 io->sgl_count = 1;

 memset(&io->iparam, 0, sizeof(io->iparam));
 io->iparam.fcp_tgt.ox_id = io->init_task_tag;
 io->iparam.fcp_tgt.offset = 0;
 io->iparam.fcp_tgt.cs_ctl = io->cs_ctl;
 io->iparam.fcp_tgt.timeout = io->timeout;

 rc = efct_scsi_io_dispatch(io, efct_target_io_cb);

 return rc;
}

static int
efct_target_abort_cb(struct efct_hw_io *hio, u32 length, int status,
       u32 ext_status, void *app)
{
 struct efct_io *io = app;
 struct efct *efct;
 enum efct_scsi_io_status scsi_status;
 efct_scsi_io_cb_t abort_cb;
 void *abort_cb_arg;

 efct = io->efct;

 if (!io->abort_cb)
  goto done;

 abort_cb = io->abort_cb;
 abort_cb_arg = io->abort_cb_arg;

 io->abort_cb = NULL;
 io->abort_cb_arg = NULL;

 switch (status) {
 case SLI4_FC_WCQE_STATUS_SUCCESS:
  scsi_status = EFCT_SCSI_STATUS_GOOD;
  break;
 case SLI4_FC_WCQE_STATUS_LOCAL_REJECT:
  switch (ext_status) {
  case SLI4_FC_LOCAL_REJECT_NO_XRI:
   scsi_status = EFCT_SCSI_STATUS_NO_IO;
   break;
  case SLI4_FC_LOCAL_REJECT_ABORT_IN_PROGRESS:
   scsi_status = EFCT_SCSI_STATUS_ABORT_IN_PROGRESS;
   break;
  default:
   /*we have seen 0x15 (abort in progress)*/
   scsi_status = EFCT_SCSI_STATUS_ERROR;
   break;
  }
  break;
 case SLI4_FC_WCQE_STATUS_FCP_RSP_FAILURE:
  scsi_status = EFCT_SCSI_STATUS_CHECK_RESPONSE;
  break;
 default:
  scsi_status = EFCT_SCSI_STATUS_ERROR;
  break;
 }
 /* invoke callback */
 abort_cb(io->io_to_abort, scsi_status, 0, abort_cb_arg);

done:
 /* done with IO to abort,efct_ref_get(): efct_scsi_tgt_abort_io() */
 kref_put(&io->io_to_abort->ref, io->io_to_abort->release);

 efct_io_pool_io_free(efct->xport->io_pool, io);

 efct_scsi_check_pending(efct);
 return 0;
}

int
efct_scsi_tgt_abort_io(struct efct_io *io, efct_scsi_io_cb_t cb, void *arg)
{
 struct efct *efct;
 struct efct_xport *xport;
 int rc;
 struct efct_io *abort_io = NULL;

 efct = io->efct;
 xport = efct->xport;

 /* take a reference on IO being aborted */
 if (kref_get_unless_zero(&io->ref) == 0) {
  /* command no longer active */
  scsi_io_printf(io, "command no longer active\n");
  return -EIO;
 }

 /*
 * allocate a new IO to send the abort request. Use efct_io_alloc()
 * directly, as we need an IO object that will not fail allocation
 * due to allocations being disabled (in efct_scsi_io_alloc())
 */
 abort_io = efct_io_pool_io_alloc(efct->xport->io_pool);
 if (!abort_io) {
  atomic_add_return(1, &xport->io_alloc_failed_count);
  kref_put(&io->ref, io->release);
  return -EIO;
 }

 /* Save the target server callback and argument */
 /* set generic fields */
 abort_io->cmd_tgt = true;
 abort_io->node = io->node;

 /* set type and abort-specific fields */
 abort_io->io_type = EFCT_IO_TYPE_ABORT;
 abort_io->display_name = "tgt_abort";
 abort_io->io_to_abort = io;
 abort_io->send_abts = false;
 abort_io->abort_cb = cb;
 abort_io->abort_cb_arg = arg;

 /* now dispatch IO */
 rc = efct_scsi_io_dispatch_abort(abort_io, efct_target_abort_cb);
 if (rc)
  kref_put(&io->ref, io->release);
 return rc;
}

void
efct_scsi_io_complete(struct efct_io *io)
{
 if (io->io_free) {
  efc_log_debug(io->efct, "completion for non-busy io tag 0x%x\n",
         io->tag);
  return;
 }

 scsi_io_trace(io, "freeing io 0x%p %s\n", io, io->display_name);
 kref_put(&io->ref, io->release);
}