Unreachable code

|int _dump_buf_done;
|
|static char *dif_op_str[] = {
| "SCSI_PROT_NORMAL",
| "SCSI_PROT_READ_INSERT",
| "SCSI_PROT_WRITE_STRIP",
| "SCSI_PROT_READ_STRIP",
| "SCSI_PROT_WRITE_INSERT",
| "SCSI_PROT_READ_PASS",
| "SCSI_PROT_WRITE_PASS",
|};
|static void
|lpfc_release_scsi_buf_s4(struct lpfc_hba *phba, struct lpfc_scsi_buf *psb);
|static void
|lpfc_release_scsi_buf_s3(struct lpfc_hba *phba, struct lpfc_scsi_buf *psb);
|
|static void
|lpfc_debug_save_data(struct lpfc_hba *phba, struct scsi_cmnd *cmnd)
|{
| void *src, *dst;
| struct scatterlist *sgde = scsi_sglist(cmnd);
|
| if (!_dump_buf_data) {
|  do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000200) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "9050 BLKGRD: ERROR %s _dump_buf_data is NULL\n", phba->brd_no, __func__); } } while (0)
|
|             ;
|  return;
| }
|
|
| if (!sgde) {
|  do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000200) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "9051 BLKGRD: ERROR: data scatterlist is null\n", phba->brd_no); } } while (0)
|                                                    ;
|  return;
| }
|
| dst = (void *) _dump_buf_data;
| while (sgde) {
|  src = sg_virt(sgde);
|  __st_memcpy_st__(dst, src, sgde->length);
|  dst += sgde->length;
|  sgde = sg_next(sgde);
| }
|}
|
|static void
|lpfc_debug_save_dif(struct lpfc_hba *phba, struct scsi_cmnd *cmnd)
|{
| void *src, *dst;
| struct scatterlist *sgde = scsi_prot_sglist(cmnd);
|
| if (!_dump_buf_dif) {
|  do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000200) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "9052 BLKGRD: ERROR %s _dump_buf_data is NULL\n", phba->brd_no, __func__); } } while (0)
|
|             ;
|  return;
| }
|
| if (!sgde) {
|  do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000200) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "9053 BLKGRD: ERROR: prot scatterlist is null\n", phba->brd_no); } } while (0)
|                                                    ;
|  return;
| }
|
| dst = _dump_buf_dif;
| while (sgde) {
|  src = sg_virt(sgde);
|  __st_memcpy_st__(dst, src, sgde->length);
|  dst += sgde->length;
|  sgde = sg_next(sgde);
| }
|}
|static void
|lpfc_sli4_set_rsp_sgl_last(struct lpfc_hba *phba,
|    struct lpfc_scsi_buf *lpfc_cmd)
|{
| struct sli4_sge *sgl = (struct sli4_sge *)lpfc_cmd->fcp_bpl;
| if (sgl) {
|  sgl += 1;
|  sgl->word2 = (( __u32)(__le32)(sgl->word2));
|  ((sgl)->word2 = ((((1) & 0x00000001) << 31) | ((sgl)->word2 & ~(0x00000001 << 31))));
|  sgl->word2 = (( __le32)(__u32)(sgl->word2));
| }
|}
|static void
|lpfc_update_stats(struct lpfc_hba *phba, struct lpfc_scsi_buf *lpfc_cmd)
|{
| struct lpfc_rport_data *rdata = lpfc_cmd->rdata;
| struct lpfc_nodelist *pnode = rdata->pnode;
| struct scsi_cmnd *cmd = lpfc_cmd->pCmd;
| unsigned long flags;
| struct Scsi_Host *shost = cmd->device->host;
| struct lpfc_vport *vport = (struct lpfc_vport *) shost->hostdata;
| unsigned long latency;
| int i;
|
| if (cmd->result)
|  return;
|
| latency = jiffies_to_msecs((long)jiffies - (long)lpfc_cmd->start_time);
|
| __st_spin_lock_irqsave_st__(shost->host_lock, flags);
| if (!vport->stat_data_enabled ||
|  vport->stat_data_blocked ||
|  !pnode ||
|  !pnode->lat_data ||
|  (phba->bucket_type == 0)) {
|  __st_spin_unlock_irqrestore_st__(shost->host_lock, flags);
|  return;
| }
|
| if (phba->bucket_type == 1) {
|  i = (latency + phba->bucket_step - 1 - phba->bucket_base)/
|   phba->bucket_step;
|
|  if (i < 0)
|   i = 0;
|  else if (i >= 20)
|   i = 20 - 1;
| } else {
|  for (i = 0; i < 20 -1; i++)
|   if (latency <= (phba->bucket_base +
|    ((1<bucket_step)))
|    break;
| }
|
| pnode->lat_data[i].cmd_count++;
| __st_spin_unlock_irqrestore_st__(shost->host_lock, flags);
|}
|static void
|lpfc_send_sdev_queuedepth_change_event(struct lpfc_hba *phba,
|  struct lpfc_vport *vport,
|  struct lpfc_nodelist *ndlp,
|  uint32_t lun,
|  uint32_t old_val,
|  uint32_t new_val)
|{
| struct lpfc_fast_path_event *fast_path_evt;
| unsigned long flags;
|
| fast_path_evt = lpfc_alloc_fast_evt(phba);
| if (!fast_path_evt)
|  return;
|
| fast_path_evt->un.queue_depth_evt.scsi_event.event_type =
|  0x0200;
| fast_path_evt->un.queue_depth_evt.scsi_event.subcategory =
|  0x0040;
|
|
| fast_path_evt->un.queue_depth_evt.scsi_event.lun = lun;
| if (ndlp && (((ndlp)->nlp_usg_map & 0x1) && !((ndlp)->nlp_usg_map & 0x8))) {
|  __st_memcpy_st__(&fast_path_evt->un.queue_depth_evt.scsi_event.wwpn,
|   &ndlp->nlp_portname, sizeof(struct lpfc_name));
|  __st_memcpy_st__(&fast_path_evt->un.queue_depth_evt.scsi_event.wwnn,
|   &ndlp->nlp_nodename, sizeof(struct lpfc_name));
| }
|
| fast_path_evt->un.queue_depth_evt.oldval = old_val;
| fast_path_evt->un.queue_depth_evt.newval = new_val;
| fast_path_evt->vport = vport;
|
| fast_path_evt->work_evt.evt = LPFC_EVT_FASTPATH_MGMT_EVT;
| __st_spin_lock_irqsave_st__(&phba->hbalock, flags);
| list_add_tail(&fast_path_evt->work_evt.evt_listp, &phba->work_list);
| __st_spin_unlock_irqrestore_st__(&phba->hbalock, flags);
| lpfc_worker_wake_up(phba);
|
| return;
|}
|int
|lpfc_change_queue_depth(struct scsi_device *sdev, int qdepth, int reason)
|{
| struct lpfc_vport *vport = (struct lpfc_vport *) sdev->host->hostdata;
| struct lpfc_hba *phba = vport->phba;
| struct lpfc_rport_data *rdata;
| unsigned long new_queue_depth, old_queue_depth;
|
| old_queue_depth = sdev->queue_depth;
| scsi_adjust_queue_depth(sdev, scsi_get_tag_type(sdev), qdepth);
| new_queue_depth = sdev->queue_depth;
| rdata = sdev->hostdata;
| if (rdata)
|  lpfc_send_sdev_queuedepth_change_event(phba, vport,
|             rdata->pnode, sdev->lun,
|             old_queue_depth,
|             new_queue_depth);
| return sdev->queue_depth;
|}
|void
|lpfc_rampdown_queue_depth(struct lpfc_hba *phba)
|{
| unsigned long flags;
| uint32_t evt_posted;
|
| __st_spin_lock_irqsave_st__(&phba->hbalock, flags);
| atomic_inc(&phba->num_rsrc_err);
| phba->last_rsrc_error_time = jiffies;
|
| if ((phba->last_ramp_down_time + (1 * 250)) > jiffies) {
|  __st_spin_unlock_irqrestore_st__(&phba->hbalock, flags);
|  return;
| }
|
| phba->last_ramp_down_time = jiffies;
|
| __st_spin_unlock_irqrestore_st__(&phba->hbalock, flags);
|
| __st_spin_lock_irqsave_st__(&phba->pport->work_port_lock, flags);
| evt_posted = phba->pport->work_port_events & 0x800;
| if (!evt_posted)
|  phba->pport->work_port_events |= 0x800;
| __st_spin_unlock_irqrestore_st__(&phba->pport->work_port_lock, flags);
|
| if (!evt_posted)
|  lpfc_worker_wake_up(phba);
| return;
|}
|static inline void
|lpfc_rampup_queue_depth(struct lpfc_vport *vport,
|   uint32_t queue_depth)
|{
| unsigned long flags;
| struct lpfc_hba *phba = vport->phba;
| uint32_t evt_posted;
| atomic_inc(&phba->num_cmd_success);
|
| if (vport->cfg_lun_queue_depth <= queue_depth)
|  return;
| __st_spin_lock_irqsave_st__(&phba->hbalock, flags);
| if ((({ unsigned long __dummy; typeof(phba->last_ramp_up_time + (300 * 250)) __dummy2; (void)(&__dummy == &__dummy2); 1; }) && ({ unsigned long __dummy; typeof(jiffies) __dummy2; (void)(&__dummy == &__dummy2); 1; }) && ((long)(jiffies) - (long)(phba->last_ramp_up_time + (300 * 250)) < 0))
|                                                     ||
|     (({ unsigned long __dummy; typeof(phba->last_rsrc_error_time + (300 * 250)) __dummy2; (void)(&__dummy == &__dummy2); 1; }) && ({ unsigned long __dummy; typeof(jiffies) __dummy2; (void)(&__dummy == &__dummy2); 1; }) && ((long)(jiffies) - (long)(phba->last_rsrc_error_time + (300 * 250)) < 0))
|                                                       ) {
|  __st_spin_unlock_irqrestore_st__(&phba->hbalock, flags);
|  return;
| }
| phba->last_ramp_up_time = jiffies;
| __st_spin_unlock_irqrestore_st__(&phba->hbalock, flags);
|
| __st_spin_lock_irqsave_st__(&phba->pport->work_port_lock, flags);
| evt_posted = phba->pport->work_port_events & 0x1000;
| if (!evt_posted)
|  phba->pport->work_port_events |= 0x1000;
| __st_spin_unlock_irqrestore_st__(&phba->pport->work_port_lock, flags);
|
| if (!evt_posted)
|  lpfc_worker_wake_up(phba);
| return;
|}
|void
|lpfc_ramp_down_queue_handler(struct lpfc_hba *phba)
|{
| struct lpfc_vport **vports;
| struct Scsi_Host *shost;
| struct scsi_device *sdev;
| unsigned long new_queue_depth;
| unsigned long num_rsrc_err, num_cmd_success;
| int i;
|
| num_rsrc_err = atomic_read(&phba->num_rsrc_err);
| num_cmd_success = atomic_read(&phba->num_cmd_success);
|
| vports = lpfc_create_vport_work_array(phba);
| if (vports != ((void *)0))
|  for (i = 0; i <= phba->max_vports && vports[i] != ((void *)0); i++) {
|   shost = lpfc_shost_from_vport(vports[i]);
|   for ((sdev) = __scsi_iterate_devices((shost), ((void *)0)); (sdev); (sdev) = __scsi_iterate_devices((shost), (sdev))) {
|    new_queue_depth =
|     sdev->queue_depth * num_rsrc_err /
|     (num_rsrc_err + num_cmd_success);
|    if (!new_queue_depth)
|     new_queue_depth = sdev->queue_depth - 1;
|    else
|     new_queue_depth = sdev->queue_depth -
|        new_queue_depth;
|    lpfc_change_queue_depth(sdev, new_queue_depth,
|       SCSI_QDEPTH_DEFAULT);
|   }
|  }
| lpfc_destroy_vport_work_array(phba, vports);
| atomic_set(&phba->num_rsrc_err, 0);
| atomic_set(&phba->num_cmd_success, 0);
|}
|void
|lpfc_ramp_up_queue_handler(struct lpfc_hba *phba)
|{
| struct lpfc_vport **vports;
| struct Scsi_Host *shost;
| struct scsi_device *sdev;
| int i;
|
| vports = lpfc_create_vport_work_array(phba);
| if (vports != ((void *)0))
|  for (i = 0; i <= phba->max_vports && vports[i] != ((void *)0); i++) {
|   shost = lpfc_shost_from_vport(vports[i]);
|   for ((sdev) = __scsi_iterate_devices((shost), ((void *)0)); (sdev); (sdev) = __scsi_iterate_devices((shost), (sdev))) {
|    if (vports[i]->cfg_lun_queue_depth <=
|        sdev->queue_depth)
|     continue;
|    lpfc_change_queue_depth(sdev,
|       sdev->queue_depth+1,
|       SCSI_QDEPTH_RAMP_UP);
|   }
|  }
| lpfc_destroy_vport_work_array(phba, vports);
| atomic_set(&phba->num_rsrc_err, 0);
| atomic_set(&phba->num_cmd_success, 0);
|}
|void
|lpfc_scsi_dev_block(struct lpfc_hba *phba)
|{
| struct lpfc_vport **vports;
| struct Scsi_Host *shost;
| struct scsi_device *sdev;
| struct fc_rport *rport;
| int i;
|
| vports = lpfc_create_vport_work_array(phba);
| if (vports != ((void *)0))
|  for (i = 0; i <= phba->max_vports && vports[i] != ((void *)0); i++) {
|   shost = lpfc_shost_from_vport(vports[i]);
|   for ((sdev) = __scsi_iterate_devices((shost), ((void *)0)); (sdev); (sdev) = __scsi_iterate_devices((shost), (sdev))) {
|    rport = scsi_is_fc_rport(scsi_target(sdev)->dev.parent) ? ({ const typeof( ((struct fc_rport *)0)->dev ) *__mptr = (scsi_target(sdev)->dev.parent); (struct fc_rport *)( (char *)__mptr - 1 );}) : ((void *)0);
|    fc_remote_port_delete(rport);
|   }
|  }
| lpfc_destroy_vport_work_array(phba, vports);
|}
|static int
|lpfc_new_scsi_buf_s3(struct lpfc_vport *vport, int num_to_alloc)
|{
| struct lpfc_hba *phba = vport->phba;
| struct lpfc_scsi_buf *psb;
| struct ulp_bde64 *bpl;
| IOCB_t *iocb;
| dma_addr_t pdma_phys_fcp_cmd;
| dma_addr_t pdma_phys_fcp_rsp;
| dma_addr_t pdma_phys_bpl;
| uint16_t iotag;
| int bcnt;
|
| for (bcnt = 0; bcnt < num_to_alloc; bcnt++) {
|  psb = kzalloc(sizeof(struct lpfc_scsi_buf), __st_GFP_KERNEL_st__);
|  if (!psb)
|   break;
|
|
|
|
|
|
|
|  psb->data = dma_pool_alloc(phba->lpfc_scsi_dma_buf_pool, __st_GFP_KERNEL_st__, &psb->dma_handle)
|                                            ;
|  if (!psb->data) {
|   kfree(psb);
|   break;
|  }
|
|
|  __st_memset_st__(psb->data, 0, phba->cfg_sg_dma_buf_size);
|
|
|  iotag = lpfc_sli_next_iotag(phba, &psb->cur_iocbq);
|  if (iotag == 0) {
|   dma_pool_free(phba->lpfc_scsi_dma_buf_pool, psb->data, psb->dma_handle)
|                                ;
|   kfree(psb);
|   break;
|  }
|  psb->cur_iocbq.iocb_flag |= 4;
|
|  psb->fcp_cmnd = psb->data;
|  psb->fcp_rsp = psb->data + sizeof(struct fcp_cmnd);
|  psb->fcp_bpl = psb->data + sizeof(struct fcp_cmnd) +
|   sizeof(struct fcp_rsp);
|
|
|  bpl = psb->fcp_bpl;
|  pdma_phys_fcp_cmd = psb->dma_handle;
|  pdma_phys_fcp_rsp = psb->dma_handle + sizeof(struct fcp_cmnd);
|  pdma_phys_bpl = psb->dma_handle + sizeof(struct fcp_cmnd) +
|   sizeof(struct fcp_rsp);
|
|
|
|
|
|
|  bpl[0].addrHigh = (( __u32)(__le32)(((uint32_t) (0xffffffff & (((u64)(pdma_phys_fcp_cmd))>>32)))));
|  bpl[0].addrLow = (( __u32)(__le32)(((uint32_t) (0xffffffff & (u64)(pdma_phys_fcp_cmd)))));
|  bpl[0].tus.f.bdeSize = sizeof(struct fcp_cmnd);
|  bpl[0].tus.f.bdeFlags = 0x00;
|  bpl[0].tus.w = (( __u32)(__le32)(bpl[0].tus.w));
|
|
|  bpl[1].addrHigh = (( __u32)(__le32)(((uint32_t) (0xffffffff & (((u64)(pdma_phys_fcp_rsp))>>32)))));
|  bpl[1].addrLow = (( __u32)(__le32)(((uint32_t) (0xffffffff & (u64)(pdma_phys_fcp_rsp)))));
|  bpl[1].tus.f.bdeSize = sizeof(struct fcp_rsp);
|  bpl[1].tus.f.bdeFlags = 0x00;
|  bpl[1].tus.w = (( __u32)(__le32)(bpl[1].tus.w));
|
|
|
|
|
|  iocb = &psb->cur_iocbq.iocb;
|  iocb->un.fcpi64.bdl.ulpIoTag32 = 0;
|  if ((phba->sli_rev == 3) &&
|    !(phba->sli3_options & 0x20)) {
|
|   iocb->un.fcpi64.bdl.bdeFlags = 0x01;
|   iocb->un.fcpi64.bdl.bdeSize = sizeof(struct fcp_cmnd);
|   iocb->un.fcpi64.bdl.addrLow = 1
|                        ;
|   iocb->un.fcpi64.bdl.addrHigh = 0;
|   iocb->ulpBdeCount = 0;
|   iocb->ulpLe = 0;
|
|   iocb->unsli3.fcp_ext.rbde.tus.f.bdeFlags =
|       0x00;
|   iocb->unsli3.fcp_ext.rbde.tus.f.bdeSize =
|    sizeof(struct fcp_rsp);
|   iocb->unsli3.fcp_ext.rbde.addrLow =
|    ((uint32_t) (0xffffffff & (u64)(pdma_phys_fcp_rsp)));
|   iocb->unsli3.fcp_ext.rbde.addrHigh =
|    ((uint32_t) (0xffffffff & (((u64)(pdma_phys_fcp_rsp))>>32)));
|  } else {
|   iocb->un.fcpi64.bdl.bdeFlags = 0x40;
|   iocb->un.fcpi64.bdl.bdeSize =
|     (2 * sizeof(struct ulp_bde64));
|   iocb->un.fcpi64.bdl.addrLow =
|     ((uint32_t) (0xffffffff & (u64)(pdma_phys_bpl)));
|   iocb->un.fcpi64.bdl.addrHigh =
|     ((uint32_t) (0xffffffff & (((u64)(pdma_phys_bpl))>>32)));
|   iocb->ulpBdeCount = 1;
|   iocb->ulpLe = 1;
|  }
|  iocb->ulpClass = 2;
|  psb->status = 0x0;
|
|  psb->cur_iocbq.context1 = psb;
|  lpfc_release_scsi_buf_s3(phba, psb);
|
| }
|
| return bcnt;
|}
|void
|lpfc_sli4_fcp_xri_aborted(struct lpfc_hba *phba,
|     struct sli4_wcqe_xri_aborted *axri)
|{
| uint16_t xri = (((axri)->word2 >> 0) & 0x0000FFFF);
| struct lpfc_scsi_buf *psb, *next_psb;
| unsigned long iflag = 0;
| struct lpfc_iocbq *iocbq;
| int i;
| struct lpfc_sli_ring *pring = &phba->sli.ring[2];
|
| __st_spin_lock_irqsave_st__(&phba->hbalock, iflag);
| __st_spin_lock_st__(&phba->sli4_hba.abts_scsi_buf_list_lock);
| for (psb = ({ const typeof( ((typeof(*psb) *)0)->list ) *__mptr = ((&phba->sli4_hba.lpfc_abts_scsi_buf_list)->next); (typeof(*psb) *)( (char *)__mptr - 1 );}), next_psb = ({ const typeof( ((typeof(*psb) *)0)->list ) *__mptr = (psb->list.next); (typeof(*psb) *)( (char *)__mptr - 1 );}); &psb->list != (&phba->sli4_hba.lpfc_abts_scsi_buf_list); psb = next_psb, next_psb = ({ const typeof( ((typeof(*next_psb) *)0)->list ) *__mptr = (next_psb->list.next); (typeof(*next_psb) *)( (char *)__mptr - 1 );}))
|                                                 {
|  if (psb->cur_iocbq.sli4_xritag == xri) {
|   list_del(&psb->list);
|   psb->exch_busy = 0;
|   psb->status = 0x0;
|   __st_spin_unlock_st__(
|    &phba->sli4_hba.abts_scsi_buf_list_lock);
|   __st_spin_unlock_irqrestore_st__(&phba->hbalock, iflag);
|   lpfc_release_scsi_buf_s4(phba, psb);
|   return;
|  }
| }
| __st_spin_unlock_st__(&phba->sli4_hba.abts_scsi_buf_list_lock);
| for (i = 1; i <= phba->sli.last_iotag; i++) {
|  iocbq = phba->sli.iocbq_lookup[i];
|
|  if (!(iocbq->iocb_flag & 4) ||
|   (iocbq->iocb_flag & 1))
|   continue;
|  if (iocbq->sli4_xritag != xri)
|   continue;
|  psb = ({ const typeof( ((struct lpfc_scsi_buf *)0)->cur_iocbq ) *__mptr = (iocbq); (struct lpfc_scsi_buf *)( (char *)__mptr - 1 );});
|  psb->exch_busy = 0;
|  __st_spin_unlock_irqrestore_st__(&phba->hbalock, iflag);
|  if (pring->txq_cnt)
|   lpfc_worker_wake_up(phba);
|  return;
|
| }
| __st_spin_unlock_irqrestore_st__(&phba->hbalock, iflag);
|}
|int
|lpfc_sli4_repost_scsi_sgl_list(struct lpfc_hba *phba)
|{
| struct lpfc_scsi_buf *psb;
| int index, status, bcnt = 0, rcnt = 0, rc = 0;
| struct list_head sblist = { &(sblist), &(sblist) };
|
| for (index = 0; index < phba->sli4_hba.scsi_xri_cnt; index++) {
|  psb = phba->sli4_hba.lpfc_scsi_psb_array[index];
|  if (psb) {
|
|   list_del(&psb->list);
|
|   list_add_tail(&psb->list, &sblist);
|   if (++rcnt == 254) {
|    bcnt = rcnt;
|    rcnt = 0;
|   }
|  } else
|
|   bcnt = rcnt;
|
|  if (index == phba->sli4_hba.scsi_xri_cnt - 1)
|
|   bcnt = rcnt;
|
|
|  if (bcnt == 0)
|   continue;
|
|  status = lpfc_sli4_post_scsi_sgl_block(phba, &sblist, bcnt);
|
|  bcnt = 0;
|  while (!list_empty(&sblist)) {
|   do { psb = ((void *)0); if (!list_empty(&sblist)) { psb = ({ const typeof( ((struct lpfc_scsi_buf *)0)->list ) *__mptr = ((&sblist)->next); (struct lpfc_scsi_buf *)( (char *)__mptr - 1 );}); list_del_init(&psb->list); } } while(0)
|           ;
|   if (status) {
|
|    psb->exch_busy = 1;
|    rc++;
|   } else {
|    psb->exch_busy = 0;
|    psb->status = 0x0;
|   }
|
|   lpfc_release_scsi_buf_s4(phba, psb);
|  }
| }
| return rc;
|}
|static int
|lpfc_new_scsi_buf_s4(struct lpfc_vport *vport, int num_to_alloc)
|{
| struct lpfc_hba *phba = vport->phba;
| struct lpfc_scsi_buf *psb;
| struct sli4_sge *sgl;
| IOCB_t *iocb;
| dma_addr_t pdma_phys_fcp_cmd;
| dma_addr_t pdma_phys_fcp_rsp;
| dma_addr_t pdma_phys_bpl, pdma_phys_bpl1;
| uint16_t iotag, last_xritag = ((uint16_t)-1);
| int status = 0, index;
| int bcnt;
| int non_sequential_xri = 0;
| struct list_head sblist = { &(sblist), &(sblist) };
|
| for (bcnt = 0; bcnt < num_to_alloc; bcnt++) {
|  psb = kzalloc(sizeof(struct lpfc_scsi_buf), __st_GFP_KERNEL_st__);
|  if (!psb)
|   break;
|
|
|
|
|
|
|
|  psb->data = dma_pool_alloc(phba->lpfc_scsi_dma_buf_pool, __st_GFP_KERNEL_st__, &psb->dma_handle)
|                                             ;
|  if (!psb->data) {
|   kfree(psb);
|   break;
|  }
|
|
|  __st_memset_st__(psb->data, 0, phba->cfg_sg_dma_buf_size);
|
|
|  iotag = lpfc_sli_next_iotag(phba, &psb->cur_iocbq);
|  if (iotag == 0) {
|   dma_pool_free(phba->lpfc_scsi_dma_buf_pool, psb->data, psb->dma_handle)
|                               ;
|   kfree(psb);
|   break;
|  }
|
|  psb->cur_iocbq.sli4_xritag = lpfc_sli4_next_xritag(phba);
|  if (psb->cur_iocbq.sli4_xritag == ((uint16_t)-1)) {
|   dma_pool_free(phba->lpfc_scsi_dma_buf_pool, psb->data, psb->dma_handle)
|                                    ;
|   kfree(psb);
|   break;
|  }
|  if (last_xritag != ((uint16_t)-1)
|   && psb->cur_iocbq.sli4_xritag != (last_xritag+1)) {
|   non_sequential_xri = 1;
|  } else
|   list_add_tail(&psb->list, &sblist);
|  last_xritag = psb->cur_iocbq.sli4_xritag;
|
|  index = phba->sli4_hba.scsi_xri_cnt++;
|  psb->cur_iocbq.iocb_flag |= 4;
|
|  psb->fcp_bpl = psb->data;
|  psb->fcp_cmnd = (psb->data + phba->cfg_sg_dma_buf_size)
|   - (sizeof(struct fcp_cmnd) + sizeof(struct fcp_rsp));
|  psb->fcp_rsp = (struct fcp_rsp *)((uint8_t *)psb->fcp_cmnd +
|     sizeof(struct fcp_cmnd));
|
|
|  sgl = (struct sli4_sge *)psb->fcp_bpl;
|  pdma_phys_bpl = psb->dma_handle;
|  pdma_phys_fcp_cmd =
|   (psb->dma_handle + phba->cfg_sg_dma_buf_size)
|    - (sizeof(struct fcp_cmnd) + sizeof(struct fcp_rsp));
|  pdma_phys_fcp_rsp = pdma_phys_fcp_cmd + sizeof(struct fcp_cmnd);
|
|
|
|
|
|
|  sgl->addr_hi = (( __le32)(__u32)(((uint32_t) (0xffffffff & (((u64)(pdma_phys_fcp_cmd))>>32)))));
|  sgl->addr_lo = (( __le32)(__u32)(((uint32_t) (0xffffffff & (u64)(pdma_phys_fcp_cmd)))));
|  ((sgl)->word2 = ((((0) & 0x00000001) << 31) | ((sgl)->word2 & ~(0x00000001 << 31))));
|  sgl->word2 = (( __le32)(__u32)(sgl->word2));
|  sgl->sge_len = (( __le32)(__u32)(sizeof(struct fcp_cmnd)));
|  sgl++;
|
|
|  sgl->addr_hi = (( __le32)(__u32)(((uint32_t) (0xffffffff & (((u64)(pdma_phys_fcp_rsp))>>32)))));
|  sgl->addr_lo = (( __le32)(__u32)(((uint32_t) (0xffffffff & (u64)(pdma_phys_fcp_rsp)))));
|  ((sgl)->word2 = ((((1) & 0x00000001) << 31) | ((sgl)->word2 & ~(0x00000001 << 31))));
|  sgl->word2 = (( __le32)(__u32)(sgl->word2));
|  sgl->sge_len = (( __le32)(__u32)(sizeof(struct fcp_rsp)));
|
|
|
|
|
|  iocb = &psb->cur_iocbq.iocb;
|  iocb->un.fcpi64.bdl.ulpIoTag32 = 0;
|  iocb->un.fcpi64.bdl.bdeFlags = 0x00;
|
|
|
|
|  iocb->un.fcpi64.bdl.bdeSize = sizeof(struct fcp_cmnd);
|  iocb->un.fcpi64.bdl.addrLow = ((uint32_t) (0xffffffff & (u64)(pdma_phys_fcp_cmd)));
|  iocb->un.fcpi64.bdl.addrHigh = ((uint32_t) (0xffffffff & (((u64)(pdma_phys_fcp_cmd))>>32)));
|  iocb->ulpBdeCount = 1;
|  iocb->ulpLe = 1;
|  iocb->ulpClass = 2;
|  psb->cur_iocbq.context1 = psb;
|  if (phba->cfg_sg_dma_buf_size > 4096)
|   pdma_phys_bpl1 = pdma_phys_bpl + 4096;
|  else
|   pdma_phys_bpl1 = 0;
|  psb->dma_phys_bpl = pdma_phys_bpl;
|  phba->sli4_hba.lpfc_scsi_psb_array[index] = psb;
|  if (non_sequential_xri) {
|   status = lpfc_sli4_post_sgl(phba, pdma_phys_bpl,
|      pdma_phys_bpl1,
|      psb->cur_iocbq.sli4_xritag);
|   if (status) {
|
|    psb->exch_busy = 1;
|   } else {
|    psb->exch_busy = 0;
|    psb->status = 0x0;
|   }
|
|   lpfc_release_scsi_buf_s4(phba, psb);
|   break;
|  }
| }
| if (bcnt) {
|  status = lpfc_sli4_post_scsi_sgl_block(phba, &sblist, bcnt);
|
|  while (!list_empty(&sblist)) {
|   do { psb = ((void *)0); if (!list_empty(&sblist)) { psb = ({ const typeof( ((struct lpfc_scsi_buf *)0)->list ) *__mptr = ((&sblist)->next); (struct lpfc_scsi_buf *)( (char *)__mptr - 1 );}); list_del_init(&psb->list); } } while(0)
|          ;
|   if (status) {
|
|    psb->exch_busy = 1;
|   } else {
|    psb->exch_busy = 0;
|    psb->status = 0x0;
|   }
|
|   lpfc_release_scsi_buf_s4(phba, psb);
|  }
| }
|
| return bcnt + non_sequential_xri;
|}
|static inline int
|lpfc_new_scsi_buf(struct lpfc_vport *vport, int num_to_alloc)
|{
| return vport->phba->lpfc_new_scsi_buf(vport, num_to_alloc);
|}
|static struct lpfc_scsi_buf*
|lpfc_get_scsi_buf(struct lpfc_hba * phba)
|{
| struct lpfc_scsi_buf * lpfc_cmd = ((void *)0);
| struct list_head *scsi_buf_list = &phba->lpfc_scsi_buf_list;
| unsigned long iflag = 0;
|
| __st_spin_lock_irqsave_st__(&phba->scsi_buf_list_lock, iflag);
| do { lpfc_cmd = ((void *)0); if (!list_empty(scsi_buf_list)) { lpfc_cmd = ({ const typeof( ((struct lpfc_scsi_buf *)0)->list ) *__mptr = ((scsi_buf_list)->next); (struct lpfc_scsi_buf *)( (char *)__mptr - 1 );}); list_del_init(&lpfc_cmd->list); } } while(0);
| if (lpfc_cmd) {
|  lpfc_cmd->seg_cnt = 0;
|  lpfc_cmd->nonsg_phys = 0;
|  lpfc_cmd->prot_seg_cnt = 0;
| }
| __st_spin_unlock_irqrestore_st__(&phba->scsi_buf_list_lock, iflag);
| return lpfc_cmd;
|}
|static void
|lpfc_release_scsi_buf_s3(struct lpfc_hba *phba, struct lpfc_scsi_buf *psb)
|{
| unsigned long iflag = 0;
|
| __st_spin_lock_irqsave_st__(&phba->scsi_buf_list_lock, iflag);
| psb->pCmd = ((void *)0);
| list_add_tail(&psb->list, &phba->lpfc_scsi_buf_list);
| __st_spin_unlock_irqrestore_st__(&phba->scsi_buf_list_lock, iflag);
|}
|static void
|lpfc_release_scsi_buf_s4(struct lpfc_hba *phba, struct lpfc_scsi_buf *psb)
|{
| unsigned long iflag = 0;
|
| if (psb->exch_busy) {
|  __st_spin_lock_irqsave_st__(&phba->sli4_hba.abts_scsi_buf_list_lock,
|     iflag);
|  psb->pCmd = ((void *)0);
|  list_add_tail(&psb->list,
|   &phba->sli4_hba.lpfc_abts_scsi_buf_list);
|  __st_spin_unlock_irqrestore_st__(&phba->sli4_hba.abts_scsi_buf_list_lock,
|     iflag);
| } else {
|
|  __st_spin_lock_irqsave_st__(&phba->scsi_buf_list_lock, iflag);
|  psb->pCmd = ((void *)0);
|  list_add_tail(&psb->list, &phba->lpfc_scsi_buf_list);
|  __st_spin_unlock_irqrestore_st__(&phba->scsi_buf_list_lock, iflag);
| }
|}
|static void
|lpfc_release_scsi_buf(struct lpfc_hba *phba, struct lpfc_scsi_buf *psb)
|{
|
| phba->lpfc_release_scsi_buf(phba, psb);
|}
|static int
|lpfc_scsi_prep_dma_buf_s3(struct lpfc_hba *phba, struct lpfc_scsi_buf *lpfc_cmd)
|{
| struct scsi_cmnd *scsi_cmnd = lpfc_cmd->pCmd;
| struct scatterlist *sgel = ((void *)0);
| struct fcp_cmnd *fcp_cmnd = lpfc_cmd->fcp_cmnd;
| struct ulp_bde64 *bpl = lpfc_cmd->fcp_bpl;
| struct lpfc_iocbq *iocbq = &lpfc_cmd->cur_iocbq;
| IOCB_t *iocb_cmd = &lpfc_cmd->cur_iocbq.iocb;
| struct ulp_bde64 *data_bde = iocb_cmd->unsli3.fcp_ext.dbde;
| dma_addr_t physaddr;
| uint32_t num_bde = 0;
| int nseg, datadir = scsi_cmnd->sc_data_direction;
|
|
|
|
|
|
|
| bpl += 2;
| if (scsi_sg_count(scsi_cmnd)) {
|
|
|
|
|
|
|
|  nseg = dma_map_sg_attrs(&phba->pcidev->dev, scsi_sglist(scsi_cmnd), scsi_sg_count(scsi_cmnd), datadir, ((void *)0))
|                                        ;
|  if (!nseg)
|   return 1;
|
|  lpfc_cmd->seg_cnt = nseg;
|  if (lpfc_cmd->seg_cnt > phba->cfg_sg_seg_cnt) {
|   do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000200) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "9064 BLKGRD: %s: Too many sg segments from " "dma_map_sg.  Config %d, seg_cnt %d\n", phba->brd_no, __func__, phba->cfg_sg_seg_cnt, lpfc_cmd->seg_cnt); } } while (0)
|
|
|
|                            ;
|   scsi_dma_unmap(scsi_cmnd);
|   return 1;
|  }
|  for (num_bde = 0, sgel = (scsi_sglist(scsi_cmnd)); num_bde < (nseg); num_bde++, sgel = sg_next(sgel)) {
|   physaddr = ((sgel)->dma_address);
|   if (phba->sli_rev == 3 &&
|       !(phba->sli3_options & 0x20) &&
|       !(iocbq->iocb_flag & 0x100) &&
|       nseg <= 3) {
|    data_bde->tus.f.bdeFlags = 0x00;
|    data_bde->tus.f.bdeSize = ((sgel)->dma_length);
|    data_bde->addrLow = ((uint32_t) (0xffffffff & (u64)(physaddr)));
|    data_bde->addrHigh = ((uint32_t) (0xffffffff & (((u64)(physaddr))>>32)));
|    data_bde++;
|   } else {
|    bpl->tus.f.bdeFlags = 0x00;
|    bpl->tus.f.bdeSize = ((sgel)->dma_length);
|    bpl->tus.w = (( __u32)(__le32)(bpl->tus.w));
|    bpl->addrLow =
|     (( __u32)(__le32)(((uint32_t) (0xffffffff & (u64)(physaddr)))));
|    bpl->addrHigh =
|     (( __u32)(__le32)(((uint32_t) (0xffffffff & (((u64)(physaddr))>>32)))));
|    bpl++;
|   }
|  }
| }
|
|
|
|
|
|
|
| if (phba->sli_rev == 3 &&
|     !(phba->sli3_options & 0x20) &&
|     !(iocbq->iocb_flag & 0x100)) {
|  if (num_bde > 3) {
|
|
|
|
|
|   physaddr = lpfc_cmd->dma_handle;
|   data_bde->tus.f.bdeFlags = 0x40;
|   data_bde->tus.f.bdeSize = (num_bde *
|         sizeof(struct ulp_bde64));
|   physaddr += (sizeof(struct fcp_cmnd) +
|         sizeof(struct fcp_rsp) +
|         (2 * sizeof(struct ulp_bde64)));
|   data_bde->addrHigh = ((uint32_t) (0xffffffff & (((u64)(physaddr))>>32)));
|   data_bde->addrLow = ((uint32_t) (0xffffffff & (u64)(physaddr)));
|
|   iocb_cmd->unsli3.fcp_ext.ebde_count = 2;
|  } else {
|
|   iocb_cmd->unsli3.fcp_ext.ebde_count = (num_bde + 1);
|  }
| } else {
|  iocb_cmd->un.fcpi64.bdl.bdeSize =
|   ((num_bde + 2) * sizeof(struct ulp_bde64));
|  iocb_cmd->unsli3.fcp_ext.ebde_count = (num_bde + 1);
| }
| fcp_cmnd->fcpDl = (( __be32)(__builtin_constant_p((__u32)((scsi_bufflen(scsi_cmnd)))) ? ((__u32)( (((__u32)((scsi_bufflen(scsi_cmnd))) & (__u32)0x000000ffUL) << 24) | (((__u32)((scsi_bufflen(scsi_cmnd))) & (__u32)0x0000ff00UL) << 8) | (((__u32)((scsi_bufflen(scsi_cmnd))) & (__u32)0x00ff0000UL) >> 8) | (((__u32)((scsi_bufflen(scsi_cmnd))) & (__u32)0xff000000UL) >> 24))) : __fswab32((scsi_bufflen(scsi_cmnd)))));
|
|
|
|
|
| iocb_cmd->un.fcpi.fcpi_parm = scsi_bufflen(scsi_cmnd);
| return 0;
|}
|static int
|lpfc_sc_to_bg_opcodes(struct lpfc_hba *phba, struct scsi_cmnd *sc,
|  uint8_t *txop, uint8_t *rxop)
|{
| uint8_t guard_type = scsi_host_get_guard(sc->device->host);
| uint8_t ret = 0;
|
| if (guard_type == SHOST_DIX_GUARD_IP) {
|  switch (scsi_get_prot_op(sc)) {
|  case SCSI_PROT_READ_INSERT:
|  case SCSI_PROT_WRITE_STRIP:
|   *txop = 0x3;
|   *rxop = 0x2;
|   break;
|
|  case SCSI_PROT_READ_STRIP:
|  case SCSI_PROT_WRITE_INSERT:
|   *txop = 0x0;
|   *rxop = 0x1;
|   break;
|
|  case SCSI_PROT_READ_PASS:
|  case SCSI_PROT_WRITE_PASS:
|   *txop = 0x7;
|   *rxop = 0x6;
|   break;
|
|  case SCSI_PROT_NORMAL:
|  default:
|   do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000200) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "9063 BLKGRD: Bad op/guard:%d/%d combination\n", phba->brd_no, scsi_get_prot_op(sc), guard_type); } } while (0)
|
|                                      ;
|   ret = 1;
|   break;
|
|  }
| } else if (guard_type == SHOST_DIX_GUARD_CRC) {
|  switch (scsi_get_prot_op(sc)) {
|  case SCSI_PROT_READ_STRIP:
|  case SCSI_PROT_WRITE_INSERT:
|   *txop = 0x0;
|   *rxop = 0x1;
|   break;
|
|  case SCSI_PROT_READ_PASS:
|  case SCSI_PROT_WRITE_PASS:
|   *txop = 0x4;
|   *rxop = 0x4;
|   break;
|
|  case SCSI_PROT_READ_INSERT:
|  case SCSI_PROT_WRITE_STRIP:
|  case SCSI_PROT_NORMAL:
|  default:
|   do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000200) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "9075 BLKGRD: Bad op/guard:%d/%d combination\n", phba->brd_no, scsi_get_prot_op(sc), guard_type); } } while (0)
|
|                                      ;
|   ret = 1;
|   break;
|  }
| } else {
|
|  __st_BUG_st__();
| }
|
| return ret;
|}
|
|struct scsi_dif_tuple {
| __be16 guard_tag;
| __be16 app_tag;
| __be32 ref_tag;
|};
|
|static inline unsigned
|lpfc_cmd_blksize(struct scsi_cmnd *sc)
|{
| return sc->device->sector_size;
|}
|static inline void
|lpfc_get_cmd_dif_parms(struct scsi_cmnd *sc, uint16_t *apptagmask,
|  uint16_t *apptagval, uint32_t *reftag)
|{
| struct scsi_dif_tuple *spt;
| unsigned char op = scsi_get_prot_op(sc);
| unsigned int protcnt = scsi_prot_sg_count(sc);
| static int cnt;
|
| if (protcnt && (op == SCSI_PROT_WRITE_STRIP ||
|    op == SCSI_PROT_WRITE_PASS)) {
|
|  cnt++;
|  spt = lowmem_page_address(sg_page(scsi_prot_sglist(sc))) +
|   scsi_prot_sglist(sc)[0].offset;
|  *apptagmask = 0;
|  *apptagval = 0;
|  *reftag = (( __be32)(__builtin_constant_p((__u32)((spt->ref_tag))) ? ((__u32)( (((__u32)((spt->ref_tag)) & (__u32)0x000000ffUL) << 24) | (((__u32)((spt->ref_tag)) & (__u32)0x0000ff00UL) << 8) | (((__u32)((spt->ref_tag)) & (__u32)0x00ff0000UL) >> 8) | (((__u32)((spt->ref_tag)) & (__u32)0xff000000UL) >> 24))) : __fswab32((spt->ref_tag))));
|
| } else {
|
|  *reftag = (uint32_t) (0xffffffff & scsi_get_lba(sc));
|  *apptagmask = 0;
|  *apptagval = 0;
| }
|}
|static int
|lpfc_bg_setup_bpl(struct lpfc_hba *phba, struct scsi_cmnd *sc,
|  struct ulp_bde64 *bpl, int datasegcnt)
|{
| struct scatterlist *sgde = ((void *)0);
| struct lpfc_pde5 *pde5 = ((void *)0);
| struct lpfc_pde6 *pde6 = ((void *)0);
| dma_addr_t physaddr;
| int i = 0, num_bde = 0, status;
| int datadir = sc->sc_data_direction;
| unsigned blksize;
| uint32_t reftag;
| uint16_t apptagmask, apptagval;
| uint8_t txop, rxop;
|
| status = lpfc_sc_to_bg_opcodes(phba, sc, &txop, &rxop);
| if (status)
|  goto out;
|
|
| blksize = lpfc_cmd_blksize(sc);
| lpfc_get_cmd_dif_parms(sc, &apptagmask, &apptagval, &reftag);
|
|
| pde5 = (struct lpfc_pde5 *) bpl;
| __st_memset_st__(pde5, 0, sizeof(struct lpfc_pde5));
| ((pde5)->word0 = ((((0x85) & 0x000000ff) << 24) | ((pde5)->word0 & ~(0x000000ff << 24))));
| pde5->reftag = reftag;
|
|
| pde5->word0 = (( __le32)(__u32)(pde5->word0));
| pde5->reftag = (( __le32)(__u32)(pde5->reftag));
|
|
| num_bde++;
| bpl++;
| pde6 = (struct lpfc_pde6 *) bpl;
|
|
| __st_memset_st__(pde6, 0, sizeof(struct lpfc_pde6));
| ((pde6)->word0 = ((((0x86) & 0x000000ff) << 24) | ((pde6)->word0 & ~(0x000000ff << 24))));
| ((pde6)->word2 = ((((txop) & 0x0000000f) << 28) | ((pde6)->word2 & ~(0x0000000f << 28))));
| ((pde6)->word2 = ((((rxop) & 0x0000000f) << 24) | ((pde6)->word2 & ~(0x0000000f << 24))));
| if (datadir == DMA_FROM_DEVICE) {
|  ((pde6)->word2 = ((((1) & 0x00000001) << 22) | ((pde6)->word2 & ~(0x00000001 << 22))));
|  ((pde6)->word2 = ((((1) & 0x00000001) << 21) | ((pde6)->word2 & ~(0x00000001 << 21))));
|  ((pde6)->word2 = ((((1) & 0x00000001) << 20) | ((pde6)->word2 & ~(0x00000001 << 20))));
| }
| ((pde6)->word2 = ((((1) & 0x00000001) << 19) | ((pde6)->word2 & ~(0x00000001 << 19))));
| ((pde6)->word2 = ((((apptagval) & 0x0000ffff) << 0) | ((pde6)->word2 & ~(0x0000ffff << 0))));
|
|
| pde6->word0 = (( __le32)(__u32)(pde6->word0));
| pde6->word1 = (( __le32)(__u32)(pde6->word1));
| pde6->word2 = (( __le32)(__u32)(pde6->word2));
|
|
| num_bde++;
| bpl++;
|
|
| for (i = 0, sgde = (scsi_sglist(sc)); i < (datasegcnt); i++, sgde = sg_next(sgde)) {
|  physaddr = ((sgde)->dma_address);
|  bpl->addrLow = (( __u32)(__le32)(((uint32_t) (0xffffffff & (u64)(physaddr)))));
|  bpl->addrHigh = (( __u32)(__le32)(((uint32_t) (0xffffffff & (((u64)(physaddr))>>32)))));
|  bpl->tus.f.bdeSize = ((sgde)->dma_length);
|  if (datadir == DMA_TO_DEVICE)
|   bpl->tus.f.bdeFlags = 0x00;
|  else
|   bpl->tus.f.bdeFlags = 0x08;
|  bpl->tus.w = (( __u32)(__le32)(bpl->tus.w));
|  bpl++;
|  num_bde++;
| }
|
|out:
| return num_bde;
|}
|static int
|lpfc_bg_setup_bpl_prot(struct lpfc_hba *phba, struct scsi_cmnd *sc,
|  struct ulp_bde64 *bpl, int datacnt, int protcnt)
|{
| struct scatterlist *sgde = ((void *)0);
| struct scatterlist *sgpe = ((void *)0);
| struct lpfc_pde5 *pde5 = ((void *)0);
| struct lpfc_pde6 *pde6 = ((void *)0);
| struct ulp_bde64 *prot_bde = ((void *)0);
| dma_addr_t dataphysaddr, protphysaddr;
| unsigned short curr_data = 0, curr_prot = 0;
| unsigned int split_offset, protgroup_len;
| unsigned int protgrp_blks, protgrp_bytes;
| unsigned int remainder, subtotal;
| int status;
| int datadir = sc->sc_data_direction;
| unsigned char pgdone = 0, alldone = 0;
| unsigned blksize;
| uint32_t reftag;
| uint16_t apptagmask, apptagval;
| uint8_t txop, rxop;
| int num_bde = 0;
|
| sgpe = scsi_prot_sglist(sc);
| sgde = scsi_sglist(sc);
|
| if (!sgpe || !sgde) {
|  do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000040) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "9020 Invalid s/g entry: data=0x%p prot=0x%p\n", phba->brd_no, sgpe, sgde); } } while (0)
|
|               ;
|  return 0;
| }
|
| status = lpfc_sc_to_bg_opcodes(phba, sc, &txop, &rxop);
| if (status)
|  goto out;
|
|
| blksize = lpfc_cmd_blksize(sc);
| lpfc_get_cmd_dif_parms(sc, &apptagmask, &apptagval, &reftag);
|
| split_offset = 0;
| do {
|
|  pde5 = (struct lpfc_pde5 *) bpl;
|  __st_memset_st__(pde5, 0, sizeof(struct lpfc_pde5));
|  ((pde5)->word0 = ((((0x85) & 0x000000ff) << 24) | ((pde5)->word0 & ~(0x000000ff << 24))));
|  pde5->reftag = reftag;
|
|
|  pde5->word0 = (( __le32)(__u32)(pde5->word0));
|  pde5->reftag = (( __le32)(__u32)(pde5->reftag));
|
|
|  num_bde++;
|  bpl++;
|  pde6 = (struct lpfc_pde6 *) bpl;
|
|
|  __st_memset_st__(pde6, 0, sizeof(struct lpfc_pde6));
|  ((pde6)->word0 = ((((0x86) & 0x000000ff) << 24) | ((pde6)->word0 & ~(0x000000ff << 24))));
|  ((pde6)->word2 = ((((txop) & 0x0000000f) << 28) | ((pde6)->word2 & ~(0x0000000f << 28))));
|  ((pde6)->word2 = ((((rxop) & 0x0000000f) << 24) | ((pde6)->word2 & ~(0x0000000f << 24))));
|  ((pde6)->word2 = ((((1) & 0x00000001) << 22) | ((pde6)->word2 & ~(0x00000001 << 22))));
|  ((pde6)->word2 = ((((1) & 0x00000001) << 21) | ((pde6)->word2 & ~(0x00000001 << 21))));
|  ((pde6)->word2 = ((((1) & 0x00000001) << 20) | ((pde6)->word2 & ~(0x00000001 << 20))));
|  ((pde6)->word2 = ((((1) & 0x00000001) << 19) | ((pde6)->word2 & ~(0x00000001 << 19))));
|  ((pde6)->word2 = ((((apptagval) & 0x0000ffff) << 0) | ((pde6)->word2 & ~(0x0000ffff << 0))));
|
|
|  pde6->word0 = (( __le32)(__u32)(pde6->word0));
|  pde6->word1 = (( __le32)(__u32)(pde6->word1));
|  pde6->word2 = (( __le32)(__u32)(pde6->word2));
|
|
|  num_bde++;
|  bpl++;
|
|
|  prot_bde = (struct ulp_bde64 *) bpl;
|  protphysaddr = ((sgpe)->dma_address);
|  prot_bde->addrHigh = (( __u32)(__le32)(((uint32_t) (0xffffffff & (u64)(protphysaddr)))));
|  prot_bde->addrLow = (( __u32)(__le32)(((uint32_t) (0xffffffff & (((u64)(protphysaddr))>>32)))));
|  protgroup_len = ((sgpe)->dma_length);
|
|
|  __st_BUG_ON_st__(protgroup_len % 8);
|
|  protgrp_blks = protgroup_len / 8;
|  protgrp_bytes = protgrp_blks * blksize;
|
|  prot_bde->tus.f.bdeSize = protgroup_len;
|  prot_bde->tus.f.bdeFlags = 0x87;
|  prot_bde->tus.w = (( __u32)(__le32)(bpl->tus.w));
|
|  curr_prot++;
|  num_bde++;
|
|
|  pgdone = 0;
|  subtotal = 0;
|  while (!pgdone) {
|   if (!sgde) {
|    do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000200) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "9065 BLKGRD:%s Invalid data segment\n", phba->brd_no, __func__); } } while (0)
|
|               ;
|    return 0;
|   }
|   bpl++;
|   dataphysaddr = ((sgde)->dma_address) + split_offset;
|   bpl->addrLow = (( __u32)(__le32)(((uint32_t) (0xffffffff & (u64)(dataphysaddr)))));
|   bpl->addrHigh = (( __u32)(__le32)(((uint32_t) (0xffffffff & (((u64)(dataphysaddr))>>32)))));
|
|   remainder = ((sgde)->dma_length) - split_offset;
|
|   if ((subtotal + remainder) <= protgrp_bytes) {
|
|    bpl->tus.f.bdeSize = remainder;
|    split_offset = 0;
|
|    if ((subtotal + remainder) == protgrp_bytes)
|     pgdone = 1;
|   } else {
|
|    bpl->tus.f.bdeSize = protgrp_bytes - subtotal;
|    split_offset += bpl->tus.f.bdeSize;
|   }
|
|   subtotal += bpl->tus.f.bdeSize;
|
|   if (datadir == DMA_TO_DEVICE)
|    bpl->tus.f.bdeFlags = 0x00;
|   else
|    bpl->tus.f.bdeFlags = 0x08;
|   bpl->tus.w = (( __u32)(__le32)(bpl->tus.w));
|
|   num_bde++;
|   curr_data++;
|
|   if (split_offset)
|    break;
|
|
|   sgde = sg_next(sgde);
|
|  }
|
|
|  if (curr_prot == protcnt) {
|   alldone = 1;
|  } else if (curr_prot < protcnt) {
|
|   sgpe = sg_next(sgpe);
|   bpl++;
|
|
|   reftag += protgrp_blks;
|  } else {
|
|   do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000200) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "9054 BLKGRD: bug in %s\n", phba->brd_no, __func__); } } while (0)
|                                         ;
|  }
|
| } while (!alldone);
|
|out:
|
| return num_bde;
|}
|
|
|
|
|
|
|
|static int
|lpfc_prot_group_type(struct lpfc_hba *phba, struct scsi_cmnd *sc)
|{
| int ret = LPFC_PG_TYPE_INVALID;
| unsigned char op = scsi_get_prot_op(sc);
|
| switch (op) {
| case SCSI_PROT_READ_STRIP:
| case SCSI_PROT_WRITE_INSERT:
|  ret = LPFC_PG_TYPE_NO_DIF;
|  break;
| case SCSI_PROT_READ_INSERT:
| case SCSI_PROT_WRITE_STRIP:
| case SCSI_PROT_READ_PASS:
| case SCSI_PROT_WRITE_PASS:
|  ret = LPFC_PG_TYPE_DIF_BUF;
|  break;
| default:
|  do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000040) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "9021 Unsupported protection op:%d\n", phba->brd_no, op); } } while (0)
|                                              ;
|  break;
| }
|
| return ret;
|}
|
|
|
|
|
|
|static int
|lpfc_bg_scsi_prep_dma_buf(struct lpfc_hba *phba,
|  struct lpfc_scsi_buf *lpfc_cmd)
|{
| struct scsi_cmnd *scsi_cmnd = lpfc_cmd->pCmd;
| struct fcp_cmnd *fcp_cmnd = lpfc_cmd->fcp_cmnd;
| struct ulp_bde64 *bpl = lpfc_cmd->fcp_bpl;
| IOCB_t *iocb_cmd = &lpfc_cmd->cur_iocbq.iocb;
| uint32_t num_bde = 0;
| int datasegcnt, protsegcnt, datadir = scsi_cmnd->sc_data_direction;
| int prot_group_type = 0;
| int diflen, fcpdl;
| unsigned blksize;
|
|
|
|
|
| bpl += 2;
| if (scsi_sg_count(scsi_cmnd)) {
|
|
|
|
|
|
|  datasegcnt = dma_map_sg_attrs(&phba->pcidev->dev, scsi_sglist(scsi_cmnd), scsi_sg_count(scsi_cmnd), datadir, ((void *)0))
|
|                                       ;
|  if (!datasegcnt)
|   return 1;
|
|  lpfc_cmd->seg_cnt = datasegcnt;
|  if (lpfc_cmd->seg_cnt > phba->cfg_sg_seg_cnt) {
|   do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000200) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "9067 BLKGRD: %s: Too many sg segments" " from dma_map_sg.  Config %d, seg_cnt" " %d\n", phba->brd_no, __func__, phba->cfg_sg_seg_cnt, lpfc_cmd->seg_cnt); } } while (0)
|
|
|
|
|                       ;
|   scsi_dma_unmap(scsi_cmnd);
|   return 1;
|  }
|
|  prot_group_type = lpfc_prot_group_type(phba, scsi_cmnd);
|
|  switch (prot_group_type) {
|  case LPFC_PG_TYPE_NO_DIF:
|   num_bde = lpfc_bg_setup_bpl(phba, scsi_cmnd, bpl,
|     datasegcnt);
|
|   if (num_bde < 2)
|    goto err;
|   break;
|  case LPFC_PG_TYPE_DIF_BUF:{
|
|
|
|
|
|   protsegcnt = dma_map_sg_attrs(&phba->pcidev->dev, scsi_prot_sglist(scsi_cmnd), scsi_prot_sg_count(scsi_cmnd), datadir, ((void *)0))
|
|                                            ;
|   if (!protsegcnt) {
|    scsi_dma_unmap(scsi_cmnd);
|    return 1;
|   }
|
|   lpfc_cmd->prot_seg_cnt = protsegcnt;
|   if (lpfc_cmd->prot_seg_cnt
|       > phba->cfg_prot_sg_seg_cnt) {
|    do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000200) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "9068 BLKGRD: %s: Too many prot sg " "segments from dma_map_sg.  Config %d," "prot_seg_cnt %d\n", phba->brd_no, __func__, phba->cfg_prot_sg_seg_cnt, lpfc_cmd->prot_seg_cnt); } } while (0)
|
|
|
|
|                             ;
|    dma_unmap_sg_attrs(&phba->pcidev->dev, scsi_prot_sglist(scsi_cmnd), scsi_prot_sg_count(scsi_cmnd), datadir, ((void *)0))
|
|
|                  ;
|    scsi_dma_unmap(scsi_cmnd);
|    return 1;
|   }
|
|   num_bde = lpfc_bg_setup_bpl_prot(phba, scsi_cmnd, bpl,
|     datasegcnt, protsegcnt);
|
|   if (num_bde < 3)
|    goto err;
|   break;
|  }
|  case LPFC_PG_TYPE_INVALID:
|  default:
|   do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000040) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "9022 Unexpected protection group %i\n", phba->brd_no, prot_group_type); } } while (0)
|
|                     ;
|   return 1;
|  }
| }
|
|
|
|
|
|
|
| iocb_cmd->un.fcpi64.bdl.bdeSize = (2 * sizeof(struct ulp_bde64));
| iocb_cmd->un.fcpi64.bdl.bdeSize += (num_bde * sizeof(struct ulp_bde64));
| iocb_cmd->ulpBdeCount = 1;
| iocb_cmd->ulpLe = 1;
|
| fcpdl = scsi_bufflen(scsi_cmnd);
|
| if (scsi_get_prot_type(scsi_cmnd) == SCSI_PROT_DIF_TYPE1) {
|
|
|
|
|
|  blksize = lpfc_cmd_blksize(scsi_cmnd);
|  diflen = (fcpdl / blksize) * 8;
|  fcpdl += diflen;
| }
| fcp_cmnd->fcpDl = (__builtin_constant_p((__u32)(( __u32)(__be32)(fcpdl))) ? ((__u32)( (((__u32)(( __u32)(__be32)(fcpdl)) & (__u32)0x000000ffUL) << 24) | (((__u32)(( __u32)(__be32)(fcpdl)) & (__u32)0x0000ff00UL) << 8) | (((__u32)(( __u32)(__be32)(fcpdl)) & (__u32)0x00ff0000UL) >> 8) | (((__u32)(( __u32)(__be32)(fcpdl)) & (__u32)0xff000000UL) >> 24))) : __fswab32(( __u32)(__be32)(fcpdl)));
|
|
|
|
|
| iocb_cmd->un.fcpi.fcpi_parm = fcpdl;
|
| return 0;
|err:
| do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000040) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "9023 Could not setup all needed BDE's" "prot_group_type=%d, num_bde=%d\n", phba->brd_no, prot_group_type, num_bde); } } while (0)
|
|
|                            ;
| return 1;
|}
|static int
|lpfc_parse_bg_err(struct lpfc_hba *phba, struct lpfc_scsi_buf *lpfc_cmd,
|   struct lpfc_iocbq *pIocbOut)
|{
| struct scsi_cmnd *cmd = lpfc_cmd->pCmd;
| struct sli3_bg_fields *bgf = &pIocbOut->iocb.unsli3.sli3_bg;
| int ret = 0;
| uint32_t bghm = bgf->bghm;
| uint32_t bgstat = bgf->bgstat;
| uint64_t failing_sector = 0;
|
| do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000200) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "9069 BLKGRD: BG ERROR in cmd" " 0x%x lba 0x%llx blk cnt 0x%x " "bgstat=0x%x bghm=0x%x\n", phba->brd_no, cmd->cmnd[0], (unsigned long long)scsi_get_lba(cmd), blk_rq_sectors(cmd->request), bgstat, bghm); } } while (0)
|
|
|
|                                              ;
|
| __st_spin_lock_st__(&_dump_buf_lock);
| if (!_dump_buf_done) {
|  do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000200) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "9070 BLKGRD: Saving" " Data for %u blocks to debugfs\n", phba->brd_no, (cmd->cmnd[7] << 8 | cmd->cmnd[8])); } } while (0)
|
|                                       ;
|  lpfc_debug_save_data(phba, cmd);
|
|
|  if (lpfc_prot_group_type(phba, cmd) ==
|    LPFC_PG_TYPE_DIF_BUF) {
|   do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000200) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "9071 BLKGRD: " "Saving DIF for %u blocks to debugfs\n", phba->brd_no, (cmd->cmnd[7] << 8 | cmd->cmnd[8])); } } while (0)
|
|                                       ;
|   lpfc_debug_save_dif(phba, cmd);
|  }
|
|  _dump_buf_done = 1;
| }
| __st_spin_unlock_st__(&_dump_buf_lock);
|
| if (lpfc_bgs_get_invalid_prof(bgstat)) {
|  cmd->result = (((0x07) << 16) | 0);
|  do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000200) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "9072 BLKGRD: Invalid" " BlockGuard profile. bgstat:0x%x\n", phba->brd_no, bgstat); } } while (0)
|
|          ;
|  ret = (-1);
|  goto out;
| }
|
| if (lpfc_bgs_get_uninit_dif_block(bgstat)) {
|  cmd->result = (((0x07) << 16) | 0);
|  do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000200) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "9073 BLKGRD: " "Invalid BlockGuard DIF Block. bgstat:0x%x\n", phba->brd_no, bgstat); } } while (0)
|
|           ;
|  ret = (-1);
|  goto out;
| }
|
| if (lpfc_bgs_get_guard_err(bgstat)) {
|  ret = 1;
|
|  scsi_build_sense_buffer(1, cmd->sense_buffer, 0x05,
|    0x10, 0x1);
|  cmd->result = 0x08 << 24
|   | (((0x05) << 16) | 0x02);
|  phba->bg_guard_err_cnt++;
|  do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000200) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "9055 BLKGRD: guard_tag error\n", phba->brd_no); } } while (0)
|                                    ;
| }
|
| if (lpfc_bgs_get_reftag_err(bgstat)) {
|  ret = 1;
|
|  scsi_build_sense_buffer(1, cmd->sense_buffer, 0x05,
|    0x10, 0x3);
|  cmd->result = 0x08 << 24
|   | (((0x05) << 16) | 0x02);
|
|  phba->bg_reftag_err_cnt++;
|  do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000200) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "9056 BLKGRD: ref_tag error\n", phba->brd_no); } } while (0)
|                                  ;
| }
|
| if (lpfc_bgs_get_apptag_err(bgstat)) {
|  ret = 1;
|
|  scsi_build_sense_buffer(1, cmd->sense_buffer, 0x05,
|    0x10, 0x2);
|  cmd->result = 0x08 << 24
|   | (((0x05) << 16) | 0x02);
|
|  phba->bg_apptag_err_cnt++;
|  do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000200) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "9061 BLKGRD: app_tag error\n", phba->brd_no); } } while (0)
|                                  ;
| }
|
| if (lpfc_bgs_get_hi_water_mark_present(bgstat)) {
|
|
|
|
|  cmd->sense_buffer[8] = 0;
|  cmd->sense_buffer[9] = 0xa;
|  bghm /= cmd->device->sector_size;
|
|  failing_sector = scsi_get_lba(cmd);
|  failing_sector += bghm;
|
|  put_unaligned_be64(failing_sector, &cmd->sense_buffer[10]);
| }
|
| if (!ret) {
|
|  cmd->result = (((0x07) << 16) | 0);
|  do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000200) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "9057 BLKGRD: no errors reported!\n", phba->brd_no); } } while (0)
|                                        ;
| }
|
|out:
| return ret;
|}
|static int
|lpfc_scsi_prep_dma_buf_s4(struct lpfc_hba *phba, struct lpfc_scsi_buf *lpfc_cmd)
|{
| struct scsi_cmnd *scsi_cmnd = lpfc_cmd->pCmd;
| struct scatterlist *sgel = ((void *)0);
| struct fcp_cmnd *fcp_cmnd = lpfc_cmd->fcp_cmnd;
| struct sli4_sge *sgl = (struct sli4_sge *)lpfc_cmd->fcp_bpl;
| IOCB_t *iocb_cmd = &lpfc_cmd->cur_iocbq.iocb;
| dma_addr_t physaddr;
| uint32_t num_bde = 0;
| uint32_t dma_len;
| uint32_t dma_offset = 0;
| int nseg;
|
|
|
|
|
|
|
| if (scsi_sg_count(scsi_cmnd)) {
|
|
|
|
|
|
|
|  nseg = scsi_dma_map(scsi_cmnd);
|  if (!nseg)
|   return 1;
|  sgl += 1;
|
|  sgl->word2 = (( __u32)(__le32)(sgl->word2));
|  ((sgl)->word2 = ((((0) & 0x00000001) << 31) | ((sgl)->word2 & ~(0x00000001 << 31))));
|  sgl->word2 = (( __le32)(__u32)(sgl->word2));
|  sgl += 1;
|
|  lpfc_cmd->seg_cnt = nseg;
|  if (lpfc_cmd->seg_cnt > phba->cfg_sg_seg_cnt) {
|   do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000200) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "9074 BLKGRD:" " %s: Too many sg segments from " "dma_map_sg.  Config %d, seg_cnt %d\n", phba->brd_no, __func__, phba->cfg_sg_seg_cnt, lpfc_cmd->seg_cnt); } } while (0)
|
|
|
|                            ;
|   scsi_dma_unmap(scsi_cmnd);
|   return 1;
|  }
|  for (num_bde = 0, sgel = (scsi_sglist(scsi_cmnd)); num_bde < (nseg); num_bde++, sgel = sg_next(sgel)) {
|   physaddr = ((sgel)->dma_address);
|   dma_len = ((sgel)->dma_length);
|   sgl->addr_lo = (( __le32)(__u32)(((uint32_t) (0xffffffff & (u64)(physaddr)))));
|   sgl->addr_hi = (( __le32)(__u32)(((uint32_t) (0xffffffff & (((u64)(physaddr))>>32)))));
|   if ((num_bde + 1) == nseg)
|    ((sgl)->word2 = ((((1) & 0x00000001) << 31) | ((sgl)->word2 & ~(0x00000001 << 31))));
|   else
|    ((sgl)->word2 = ((((0) & 0x00000001) << 31) | ((sgl)->word2 & ~(0x00000001 << 31))));
|   ((sgl)->word2 = ((((dma_offset) & 0x00FFFFFF) << 0) | ((sgl)->word2 & ~(0x00FFFFFF << 0))));
|   sgl->word2 = (( __le32)(__u32)(sgl->word2));
|   sgl->sge_len = (( __le32)(__u32)(dma_len));
|   dma_offset += dma_len;
|   sgl++;
|  }
| } else {
|  sgl += 1;
|
|  sgl->word2 = (( __u32)(__le32)(sgl->word2));
|  ((sgl)->word2 = ((((1) & 0x00000001) << 31) | ((sgl)->word2 & ~(0x00000001 << 31))));
|  sgl->word2 = (( __le32)(__u32)(sgl->word2));
| }
|
|
|
|
|
|
|
| fcp_cmnd->fcpDl = (( __be32)(__builtin_constant_p((__u32)((scsi_bufflen(scsi_cmnd)))) ? ((__u32)( (((__u32)((scsi_bufflen(scsi_cmnd))) & (__u32)0x000000ffUL) << 24) | (((__u32)((scsi_bufflen(scsi_cmnd))) & (__u32)0x0000ff00UL) << 8) | (((__u32)((scsi_bufflen(scsi_cmnd))) & (__u32)0x00ff0000UL) >> 8) | (((__u32)((scsi_bufflen(scsi_cmnd))) & (__u32)0xff000000UL) >> 24))) : __fswab32((scsi_bufflen(scsi_cmnd)))));
|
|
|
|
|
| iocb_cmd->un.fcpi.fcpi_parm = scsi_bufflen(scsi_cmnd);
| return 0;
|}
|static inline int
|lpfc_scsi_prep_dma_buf(struct lpfc_hba *phba, struct lpfc_scsi_buf *lpfc_cmd)
|{
| return phba->lpfc_scsi_prep_dma_buf(phba, lpfc_cmd);
|}
|static void
|lpfc_send_scsi_error_event(struct lpfc_hba *phba, struct lpfc_vport *vport,
|  struct lpfc_scsi_buf *lpfc_cmd, struct lpfc_iocbq *rsp_iocb) {
| struct scsi_cmnd *cmnd = lpfc_cmd->pCmd;
| struct fcp_rsp *fcprsp = lpfc_cmd->fcp_rsp;
| uint32_t resp_info = fcprsp->rspStatus2;
| uint32_t scsi_status = fcprsp->rspStatus3;
| uint32_t fcpi_parm = rsp_iocb->iocb.un.fcpi.fcpi_parm;
| struct lpfc_fast_path_event *fast_path_evt = ((void *)0);
| struct lpfc_nodelist *pnode = lpfc_cmd->rdata->pnode;
| unsigned long flags;
|
| if (!pnode || !(((pnode)->nlp_usg_map & 0x1) && !((pnode)->nlp_usg_map & 0x8)))
|  return;
|
|
| if ((cmnd->result == 0x28) ||
|  (cmnd->result == 0x08)) {
|  fast_path_evt = lpfc_alloc_fast_evt(phba);
|  if (!fast_path_evt)
|   return;
|  fast_path_evt->un.scsi_evt.event_type =
|   0x0200;
|  fast_path_evt->un.scsi_evt.subcategory =
|  (cmnd->result == 0x28) ?
|  0x0001 : 0x0002;
|  fast_path_evt->un.scsi_evt.lun = cmnd->device->lun;
|  __st_memcpy_st__(&fast_path_evt->un.scsi_evt.wwpn,
|   &pnode->nlp_portname, sizeof(struct lpfc_name));
|  __st_memcpy_st__(&fast_path_evt->un.scsi_evt.wwnn,
|   &pnode->nlp_nodename, sizeof(struct lpfc_name));
| } else if ((resp_info & 0x02) && fcprsp->rspSnsLen &&
|  ((cmnd->cmnd[0] == 0x28) || (cmnd->cmnd[0] == 0x2a))) {
|  fast_path_evt = lpfc_alloc_fast_evt(phba);
|  if (!fast_path_evt)
|   return;
|  fast_path_evt->un.check_cond_evt.scsi_event.event_type =
|   0x0200;
|  fast_path_evt->un.check_cond_evt.scsi_event.subcategory =
|   0x0004;
|  fast_path_evt->un.check_cond_evt.scsi_event.lun =
|   cmnd->device->lun;
|  __st_memcpy_st__(&fast_path_evt->un.check_cond_evt.scsi_event.wwpn,
|   &pnode->nlp_portname, sizeof(struct lpfc_name));
|  __st_memcpy_st__(&fast_path_evt->un.check_cond_evt.scsi_event.wwnn,
|   &pnode->nlp_nodename, sizeof(struct lpfc_name));
|  fast_path_evt->un.check_cond_evt.sense_key =
|   cmnd->sense_buffer[2] & 0xf;
|  fast_path_evt->un.check_cond_evt.asc = cmnd->sense_buffer[12];
|  fast_path_evt->un.check_cond_evt.ascq = cmnd->sense_buffer[13];
| } else if ((cmnd->sc_data_direction == DMA_FROM_DEVICE) &&
|       fcpi_parm &&
|       (((__builtin_constant_p((__u32)(( __u32)(__be32)(fcprsp->rspResId))) ? ((__u32)( (((__u32)(( __u32)(__be32)(fcprsp->rspResId)) & (__u32)0x000000ffUL) << 24) | (((__u32)(( __u32)(__be32)(fcprsp->rspResId)) & (__u32)0x0000ff00UL) << 8) | (((__u32)(( __u32)(__be32)(fcprsp->rspResId)) & (__u32)0x00ff0000UL) >> 8) | (((__u32)(( __u32)(__be32)(fcprsp->rspResId)) & (__u32)0xff000000UL) >> 24))) : __fswab32(( __u32)(__be32)(fcprsp->rspResId))) != fcpi_parm) ||
|   ((scsi_status == 0x00) &&
|   !(resp_info & (0x08 | 0x04))))) {
|
|
|
|
|  fast_path_evt = lpfc_alloc_fast_evt(phba);
|  if (!fast_path_evt)
|   return;
|  fast_path_evt->un.read_check_error.header.event_type =
|   0x0100;
|  fast_path_evt->un.read_check_error.header.subcategory =
|   0x04;
|  __st_memcpy_st__(&fast_path_evt->un.read_check_error.header.wwpn,
|   &pnode->nlp_portname, sizeof(struct lpfc_name));
|  __st_memcpy_st__(&fast_path_evt->un.read_check_error.header.wwnn,
|   &pnode->nlp_nodename, sizeof(struct lpfc_name));
|  fast_path_evt->un.read_check_error.lun = cmnd->device->lun;
|  fast_path_evt->un.read_check_error.opcode = cmnd->cmnd[0];
|  fast_path_evt->un.read_check_error.fcpiparam =
|   fcpi_parm;
| } else
|  return;
|
| fast_path_evt->vport = vport;
| __st_spin_lock_irqsave_st__(&phba->hbalock, flags);
| list_add_tail(&fast_path_evt->work_evt.evt_listp, &phba->work_list);
| __st_spin_unlock_irqrestore_st__(&phba->hbalock, flags);
| lpfc_worker_wake_up(phba);
| return;
|}
|static void
|lpfc_scsi_unprep_dma_buf(struct lpfc_hba *phba, struct lpfc_scsi_buf *psb)
|{
|
|
|
|
|
|
| if (psb->seg_cnt > 0)
|  scsi_dma_unmap(psb->pCmd);
| if (psb->prot_seg_cnt > 0)
|  dma_unmap_sg_attrs(&phba->pcidev->dev, scsi_prot_sglist(psb->pCmd), scsi_prot_sg_count(psb->pCmd), psb->pCmd->sc_data_direction, ((void *)0))
|
|                                 ;
|}
|static void
|lpfc_handle_fcp_err(struct lpfc_vport *vport, struct lpfc_scsi_buf *lpfc_cmd,
|      struct lpfc_iocbq *rsp_iocb)
|{
| struct scsi_cmnd *cmnd = lpfc_cmd->pCmd;
| struct fcp_cmnd *fcpcmd = lpfc_cmd->fcp_cmnd;
| struct fcp_rsp *fcprsp = lpfc_cmd->fcp_rsp;
| uint32_t fcpi_parm = rsp_iocb->iocb.un.fcpi.fcpi_parm;
| uint32_t resp_info = fcprsp->rspStatus2;
| uint32_t scsi_status = fcprsp->rspStatus3;
| uint32_t *lp;
| uint32_t host_status = 0x00;
| uint32_t rsplen = 0;
| uint32_t logit = 0x00000040 | 0x00001000;
|
|
|
|
|
|
|
| if (fcpcmd->fcpCntl2) {
|  scsi_status = 0;
|  goto out;
| }
|
| if (resp_info & 0x01) {
|  rsplen = (__builtin_constant_p((__u32)(( __u32)(__be32)(fcprsp->rspRspLen))) ? ((__u32)( (((__u32)(( __u32)(__be32)(fcprsp->rspRspLen)) & (__u32)0x000000ffUL) << 24) | (((__u32)(( __u32)(__be32)(fcprsp->rspRspLen)) & (__u32)0x0000ff00UL) << 8) | (((__u32)(( __u32)(__be32)(fcprsp->rspRspLen)) & (__u32)0x00ff0000UL) >> 8) | (((__u32)(( __u32)(__be32)(fcprsp->rspRspLen)) & (__u32)0xff000000UL) >> 24))) : __fswab32(( __u32)(__be32)(fcprsp->rspRspLen)));
|  if (rsplen != 0 && rsplen != 4 && rsplen != 8) {
|   do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "2719 Invalid response length: " "tgt x%x lun x%x cmnd x%x rsplen x%x\n", (vport)->phba->brd_no, vport->vpi, cmnd->device->id, cmnd->device->lun, cmnd->cmnd[0], rsplen); } } while (0)
|
|
|
|
|            ;
|   host_status = 0x07;
|   goto out;
|  }
|  if (fcprsp->rspInfo3 != 0x00) {
|   do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "2757 Protocol failure detected during " "processing of FCP I/O op: " "tgt x%x lun x%x cmnd x%x rspInfo3 x%x\n", (vport)->phba->brd_no, vport->vpi, cmnd->device->id, cmnd->device->lun, cmnd->cmnd[0], fcprsp->rspInfo3); } } while (0)
|
|
|
|
|
|                      ;
|   host_status = 0x07;
|   goto out;
|  }
| }
|
| if ((resp_info & 0x02) && fcprsp->rspSnsLen) {
|  uint32_t snslen = (__builtin_constant_p((__u32)(( __u32)(__be32)(fcprsp->rspSnsLen))) ? ((__u32)( (((__u32)(( __u32)(__be32)(fcprsp->rspSnsLen)) & (__u32)0x000000ffUL) << 24) | (((__u32)(( __u32)(__be32)(fcprsp->rspSnsLen)) & (__u32)0x0000ff00UL) << 8) | (((__u32)(( __u32)(__be32)(fcprsp->rspSnsLen)) & (__u32)0x00ff0000UL) >> 8) | (((__u32)(( __u32)(__be32)(fcprsp->rspSnsLen)) & (__u32)0xff000000UL) >> 24))) : __fswab32(( __u32)(__be32)(fcprsp->rspSnsLen)));
|  if (snslen > 96)
|   snslen = 96;
|
|  if (resp_info & 0x01)
|    rsplen = (__builtin_constant_p((__u32)(( __u32)(__be32)(fcprsp->rspRspLen))) ? ((__u32)( (((__u32)(( __u32)(__be32)(fcprsp->rspRspLen)) & (__u32)0x000000ffUL) << 24) | (((__u32)(( __u32)(__be32)(fcprsp->rspRspLen)) & (__u32)0x0000ff00UL) << 8) | (((__u32)(( __u32)(__be32)(fcprsp->rspRspLen)) & (__u32)0x00ff0000UL) >> 8) | (((__u32)(( __u32)(__be32)(fcprsp->rspRspLen)) & (__u32)0xff000000UL) >> 24))) : __fswab32(( __u32)(__be32)(fcprsp->rspRspLen)));
|  __st_memcpy_st__(cmnd->sense_buffer, &fcprsp->rspInfo0 + rsplen, snslen);
| }
| lp = (uint32_t *)cmnd->sense_buffer;
|
| if (!scsi_status && (resp_info & 0x08))
|  logit = 0x00000040;
|
| do { { if (((logit) & (vport)->cfg_log_verbose) || ("<4>"[1] <= '3')) dev_printk("<4>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "9024 FCP command x%x failed: x%x SNS x%x x%x " "Data: x%x x%x x%x x%x x%x\n", (vport)->phba->brd_no, vport->vpi, cmnd->cmnd[0], scsi_status, (__builtin_constant_p((__u32)(( __u32)(__be32)(*lp))) ? ((__u32)( (((__u32)(( __u32)(__be32)(*lp)) & (__u32)0x000000ffUL) << 24) | (((__u32)(( __u32)(__be32)(*lp)) & (__u32)0x0000ff00UL) << 8) | (((__u32)(( __u32)(__be32)(*lp)) & (__u32)0x00ff0000UL) >> 8) | (((__u32)(( __u32)(__be32)(*lp)) & (__u32)0xff000000UL) >> 24))) : __fswab32(( __u32)(__be32)(*lp))), (__builtin_constant_p((__u32)(( __u32)(__be32)(*(lp + 3)))) ? ((__u32)( (((__u32)(( __u32)(__be32)(*(lp + 3))) & (__u32)0x000000ffUL) << 24) | (((__u32)(( __u32)(__be32)(*(lp + 3))) & (__u32)0x0000ff00UL) << 8) | (((__u32)(( __u32)(__be32)(*(lp + 3))) & (__u32)0x00ff0000UL) >> 8) | (((__u32)(( __u32)(__be32)(*(lp + 3))) & (__u32)0xff000000UL) >> 24))) : __fswab32(( __u32)(__be32)(*(lp + 3)))), resp_info, (__builtin_constant_p((__u32)(( __u32)(__be32)(fcprsp->rspResId))) ? ((__u32)( (((__u32)(( __u32)(__be32)(fcprsp->rspResId)) & (__u32)0x000000ffUL) << 24) | (((__u32)(( __u32)(__be32)(fcprsp->rspResId)) & (__u32)0x0000ff00UL) << 8) | (((__u32)(( __u32)(__be32)(fcprsp->rspResId)) & (__u32)0x00ff0000UL) >> 8) | (((__u32)(( __u32)(__be32)(fcprsp->rspResId)) & (__u32)0xff000000UL) >> 24))) : __fswab32(( __u32)(__be32)(fcprsp->rspResId))), (__builtin_constant_p((__u32)(( __u32)(__be32)(fcprsp->rspSnsLen))) ? ((__u32)( (((__u32)(( __u32)(__be32)(fcprsp->rspSnsLen)) & (__u32)0x000000ffUL) << 24) | (((__u32)(( __u32)(__be32)(fcprsp->rspSnsLen)) & (__u32)0x0000ff00UL) << 8) | (((__u32)(( __u32)(__be32)(fcprsp->rspSnsLen)) & (__u32)0x00ff0000UL) >> 8) | (((__u32)(( __u32)(__be32)(fcprsp->rspSnsLen)) & (__u32)0xff000000UL) >> 24))) : __fswab32(( __u32)(__be32)(fcprsp->rspSnsLen))), (__builtin_constant_p((__u32)(( __u32)(__be32)(fcprsp->rspRspLen))) ? ((__u32)( (((__u32)(( __u32)(__be32)(fcprsp->rspRspLen)) & (__u32)0x000000ffUL) << 24) | (((__u32)(( __u32)(__be32)(fcprsp->rspRspLen)) & (__u32)0x0000ff00UL) << 8) | (((__u32)(( __u32)(__be32)(fcprsp->rspRspLen)) & (__u32)0x00ff0000UL) >> 8) | (((__u32)(( __u32)(__be32)(fcprsp->rspRspLen)) & (__u32)0xff000000UL) >> 24))) : __fswab32(( __u32)(__be32)(fcprsp->rspRspLen))), fcprsp->rspInfo3); } } while (0)
|
|
|
|
|
|
|
|                     ;
|
| scsi_set_resid(cmnd, 0);
| if (resp_info & 0x08) {
|  scsi_set_resid(cmnd, (__builtin_constant_p((__u32)(( __u32)(__be32)(fcprsp->rspResId))) ? ((__u32)( (((__u32)(( __u32)(__be32)(fcprsp->rspResId)) & (__u32)0x000000ffUL) << 24) | (((__u32)(( __u32)(__be32)(fcprsp->rspResId)) & (__u32)0x0000ff00UL) << 8) | (((__u32)(( __u32)(__be32)(fcprsp->rspResId)) & (__u32)0x00ff0000UL) >> 8) | (((__u32)(( __u32)(__be32)(fcprsp->rspResId)) & (__u32)0xff000000UL) >> 24))) : __fswab32(( __u32)(__be32)(fcprsp->rspResId))));
|
|  do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<6>"[1] <= '3')) dev_printk("<6>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "9025 FCP Read Underrun, expected %d, " "residual %d Data: x%x x%x x%x\n", (vport)->phba->brd_no, vport->vpi, (__builtin_constant_p((__u32)(( __u32)(__be32)(fcpcmd->fcpDl))) ? ((__u32)( (((__u32)(( __u32)(__be32)(fcpcmd->fcpDl)) & (__u32)0x000000ffUL) << 24) | (((__u32)(( __u32)(__be32)(fcpcmd->fcpDl)) & (__u32)0x0000ff00UL) << 8) | (((__u32)(( __u32)(__be32)(fcpcmd->fcpDl)) & (__u32)0x00ff0000UL) >> 8) | (((__u32)(( __u32)(__be32)(fcpcmd->fcpDl)) & (__u32)0xff000000UL) >> 24))) : __fswab32(( __u32)(__be32)(fcpcmd->fcpDl))), scsi_get_resid(cmnd), fcpi_parm, cmnd->cmnd[0], cmnd->underflow); } } while (0)
|
|
|
|
|                     ;
|
|
|
|
|
|
|  if ((cmnd->sc_data_direction == DMA_FROM_DEVICE) &&
|   fcpi_parm &&
|   (scsi_get_resid(cmnd) != fcpi_parm)) {
|   do { { if (((0x00000040 | 0x00001000) & (vport)->cfg_log_verbose) || ("<4>"[1] <= '3')) dev_printk("<4>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "9026 FCP Read Check Error " "and Underrun Data: x%x x%x x%x x%x\n", (vport)->phba->brd_no, vport->vpi, (__builtin_constant_p((__u32)(( __u32)(__be32)(fcpcmd->fcpDl))) ? ((__u32)( (((__u32)(( __u32)(__be32)(fcpcmd->fcpDl)) & (__u32)0x000000ffUL) << 24) | (((__u32)(( __u32)(__be32)(fcpcmd->fcpDl)) & (__u32)0x0000ff00UL) << 8) | (((__u32)(( __u32)(__be32)(fcpcmd->fcpDl)) & (__u32)0x00ff0000UL) >> 8) | (((__u32)(( __u32)(__be32)(fcpcmd->fcpDl)) & (__u32)0xff000000UL) >> 24))) : __fswab32(( __u32)(__be32)(fcpcmd->fcpDl))), scsi_get_resid(cmnd), fcpi_parm, cmnd->cmnd[0]); } } while (0)
|
|
|
|
|
|                    ;
|   scsi_set_resid(cmnd, scsi_bufflen(cmnd));
|   host_status = 0x07;
|  }
|
|
|
|
|
|
|  if (!(resp_info & 0x02) &&
|      (scsi_status == 0x00) &&
|      (scsi_bufflen(cmnd) - scsi_get_resid(cmnd)
|       < cmnd->underflow)) {
|   do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<6>"[1] <= '3')) dev_printk("<6>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "9027 FCP command x%x residual " "underrun converted to error " "Data: x%x x%x x%x\n", (vport)->phba->brd_no, vport->vpi, cmnd->cmnd[0], scsi_bufflen(cmnd), scsi_get_resid(cmnd), cmnd->underflow); } } while (0)
|
|
|
|
|                                            ;
|   host_status = 0x07;
|  }
| } else if (resp_info & 0x04) {
|  do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<4>"[1] <= '3')) dev_printk("<4>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "9028 FCP command x%x residual overrun error. " "Data: x%x x%x\n", (vport)->phba->brd_no, vport->vpi, cmnd->cmnd[0], scsi_bufflen(cmnd), scsi_get_resid(cmnd)); } } while (0)
|
|
|                                              ;
|  host_status = 0x07;
|
|
|
|
|
| } else if (fcpi_parm && (cmnd->sc_data_direction == DMA_FROM_DEVICE)) {
|  do { { if (((0x00000040 | 0x00001000) & (vport)->cfg_log_verbose) || ("<4>"[1] <= '3')) dev_printk("<4>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "9029 FCP Read Check Error Data: " "x%x x%x x%x x%x x%x\n", (vport)->phba->brd_no, vport->vpi, (__builtin_constant_p((__u32)(( __u32)(__be32)(fcpcmd->fcpDl))) ? ((__u32)( (((__u32)(( __u32)(__be32)(fcpcmd->fcpDl)) & (__u32)0x000000ffUL) << 24) | (((__u32)(( __u32)(__be32)(fcpcmd->fcpDl)) & (__u32)0x0000ff00UL) << 8) | (((__u32)(( __u32)(__be32)(fcpcmd->fcpDl)) & (__u32)0x00ff0000UL) >> 8) | (((__u32)(( __u32)(__be32)(fcpcmd->fcpDl)) & (__u32)0xff000000UL) >> 24))) : __fswab32(( __u32)(__be32)(fcpcmd->fcpDl))), (__builtin_constant_p((__u32)(( __u32)(__be32)(fcprsp->rspResId))) ? ((__u32)( (((__u32)(( __u32)(__be32)(fcprsp->rspResId)) & (__u32)0x000000ffUL) << 24) | (((__u32)(( __u32)(__be32)(fcprsp->rspResId)) & (__u32)0x0000ff00UL) << 8) | (((__u32)(( __u32)(__be32)(fcprsp->rspResId)) & (__u32)0x00ff0000UL) >> 8) | (((__u32)(( __u32)(__be32)(fcprsp->rspResId)) & (__u32)0xff000000UL) >> 24))) : __fswab32(( __u32)(__be32)(fcprsp->rspResId))), fcpi_parm, cmnd->cmnd[0], scsi_status); } } while (0)
|
|
|
|
|                                           ;
|  switch (scsi_status) {
|  case 0x00:
|  case 0x02:
|
|
|
|
|
|   host_status = 0x07;
|   break;
|  }
|  scsi_set_resid(cmnd, scsi_bufflen(cmnd));
| }
|
| out:
| cmnd->result = (((host_status) << 16) | scsi_status);
| lpfc_send_scsi_error_event(vport->phba, vport, lpfc_cmd, rsp_iocb);
|}
|static void
|lpfc_scsi_cmd_iocb_cmpl(struct lpfc_hba *phba, struct lpfc_iocbq *pIocbIn,
|   struct lpfc_iocbq *pIocbOut)
|{
| struct lpfc_scsi_buf *lpfc_cmd =
|  (struct lpfc_scsi_buf *) pIocbIn->context1;
| struct lpfc_vport *vport = pIocbIn->vport;
| struct lpfc_rport_data *rdata = lpfc_cmd->rdata;
| struct lpfc_nodelist *pnode = rdata->pnode;
| struct scsi_cmnd *cmd;
| int result;
| struct scsi_device *tmp_sdev;
| int depth;
| unsigned long flags;
| struct lpfc_fast_path_event *fast_path_evt;
| struct Scsi_Host *shost;
| uint32_t queue_depth, scsi_id;
|
|
| if (!(lpfc_cmd->pCmd))
|  return;
| cmd = lpfc_cmd->pCmd;
| shost = cmd->device->host;
|
| lpfc_cmd->result = pIocbOut->iocb.un.ulpWord[4];
| lpfc_cmd->status = pIocbOut->iocb.ulpStatus;
|
| lpfc_cmd->exch_busy = pIocbOut->iocb_flag & 0x40;
|
| if (pnode && (((pnode)->nlp_usg_map & 0x1) && !((pnode)->nlp_usg_map & 0x8)))
|  atomic_dec(&pnode->cmd_pending);
|
| if (lpfc_cmd->status) {
|  if (lpfc_cmd->status == 0x3 &&
|      (lpfc_cmd->result & 0x100))
|   lpfc_cmd->status = 0x10;
|  else if (lpfc_cmd->status >= 0x11)
|   lpfc_cmd->status = 0xF;
|
|  do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<4>"[1] <= '3')) dev_printk("<4>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "9030 FCP cmd x%x failed <%d/%d> " "status: x%x result: x%x Data: x%x x%x\n", (vport)->phba->brd_no, vport->vpi, cmd->cmnd[0], cmd->device ? cmd->device->id : 0xffff, cmd->device ? cmd->device->lun : 0xffff, lpfc_cmd->status, lpfc_cmd->result, pIocbOut->iocb.un1.t1.ulpContext, lpfc_cmd->cur_iocbq.iocb.un1.t1.ulpIoTag); } } while (0)
|
|
|
|
|
|
|
|                                       ;
|
|  switch (lpfc_cmd->status) {
|  case 0x1:
|
|   lpfc_handle_fcp_err(vport, lpfc_cmd, pIocbOut);
|   break;
|  case 0x6:
|  case 0x7:
|   cmd->result = (((0x0e) << 16) | 0);
|   fast_path_evt = lpfc_alloc_fast_evt(phba);
|   if (!fast_path_evt)
|    break;
|   fast_path_evt->un.fabric_evt.event_type =
|    0x0100;
|   fast_path_evt->un.fabric_evt.subcategory =
|    (lpfc_cmd->status == 0x6) ?
|    0x02 : 0x01;
|   if (pnode && (((pnode)->nlp_usg_map & 0x1) && !((pnode)->nlp_usg_map & 0x8))) {
|    __st_memcpy_st__(&fast_path_evt->un.fabric_evt.wwpn,
|     &pnode->nlp_portname,
|     sizeof(struct lpfc_name));
|    __st_memcpy_st__(&fast_path_evt->un.fabric_evt.wwnn,
|     &pnode->nlp_nodename,
|     sizeof(struct lpfc_name));
|   }
|   fast_path_evt->vport = vport;
|   fast_path_evt->work_evt.evt =
|    LPFC_EVT_FASTPATH_MGMT_EVT;
|   __st_spin_lock_irqsave_st__(&phba->hbalock, flags);
|   list_add_tail(&fast_path_evt->work_evt.evt_listp,
|    &phba->work_list);
|   __st_spin_unlock_irqrestore_st__(&phba->hbalock, flags);
|   lpfc_worker_wake_up(phba);
|   break;
|  case 0x3:
|   if (lpfc_cmd->result == 0x04 ||
|       lpfc_cmd->result == 0x11 ||
|       lpfc_cmd->result == 0x16 ||
|       lpfc_cmd->result == 0x47) {
|    cmd->result = (((0x0d) << 16) | 0);
|    break;
|   }
|
|   if ((lpfc_cmd->result == 0x0E ||
|        lpfc_cmd->result == 0x0D) &&
|        pIocbOut->iocb.unsli3.sli3_bg.bgstat) {
|    if (scsi_get_prot_op(cmd) != SCSI_PROT_NORMAL) {
|
|
|
|
|     lpfc_parse_bg_err(phba, lpfc_cmd,
|       pIocbOut);
|     break;
|    } else {
|     do { { if (((0x00000200) & (vport)->cfg_log_verbose) || ("<4>"[1] <= '3')) dev_printk("<4>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "9031 non-zero BGSTAT " "on unprotected cmd\n", (vport)->phba->brd_no, vport->vpi); } } while (0)
|
|
|                              ;
|    }
|   }
|
|
|  default:
|   cmd->result = (((0x07) << 16) | 0);
|   break;
|  }
|
|  if (!pnode || !(((pnode)->nlp_usg_map & 0x1) && !((pnode)->nlp_usg_map & 0x8))
|      || (pnode->nlp_state != 0x6))
|   cmd->result = (((0x0e) << 16) | 0x08)
|                     ;
| } else {
|  cmd->result = (((0x00) << 16) | 0);
| }
|
| if (cmd->result || lpfc_cmd->fcp_rsp->rspSnsLen) {
|  uint32_t *lp = (uint32_t *)cmd->sense_buffer;
|
|  do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<6>"[1] <= '3')) dev_printk("<6>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "0710 Iodone <%d/%d> cmd %p, error " "x%x SNS x%x x%x Data: x%x x%x\n", (vport)->phba->brd_no, vport->vpi, cmd->device->id, cmd->device->lun, cmd, cmd->result, *lp, *(lp + 3), cmd->retries, scsi_get_resid(cmd)); } } while (0)
|
|
|
|
|                         ;
| }
|
| lpfc_update_stats(phba, lpfc_cmd);
| result = cmd->result;
| if (vport->cfg_max_scsicmpl_time &&
|    (({ unsigned long __dummy; typeof(jiffies) __dummy2; (void)(&__dummy == &__dummy2); 1; }) && ({ unsigned long __dummy; typeof(lpfc_cmd->start_time + msecs_to_jiffies(vport->cfg_max_scsicmpl_time)) __dummy2; (void)(&__dummy == &__dummy2); 1; }) && ((long)(lpfc_cmd->start_time + msecs_to_jiffies(vport->cfg_max_scsicmpl_time)) - (long)(jiffies) < 0))
|                                                 ) {
|  __st_spin_lock_irqsave_st__(shost->host_lock, flags);
|  if (pnode && (((pnode)->nlp_usg_map & 0x1) && !((pnode)->nlp_usg_map & 0x8))) {
|   if (pnode->cmd_qdepth >
|    atomic_read(&pnode->cmd_pending) &&
|    (atomic_read(&pnode->cmd_pending) >
|    10) &&
|    ((cmd->cmnd[0] == 0x28) ||
|    (cmd->cmnd[0] == 0x2a)))
|    pnode->cmd_qdepth =
|     atomic_read(&pnode->cmd_pending);
|
|   pnode->last_change_time = jiffies;
|  }
|  __st_spin_unlock_irqrestore_st__(shost->host_lock, flags);
| } else if (pnode && (((pnode)->nlp_usg_map & 0x1) && !((pnode)->nlp_usg_map & 0x8))) {
|  if ((pnode->cmd_qdepth < vport->cfg_tgt_queue_depth) &&
|     (({ unsigned long __dummy; typeof(jiffies) __dummy2; (void)(&__dummy == &__dummy2); 1; }) && ({ unsigned long __dummy; typeof(pnode->last_change_time + msecs_to_jiffies(40000)) __dummy2; (void)(&__dummy == &__dummy2); 1; }) && ((long)(pnode->last_change_time + msecs_to_jiffies(40000)) - (long)(jiffies) < 0))
|                                              ) {
|   __st_spin_lock_irqsave_st__(shost->host_lock, flags);
|   depth = pnode->cmd_qdepth * 5
|    / 100;
|   depth = depth ? depth : 1;
|   pnode->cmd_qdepth += depth;
|   if (pnode->cmd_qdepth > vport->cfg_tgt_queue_depth)
|    pnode->cmd_qdepth = vport->cfg_tgt_queue_depth;
|   pnode->last_change_time = jiffies;
|   __st_spin_unlock_irqrestore_st__(shost->host_lock, flags);
|  }
| }
|
| lpfc_scsi_unprep_dma_buf(phba, lpfc_cmd);
|
|
| queue_depth = cmd->device->queue_depth;
| scsi_id = cmd->device->id;
| cmd->scsi_done(cmd);
|
| if (phba->cfg_poll & ENABLE_FCP_RING_POLLING) {
|
|
|
|
|  __st_spin_lock_irqsave_st__(shost->host_lock, flags);
|  lpfc_cmd->pCmd = ((void *)0);
|  if (lpfc_cmd->waitq)
|   __wake_up(lpfc_cmd->waitq, (1 | 2), 1, ((void *)0));
|  __st_spin_unlock_irqrestore_st__(shost->host_lock, flags);
|  lpfc_release_scsi_buf(phba, lpfc_cmd);
|  return;
| }
|
| if (!result)
|  lpfc_rampup_queue_depth(vport, queue_depth);
|
|
|
|
|
| if (result == 0x28 && pnode &&
|     (((pnode)->nlp_usg_map & 0x1) && !((pnode)->nlp_usg_map & 0x8))) {
|  for ((tmp_sdev) = __scsi_iterate_devices((shost), ((void *)0)); (tmp_sdev); (tmp_sdev) = __scsi_iterate_devices((shost), (tmp_sdev))) {
|   if (tmp_sdev->id != scsi_id)
|    continue;
|   depth = scsi_track_queue_full(tmp_sdev,
|            tmp_sdev->queue_depth-1);
|   if (depth <= 0)
|    continue;
|   do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<4>"[1] <= '3')) dev_printk("<4>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "0711 detected queue full - lun queue " "depth adjusted to %d.\n", (vport)->phba->brd_no, vport->vpi, depth); } } while (0)
|
|                                       ;
|   lpfc_send_sdev_queuedepth_change_event(phba, vport,
|              pnode,
|              tmp_sdev->lun,
|              depth+1, depth);
|  }
| }
|
|
|
|
|
| __st_spin_lock_irqsave_st__(shost->host_lock, flags);
| lpfc_cmd->pCmd = ((void *)0);
| if (lpfc_cmd->waitq)
|  __wake_up(lpfc_cmd->waitq, (1 | 2), 1, ((void *)0));
| __st_spin_unlock_irqrestore_st__(shost->host_lock, flags);
|
| lpfc_release_scsi_buf(phba, lpfc_cmd);
|}
|static void
|lpfc_fcpcmd_to_iocb(uint8_t *data, struct fcp_cmnd *fcp_cmnd)
|{
| int i, j;
| for (i = 0, j = 0; i < sizeof(struct fcp_cmnd);
|      i += sizeof(uint32_t), j++) {
|  ((uint32_t *)data)[j] = (( __be32)(__builtin_constant_p((__u32)((((uint32_t *)fcp_cmnd)[j]))) ? ((__u32)( (((__u32)((((uint32_t *)fcp_cmnd)[j])) & (__u32)0x000000ffUL) << 24) | (((__u32)((((uint32_t *)fcp_cmnd)[j])) & (__u32)0x0000ff00UL) << 8) | (((__u32)((((uint32_t *)fcp_cmnd)[j])) & (__u32)0x00ff0000UL) >> 8) | (((__u32)((((uint32_t *)fcp_cmnd)[j])) & (__u32)0xff000000UL) >> 24))) : __fswab32((((uint32_t *)fcp_cmnd)[j]))));
| }
|}
|static void
|lpfc_scsi_prep_cmnd(struct lpfc_vport *vport, struct lpfc_scsi_buf *lpfc_cmd,
|      struct lpfc_nodelist *pnode)
|{
| struct lpfc_hba *phba = vport->phba;
| struct scsi_cmnd *scsi_cmnd = lpfc_cmd->pCmd;
| struct fcp_cmnd *fcp_cmnd = lpfc_cmd->fcp_cmnd;
| IOCB_t *iocb_cmd = &lpfc_cmd->cur_iocbq.iocb;
| struct lpfc_iocbq *piocbq = &(lpfc_cmd->cur_iocbq);
| int datadir = scsi_cmnd->sc_data_direction;
| char tag[2];
|
| if (!pnode || !(((pnode)->nlp_usg_map & 0x1) && !((pnode)->nlp_usg_map & 0x8)))
|  return;
|
| lpfc_cmd->fcp_rsp->rspSnsLen = 0;
|
| lpfc_cmd->fcp_cmnd->fcpCntl2 = 0;
|
| int_to_scsilun(lpfc_cmd->pCmd->device->lun,
|   &lpfc_cmd->fcp_cmnd->fcp_lun);
|
| __st_memcpy_st__(&fcp_cmnd->fcpCdb[0], scsi_cmnd->cmnd, 16);
|
| if (scsi_populate_tag_msg(scsi_cmnd, tag)) {
|  switch (tag[0]) {
|  case 0x21:
|   fcp_cmnd->fcpCntl1 = 0x01;
|   break;
|  case 0x22:
|   fcp_cmnd->fcpCntl1 = 0x02;
|   break;
|  default:
|   fcp_cmnd->fcpCntl1 = 0x00;
|   break;
|  }
| } else
|  fcp_cmnd->fcpCntl1 = 0;
|
|
|
|
|
|
|
| if (scsi_sg_count(scsi_cmnd)) {
|  if (datadir == DMA_TO_DEVICE) {
|   iocb_cmd->ulpCommand = 0x98;
|   if (phba->sli_rev < 4) {
|    iocb_cmd->un.fcpi.fcpi_parm = 0;
|    iocb_cmd->ulpPU = 0;
|   } else
|    iocb_cmd->ulpPU = 2;
|   fcp_cmnd->fcpCntl3 = 0x01;
|   phba->fc4OutputRequests++;
|  } else {
|   iocb_cmd->ulpCommand = 0x9A;
|   iocb_cmd->ulpPU = 2;
|   fcp_cmnd->fcpCntl3 = 0x02;
|   phba->fc4InputRequests++;
|  }
| } else {
|  iocb_cmd->ulpCommand = 0x9C;
|  iocb_cmd->un.fcpi.fcpi_parm = 0;
|  iocb_cmd->ulpPU = 0;
|  fcp_cmnd->fcpCntl3 = 0;
|  phba->fc4ControlRequests++;
| }
| if (phba->sli_rev == 3 &&
|     !(phba->sli3_options & 0x20))
|  lpfc_fcpcmd_to_iocb(iocb_cmd->unsli3.fcp_ext.icd, fcp_cmnd);
|
|
|
|
| piocbq->iocb.un1.t1.ulpContext = pnode->nlp_rpi;
| if (pnode->nlp_fcp_info & 0x10)
|  piocbq->iocb.ulpFCP2Rcvy = 1;
| else
|  piocbq->iocb.ulpFCP2Rcvy = 0;
|
| piocbq->iocb.ulpClass = (pnode->nlp_fcp_info & 0x0f);
| piocbq->context1 = lpfc_cmd;
| piocbq->iocb_cmpl = lpfc_scsi_cmd_iocb_cmpl;
| piocbq->iocb.ulpTimeout = lpfc_cmd->timeout;
| piocbq->vport = vport;
|}
|static int
|lpfc_scsi_prep_task_mgmt_cmd(struct lpfc_vport *vport,
|        struct lpfc_scsi_buf *lpfc_cmd,
|        unsigned int lun,
|        uint8_t task_mgmt_cmd)
|{
| struct lpfc_iocbq *piocbq;
| IOCB_t *piocb;
| struct fcp_cmnd *fcp_cmnd;
| struct lpfc_rport_data *rdata = lpfc_cmd->rdata;
| struct lpfc_nodelist *ndlp = rdata->pnode;
|
| if (!ndlp || !(((ndlp)->nlp_usg_map & 0x1) && !((ndlp)->nlp_usg_map & 0x8)) ||
|     ndlp->nlp_state != 0x6)
|  return 0;
|
| piocbq = &(lpfc_cmd->cur_iocbq);
| piocbq->vport = vport;
|
| piocb = &piocbq->iocb;
|
| fcp_cmnd = lpfc_cmd->fcp_cmnd;
|
| __st_memset_st__(fcp_cmnd, 0, sizeof(struct fcp_cmnd));
| int_to_scsilun(lun, &fcp_cmnd->fcp_lun);
| fcp_cmnd->fcpCntl2 = task_mgmt_cmd;
| if (vport->phba->sli_rev == 3 &&
|     !(vport->phba->sli3_options & 0x20))
|  lpfc_fcpcmd_to_iocb(piocb->unsli3.fcp_ext.icd, fcp_cmnd);
| piocb->ulpCommand = 0x9C;
| piocb->un1.t1.ulpContext = ndlp->nlp_rpi;
| if (ndlp->nlp_fcp_info & 0x10) {
|  piocb->ulpFCP2Rcvy = 1;
| }
| piocb->ulpClass = (ndlp->nlp_fcp_info & 0x0f);
|
|
| if (lpfc_cmd->timeout > 0xff) {
|
|
|
|
|  piocb->ulpTimeout = 0;
| } else
|  piocb->ulpTimeout = lpfc_cmd->timeout;
|
| if (vport->phba->sli_rev == 4)
|  lpfc_sli4_set_rsp_sgl_last(vport->phba, lpfc_cmd);
|
| return 1;
|}
|int
|lpfc_scsi_api_table_setup(struct lpfc_hba *phba, uint8_t dev_grp)
|{
|
| phba->lpfc_scsi_unprep_dma_buf = lpfc_scsi_unprep_dma_buf;
| phba->lpfc_scsi_prep_cmnd = lpfc_scsi_prep_cmnd;
| phba->lpfc_get_scsi_buf = lpfc_get_scsi_buf;
|
| switch (dev_grp) {
| case 0x1:
|  phba->lpfc_new_scsi_buf = lpfc_new_scsi_buf_s3;
|  phba->lpfc_scsi_prep_dma_buf = lpfc_scsi_prep_dma_buf_s3;
|  phba->lpfc_release_scsi_buf = lpfc_release_scsi_buf_s3;
|  break;
| case 0x2:
|  phba->lpfc_new_scsi_buf = lpfc_new_scsi_buf_s4;
|  phba->lpfc_scsi_prep_dma_buf = lpfc_scsi_prep_dma_buf_s4;
|  phba->lpfc_release_scsi_buf = lpfc_release_scsi_buf_s4;
|  break;
| default:
|  do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000008) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "1418 Invalid HBA PCI-device group: 0x%x\n", phba->brd_no, dev_grp); } } while (0)
|
|            ;
|  return -19;
|  break;
     |This node is unreachable prev next
| }
| phba->lpfc_get_scsi_buf = lpfc_get_scsi_buf;
| phba->lpfc_rampdown_queue_depth = lpfc_rampdown_queue_depth;
| phba->lpfc_scsi_cmd_iocb_cmpl = lpfc_scsi_cmd_iocb_cmpl;
| return 0;
|}
|static void
|lpfc_tskmgmt_def_cmpl(struct lpfc_hba *phba,
|   struct lpfc_iocbq *cmdiocbq,
|   struct lpfc_iocbq *rspiocbq)
|{
| struct lpfc_scsi_buf *lpfc_cmd =
|  (struct lpfc_scsi_buf *) cmdiocbq->context1;
| if (lpfc_cmd)
|  lpfc_release_scsi_buf(phba, lpfc_cmd);
| return;
|}
|const char *
|lpfc_info(struct Scsi_Host *host)
|{
| struct lpfc_vport *vport = (struct lpfc_vport *) host->hostdata;
| struct lpfc_hba *phba = vport->phba;
| int len;
| static char lpfcinfobuf[384];
|
| __st_memset_st__(lpfcinfobuf,0,384);
| if (phba && phba->pcidev){
|  strncpy(lpfcinfobuf, phba->ModelDesc, 256);
|  len = strlen(lpfcinfobuf);
|  snprintf(lpfcinfobuf + len,
|   384-len,
|   " on PCI bus %02x device %02x irq %d",
|   phba->pcidev->bus->number,
|   phba->pcidev->devfn,
|   phba->pcidev->irq);
|  len = strlen(lpfcinfobuf);
|  if (phba->Port[0]) {
|   snprintf(lpfcinfobuf + len,
|     384-len,
|     " port %s",
|     phba->Port);
|  }
|  len = strlen(lpfcinfobuf);
|  if (phba->sli4_hba.link_state.logical_speed) {
|   snprintf(lpfcinfobuf + len,
|     384-len,
|     " Logical Link Speed: %d Mbps",
|     phba->sli4_hba.link_state.logical_speed * 10);
|  }
| }
| return lpfcinfobuf;
|}
|static __inline__ void lpfc_poll_rearm_timer(struct lpfc_hba * phba)
|{
| unsigned long poll_tmo_expires =
|  (jiffies + msecs_to_jiffies(phba->cfg_poll_tmo));
|
| if (phba->sli.ring[0].txcmplq_cnt)
|  mod_timer(&phba->fcp_poll_timer,
|     poll_tmo_expires);
|}
|
|
|
|
|
|
|
|void lpfc_poll_start_timer(struct lpfc_hba * phba)
|{
| lpfc_poll_rearm_timer(phba);
|}
|void lpfc_poll_timeout(unsigned long ptr)
|{
| struct lpfc_hba *phba = (struct lpfc_hba *) ptr;
|
| if (phba->cfg_poll & ENABLE_FCP_RING_POLLING) {
|  lpfc_sli_handle_fast_ring_event(phba,
|   &phba->sli.ring[0], 0x00000001);
|
|  if (phba->cfg_poll & DISABLE_FCP_RING_INT)
|   lpfc_poll_rearm_timer(phba);
| }
|}
|static int
|lpfc_queuecommand_lck(struct scsi_cmnd *cmnd, void (*done) (struct scsi_cmnd *))
|{
| struct Scsi_Host *shost = cmnd->device->host;
| struct lpfc_vport *vport = (struct lpfc_vport *) shost->hostdata;
| struct lpfc_hba *phba = vport->phba;
| struct lpfc_rport_data *rdata = cmnd->device->hostdata;
| struct lpfc_nodelist *ndlp;
| struct lpfc_scsi_buf *lpfc_cmd;
| struct fc_rport *rport = scsi_is_fc_rport(scsi_target(cmnd->device)->dev.parent) ? ({ const typeof( ((struct fc_rport *)0)->dev ) *__mptr = (scsi_target(cmnd->device)->dev.parent); (struct fc_rport *)( (char *)__mptr - 1 );}) : ((void *)0);
| int err;
|
| err = fc_remote_port_chkready(rport);
| if (err) {
|  cmnd->result = err;
|  goto out_fail_command;
| }
| ndlp = rdata->pnode;
|
| if (!(phba->sli3_options & 0x20) &&
|  scsi_get_prot_op(cmnd) != SCSI_PROT_NORMAL) {
|
|  do { { uint32_t log_verbose = (phba)->pport ? (phba)->pport->cfg_log_verbose : (phba)->cfg_log_verbose; if (((0x00000200) & log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((phba)->pcidev)->dev, "%d:" "9058 BLKGRD: ERROR: rcvd protected cmd:%02x" " op:%02x str=%s without registering for" " BlockGuard - Rejecting command\n", phba->brd_no, cmnd->cmnd[0], scsi_get_prot_op(cmnd), dif_op_str[scsi_get_prot_op(cmnd)]); } } while (0)
|
|
|
|
|                                       ;
|  goto out_fail_command;
| }
|
|
|
|
|
| if (!ndlp || !(((ndlp)->nlp_usg_map & 0x1) && !((ndlp)->nlp_usg_map & 0x8))) {
|  cmnd->result = (((0x0e) << 16) | 0);
|  goto out_fail_command;
| }
| if (atomic_read(&ndlp->cmd_pending) >= ndlp->cmd_qdepth)
|  goto out_host_busy;
|
| lpfc_cmd = lpfc_get_scsi_buf(phba);
| if (lpfc_cmd == ((void *)0)) {
|  lpfc_rampdown_queue_depth(phba);
|
|  do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<6>"[1] <= '3')) dev_printk("<6>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "0707 driver's buffer pool is empty, " "IO busied\n", (vport)->phba->brd_no, vport->vpi); } } while (0)
|
|                   ;
|  goto out_host_busy;
| }
|
|
|
|
|
| lpfc_cmd->pCmd = cmnd;
| lpfc_cmd->rdata = rdata;
| lpfc_cmd->timeout = 0;
| lpfc_cmd->start_time = jiffies;
| cmnd->host_scribble = (unsigned char *)lpfc_cmd;
| cmnd->scsi_done = done;
|
| if (scsi_get_prot_op(cmnd) != SCSI_PROT_NORMAL) {
|  if (vport->phba->cfg_enable_bg) {
|   do { { if (((0x00000200) & (vport)->cfg_log_verbose) || ("<4>"[1] <= '3')) dev_printk("<4>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "9033 BLKGRD: rcvd protected cmd:%02x op:%02x " "str=%s\n", (vport)->phba->brd_no, vport->vpi, cmnd->cmnd[0], scsi_get_prot_op(cmnd), dif_op_str[scsi_get_prot_op(cmnd)]); } } while (0)
|
|
|
|                                       ;
|   do { { if (((0x00000200) & (vport)->cfg_log_verbose) || ("<4>"[1] <= '3')) dev_printk("<4>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "9034 BLKGRD: CDB: %02x %02x %02x %02x %02x " "%02x %02x %02x %02x %02x\n", (vport)->phba->brd_no, vport->vpi, cmnd->cmnd[0], cmnd->cmnd[1], cmnd->cmnd[2], cmnd->cmnd[3], cmnd->cmnd[4], cmnd->cmnd[5], cmnd->cmnd[6], cmnd->cmnd[7], cmnd->cmnd[8], cmnd->cmnd[9]); } } while (0)
|
|
|
|
|
|                  ;
|   if (cmnd->cmnd[0] == 0x28)
|    do { { if (((0x00000200) & (vport)->cfg_log_verbose) || ("<4>"[1] <= '3')) dev_printk("<4>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "9035 BLKGRD: READ @ sector %llu, " "count %u\n", (vport)->phba->brd_no, vport->vpi, (unsigned long long)scsi_get_lba(cmnd), blk_rq_sectors(cmnd->request)); } } while (0)
|
|
|
|                                   ;
|   else if (cmnd->cmnd[0] == 0x2a)
|    do { { if (((0x00000200) & (vport)->cfg_log_verbose) || ("<4>"[1] <= '3')) dev_printk("<4>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "9036 BLKGRD: WRITE @ sector %llu, " "count %u cmd=%p\n", (vport)->phba->brd_no, vport->vpi, (unsigned long long)scsi_get_lba(cmnd), blk_rq_sectors(cmnd->request), cmnd); } } while (0)
|
|
|
|
|          ;
|  }
|
|  err = lpfc_bg_scsi_prep_dma_buf(phba, lpfc_cmd);
| } else {
|  if (vport->phba->cfg_enable_bg) {
|   do { { if (((0x00000200) & (vport)->cfg_log_verbose) || ("<4>"[1] <= '3')) dev_printk("<4>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "9038 BLKGRD: rcvd unprotected cmd:" "%02x op:%02x str=%s\n", (vport)->phba->brd_no, vport->vpi, cmnd->cmnd[0], scsi_get_prot_op(cmnd), dif_op_str[scsi_get_prot_op(cmnd)]); } } while (0)
|
|
|
|                                        ;
|    do { { if (((0x00000200) & (vport)->cfg_log_verbose) || ("<4>"[1] <= '3')) dev_printk("<4>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "9039 BLKGRD: CDB: %02x %02x %02x " "%02x %02x %02x %02x %02x %02x %02x\n", (vport)->phba->brd_no, vport->vpi, cmnd->cmnd[0], cmnd->cmnd[1], cmnd->cmnd[2], cmnd->cmnd[3], cmnd->cmnd[4], cmnd->cmnd[5], cmnd->cmnd[6], cmnd->cmnd[7], cmnd->cmnd[8], cmnd->cmnd[9]); } } while (0)
|
|
|
|
|
|
|                                  ;
|   if (cmnd->cmnd[0] == 0x28)
|    do { { if (((0x00000200) & (vport)->cfg_log_verbose) || ("<4>"[1] <= '3')) dev_printk("<4>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "9040 dbg: READ @ sector %llu, " "count %u\n", (vport)->phba->brd_no, vport->vpi, (unsigned long long)scsi_get_lba(cmnd), blk_rq_sectors(cmnd->request)); } } while (0)
|
|
|
|                                    ;
|   else if (cmnd->cmnd[0] == 0x2a)
|    do { { if (((0x00000200) & (vport)->cfg_log_verbose) || ("<4>"[1] <= '3')) dev_printk("<4>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "9041 dbg: WRITE @ sector %llu, " "count %u cmd=%p\n", (vport)->phba->brd_no, vport->vpi, (unsigned long long)scsi_get_lba(cmnd), blk_rq_sectors(cmnd->request), cmnd); } } while (0)
|
|
|
|                                          ;
|   else
|    do { { if (((0x00000200) & (vport)->cfg_log_verbose) || ("<4>"[1] <= '3')) dev_printk("<4>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "9042 dbg: parser not implemented\n", (vport)->phba->brd_no, vport->vpi); } } while (0)
|                                           ;
|  }
|  err = lpfc_scsi_prep_dma_buf(phba, lpfc_cmd);
| }
|
| if (err)
|  goto out_host_busy_free_buf;
|
| lpfc_scsi_prep_cmnd(vport, lpfc_cmd, ndlp);
|
| atomic_inc(&ndlp->cmd_pending);
| err = lpfc_sli_issue_iocb(phba, 0,
|      &lpfc_cmd->cur_iocbq, 1);
| if (err) {
|  atomic_dec(&ndlp->cmd_pending);
|  goto out_host_busy_free_buf;
| }
| if (phba->cfg_poll & ENABLE_FCP_RING_POLLING) {
|  __st_spin_unlock_st__(shost->host_lock);
|  lpfc_sli_handle_fast_ring_event(phba,
|   &phba->sli.ring[0], 0x00000001);
|
|  __st_spin_lock_st__(shost->host_lock);
|  if (phba->cfg_poll & DISABLE_FCP_RING_INT)
|   lpfc_poll_rearm_timer(phba);
| }
|
| return 0;
|
| out_host_busy_free_buf:
| lpfc_scsi_unprep_dma_buf(phba, lpfc_cmd);
| lpfc_release_scsi_buf(phba, lpfc_cmd);
| out_host_busy:
| return 0x1055;
|
| out_fail_command:
| done(cmnd);
| return 0;
|}
|
|static int lpfc_queuecommand(struct Scsi_Host *shost, struct scsi_cmnd *cmd) { unsigned long irq_flags; int rc; do { do { ({ unsigned long __dummy; typeof(irq_flags) __dummy2; (void)(&__dummy == &__dummy2); 1; }); irq_flags = _raw_spin_lock_irqsave(spinlock_check(shost->host_lock)); } while (0); } while (0); scsi_cmd_get_serial(shost, cmd); rc = lpfc_queuecommand_lck (cmd, cmd->scsi_done); spin_unlock_irqrestore(shost->host_lock, irq_flags); return rc; }
|static int
|lpfc_abort_handler(struct scsi_cmnd *cmnd)
|{
| struct Scsi_Host *shost = cmnd->device->host;
| struct lpfc_vport *vport = (struct lpfc_vport *) shost->hostdata;
| struct lpfc_hba *phba = vport->phba;
| struct lpfc_iocbq *iocb;
| struct lpfc_iocbq *abtsiocb;
| struct lpfc_scsi_buf *lpfc_cmd;
| IOCB_t *cmd, *icmd;
| int ret = 0x2002;
| wait_queue_head_t waitq = ({ do { static struct lock_class_key __key; __init_waitqueue_head((&waitq), &__key); } while (0); waitq; });
|
| ret = fc_block_scsi_eh(cmnd);
| if (ret)
|  return ret;
| lpfc_cmd = (struct lpfc_scsi_buf *)cmnd->host_scribble;
| if (!lpfc_cmd) {
|  do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<4>"[1] <= '3')) dev_printk("<4>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "2873 SCSI Layer I/O Abort Request IO CMPL Status " "x%x ID %d " "LUN %d snum %#lx\n", (vport)->phba->brd_no, vport->vpi, ret, cmnd->device->id, cmnd->device->lun, cmnd->serial_number); } } while (0)
|
|
|
|                                           ;
|  return 0x2002;
| }
| iocb = &lpfc_cmd->cur_iocbq;
| if (lpfc_cmd->pCmd != cmnd)
|  goto out;
|
| __st_BUG_ON_st__(iocb->context1 != lpfc_cmd);
|
| abtsiocb = lpfc_sli_get_iocbq(phba);
| if (abtsiocb == ((void *)0)) {
|  ret = 0x2003;
|  goto out;
| }
|
|
|
|
|
|
|
| cmd = &iocb->iocb;
| icmd = &abtsiocb->iocb;
| icmd->un.acxri.abortType = 0x00000001;
| icmd->un.acxri.abortContextTag = cmd->un1.t1.ulpContext;
| if (phba->sli_rev == 4)
|  icmd->un.acxri.abortIoTag = iocb->sli4_xritag;
| else
|  icmd->un.acxri.abortIoTag = cmd->un1.t1.ulpIoTag;
|
| icmd->ulpLe = 1;
| icmd->ulpClass = cmd->ulpClass;
|
|
| abtsiocb->fcp_wqidx = iocb->fcp_wqidx;
| abtsiocb->iocb_flag |= 0x80;
|
| if (lpfc_is_link_up(phba))
|  icmd->ulpCommand = 0x0E;
| else
|  icmd->ulpCommand = 0x10;
|
| abtsiocb->iocb_cmpl = lpfc_sli_abort_fcp_cmpl;
| abtsiocb->vport = vport;
| if (lpfc_sli_issue_iocb(phba, 0, abtsiocb, 0) ==
|     2) {
|  lpfc_sli_release_iocbq(phba, abtsiocb);
|  ret = 0x2003;
|  goto out;
| }
|
| if (phba->cfg_poll & DISABLE_FCP_RING_INT)
|  lpfc_sli_handle_fast_ring_event(phba,
|   &phba->sli.ring[0], 0x00000001);
|
| lpfc_cmd->waitq = &waitq;
|
| ({ long __ret = (2*vport->cfg_devloss_tmo*250); if (!((lpfc_cmd->pCmd != cmnd))) do { wait_queue_t __wait = { .private = get_current(), .func = autoremove_wake_function, .task_list = { &((__wait).task_list), &((__wait).task_list) }, }; for (;;) { prepare_to_wait(&waitq, &__wait, 2); if ((lpfc_cmd->pCmd != cmnd)) break; __ret = schedule_timeout(__ret); if (!__ret) break; } finish_wait(&waitq, &__wait); } while (0); __ret; })
|
|                                    ;
|
| __st_spin_lock_irq_st__(shost->host_lock);
| lpfc_cmd->waitq = ((void *)0);
| __st_spin_unlock_irq_st__(shost->host_lock);
|
| if (lpfc_cmd->pCmd == cmnd) {
|  ret = 0x2003;
|  do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "0748 abort handler timed out waiting " "for abort to complete: ret %#x, ID %d, " "LUN %d, snum %#lx\n", (vport)->phba->brd_no, vport->vpi, ret, cmnd->device->id, cmnd->device->lun, cmnd->serial_number); } } while (0)
|
|
|
|
|                         ;
| }
|
| out:
| do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<4>"[1] <= '3')) dev_printk("<4>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "0749 SCSI Layer I/O Abort Request Status x%x ID %d " "LUN %d snum %#lx\n", (vport)->phba->brd_no, vport->vpi, ret, cmnd->device->id, cmnd->device->lun, cmnd->serial_number); } } while (0)
|
|
|                                           ;
| return ret;
|}
|
|static char *
|lpfc_taskmgmt_name(uint8_t task_mgmt_cmd)
|{
| switch (task_mgmt_cmd) {
| case 0x02:
|  return "ABORT_TASK_SET";
| case 0x04:
|  return "FCP_CLEAR_TASK_SET";
| case 0x08:
|  return "FCP_BUS_RESET";
| case 0x10:
|  return "FCP_LUN_RESET";
| case 0x20:
|  return "FCP_TARGET_RESET";
| case 0x40:
|  return "FCP_CLEAR_ACA";
| case 0x80:
|  return "FCP_TERMINATE_TASK";
| default:
|  return "unknown";
| }
|}
|static int
|lpfc_send_taskmgmt(struct lpfc_vport *vport, struct lpfc_rport_data *rdata,
|      unsigned tgt_id, unsigned int lun_id,
|      uint8_t task_mgmt_cmd)
|{
| struct lpfc_hba *phba = vport->phba;
| struct lpfc_scsi_buf *lpfc_cmd;
| struct lpfc_iocbq *iocbq;
| struct lpfc_iocbq *iocbqrsp;
| struct lpfc_nodelist *pnode = rdata->pnode;
| int ret;
| int status;
|
| if (!pnode || !(((pnode)->nlp_usg_map & 0x1) && !((pnode)->nlp_usg_map & 0x8)))
|  return 0x2003;
|
| lpfc_cmd = lpfc_get_scsi_buf(phba);
| if (lpfc_cmd == ((void *)0))
|  return 0x2003;
| lpfc_cmd->timeout = 60;
| lpfc_cmd->rdata = rdata;
|
| status = lpfc_scsi_prep_task_mgmt_cmd(vport, lpfc_cmd, lun_id,
|        task_mgmt_cmd);
| if (!status) {
|  lpfc_release_scsi_buf(phba, lpfc_cmd);
|  return 0x2003;
| }
|
| iocbq = &lpfc_cmd->cur_iocbq;
| iocbqrsp = lpfc_sli_get_iocbq(phba);
| if (iocbqrsp == ((void *)0)) {
|  lpfc_release_scsi_buf(phba, lpfc_cmd);
|  return 0x2003;
| }
|
| do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<6>"[1] <= '3')) dev_printk("<6>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "0702 Issue %s to TGT %d LUN %d " "rpi x%x nlp_flag x%x\n", (vport)->phba->brd_no, vport->vpi, lpfc_taskmgmt_name(task_mgmt_cmd), tgt_id, lun_id, pnode->nlp_rpi, pnode->nlp_flag); } } while (0)
|
|
|
|                                    ;
|
| status = lpfc_sli_issue_iocb_wait(phba, 0,
|       iocbq, iocbqrsp, lpfc_cmd->timeout);
| if (status != 0) {
|  if (status == 3) {
|   iocbq->iocb_cmpl = lpfc_tskmgmt_def_cmpl;
|   ret = 0x2007;
|  } else
|   ret = 0x2003;
|  lpfc_cmd->status = 0x10;
|  do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "0727 TMF %s to TGT %d LUN %d failed (%d, %d)\n", (vport)->phba->brd_no, vport->vpi, lpfc_taskmgmt_name(task_mgmt_cmd), tgt_id, lun_id, iocbqrsp->iocb.ulpStatus, iocbqrsp->iocb.un.ulpWord[4]); } } while (0)
|
|
|
|                                 ;
| } else if (status == 1)
|  ret = 0x2003;
| else
|  ret = 0x2002;
|
| lpfc_sli_release_iocbq(phba, iocbqrsp);
|
| if (ret != 0x2007)
|  lpfc_release_scsi_buf(phba, lpfc_cmd);
|
| return ret;
|}
|static int
|lpfc_chk_tgt_mapped(struct lpfc_vport *vport, struct scsi_cmnd *cmnd)
|{
| struct lpfc_rport_data *rdata = cmnd->device->hostdata;
| struct lpfc_nodelist *pnode;
| unsigned long later;
|
| if (!rdata) {
|  do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<6>"[1] <= '3')) dev_printk("<6>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "0797 Tgt Map rport failure: rdata x%p\n", (vport)->phba->brd_no, vport->vpi, rdata); } } while (0)
|                                                    ;
|  return 0x2003;
| }
| pnode = rdata->pnode;
|
|
|
|
| later = msecs_to_jiffies(2 * vport->cfg_devloss_tmo * 1000) + jiffies;
| while ((({ unsigned long __dummy; typeof(later) __dummy2; (void)(&__dummy == &__dummy2); 1; }) && ({ unsigned long __dummy; typeof(jiffies) __dummy2; (void)(&__dummy == &__dummy2); 1; }) && ((long)(jiffies) - (long)(later) < 0))) {
|  if (!pnode || !(((pnode)->nlp_usg_map & 0x1) && !((pnode)->nlp_usg_map & 0x8)))
|   return 0x2003;
|  if (pnode->nlp_state == 0x6)
|   return 0x2002;
|  schedule_timeout_uninterruptible(msecs_to_jiffies(500));
|  rdata = cmnd->device->hostdata;
|  if (!rdata)
|   return 0x2003;
|  pnode = rdata->pnode;
| }
| if (!pnode || !(((pnode)->nlp_usg_map & 0x1) && !((pnode)->nlp_usg_map & 0x8)) ||
|     (pnode->nlp_state != 0x6))
|  return 0x2003;
| return 0x2002;
|}
|static int
|lpfc_reset_flush_io_context(struct lpfc_vport *vport, uint16_t tgt_id,
|   uint64_t lun_id, lpfc_ctx_cmd context)
|{
| struct lpfc_hba *phba = vport->phba;
| unsigned long later;
| int cnt;
|
| cnt = lpfc_sli_sum_iocb(vport, tgt_id, lun_id, context);
| if (cnt)
|  lpfc_sli_abort_iocb(vport, &phba->sli.ring[phba->sli.fcp_ring],
|        tgt_id, lun_id, context);
| later = msecs_to_jiffies(2 * vport->cfg_devloss_tmo * 1000) + jiffies;
| while ((({ unsigned long __dummy; typeof(later) __dummy2; (void)(&__dummy == &__dummy2); 1; }) && ({ unsigned long __dummy; typeof(jiffies) __dummy2; (void)(&__dummy == &__dummy2); 1; }) && ((long)(jiffies) - (long)(later) < 0)) && cnt) {
|  schedule_timeout_uninterruptible(msecs_to_jiffies(20));
|  cnt = lpfc_sli_sum_iocb(vport, tgt_id, lun_id, context);
| }
| if (cnt) {
|  do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "0724 I/O flush failure for context %s : cnt x%x\n", (vport)->phba->brd_no, vport->vpi, ((context == LPFC_CTX_LUN) ? "LUN" : ((context == LPFC_CTX_TGT) ? "TGT" : ((context == LPFC_CTX_HOST) ? "HOST" : "Unknown"))), cnt); } } while (0)
|
|
|
|
|       ;
|  return 0x2003;
| }
| return 0x2002;
|}
|static int
|lpfc_device_reset_handler(struct scsi_cmnd *cmnd)
|{
| struct Scsi_Host *shost = cmnd->device->host;
| struct lpfc_vport *vport = (struct lpfc_vport *) shost->hostdata;
| struct lpfc_rport_data *rdata = cmnd->device->hostdata;
| struct lpfc_nodelist *pnode;
| unsigned tgt_id = cmnd->device->id;
| unsigned int lun_id = cmnd->device->lun;
| struct lpfc_scsi_event_header scsi_event;
| int status;
|
| if (!rdata) {
|  do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "0798 Device Reset rport failure: rdata x%p\n", (vport)->phba->brd_no, vport->vpi, rdata); } } while (0)
|                                                         ;
|  return 0x2003;
| }
| pnode = rdata->pnode;
| status = fc_block_scsi_eh(cmnd);
| if (status)
|  return status;
|
| status = lpfc_chk_tgt_mapped(vport, cmnd);
| if (status == 0x2003) {
|  do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "0721 Device Reset rport failure: rdata x%p\n", (vport)->phba->brd_no, vport->vpi, rdata); } } while (0)
|                                                         ;
|  return 0x2003;
| }
|
| scsi_event.event_type = 0x0200;
| scsi_event.subcategory = 0x0008;
| scsi_event.lun = lun_id;
| __st_memcpy_st__(scsi_event.wwpn, &pnode->nlp_portname, sizeof(struct lpfc_name));
| __st_memcpy_st__(scsi_event.wwnn, &pnode->nlp_nodename, sizeof(struct lpfc_name));
|
| fc_host_post_vendor_event(shost, fc_get_event_number(),
|  sizeof(scsi_event), (char *)&scsi_event, (((__u64)0x01 << 56) | 0x10df));
|
| status = lpfc_send_taskmgmt(vport, rdata, tgt_id, lun_id,
|      0x10);
|
| do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "0713 SCSI layer issued Device Reset (%d, %d) " "return x%x\n", (vport)->phba->brd_no, vport->vpi, tgt_id, lun_id, status); } } while (0)
|
|                                           ;
|
|
|
|
|
|
|
| status = lpfc_reset_flush_io_context(vport, tgt_id, lun_id,
|      LPFC_CTX_LUN);
| return status;
|}
|static int
|lpfc_target_reset_handler(struct scsi_cmnd *cmnd)
|{
| struct Scsi_Host *shost = cmnd->device->host;
| struct lpfc_vport *vport = (struct lpfc_vport *) shost->hostdata;
| struct lpfc_rport_data *rdata = cmnd->device->hostdata;
| struct lpfc_nodelist *pnode;
| unsigned tgt_id = cmnd->device->id;
| unsigned int lun_id = cmnd->device->lun;
| struct lpfc_scsi_event_header scsi_event;
| int status;
|
| if (!rdata) {
|  do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "0799 Target Reset rport failure: rdata x%p\n", (vport)->phba->brd_no, vport->vpi, rdata); } } while (0)
|                                                         ;
|  return 0x2003;
| }
| pnode = rdata->pnode;
| status = fc_block_scsi_eh(cmnd);
| if (status)
|  return status;
|
| status = lpfc_chk_tgt_mapped(vport, cmnd);
| if (status == 0x2003) {
|  do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "0722 Target Reset rport failure: rdata x%p\n", (vport)->phba->brd_no, vport->vpi, rdata); } } while (0)
|                                                         ;
|  return 0x2003;
| }
|
| scsi_event.event_type = 0x0200;
| scsi_event.subcategory = 0x0010;
| scsi_event.lun = 0;
| __st_memcpy_st__(scsi_event.wwpn, &pnode->nlp_portname, sizeof(struct lpfc_name));
| __st_memcpy_st__(scsi_event.wwnn, &pnode->nlp_nodename, sizeof(struct lpfc_name));
|
| fc_host_post_vendor_event(shost, fc_get_event_number(),
|  sizeof(scsi_event), (char *)&scsi_event, (((__u64)0x01 << 56) | 0x10df));
|
| status = lpfc_send_taskmgmt(vport, rdata, tgt_id, lun_id,
|     0x20);
|
| do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "0723 SCSI layer issued Target Reset (%d, %d) " "return x%x\n", (vport)->phba->brd_no, vport->vpi, tgt_id, lun_id, status); } } while (0)
|
|                                           ;
|
|
|
|
|
|
|
| status = lpfc_reset_flush_io_context(vport, tgt_id, lun_id,
|     LPFC_CTX_TGT);
| return status;
|}
|static int
|lpfc_bus_reset_handler(struct scsi_cmnd *cmnd)
|{
| struct Scsi_Host *shost = cmnd->device->host;
| struct lpfc_vport *vport = (struct lpfc_vport *) shost->hostdata;
| struct lpfc_nodelist *ndlp = ((void *)0);
| struct lpfc_scsi_event_header scsi_event;
| int match;
| int ret = 0x2002, status, i;
|
| scsi_event.event_type = 0x0200;
| scsi_event.subcategory = 0x0020;
| scsi_event.lun = 0;
| __st_memcpy_st__(scsi_event.wwpn, &vport->fc_portname, sizeof(struct lpfc_name));
| __st_memcpy_st__(scsi_event.wwnn, &vport->fc_nodename, sizeof(struct lpfc_name));
|
| fc_host_post_vendor_event(shost, fc_get_event_number(),
|  sizeof(scsi_event), (char *)&scsi_event, (((__u64)0x01 << 56) | 0x10df));
|
| ret = fc_block_scsi_eh(cmnd);
| if (ret)
|  return ret;
|
|
|
|
|
|
| for (i = 0; i < 4096; i++) {
|
|  match = 0;
|  __st_spin_lock_irq_st__(shost->host_lock);
|  for (ndlp = ({ const typeof( ((typeof(*ndlp) *)0)->nlp_listp ) *__mptr = ((&vport->fc_nodes)->next); (typeof(*ndlp) *)( (char *)__mptr - 1 );}); __builtin_prefetch(ndlp->nlp_listp.next), &ndlp->nlp_listp != (&vport->fc_nodes); ndlp = ({ const typeof( ((typeof(*ndlp) *)0)->nlp_listp ) *__mptr = (ndlp->nlp_listp.next); (typeof(*ndlp) *)( (char *)__mptr - 1 );})) {
|   if (!(((ndlp)->nlp_usg_map & 0x1) && !((ndlp)->nlp_usg_map & 0x8)))
|    continue;
|   if (ndlp->nlp_state == 0x6 &&
|       ndlp->nlp_sid == i &&
|       ndlp->rport) {
|    match = 1;
|    break;
|   }
|  }
|  __st_spin_unlock_irq_st__(shost->host_lock);
|  if (!match)
|   continue;
|
|  status = lpfc_send_taskmgmt(vport, ndlp->rport->dd_data,
|     i, 0, 0x20);
|
|  if (status != 0x2002) {
|   do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "0700 Bus Reset on target %d failed\n", (vport)->phba->brd_no, vport->vpi, i); } } while (0)
|
|        ;
|   ret = 0x2003;
|  }
| }
|
|
|
|
|
|
|
| status = lpfc_reset_flush_io_context(vport, 0, 0, LPFC_CTX_HOST);
| if (status != 0x2002)
|  ret = 0x2003;
|
| do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<3>"[1] <= '3')) dev_printk("<3>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "0714 SCSI layer issued Bus Reset Data: x%x\n", (vport)->phba->brd_no, vport->vpi, ret); } } while (0)
|                                                        ;
| return ret;
|}
|static int
|lpfc_slave_alloc(struct scsi_device *sdev)
|{
| struct lpfc_vport *vport = (struct lpfc_vport *) sdev->host->hostdata;
| struct lpfc_hba *phba = vport->phba;
| struct fc_rport *rport = scsi_is_fc_rport(scsi_target(sdev)->dev.parent) ? ({ const typeof( ((struct fc_rport *)0)->dev ) *__mptr = (scsi_target(sdev)->dev.parent); (struct fc_rport *)( (char *)__mptr - 1 );}) : ((void *)0);
| uint32_t total = 0;
| uint32_t num_to_alloc = 0;
| int num_allocated = 0;
| uint32_t sdev_cnt;
|
| if (!rport || fc_remote_port_chkready(rport))
|  return -6;
|
| sdev->hostdata = rport->dd_data;
| sdev_cnt = (atomic_add_return(1, &phba->sdev_cnt));
| total = phba->total_scsi_bufs;
| num_to_alloc = vport->cfg_lun_queue_depth + 2;
|
|
| if ((sdev_cnt * (vport->cfg_lun_queue_depth + 2)) < total)
|  return 0;
|
|
| if (total >= phba->cfg_hba_queue_depth - 20 ) {
|  do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<4>"[1] <= '3')) dev_printk("<4>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "0704 At limitation of %d preallocated " "command buffers\n", (vport)->phba->brd_no, vport->vpi, total); } } while (0)
|
|                                ;
|  return 0;
|
| } else if (total + num_to_alloc >
|  phba->cfg_hba_queue_depth - 20 ) {
|  do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<4>"[1] <= '3')) dev_printk("<4>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "0705 Allocation request of %d " "command buffers will exceed max of %d.  " "Reducing allocation request to %d.\n", (vport)->phba->brd_no, vport->vpi, num_to_alloc, phba->cfg_hba_queue_depth, (phba->cfg_hba_queue_depth - total)); } } while (0)
|
|
|
|
|                                         ;
|  num_to_alloc = phba->cfg_hba_queue_depth - total;
| }
| num_allocated = lpfc_new_scsi_buf(vport, num_to_alloc);
| if (num_to_alloc != num_allocated) {
|   do { { if (((0x00000040) & (vport)->cfg_log_verbose) || ("<4>"[1] <= '3')) dev_printk("<4>", &((vport)->phba->pcidev)->dev, "%d:(%d):" "0708 Allocation request of %d " "command buffers did not succeed.  " "Allocated %d buffers.\n", (vport)->phba->brd_no, vport->vpi, num_to_alloc, num_allocated); } } while (0)
|
|
|
|                                 ;
| }
| if (num_allocated > 0)
|  phba->total_scsi_bufs += num_allocated;
| return 0;
|}
|static int
|lpfc_slave_configure(struct scsi_device *sdev)
|{
| struct lpfc_vport *vport = (struct lpfc_vport *) sdev->host->hostdata;
| struct lpfc_hba *phba = vport->phba;
|
| if (sdev->tagged_supported)
|  scsi_activate_tcq(sdev, vport->cfg_lun_queue_depth);
| else
|  scsi_deactivate_tcq(sdev, vport->cfg_lun_queue_depth);
|
| if (phba->cfg_poll & ENABLE_FCP_RING_POLLING) {
|  lpfc_sli_handle_fast_ring_event(phba,
|   &phba->sli.ring[0], 0x00000001);
|  if (phba->cfg_poll & DISABLE_FCP_RING_INT)
|   lpfc_poll_rearm_timer(phba);
| }
|
| return 0;
|}
|
|
|
|
|
|
|
|static void
|lpfc_slave_destroy(struct scsi_device *sdev)
|{
| struct lpfc_vport *vport = (struct lpfc_vport *) sdev->host->hostdata;
| struct lpfc_hba *phba = vport->phba;
| atomic_dec(&phba->sdev_cnt);
| sdev->hostdata = ((void *)0);
| return;
|}
|
|
|struct scsi_host_template lpfc_template = {
| .module = (&__this_module),
| .name = "lpfc",
| .info = lpfc_info,
| .queuecommand = lpfc_queuecommand,
| .eh_abort_handler = lpfc_abort_handler,
| .eh_device_reset_handler = lpfc_device_reset_handler,
| .eh_target_reset_handler = lpfc_target_reset_handler,
| .eh_bus_reset_handler = lpfc_bus_reset_handler,
| .slave_alloc = lpfc_slave_alloc,
| .slave_configure = lpfc_slave_configure,
| .slave_destroy = lpfc_slave_destroy,
| .scan_finished = lpfc_scan_finished,
| .this_id = -1,
| .sg_tablesize = 64,
| .cmd_per_lun = 3,
| .use_clustering = 1,
| .shost_attrs = lpfc_hba_attrs,
| .max_sectors = 0xFFFF,
| .vendor_id = (((__u64)0x01 << 56) | 0x10df),
| .change_queue_depth = lpfc_change_queue_depth,
|};
|
|struct scsi_host_template lpfc_vport_template = {
| .module = (&__this_module),
| .name = "lpfc",
| .info = lpfc_info,
| .queuecommand = lpfc_queuecommand,
| .eh_abort_handler = lpfc_abort_handler,
| .eh_device_reset_handler = lpfc_device_reset_handler,
| .eh_target_reset_handler = lpfc_target_reset_handler,
| .eh_bus_reset_handler = lpfc_bus_reset_handler,
| .slave_alloc = lpfc_slave_alloc,
| .slave_configure = lpfc_slave_configure,
| .slave_destroy = lpfc_slave_destroy,
| .scan_finished = lpfc_scan_finished,
| .this_id = -1,
| .sg_tablesize = 64,
| .cmd_per_lun = 3,
| .use_clustering = 1,
| .shost_attrs = lpfc_vport_attrs,
| .max_sectors = 0xFFFF,
| .change_queue_depth = lpfc_change_queue_depth,
|};