]> err.no Git - linux-2.6/blob - drivers/scsi/lpfc/lpfc_scsi.c
[SCSI] lpfc 8.2.6 : Multiple discovery fixes
[linux-2.6] / drivers / scsi / lpfc / lpfc_scsi.c
1 /*******************************************************************
2  * This file is part of the Emulex Linux Device Driver for         *
3  * Fibre Channel Host Bus Adapters.                                *
4  * Copyright (C) 2004-2008 Emulex.  All rights reserved.           *
5  * EMULEX and SLI are trademarks of Emulex.                        *
6  * www.emulex.com                                                  *
7  * Portions Copyright (C) 2004-2005 Christoph Hellwig              *
8  *                                                                 *
9  * This program is free software; you can redistribute it and/or   *
10  * modify it under the terms of version 2 of the GNU General       *
11  * Public License as published by the Free Software Foundation.    *
12  * This program is distributed in the hope that it will be useful. *
13  * ALL EXPRESS OR IMPLIED CONDITIONS, REPRESENTATIONS AND          *
14  * WARRANTIES, INCLUDING ANY IMPLIED WARRANTY OF MERCHANTABILITY,  *
15  * FITNESS FOR A PARTICULAR PURPOSE, OR NON-INFRINGEMENT, ARE      *
16  * DISCLAIMED, EXCEPT TO THE EXTENT THAT SUCH DISCLAIMERS ARE HELD *
17  * TO BE LEGALLY INVALID.  See the GNU General Public License for  *
18  * more details, a copy of which can be found in the file COPYING  *
19  * included with this package.                                     *
20  *******************************************************************/
21
22 #include <linux/pci.h>
23 #include <linux/interrupt.h>
24 #include <linux/delay.h>
25
26 #include <scsi/scsi.h>
27 #include <scsi/scsi_device.h>
28 #include <scsi/scsi_host.h>
29 #include <scsi/scsi_tcq.h>
30 #include <scsi/scsi_transport_fc.h>
31
32 #include "lpfc_version.h"
33 #include "lpfc_hw.h"
34 #include "lpfc_sli.h"
35 #include "lpfc_disc.h"
36 #include "lpfc_scsi.h"
37 #include "lpfc.h"
38 #include "lpfc_logmsg.h"
39 #include "lpfc_crtn.h"
40 #include "lpfc_vport.h"
41
42 #define LPFC_RESET_WAIT  2
43 #define LPFC_ABORT_WAIT  2
44
45 /*
46  * This function is called with no lock held when there is a resource
47  * error in driver or in firmware.
48  */
49 void
50 lpfc_adjust_queue_depth(struct lpfc_hba *phba)
51 {
52         unsigned long flags;
53
54         spin_lock_irqsave(&phba->hbalock, flags);
55         atomic_inc(&phba->num_rsrc_err);
56         phba->last_rsrc_error_time = jiffies;
57
58         if ((phba->last_ramp_down_time + QUEUE_RAMP_DOWN_INTERVAL) > jiffies) {
59                 spin_unlock_irqrestore(&phba->hbalock, flags);
60                 return;
61         }
62
63         phba->last_ramp_down_time = jiffies;
64
65         spin_unlock_irqrestore(&phba->hbalock, flags);
66
67         spin_lock_irqsave(&phba->pport->work_port_lock, flags);
68         if ((phba->pport->work_port_events &
69                 WORKER_RAMP_DOWN_QUEUE) == 0) {
70                 phba->pport->work_port_events |= WORKER_RAMP_DOWN_QUEUE;
71         }
72         spin_unlock_irqrestore(&phba->pport->work_port_lock, flags);
73
74         spin_lock_irqsave(&phba->hbalock, flags);
75         if (phba->work_wait)
76                 wake_up(phba->work_wait);
77         spin_unlock_irqrestore(&phba->hbalock, flags);
78
79         return;
80 }
81
82 /*
83  * This function is called with no lock held when there is a successful
84  * SCSI command completion.
85  */
86 static inline void
87 lpfc_rampup_queue_depth(struct lpfc_vport  *vport,
88                         struct scsi_device *sdev)
89 {
90         unsigned long flags;
91         struct lpfc_hba *phba = vport->phba;
92         atomic_inc(&phba->num_cmd_success);
93
94         if (vport->cfg_lun_queue_depth <= sdev->queue_depth)
95                 return;
96         spin_lock_irqsave(&phba->hbalock, flags);
97         if (((phba->last_ramp_up_time + QUEUE_RAMP_UP_INTERVAL) > jiffies) ||
98          ((phba->last_rsrc_error_time + QUEUE_RAMP_UP_INTERVAL ) > jiffies)) {
99                 spin_unlock_irqrestore(&phba->hbalock, flags);
100                 return;
101         }
102         phba->last_ramp_up_time = jiffies;
103         spin_unlock_irqrestore(&phba->hbalock, flags);
104
105         spin_lock_irqsave(&phba->pport->work_port_lock, flags);
106         if ((phba->pport->work_port_events &
107                 WORKER_RAMP_UP_QUEUE) == 0) {
108                 phba->pport->work_port_events |= WORKER_RAMP_UP_QUEUE;
109         }
110         spin_unlock_irqrestore(&phba->pport->work_port_lock, flags);
111
112         spin_lock_irqsave(&phba->hbalock, flags);
113         if (phba->work_wait)
114                 wake_up(phba->work_wait);
115         spin_unlock_irqrestore(&phba->hbalock, flags);
116 }
117
118 void
119 lpfc_ramp_down_queue_handler(struct lpfc_hba *phba)
120 {
121         struct lpfc_vport **vports;
122         struct Scsi_Host  *shost;
123         struct scsi_device *sdev;
124         unsigned long new_queue_depth;
125         unsigned long num_rsrc_err, num_cmd_success;
126         int i;
127
128         num_rsrc_err = atomic_read(&phba->num_rsrc_err);
129         num_cmd_success = atomic_read(&phba->num_cmd_success);
130
131         vports = lpfc_create_vport_work_array(phba);
132         if (vports != NULL)
133                 for(i = 0; i <= phba->max_vpi && vports[i] != NULL; i++) {
134                         shost = lpfc_shost_from_vport(vports[i]);
135                         shost_for_each_device(sdev, shost) {
136                                 new_queue_depth =
137                                         sdev->queue_depth * num_rsrc_err /
138                                         (num_rsrc_err + num_cmd_success);
139                                 if (!new_queue_depth)
140                                         new_queue_depth = sdev->queue_depth - 1;
141                                 else
142                                         new_queue_depth = sdev->queue_depth -
143                                                                 new_queue_depth;
144                                 if (sdev->ordered_tags)
145                                         scsi_adjust_queue_depth(sdev,
146                                                         MSG_ORDERED_TAG,
147                                                         new_queue_depth);
148                                 else
149                                         scsi_adjust_queue_depth(sdev,
150                                                         MSG_SIMPLE_TAG,
151                                                         new_queue_depth);
152                         }
153                 }
154         lpfc_destroy_vport_work_array(phba, vports);
155         atomic_set(&phba->num_rsrc_err, 0);
156         atomic_set(&phba->num_cmd_success, 0);
157 }
158
159 void
160 lpfc_ramp_up_queue_handler(struct lpfc_hba *phba)
161 {
162         struct lpfc_vport **vports;
163         struct Scsi_Host  *shost;
164         struct scsi_device *sdev;
165         int i;
166
167         vports = lpfc_create_vport_work_array(phba);
168         if (vports != NULL)
169                 for(i = 0; i <= phba->max_vpi && vports[i] != NULL; i++) {
170                         shost = lpfc_shost_from_vport(vports[i]);
171                         shost_for_each_device(sdev, shost) {
172                                 if (sdev->ordered_tags)
173                                         scsi_adjust_queue_depth(sdev,
174                                                         MSG_ORDERED_TAG,
175                                                         sdev->queue_depth+1);
176                                 else
177                                         scsi_adjust_queue_depth(sdev,
178                                                         MSG_SIMPLE_TAG,
179                                                         sdev->queue_depth+1);
180                         }
181                 }
182         lpfc_destroy_vport_work_array(phba, vports);
183         atomic_set(&phba->num_rsrc_err, 0);
184         atomic_set(&phba->num_cmd_success, 0);
185 }
186
187 /*
188  * This routine allocates a scsi buffer, which contains all the necessary
189  * information needed to initiate a SCSI I/O.  The non-DMAable buffer region
190  * contains information to build the IOCB.  The DMAable region contains
191  * memory for the FCP CMND, FCP RSP, and the inital BPL.  In addition to
192  * allocating memeory, the FCP CMND and FCP RSP BDEs are setup in the BPL
193  * and the BPL BDE is setup in the IOCB.
194  */
195 static struct lpfc_scsi_buf *
196 lpfc_new_scsi_buf(struct lpfc_vport *vport)
197 {
198         struct lpfc_hba *phba = vport->phba;
199         struct lpfc_scsi_buf *psb;
200         struct ulp_bde64 *bpl;
201         IOCB_t *iocb;
202         dma_addr_t pdma_phys;
203         uint16_t iotag;
204
205         psb = kzalloc(sizeof(struct lpfc_scsi_buf), GFP_KERNEL);
206         if (!psb)
207                 return NULL;
208
209         /*
210          * Get memory from the pci pool to map the virt space to pci bus space
211          * for an I/O.  The DMA buffer includes space for the struct fcp_cmnd,
212          * struct fcp_rsp and the number of bde's necessary to support the
213          * sg_tablesize.
214          */
215         psb->data = pci_pool_alloc(phba->lpfc_scsi_dma_buf_pool, GFP_KERNEL,
216                                                         &psb->dma_handle);
217         if (!psb->data) {
218                 kfree(psb);
219                 return NULL;
220         }
221
222         /* Initialize virtual ptrs to dma_buf region. */
223         memset(psb->data, 0, phba->cfg_sg_dma_buf_size);
224
225         /* Allocate iotag for psb->cur_iocbq. */
226         iotag = lpfc_sli_next_iotag(phba, &psb->cur_iocbq);
227         if (iotag == 0) {
228                 pci_pool_free(phba->lpfc_scsi_dma_buf_pool,
229                               psb->data, psb->dma_handle);
230                 kfree (psb);
231                 return NULL;
232         }
233         psb->cur_iocbq.iocb_flag |= LPFC_IO_FCP;
234
235         psb->fcp_cmnd = psb->data;
236         psb->fcp_rsp = psb->data + sizeof(struct fcp_cmnd);
237         psb->fcp_bpl = psb->data + sizeof(struct fcp_cmnd) +
238                                                         sizeof(struct fcp_rsp);
239
240         /* Initialize local short-hand pointers. */
241         bpl = psb->fcp_bpl;
242         pdma_phys = psb->dma_handle;
243
244         /*
245          * The first two bdes are the FCP_CMD and FCP_RSP.  The balance are sg
246          * list bdes.  Initialize the first two and leave the rest for
247          * queuecommand.
248          */
249         bpl->addrHigh = le32_to_cpu(putPaddrHigh(pdma_phys));
250         bpl->addrLow = le32_to_cpu(putPaddrLow(pdma_phys));
251         bpl->tus.f.bdeSize = sizeof (struct fcp_cmnd);
252         bpl->tus.f.bdeFlags = BUFF_USE_CMND;
253         bpl->tus.w = le32_to_cpu(bpl->tus.w);
254         bpl++;
255
256         /* Setup the physical region for the FCP RSP */
257         pdma_phys += sizeof (struct fcp_cmnd);
258         bpl->addrHigh = le32_to_cpu(putPaddrHigh(pdma_phys));
259         bpl->addrLow = le32_to_cpu(putPaddrLow(pdma_phys));
260         bpl->tus.f.bdeSize = sizeof (struct fcp_rsp);
261         bpl->tus.f.bdeFlags = (BUFF_USE_CMND | BUFF_USE_RCV);
262         bpl->tus.w = le32_to_cpu(bpl->tus.w);
263
264         /*
265          * Since the IOCB for the FCP I/O is built into this lpfc_scsi_buf,
266          * initialize it with all known data now.
267          */
268         pdma_phys += (sizeof (struct fcp_rsp));
269         iocb = &psb->cur_iocbq.iocb;
270         iocb->un.fcpi64.bdl.ulpIoTag32 = 0;
271         iocb->un.fcpi64.bdl.addrHigh = putPaddrHigh(pdma_phys);
272         iocb->un.fcpi64.bdl.addrLow = putPaddrLow(pdma_phys);
273         iocb->un.fcpi64.bdl.bdeSize = (2 * sizeof (struct ulp_bde64));
274         iocb->un.fcpi64.bdl.bdeFlags = BUFF_TYPE_BDL;
275         iocb->ulpBdeCount = 1;
276         iocb->ulpClass = CLASS3;
277
278         return psb;
279 }
280
281 static struct lpfc_scsi_buf*
282 lpfc_get_scsi_buf(struct lpfc_hba * phba)
283 {
284         struct  lpfc_scsi_buf * lpfc_cmd = NULL;
285         struct list_head *scsi_buf_list = &phba->lpfc_scsi_buf_list;
286         unsigned long iflag = 0;
287
288         spin_lock_irqsave(&phba->scsi_buf_list_lock, iflag);
289         list_remove_head(scsi_buf_list, lpfc_cmd, struct lpfc_scsi_buf, list);
290         if (lpfc_cmd) {
291                 lpfc_cmd->seg_cnt = 0;
292                 lpfc_cmd->nonsg_phys = 0;
293         }
294         spin_unlock_irqrestore(&phba->scsi_buf_list_lock, iflag);
295         return  lpfc_cmd;
296 }
297
298 static void
299 lpfc_release_scsi_buf(struct lpfc_hba *phba, struct lpfc_scsi_buf *psb)
300 {
301         unsigned long iflag = 0;
302
303         spin_lock_irqsave(&phba->scsi_buf_list_lock, iflag);
304         psb->pCmd = NULL;
305         list_add_tail(&psb->list, &phba->lpfc_scsi_buf_list);
306         spin_unlock_irqrestore(&phba->scsi_buf_list_lock, iflag);
307 }
308
309 static int
310 lpfc_scsi_prep_dma_buf(struct lpfc_hba *phba, struct lpfc_scsi_buf *lpfc_cmd)
311 {
312         struct scsi_cmnd *scsi_cmnd = lpfc_cmd->pCmd;
313         struct scatterlist *sgel = NULL;
314         struct fcp_cmnd *fcp_cmnd = lpfc_cmd->fcp_cmnd;
315         struct ulp_bde64 *bpl = lpfc_cmd->fcp_bpl;
316         IOCB_t *iocb_cmd = &lpfc_cmd->cur_iocbq.iocb;
317         dma_addr_t physaddr;
318         uint32_t i, num_bde = 0;
319         int nseg, datadir = scsi_cmnd->sc_data_direction;
320
321         /*
322          * There are three possibilities here - use scatter-gather segment, use
323          * the single mapping, or neither.  Start the lpfc command prep by
324          * bumping the bpl beyond the fcp_cmnd and fcp_rsp regions to the first
325          * data bde entry.
326          */
327         bpl += 2;
328         if (scsi_sg_count(scsi_cmnd)) {
329                 /*
330                  * The driver stores the segment count returned from pci_map_sg
331                  * because this a count of dma-mappings used to map the use_sg
332                  * pages.  They are not guaranteed to be the same for those
333                  * architectures that implement an IOMMU.
334                  */
335
336                 nseg = dma_map_sg(&phba->pcidev->dev, scsi_sglist(scsi_cmnd),
337                                   scsi_sg_count(scsi_cmnd), datadir);
338                 if (unlikely(!nseg))
339                         return 1;
340
341                 lpfc_cmd->seg_cnt = nseg;
342                 if (lpfc_cmd->seg_cnt > phba->cfg_sg_seg_cnt) {
343                         printk(KERN_ERR "%s: Too many sg segments from "
344                                "dma_map_sg.  Config %d, seg_cnt %d",
345                                __FUNCTION__, phba->cfg_sg_seg_cnt,
346                                lpfc_cmd->seg_cnt);
347                         scsi_dma_unmap(scsi_cmnd);
348                         return 1;
349                 }
350
351                 /*
352                  * The driver established a maximum scatter-gather segment count
353                  * during probe that limits the number of sg elements in any
354                  * single scsi command.  Just run through the seg_cnt and format
355                  * the bde's.
356                  */
357                 scsi_for_each_sg(scsi_cmnd, sgel, nseg, i) {
358                         physaddr = sg_dma_address(sgel);
359                         bpl->addrLow = le32_to_cpu(putPaddrLow(physaddr));
360                         bpl->addrHigh = le32_to_cpu(putPaddrHigh(physaddr));
361                         bpl->tus.f.bdeSize = sg_dma_len(sgel);
362                         if (datadir == DMA_TO_DEVICE)
363                                 bpl->tus.f.bdeFlags = 0;
364                         else
365                                 bpl->tus.f.bdeFlags = BUFF_USE_RCV;
366                         bpl->tus.w = le32_to_cpu(bpl->tus.w);
367                         bpl++;
368                         num_bde++;
369                 }
370         }
371
372         /*
373          * Finish initializing those IOCB fields that are dependent on the
374          * scsi_cmnd request_buffer.  Note that the bdeSize is explicitly
375          * reinitialized since all iocb memory resources are used many times
376          * for transmit, receive, and continuation bpl's.
377          */
378         iocb_cmd->un.fcpi64.bdl.bdeSize = (2 * sizeof (struct ulp_bde64));
379         iocb_cmd->un.fcpi64.bdl.bdeSize +=
380                 (num_bde * sizeof (struct ulp_bde64));
381         iocb_cmd->ulpBdeCount = 1;
382         iocb_cmd->ulpLe = 1;
383         fcp_cmnd->fcpDl = cpu_to_be32(scsi_bufflen(scsi_cmnd));
384         return 0;
385 }
386
387 static void
388 lpfc_scsi_unprep_dma_buf(struct lpfc_hba * phba, struct lpfc_scsi_buf * psb)
389 {
390         /*
391          * There are only two special cases to consider.  (1) the scsi command
392          * requested scatter-gather usage or (2) the scsi command allocated
393          * a request buffer, but did not request use_sg.  There is a third
394          * case, but it does not require resource deallocation.
395          */
396         if (psb->seg_cnt > 0)
397                 scsi_dma_unmap(psb->pCmd);
398 }
399
400 static void
401 lpfc_handle_fcp_err(struct lpfc_vport *vport, struct lpfc_scsi_buf *lpfc_cmd,
402                     struct lpfc_iocbq *rsp_iocb)
403 {
404         struct scsi_cmnd *cmnd = lpfc_cmd->pCmd;
405         struct fcp_cmnd *fcpcmd = lpfc_cmd->fcp_cmnd;
406         struct fcp_rsp *fcprsp = lpfc_cmd->fcp_rsp;
407         uint32_t fcpi_parm = rsp_iocb->iocb.un.fcpi.fcpi_parm;
408         uint32_t resp_info = fcprsp->rspStatus2;
409         uint32_t scsi_status = fcprsp->rspStatus3;
410         uint32_t *lp;
411         uint32_t host_status = DID_OK;
412         uint32_t rsplen = 0;
413         uint32_t logit = LOG_FCP | LOG_FCP_ERROR;
414
415         /*
416          *  If this is a task management command, there is no
417          *  scsi packet associated with this lpfc_cmd.  The driver
418          *  consumes it.
419          */
420         if (fcpcmd->fcpCntl2) {
421                 scsi_status = 0;
422                 goto out;
423         }
424
425         if ((resp_info & SNS_LEN_VALID) && fcprsp->rspSnsLen) {
426                 uint32_t snslen = be32_to_cpu(fcprsp->rspSnsLen);
427                 if (snslen > SCSI_SENSE_BUFFERSIZE)
428                         snslen = SCSI_SENSE_BUFFERSIZE;
429
430                 if (resp_info & RSP_LEN_VALID)
431                   rsplen = be32_to_cpu(fcprsp->rspRspLen);
432                 memcpy(cmnd->sense_buffer, &fcprsp->rspInfo0 + rsplen, snslen);
433         }
434         lp = (uint32_t *)cmnd->sense_buffer;
435
436         if (!scsi_status && (resp_info & RESID_UNDER))
437                 logit = LOG_FCP;
438
439         lpfc_printf_vlog(vport, KERN_WARNING, logit,
440                          "0730 FCP command x%x failed: x%x SNS x%x x%x "
441                          "Data: x%x x%x x%x x%x x%x\n",
442                          cmnd->cmnd[0], scsi_status,
443                          be32_to_cpu(*lp), be32_to_cpu(*(lp + 3)), resp_info,
444                          be32_to_cpu(fcprsp->rspResId),
445                          be32_to_cpu(fcprsp->rspSnsLen),
446                          be32_to_cpu(fcprsp->rspRspLen),
447                          fcprsp->rspInfo3);
448
449         if (resp_info & RSP_LEN_VALID) {
450                 rsplen = be32_to_cpu(fcprsp->rspRspLen);
451                 if ((rsplen != 0 && rsplen != 4 && rsplen != 8) ||
452                     (fcprsp->rspInfo3 != RSP_NO_FAILURE)) {
453                         host_status = DID_ERROR;
454                         goto out;
455                 }
456         }
457
458         scsi_set_resid(cmnd, 0);
459         if (resp_info & RESID_UNDER) {
460                 scsi_set_resid(cmnd, be32_to_cpu(fcprsp->rspResId));
461
462                 lpfc_printf_vlog(vport, KERN_INFO, LOG_FCP,
463                                  "0716 FCP Read Underrun, expected %d, "
464                                  "residual %d Data: x%x x%x x%x\n",
465                                  be32_to_cpu(fcpcmd->fcpDl),
466                                  scsi_get_resid(cmnd), fcpi_parm, cmnd->cmnd[0],
467                                  cmnd->underflow);
468
469                 /*
470                  * If there is an under run check if under run reported by
471                  * storage array is same as the under run reported by HBA.
472                  * If this is not same, there is a dropped frame.
473                  */
474                 if ((cmnd->sc_data_direction == DMA_FROM_DEVICE) &&
475                         fcpi_parm &&
476                         (scsi_get_resid(cmnd) != fcpi_parm)) {
477                         lpfc_printf_vlog(vport, KERN_WARNING,
478                                          LOG_FCP | LOG_FCP_ERROR,
479                                          "0735 FCP Read Check Error "
480                                          "and Underrun Data: x%x x%x x%x x%x\n",
481                                          be32_to_cpu(fcpcmd->fcpDl),
482                                          scsi_get_resid(cmnd), fcpi_parm,
483                                          cmnd->cmnd[0]);
484                         scsi_set_resid(cmnd, scsi_bufflen(cmnd));
485                         host_status = DID_ERROR;
486                 }
487                 /*
488                  * The cmnd->underflow is the minimum number of bytes that must
489                  * be transfered for this command.  Provided a sense condition
490                  * is not present, make sure the actual amount transferred is at
491                  * least the underflow value or fail.
492                  */
493                 if (!(resp_info & SNS_LEN_VALID) &&
494                     (scsi_status == SAM_STAT_GOOD) &&
495                     (scsi_bufflen(cmnd) - scsi_get_resid(cmnd)
496                      < cmnd->underflow)) {
497                         lpfc_printf_vlog(vport, KERN_INFO, LOG_FCP,
498                                          "0717 FCP command x%x residual "
499                                          "underrun converted to error "
500                                          "Data: x%x x%x x%x\n",
501                                          cmnd->cmnd[0], scsi_bufflen(cmnd),
502                                          scsi_get_resid(cmnd), cmnd->underflow);
503                         host_status = DID_ERROR;
504                 }
505         } else if (resp_info & RESID_OVER) {
506                 lpfc_printf_vlog(vport, KERN_WARNING, LOG_FCP,
507                                  "0720 FCP command x%x residual overrun error. "
508                                  "Data: x%x x%x \n", cmnd->cmnd[0],
509                                  scsi_bufflen(cmnd), scsi_get_resid(cmnd));
510                 host_status = DID_ERROR;
511
512         /*
513          * Check SLI validation that all the transfer was actually done
514          * (fcpi_parm should be zero). Apply check only to reads.
515          */
516         } else if ((scsi_status == SAM_STAT_GOOD) && fcpi_parm &&
517                         (cmnd->sc_data_direction == DMA_FROM_DEVICE)) {
518                 lpfc_printf_vlog(vport, KERN_WARNING, LOG_FCP | LOG_FCP_ERROR,
519                                  "0734 FCP Read Check Error Data: "
520                                  "x%x x%x x%x x%x\n",
521                                  be32_to_cpu(fcpcmd->fcpDl),
522                                  be32_to_cpu(fcprsp->rspResId),
523                                  fcpi_parm, cmnd->cmnd[0]);
524                 host_status = DID_ERROR;
525                 scsi_set_resid(cmnd, scsi_bufflen(cmnd));
526         }
527
528  out:
529         cmnd->result = ScsiResult(host_status, scsi_status);
530 }
531
532 static void
533 lpfc_scsi_cmd_iocb_cmpl(struct lpfc_hba *phba, struct lpfc_iocbq *pIocbIn,
534                         struct lpfc_iocbq *pIocbOut)
535 {
536         struct lpfc_scsi_buf *lpfc_cmd =
537                 (struct lpfc_scsi_buf *) pIocbIn->context1;
538         struct lpfc_vport      *vport = pIocbIn->vport;
539         struct lpfc_rport_data *rdata = lpfc_cmd->rdata;
540         struct lpfc_nodelist *pnode = rdata->pnode;
541         struct scsi_cmnd *cmd = lpfc_cmd->pCmd;
542         int result;
543         struct scsi_device *sdev, *tmp_sdev;
544         int depth = 0;
545         unsigned long flags;
546
547         lpfc_cmd->result = pIocbOut->iocb.un.ulpWord[4];
548         lpfc_cmd->status = pIocbOut->iocb.ulpStatus;
549
550         if (lpfc_cmd->status) {
551                 if (lpfc_cmd->status == IOSTAT_LOCAL_REJECT &&
552                     (lpfc_cmd->result & IOERR_DRVR_MASK))
553                         lpfc_cmd->status = IOSTAT_DRIVER_REJECT;
554                 else if (lpfc_cmd->status >= IOSTAT_CNT)
555                         lpfc_cmd->status = IOSTAT_DEFAULT;
556
557                 lpfc_printf_vlog(vport, KERN_WARNING, LOG_FCP,
558                                  "0729 FCP cmd x%x failed <%d/%d> "
559                                  "status: x%x result: x%x Data: x%x x%x\n",
560                                  cmd->cmnd[0],
561                                  cmd->device ? cmd->device->id : 0xffff,
562                                  cmd->device ? cmd->device->lun : 0xffff,
563                                  lpfc_cmd->status, lpfc_cmd->result,
564                                  pIocbOut->iocb.ulpContext,
565                                  lpfc_cmd->cur_iocbq.iocb.ulpIoTag);
566
567                 switch (lpfc_cmd->status) {
568                 case IOSTAT_FCP_RSP_ERROR:
569                         /* Call FCP RSP handler to determine result */
570                         lpfc_handle_fcp_err(vport, lpfc_cmd, pIocbOut);
571                         break;
572                 case IOSTAT_NPORT_BSY:
573                 case IOSTAT_FABRIC_BSY:
574                         cmd->result = ScsiResult(DID_BUS_BUSY, 0);
575                         break;
576                 case IOSTAT_LOCAL_REJECT:
577                         if (lpfc_cmd->result == RJT_UNAVAIL_PERM ||
578                             lpfc_cmd->result == IOERR_NO_RESOURCES ||
579                             lpfc_cmd->result == RJT_LOGIN_REQUIRED) {
580                                 cmd->result = ScsiResult(DID_REQUEUE, 0);
581                                 break;
582                         } /* else: fall through */
583                 default:
584                         cmd->result = ScsiResult(DID_ERROR, 0);
585                         break;
586                 }
587
588                 if (!pnode || !NLP_CHK_NODE_ACT(pnode)
589                     || (pnode->nlp_state != NLP_STE_MAPPED_NODE))
590                         cmd->result = ScsiResult(DID_BUS_BUSY, SAM_STAT_BUSY);
591         } else {
592                 cmd->result = ScsiResult(DID_OK, 0);
593         }
594
595         if (cmd->result || lpfc_cmd->fcp_rsp->rspSnsLen) {
596                 uint32_t *lp = (uint32_t *)cmd->sense_buffer;
597
598                 lpfc_printf_vlog(vport, KERN_INFO, LOG_FCP,
599                                  "0710 Iodone <%d/%d> cmd %p, error "
600                                  "x%x SNS x%x x%x Data: x%x x%x\n",
601                                  cmd->device->id, cmd->device->lun, cmd,
602                                  cmd->result, *lp, *(lp + 3), cmd->retries,
603                                  scsi_get_resid(cmd));
604         }
605
606         result = cmd->result;
607         sdev = cmd->device;
608         lpfc_scsi_unprep_dma_buf(phba, lpfc_cmd);
609         cmd->scsi_done(cmd);
610
611         if (phba->cfg_poll & ENABLE_FCP_RING_POLLING) {
612                 /*
613                  * If there is a thread waiting for command completion
614                  * wake up the thread.
615                  */
616                 spin_lock_irqsave(sdev->host->host_lock, flags);
617                 lpfc_cmd->pCmd = NULL;
618                 if (lpfc_cmd->waitq)
619                         wake_up(lpfc_cmd->waitq);
620                 spin_unlock_irqrestore(sdev->host->host_lock, flags);
621                 lpfc_release_scsi_buf(phba, lpfc_cmd);
622                 return;
623         }
624
625
626         if (!result)
627                 lpfc_rampup_queue_depth(vport, sdev);
628
629         if (!result && pnode && NLP_CHK_NODE_ACT(pnode) &&
630            ((jiffies - pnode->last_ramp_up_time) >
631                 LPFC_Q_RAMP_UP_INTERVAL * HZ) &&
632            ((jiffies - pnode->last_q_full_time) >
633                 LPFC_Q_RAMP_UP_INTERVAL * HZ) &&
634            (vport->cfg_lun_queue_depth > sdev->queue_depth)) {
635                 shost_for_each_device(tmp_sdev, sdev->host) {
636                         if (vport->cfg_lun_queue_depth > tmp_sdev->queue_depth){
637                                 if (tmp_sdev->id != sdev->id)
638                                         continue;
639                                 if (tmp_sdev->ordered_tags)
640                                         scsi_adjust_queue_depth(tmp_sdev,
641                                                 MSG_ORDERED_TAG,
642                                                 tmp_sdev->queue_depth+1);
643                                 else
644                                         scsi_adjust_queue_depth(tmp_sdev,
645                                                 MSG_SIMPLE_TAG,
646                                                 tmp_sdev->queue_depth+1);
647
648                                 pnode->last_ramp_up_time = jiffies;
649                         }
650                 }
651         }
652
653         /*
654          * Check for queue full.  If the lun is reporting queue full, then
655          * back off the lun queue depth to prevent target overloads.
656          */
657         if (result == SAM_STAT_TASK_SET_FULL && pnode &&
658             NLP_CHK_NODE_ACT(pnode)) {
659                 pnode->last_q_full_time = jiffies;
660
661                 shost_for_each_device(tmp_sdev, sdev->host) {
662                         if (tmp_sdev->id != sdev->id)
663                                 continue;
664                         depth = scsi_track_queue_full(tmp_sdev,
665                                         tmp_sdev->queue_depth - 1);
666                 }
667                 /*
668                  * The queue depth cannot be lowered any more.
669                  * Modify the returned error code to store
670                  * the final depth value set by
671                  * scsi_track_queue_full.
672                  */
673                 if (depth == -1)
674                         depth = sdev->host->cmd_per_lun;
675
676                 if (depth) {
677                         lpfc_printf_vlog(vport, KERN_WARNING, LOG_FCP,
678                                          "0711 detected queue full - lun queue "
679                                          "depth adjusted to %d.\n", depth);
680                 }
681         }
682
683         /*
684          * If there is a thread waiting for command completion
685          * wake up the thread.
686          */
687         spin_lock_irqsave(sdev->host->host_lock, flags);
688         lpfc_cmd->pCmd = NULL;
689         if (lpfc_cmd->waitq)
690                 wake_up(lpfc_cmd->waitq);
691         spin_unlock_irqrestore(sdev->host->host_lock, flags);
692
693         lpfc_release_scsi_buf(phba, lpfc_cmd);
694 }
695
696 static void
697 lpfc_scsi_prep_cmnd(struct lpfc_vport *vport, struct lpfc_scsi_buf *lpfc_cmd,
698                     struct lpfc_nodelist *pnode)
699 {
700         struct lpfc_hba *phba = vport->phba;
701         struct scsi_cmnd *scsi_cmnd = lpfc_cmd->pCmd;
702         struct fcp_cmnd *fcp_cmnd = lpfc_cmd->fcp_cmnd;
703         IOCB_t *iocb_cmd = &lpfc_cmd->cur_iocbq.iocb;
704         struct lpfc_iocbq *piocbq = &(lpfc_cmd->cur_iocbq);
705         int datadir = scsi_cmnd->sc_data_direction;
706         char tag[2];
707
708         if (!pnode || !NLP_CHK_NODE_ACT(pnode))
709                 return;
710
711         lpfc_cmd->fcp_rsp->rspSnsLen = 0;
712         /* clear task management bits */
713         lpfc_cmd->fcp_cmnd->fcpCntl2 = 0;
714
715         int_to_scsilun(lpfc_cmd->pCmd->device->lun,
716                         &lpfc_cmd->fcp_cmnd->fcp_lun);
717
718         memcpy(&fcp_cmnd->fcpCdb[0], scsi_cmnd->cmnd, 16);
719
720         if (scsi_populate_tag_msg(scsi_cmnd, tag)) {
721                 switch (tag[0]) {
722                 case HEAD_OF_QUEUE_TAG:
723                         fcp_cmnd->fcpCntl1 = HEAD_OF_Q;
724                         break;
725                 case ORDERED_QUEUE_TAG:
726                         fcp_cmnd->fcpCntl1 = ORDERED_Q;
727                         break;
728                 default:
729                         fcp_cmnd->fcpCntl1 = SIMPLE_Q;
730                         break;
731                 }
732         } else
733                 fcp_cmnd->fcpCntl1 = 0;
734
735         /*
736          * There are three possibilities here - use scatter-gather segment, use
737          * the single mapping, or neither.  Start the lpfc command prep by
738          * bumping the bpl beyond the fcp_cmnd and fcp_rsp regions to the first
739          * data bde entry.
740          */
741         if (scsi_sg_count(scsi_cmnd)) {
742                 if (datadir == DMA_TO_DEVICE) {
743                         iocb_cmd->ulpCommand = CMD_FCP_IWRITE64_CR;
744                         iocb_cmd->un.fcpi.fcpi_parm = 0;
745                         iocb_cmd->ulpPU = 0;
746                         fcp_cmnd->fcpCntl3 = WRITE_DATA;
747                         phba->fc4OutputRequests++;
748                 } else {
749                         iocb_cmd->ulpCommand = CMD_FCP_IREAD64_CR;
750                         iocb_cmd->ulpPU = PARM_READ_CHECK;
751                         iocb_cmd->un.fcpi.fcpi_parm = scsi_bufflen(scsi_cmnd);
752                         fcp_cmnd->fcpCntl3 = READ_DATA;
753                         phba->fc4InputRequests++;
754                 }
755         } else {
756                 iocb_cmd->ulpCommand = CMD_FCP_ICMND64_CR;
757                 iocb_cmd->un.fcpi.fcpi_parm = 0;
758                 iocb_cmd->ulpPU = 0;
759                 fcp_cmnd->fcpCntl3 = 0;
760                 phba->fc4ControlRequests++;
761         }
762
763         /*
764          * Finish initializing those IOCB fields that are independent
765          * of the scsi_cmnd request_buffer
766          */
767         piocbq->iocb.ulpContext = pnode->nlp_rpi;
768         if (pnode->nlp_fcp_info & NLP_FCP_2_DEVICE)
769                 piocbq->iocb.ulpFCP2Rcvy = 1;
770         else
771                 piocbq->iocb.ulpFCP2Rcvy = 0;
772
773         piocbq->iocb.ulpClass = (pnode->nlp_fcp_info & 0x0f);
774         piocbq->context1  = lpfc_cmd;
775         piocbq->iocb_cmpl = lpfc_scsi_cmd_iocb_cmpl;
776         piocbq->iocb.ulpTimeout = lpfc_cmd->timeout;
777         piocbq->vport = vport;
778 }
779
780 static int
781 lpfc_scsi_prep_task_mgmt_cmd(struct lpfc_vport *vport,
782                              struct lpfc_scsi_buf *lpfc_cmd,
783                              unsigned int lun,
784                              uint8_t task_mgmt_cmd)
785 {
786         struct lpfc_iocbq *piocbq;
787         IOCB_t *piocb;
788         struct fcp_cmnd *fcp_cmnd;
789         struct lpfc_rport_data *rdata = lpfc_cmd->rdata;
790         struct lpfc_nodelist *ndlp = rdata->pnode;
791
792         if (!ndlp || !NLP_CHK_NODE_ACT(ndlp) ||
793             ndlp->nlp_state != NLP_STE_MAPPED_NODE)
794                 return 0;
795
796         piocbq = &(lpfc_cmd->cur_iocbq);
797         piocbq->vport = vport;
798
799         piocb = &piocbq->iocb;
800
801         fcp_cmnd = lpfc_cmd->fcp_cmnd;
802         int_to_scsilun(lun, &lpfc_cmd->fcp_cmnd->fcp_lun);
803         fcp_cmnd->fcpCntl2 = task_mgmt_cmd;
804
805         piocb->ulpCommand = CMD_FCP_ICMND64_CR;
806
807         piocb->ulpContext = ndlp->nlp_rpi;
808         if (ndlp->nlp_fcp_info & NLP_FCP_2_DEVICE) {
809                 piocb->ulpFCP2Rcvy = 1;
810         }
811         piocb->ulpClass = (ndlp->nlp_fcp_info & 0x0f);
812
813         /* ulpTimeout is only one byte */
814         if (lpfc_cmd->timeout > 0xff) {
815                 /*
816                  * Do not timeout the command at the firmware level.
817                  * The driver will provide the timeout mechanism.
818                  */
819                 piocb->ulpTimeout = 0;
820         } else {
821                 piocb->ulpTimeout = lpfc_cmd->timeout;
822         }
823
824         return 1;
825 }
826
827 static void
828 lpfc_tskmgmt_def_cmpl(struct lpfc_hba *phba,
829                         struct lpfc_iocbq *cmdiocbq,
830                         struct lpfc_iocbq *rspiocbq)
831 {
832         struct lpfc_scsi_buf *lpfc_cmd =
833                 (struct lpfc_scsi_buf *) cmdiocbq->context1;
834         if (lpfc_cmd)
835                 lpfc_release_scsi_buf(phba, lpfc_cmd);
836         return;
837 }
838
839 static int
840 lpfc_scsi_tgt_reset(struct lpfc_scsi_buf *lpfc_cmd, struct lpfc_vport *vport,
841                     unsigned  tgt_id, unsigned int lun,
842                     struct lpfc_rport_data *rdata)
843 {
844         struct lpfc_hba   *phba = vport->phba;
845         struct lpfc_iocbq *iocbq;
846         struct lpfc_iocbq *iocbqrsp;
847         int ret;
848
849         if (!rdata->pnode || !NLP_CHK_NODE_ACT(rdata->pnode))
850                 return FAILED;
851
852         lpfc_cmd->rdata = rdata;
853         ret = lpfc_scsi_prep_task_mgmt_cmd(vport, lpfc_cmd, lun,
854                                            FCP_TARGET_RESET);
855         if (!ret)
856                 return FAILED;
857
858         iocbq = &lpfc_cmd->cur_iocbq;
859         iocbqrsp = lpfc_sli_get_iocbq(phba);
860
861         if (!iocbqrsp)
862                 return FAILED;
863
864         /* Issue Target Reset to TGT <num> */
865         lpfc_printf_vlog(vport, KERN_INFO, LOG_FCP,
866                          "0702 Issue Target Reset to TGT %d Data: x%x x%x\n",
867                          tgt_id, rdata->pnode->nlp_rpi, rdata->pnode->nlp_flag);
868         ret = lpfc_sli_issue_iocb_wait(phba,
869                                        &phba->sli.ring[phba->sli.fcp_ring],
870                                        iocbq, iocbqrsp, lpfc_cmd->timeout);
871         if (ret != IOCB_SUCCESS) {
872                 if (ret == IOCB_TIMEDOUT)
873                         iocbq->iocb_cmpl = lpfc_tskmgmt_def_cmpl;
874                 lpfc_cmd->status = IOSTAT_DRIVER_REJECT;
875         } else {
876                 ret = SUCCESS;
877                 lpfc_cmd->result = iocbqrsp->iocb.un.ulpWord[4];
878                 lpfc_cmd->status = iocbqrsp->iocb.ulpStatus;
879                 if (lpfc_cmd->status == IOSTAT_LOCAL_REJECT &&
880                         (lpfc_cmd->result & IOERR_DRVR_MASK))
881                                 lpfc_cmd->status = IOSTAT_DRIVER_REJECT;
882         }
883
884         lpfc_sli_release_iocbq(phba, iocbqrsp);
885         return ret;
886 }
887
888 const char *
889 lpfc_info(struct Scsi_Host *host)
890 {
891         struct lpfc_vport *vport = (struct lpfc_vport *) host->hostdata;
892         struct lpfc_hba   *phba = vport->phba;
893         int len;
894         static char  lpfcinfobuf[384];
895
896         memset(lpfcinfobuf,0,384);
897         if (phba && phba->pcidev){
898                 strncpy(lpfcinfobuf, phba->ModelDesc, 256);
899                 len = strlen(lpfcinfobuf);
900                 snprintf(lpfcinfobuf + len,
901                         384-len,
902                         " on PCI bus %02x device %02x irq %d",
903                         phba->pcidev->bus->number,
904                         phba->pcidev->devfn,
905                         phba->pcidev->irq);
906                 len = strlen(lpfcinfobuf);
907                 if (phba->Port[0]) {
908                         snprintf(lpfcinfobuf + len,
909                                  384-len,
910                                  " port %s",
911                                  phba->Port);
912                 }
913         }
914         return lpfcinfobuf;
915 }
916
917 static __inline__ void lpfc_poll_rearm_timer(struct lpfc_hba * phba)
918 {
919         unsigned long  poll_tmo_expires =
920                 (jiffies + msecs_to_jiffies(phba->cfg_poll_tmo));
921
922         if (phba->sli.ring[LPFC_FCP_RING].txcmplq_cnt)
923                 mod_timer(&phba->fcp_poll_timer,
924                           poll_tmo_expires);
925 }
926
927 void lpfc_poll_start_timer(struct lpfc_hba * phba)
928 {
929         lpfc_poll_rearm_timer(phba);
930 }
931
932 void lpfc_poll_timeout(unsigned long ptr)
933 {
934         struct lpfc_hba *phba = (struct lpfc_hba *) ptr;
935
936         if (phba->cfg_poll & ENABLE_FCP_RING_POLLING) {
937                 lpfc_sli_poll_fcp_ring (phba);
938                 if (phba->cfg_poll & DISABLE_FCP_RING_INT)
939                         lpfc_poll_rearm_timer(phba);
940         }
941 }
942
943 static int
944 lpfc_queuecommand(struct scsi_cmnd *cmnd, void (*done) (struct scsi_cmnd *))
945 {
946         struct Scsi_Host  *shost = cmnd->device->host;
947         struct lpfc_vport *vport = (struct lpfc_vport *) shost->hostdata;
948         struct lpfc_hba   *phba = vport->phba;
949         struct lpfc_sli   *psli = &phba->sli;
950         struct lpfc_rport_data *rdata = cmnd->device->hostdata;
951         struct lpfc_nodelist *ndlp = rdata->pnode;
952         struct lpfc_scsi_buf *lpfc_cmd;
953         struct fc_rport *rport = starget_to_rport(scsi_target(cmnd->device));
954         int err;
955
956         err = fc_remote_port_chkready(rport);
957         if (err) {
958                 cmnd->result = err;
959                 goto out_fail_command;
960         }
961
962         /*
963          * Catch race where our node has transitioned, but the
964          * transport is still transitioning.
965          */
966         if (!ndlp || !NLP_CHK_NODE_ACT(ndlp)) {
967                 cmnd->result = ScsiResult(DID_BUS_BUSY, 0);
968                 goto out_fail_command;
969         }
970         lpfc_cmd = lpfc_get_scsi_buf(phba);
971         if (lpfc_cmd == NULL) {
972                 lpfc_adjust_queue_depth(phba);
973
974                 lpfc_printf_vlog(vport, KERN_INFO, LOG_FCP,
975                                  "0707 driver's buffer pool is empty, "
976                                  "IO busied\n");
977                 goto out_host_busy;
978         }
979
980         /*
981          * Store the midlayer's command structure for the completion phase
982          * and complete the command initialization.
983          */
984         lpfc_cmd->pCmd  = cmnd;
985         lpfc_cmd->rdata = rdata;
986         lpfc_cmd->timeout = 0;
987         cmnd->host_scribble = (unsigned char *)lpfc_cmd;
988         cmnd->scsi_done = done;
989
990         err = lpfc_scsi_prep_dma_buf(phba, lpfc_cmd);
991         if (err)
992                 goto out_host_busy_free_buf;
993
994         lpfc_scsi_prep_cmnd(vport, lpfc_cmd, ndlp);
995
996         err = lpfc_sli_issue_iocb(phba, &phba->sli.ring[psli->fcp_ring],
997                                   &lpfc_cmd->cur_iocbq, SLI_IOCB_RET_IOCB);
998         if (err)
999                 goto out_host_busy_free_buf;
1000
1001         if (phba->cfg_poll & ENABLE_FCP_RING_POLLING) {
1002                 lpfc_sli_poll_fcp_ring(phba);
1003                 if (phba->cfg_poll & DISABLE_FCP_RING_INT)
1004                         lpfc_poll_rearm_timer(phba);
1005         }
1006
1007         return 0;
1008
1009  out_host_busy_free_buf:
1010         lpfc_scsi_unprep_dma_buf(phba, lpfc_cmd);
1011         lpfc_release_scsi_buf(phba, lpfc_cmd);
1012  out_host_busy:
1013         return SCSI_MLQUEUE_HOST_BUSY;
1014
1015  out_fail_command:
1016         done(cmnd);
1017         return 0;
1018 }
1019
1020 static void
1021 lpfc_block_error_handler(struct scsi_cmnd *cmnd)
1022 {
1023         struct Scsi_Host *shost = cmnd->device->host;
1024         struct fc_rport *rport = starget_to_rport(scsi_target(cmnd->device));
1025
1026         spin_lock_irq(shost->host_lock);
1027         while (rport->port_state == FC_PORTSTATE_BLOCKED) {
1028                 spin_unlock_irq(shost->host_lock);
1029                 msleep(1000);
1030                 spin_lock_irq(shost->host_lock);
1031         }
1032         spin_unlock_irq(shost->host_lock);
1033         return;
1034 }
1035
1036 static int
1037 lpfc_abort_handler(struct scsi_cmnd *cmnd)
1038 {
1039         struct Scsi_Host  *shost = cmnd->device->host;
1040         struct lpfc_vport *vport = (struct lpfc_vport *) shost->hostdata;
1041         struct lpfc_hba   *phba = vport->phba;
1042         struct lpfc_sli_ring *pring = &phba->sli.ring[phba->sli.fcp_ring];
1043         struct lpfc_iocbq *iocb;
1044         struct lpfc_iocbq *abtsiocb;
1045         struct lpfc_scsi_buf *lpfc_cmd;
1046         IOCB_t *cmd, *icmd;
1047         int ret = SUCCESS;
1048         DECLARE_WAIT_QUEUE_HEAD_ONSTACK(waitq);
1049
1050         lpfc_block_error_handler(cmnd);
1051         lpfc_cmd = (struct lpfc_scsi_buf *)cmnd->host_scribble;
1052         BUG_ON(!lpfc_cmd);
1053
1054         /*
1055          * If pCmd field of the corresponding lpfc_scsi_buf structure
1056          * points to a different SCSI command, then the driver has
1057          * already completed this command, but the midlayer did not
1058          * see the completion before the eh fired.  Just return
1059          * SUCCESS.
1060          */
1061         iocb = &lpfc_cmd->cur_iocbq;
1062         if (lpfc_cmd->pCmd != cmnd)
1063                 goto out;
1064
1065         BUG_ON(iocb->context1 != lpfc_cmd);
1066
1067         abtsiocb = lpfc_sli_get_iocbq(phba);
1068         if (abtsiocb == NULL) {
1069                 ret = FAILED;
1070                 goto out;
1071         }
1072
1073         /*
1074          * The scsi command can not be in txq and it is in flight because the
1075          * pCmd is still pointig at the SCSI command we have to abort. There
1076          * is no need to search the txcmplq. Just send an abort to the FW.
1077          */
1078
1079         cmd = &iocb->iocb;
1080         icmd = &abtsiocb->iocb;
1081         icmd->un.acxri.abortType = ABORT_TYPE_ABTS;
1082         icmd->un.acxri.abortContextTag = cmd->ulpContext;
1083         icmd->un.acxri.abortIoTag = cmd->ulpIoTag;
1084
1085         icmd->ulpLe = 1;
1086         icmd->ulpClass = cmd->ulpClass;
1087         if (lpfc_is_link_up(phba))
1088                 icmd->ulpCommand = CMD_ABORT_XRI_CN;
1089         else
1090                 icmd->ulpCommand = CMD_CLOSE_XRI_CN;
1091
1092         abtsiocb->iocb_cmpl = lpfc_sli_abort_fcp_cmpl;
1093         abtsiocb->vport = vport;
1094         if (lpfc_sli_issue_iocb(phba, pring, abtsiocb, 0) == IOCB_ERROR) {
1095                 lpfc_sli_release_iocbq(phba, abtsiocb);
1096                 ret = FAILED;
1097                 goto out;
1098         }
1099
1100         if (phba->cfg_poll & DISABLE_FCP_RING_INT)
1101                 lpfc_sli_poll_fcp_ring (phba);
1102
1103         lpfc_cmd->waitq = &waitq;
1104         /* Wait for abort to complete */
1105         wait_event_timeout(waitq,
1106                           (lpfc_cmd->pCmd != cmnd),
1107                            (2*vport->cfg_devloss_tmo*HZ));
1108
1109         spin_lock_irq(shost->host_lock);
1110         lpfc_cmd->waitq = NULL;
1111         spin_unlock_irq(shost->host_lock);
1112
1113         if (lpfc_cmd->pCmd == cmnd) {
1114                 ret = FAILED;
1115                 lpfc_printf_vlog(vport, KERN_ERR, LOG_FCP,
1116                                  "0748 abort handler timed out waiting "
1117                                  "for abort to complete: ret %#x, ID %d, "
1118                                  "LUN %d, snum %#lx\n",
1119                                  ret, cmnd->device->id, cmnd->device->lun,
1120                                  cmnd->serial_number);
1121         }
1122
1123  out:
1124         lpfc_printf_vlog(vport, KERN_WARNING, LOG_FCP,
1125                          "0749 SCSI Layer I/O Abort Request Status x%x ID %d "
1126                          "LUN %d snum %#lx\n", ret, cmnd->device->id,
1127                          cmnd->device->lun, cmnd->serial_number);
1128         return ret;
1129 }
1130
1131 static int
1132 lpfc_device_reset_handler(struct scsi_cmnd *cmnd)
1133 {
1134         struct Scsi_Host  *shost = cmnd->device->host;
1135         struct lpfc_vport *vport = (struct lpfc_vport *) shost->hostdata;
1136         struct lpfc_hba   *phba = vport->phba;
1137         struct lpfc_scsi_buf *lpfc_cmd;
1138         struct lpfc_iocbq *iocbq, *iocbqrsp;
1139         struct lpfc_rport_data *rdata = cmnd->device->hostdata;
1140         struct lpfc_nodelist *pnode = rdata->pnode;
1141         uint32_t cmd_result = 0, cmd_status = 0;
1142         int ret = FAILED;
1143         int iocb_status = IOCB_SUCCESS;
1144         int cnt, loopcnt;
1145
1146         lpfc_block_error_handler(cmnd);
1147         loopcnt = 0;
1148         /*
1149          * If target is not in a MAPPED state, delay the reset until
1150          * target is rediscovered or devloss timeout expires.
1151          */
1152         while (1) {
1153                 if (!pnode || !NLP_CHK_NODE_ACT(pnode))
1154                         goto out;
1155
1156                 if (pnode->nlp_state != NLP_STE_MAPPED_NODE) {
1157                         schedule_timeout_uninterruptible(msecs_to_jiffies(500));
1158                         loopcnt++;
1159                         rdata = cmnd->device->hostdata;
1160                         if (!rdata ||
1161                                 (loopcnt > ((vport->cfg_devloss_tmo * 2) + 1))){
1162                                 lpfc_printf_vlog(vport, KERN_ERR, LOG_FCP,
1163                                                  "0721 LUN Reset rport "
1164                                                  "failure: cnt x%x rdata x%p\n",
1165                                                  loopcnt, rdata);
1166                                 goto out;
1167                         }
1168                         pnode = rdata->pnode;
1169                         if (!pnode || !NLP_CHK_NODE_ACT(pnode))
1170                                 goto out;
1171                 }
1172                 if (pnode->nlp_state == NLP_STE_MAPPED_NODE)
1173                         break;
1174         }
1175
1176         lpfc_cmd = lpfc_get_scsi_buf(phba);
1177         if (lpfc_cmd == NULL)
1178                 goto out;
1179
1180         lpfc_cmd->timeout = 60;
1181         lpfc_cmd->rdata = rdata;
1182
1183         ret = lpfc_scsi_prep_task_mgmt_cmd(vport, lpfc_cmd, cmnd->device->lun,
1184                                            FCP_TARGET_RESET);
1185         if (!ret)
1186                 goto out_free_scsi_buf;
1187
1188         iocbq = &lpfc_cmd->cur_iocbq;
1189
1190         /* get a buffer for this IOCB command response */
1191         iocbqrsp = lpfc_sli_get_iocbq(phba);
1192         if (iocbqrsp == NULL)
1193                 goto out_free_scsi_buf;
1194
1195         lpfc_printf_vlog(vport, KERN_INFO, LOG_FCP,
1196                          "0703 Issue target reset to TGT %d LUN %d "
1197                          "rpi x%x nlp_flag x%x\n", cmnd->device->id,
1198                          cmnd->device->lun, pnode->nlp_rpi, pnode->nlp_flag);
1199         iocb_status = lpfc_sli_issue_iocb_wait(phba,
1200                                        &phba->sli.ring[phba->sli.fcp_ring],
1201                                        iocbq, iocbqrsp, lpfc_cmd->timeout);
1202
1203         if (iocb_status == IOCB_TIMEDOUT)
1204                 iocbq->iocb_cmpl = lpfc_tskmgmt_def_cmpl;
1205
1206         if (iocb_status == IOCB_SUCCESS)
1207                 ret = SUCCESS;
1208         else
1209                 ret = iocb_status;
1210
1211         cmd_result = iocbqrsp->iocb.un.ulpWord[4];
1212         cmd_status = iocbqrsp->iocb.ulpStatus;
1213
1214         lpfc_sli_release_iocbq(phba, iocbqrsp);
1215
1216         /*
1217          * All outstanding txcmplq I/Os should have been aborted by the device.
1218          * Unfortunately, some targets do not abide by this forcing the driver
1219          * to double check.
1220          */
1221         cnt = lpfc_sli_sum_iocb(vport, cmnd->device->id, cmnd->device->lun,
1222                                 LPFC_CTX_LUN);
1223         if (cnt)
1224                 lpfc_sli_abort_iocb(vport, &phba->sli.ring[phba->sli.fcp_ring],
1225                                     cmnd->device->id, cmnd->device->lun,
1226                                     LPFC_CTX_LUN);
1227         loopcnt = 0;
1228         while(cnt) {
1229                 schedule_timeout_uninterruptible(LPFC_RESET_WAIT*HZ);
1230
1231                 if (++loopcnt
1232                     > (2 * vport->cfg_devloss_tmo)/LPFC_RESET_WAIT)
1233                         break;
1234
1235                 cnt = lpfc_sli_sum_iocb(vport, cmnd->device->id,
1236                                         cmnd->device->lun, LPFC_CTX_LUN);
1237         }
1238
1239         if (cnt) {
1240                 lpfc_printf_vlog(vport, KERN_ERR, LOG_FCP,
1241                                  "0719 device reset I/O flush failure: "
1242                                  "cnt x%x\n", cnt);
1243                 ret = FAILED;
1244         }
1245
1246 out_free_scsi_buf:
1247         if (iocb_status != IOCB_TIMEDOUT) {
1248                 lpfc_release_scsi_buf(phba, lpfc_cmd);
1249         }
1250         lpfc_printf_vlog(vport, KERN_ERR, LOG_FCP,
1251                          "0713 SCSI layer issued device reset (%d, %d) "
1252                          "return x%x status x%x result x%x\n",
1253                          cmnd->device->id, cmnd->device->lun, ret,
1254                          cmd_status, cmd_result);
1255 out:
1256         return ret;
1257 }
1258
1259 static int
1260 lpfc_bus_reset_handler(struct scsi_cmnd *cmnd)
1261 {
1262         struct Scsi_Host  *shost = cmnd->device->host;
1263         struct lpfc_vport *vport = (struct lpfc_vport *) shost->hostdata;
1264         struct lpfc_hba   *phba = vport->phba;
1265         struct lpfc_nodelist *ndlp = NULL;
1266         int match;
1267         int ret = FAILED, i, err_count = 0;
1268         int cnt, loopcnt;
1269         struct lpfc_scsi_buf * lpfc_cmd;
1270
1271         lpfc_block_error_handler(cmnd);
1272
1273         lpfc_cmd = lpfc_get_scsi_buf(phba);
1274         if (lpfc_cmd == NULL)
1275                 goto out;
1276
1277         /* The lpfc_cmd storage is reused.  Set all loop invariants. */
1278         lpfc_cmd->timeout = 60;
1279
1280         /*
1281          * Since the driver manages a single bus device, reset all
1282          * targets known to the driver.  Should any target reset
1283          * fail, this routine returns failure to the midlayer.
1284          */
1285         for (i = 0; i < LPFC_MAX_TARGET; i++) {
1286                 /* Search for mapped node by target ID */
1287                 match = 0;
1288                 spin_lock_irq(shost->host_lock);
1289                 list_for_each_entry(ndlp, &vport->fc_nodes, nlp_listp) {
1290                         if (!NLP_CHK_NODE_ACT(ndlp))
1291                                 continue;
1292                         if (ndlp->nlp_state == NLP_STE_MAPPED_NODE &&
1293                             i == ndlp->nlp_sid &&
1294                             ndlp->rport) {
1295                                 match = 1;
1296                                 break;
1297                         }
1298                 }
1299                 spin_unlock_irq(shost->host_lock);
1300                 if (!match)
1301                         continue;
1302
1303                 ret = lpfc_scsi_tgt_reset(lpfc_cmd, vport, i,
1304                                           cmnd->device->lun,
1305                                           ndlp->rport->dd_data);
1306                 if (ret != SUCCESS) {
1307                         lpfc_printf_vlog(vport, KERN_ERR, LOG_FCP,
1308                                          "0700 Bus Reset on target %d failed\n",
1309                                          i);
1310                         err_count++;
1311                         break;
1312                 }
1313         }
1314
1315         if (ret != IOCB_TIMEDOUT)
1316                 lpfc_release_scsi_buf(phba, lpfc_cmd);
1317
1318         if (err_count == 0)
1319                 ret = SUCCESS;
1320         else
1321                 ret = FAILED;
1322
1323         /*
1324          * All outstanding txcmplq I/Os should have been aborted by
1325          * the targets.  Unfortunately, some targets do not abide by
1326          * this forcing the driver to double check.
1327          */
1328         cnt = lpfc_sli_sum_iocb(vport, 0, 0, LPFC_CTX_HOST);
1329         if (cnt)
1330                 lpfc_sli_abort_iocb(vport, &phba->sli.ring[phba->sli.fcp_ring],
1331                                     0, 0, LPFC_CTX_HOST);
1332         loopcnt = 0;
1333         while(cnt) {
1334                 schedule_timeout_uninterruptible(LPFC_RESET_WAIT*HZ);
1335
1336                 if (++loopcnt
1337                     > (2 * vport->cfg_devloss_tmo)/LPFC_RESET_WAIT)
1338                         break;
1339
1340                 cnt = lpfc_sli_sum_iocb(vport, 0, 0, LPFC_CTX_HOST);
1341         }
1342
1343         if (cnt) {
1344                 lpfc_printf_vlog(vport, KERN_ERR, LOG_FCP,
1345                                  "0715 Bus Reset I/O flush failure: "
1346                                  "cnt x%x left x%x\n", cnt, i);
1347                 ret = FAILED;
1348         }
1349
1350         lpfc_printf_vlog(vport, KERN_ERR, LOG_FCP,
1351                          "0714 SCSI layer issued Bus Reset Data: x%x\n", ret);
1352 out:
1353         return ret;
1354 }
1355
1356 static int
1357 lpfc_slave_alloc(struct scsi_device *sdev)
1358 {
1359         struct lpfc_vport *vport = (struct lpfc_vport *) sdev->host->hostdata;
1360         struct lpfc_hba   *phba = vport->phba;
1361         struct lpfc_scsi_buf *scsi_buf = NULL;
1362         struct fc_rport *rport = starget_to_rport(scsi_target(sdev));
1363         uint32_t total = 0, i;
1364         uint32_t num_to_alloc = 0;
1365         unsigned long flags;
1366
1367         if (!rport || fc_remote_port_chkready(rport))
1368                 return -ENXIO;
1369
1370         sdev->hostdata = rport->dd_data;
1371
1372         /*
1373          * Populate the cmds_per_lun count scsi_bufs into this host's globally
1374          * available list of scsi buffers.  Don't allocate more than the
1375          * HBA limit conveyed to the midlayer via the host structure.  The
1376          * formula accounts for the lun_queue_depth + error handlers + 1
1377          * extra.  This list of scsi bufs exists for the lifetime of the driver.
1378          */
1379         total = phba->total_scsi_bufs;
1380         num_to_alloc = vport->cfg_lun_queue_depth + 2;
1381
1382         /* Allow some exchanges to be available always to complete discovery */
1383         if (total >= phba->cfg_hba_queue_depth - LPFC_DISC_IOCB_BUFF_COUNT ) {
1384                 lpfc_printf_vlog(vport, KERN_WARNING, LOG_FCP,
1385                                  "0704 At limitation of %d preallocated "
1386                                  "command buffers\n", total);
1387                 return 0;
1388         /* Allow some exchanges to be available always to complete discovery */
1389         } else if (total + num_to_alloc >
1390                 phba->cfg_hba_queue_depth - LPFC_DISC_IOCB_BUFF_COUNT ) {
1391                 lpfc_printf_vlog(vport, KERN_WARNING, LOG_FCP,
1392                                  "0705 Allocation request of %d "
1393                                  "command buffers will exceed max of %d.  "
1394                                  "Reducing allocation request to %d.\n",
1395                                  num_to_alloc, phba->cfg_hba_queue_depth,
1396                                  (phba->cfg_hba_queue_depth - total));
1397                 num_to_alloc = phba->cfg_hba_queue_depth - total;
1398         }
1399
1400         for (i = 0; i < num_to_alloc; i++) {
1401                 scsi_buf = lpfc_new_scsi_buf(vport);
1402                 if (!scsi_buf) {
1403                         lpfc_printf_vlog(vport, KERN_ERR, LOG_FCP,
1404                                          "0706 Failed to allocate "
1405                                          "command buffer\n");
1406                         break;
1407                 }
1408
1409                 spin_lock_irqsave(&phba->scsi_buf_list_lock, flags);
1410                 phba->total_scsi_bufs++;
1411                 list_add_tail(&scsi_buf->list, &phba->lpfc_scsi_buf_list);
1412                 spin_unlock_irqrestore(&phba->scsi_buf_list_lock, flags);
1413         }
1414         return 0;
1415 }
1416
1417 static int
1418 lpfc_slave_configure(struct scsi_device *sdev)
1419 {
1420         struct lpfc_vport *vport = (struct lpfc_vport *) sdev->host->hostdata;
1421         struct lpfc_hba   *phba = vport->phba;
1422         struct fc_rport   *rport = starget_to_rport(sdev->sdev_target);
1423
1424         if (sdev->tagged_supported)
1425                 scsi_activate_tcq(sdev, vport->cfg_lun_queue_depth);
1426         else
1427                 scsi_deactivate_tcq(sdev, vport->cfg_lun_queue_depth);
1428
1429         /*
1430          * Initialize the fc transport attributes for the target
1431          * containing this scsi device.  Also note that the driver's
1432          * target pointer is stored in the starget_data for the
1433          * driver's sysfs entry point functions.
1434          */
1435         rport->dev_loss_tmo = vport->cfg_devloss_tmo;
1436
1437         if (phba->cfg_poll & ENABLE_FCP_RING_POLLING) {
1438                 lpfc_sli_poll_fcp_ring(phba);
1439                 if (phba->cfg_poll & DISABLE_FCP_RING_INT)
1440                         lpfc_poll_rearm_timer(phba);
1441         }
1442
1443         return 0;
1444 }
1445
1446 static void
1447 lpfc_slave_destroy(struct scsi_device *sdev)
1448 {
1449         sdev->hostdata = NULL;
1450         return;
1451 }
1452
1453
1454 struct scsi_host_template lpfc_template = {
1455         .module                 = THIS_MODULE,
1456         .name                   = LPFC_DRIVER_NAME,
1457         .info                   = lpfc_info,
1458         .queuecommand           = lpfc_queuecommand,
1459         .eh_abort_handler       = lpfc_abort_handler,
1460         .eh_device_reset_handler= lpfc_device_reset_handler,
1461         .eh_bus_reset_handler   = lpfc_bus_reset_handler,
1462         .slave_alloc            = lpfc_slave_alloc,
1463         .slave_configure        = lpfc_slave_configure,
1464         .slave_destroy          = lpfc_slave_destroy,
1465         .scan_finished          = lpfc_scan_finished,
1466         .this_id                = -1,
1467         .sg_tablesize           = LPFC_DEFAULT_SG_SEG_CNT,
1468         .cmd_per_lun            = LPFC_CMD_PER_LUN,
1469         .use_clustering         = ENABLE_CLUSTERING,
1470         .shost_attrs            = lpfc_hba_attrs,
1471         .max_sectors            = 0xFFFF,
1472 };
1473
1474 struct scsi_host_template lpfc_vport_template = {
1475         .module                 = THIS_MODULE,
1476         .name                   = LPFC_DRIVER_NAME,
1477         .info                   = lpfc_info,
1478         .queuecommand           = lpfc_queuecommand,
1479         .eh_abort_handler       = lpfc_abort_handler,
1480         .eh_device_reset_handler= lpfc_device_reset_handler,
1481         .eh_bus_reset_handler   = lpfc_bus_reset_handler,
1482         .slave_alloc            = lpfc_slave_alloc,
1483         .slave_configure        = lpfc_slave_configure,
1484         .slave_destroy          = lpfc_slave_destroy,
1485         .scan_finished          = lpfc_scan_finished,
1486         .this_id                = -1,
1487         .sg_tablesize           = LPFC_DEFAULT_SG_SEG_CNT,
1488         .cmd_per_lun            = LPFC_CMD_PER_LUN,
1489         .use_clustering         = ENABLE_CLUSTERING,
1490         .shost_attrs            = lpfc_vport_attrs,
1491         .max_sectors            = 0xFFFF,
1492 };