Merge git://git.kernel.org/pub/scm/linux/kernel/git/jejb/scsi-misc-2.6
[linux-3.10.git] / 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-2009 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 #include <linux/pci.h>
22 #include <linux/interrupt.h>
23 #include <linux/delay.h>
24 #include <asm/unaligned.h>
25
26 #include <scsi/scsi.h>
27 #include <scsi/scsi_device.h>
28 #include <scsi/scsi_eh.h>
29 #include <scsi/scsi_host.h>
30 #include <scsi/scsi_tcq.h>
31 #include <scsi/scsi_transport_fc.h>
32
33 #include "lpfc_version.h"
34 #include "lpfc_hw4.h"
35 #include "lpfc_hw.h"
36 #include "lpfc_sli.h"
37 #include "lpfc_sli4.h"
38 #include "lpfc_nl.h"
39 #include "lpfc_disc.h"
40 #include "lpfc_scsi.h"
41 #include "lpfc.h"
42 #include "lpfc_logmsg.h"
43 #include "lpfc_crtn.h"
44 #include "lpfc_vport.h"
45
46 #define LPFC_RESET_WAIT  2
47 #define LPFC_ABORT_WAIT  2
48
49 int _dump_buf_done;
50
51 static char *dif_op_str[] = {
52         "SCSI_PROT_NORMAL",
53         "SCSI_PROT_READ_INSERT",
54         "SCSI_PROT_WRITE_STRIP",
55         "SCSI_PROT_READ_STRIP",
56         "SCSI_PROT_WRITE_INSERT",
57         "SCSI_PROT_READ_PASS",
58         "SCSI_PROT_WRITE_PASS",
59 };
60 static void
61 lpfc_release_scsi_buf_s4(struct lpfc_hba *phba, struct lpfc_scsi_buf *psb);
62 static void
63 lpfc_release_scsi_buf_s3(struct lpfc_hba *phba, struct lpfc_scsi_buf *psb);
64
65 static void
66 lpfc_debug_save_data(struct lpfc_hba *phba, struct scsi_cmnd *cmnd)
67 {
68         void *src, *dst;
69         struct scatterlist *sgde = scsi_sglist(cmnd);
70
71         if (!_dump_buf_data) {
72                 lpfc_printf_log(phba, KERN_ERR, LOG_BG,
73                         "9050 BLKGRD: ERROR %s _dump_buf_data is NULL\n",
74                                 __func__);
75                 return;
76         }
77
78
79         if (!sgde) {
80                 lpfc_printf_log(phba, KERN_ERR, LOG_BG,
81                         "9051 BLKGRD: ERROR: data scatterlist is null\n");
82                 return;
83         }
84
85         dst = (void *) _dump_buf_data;
86         while (sgde) {
87                 src = sg_virt(sgde);
88                 memcpy(dst, src, sgde->length);
89                 dst += sgde->length;
90                 sgde = sg_next(sgde);
91         }
92 }
93
94 static void
95 lpfc_debug_save_dif(struct lpfc_hba *phba, struct scsi_cmnd *cmnd)
96 {
97         void *src, *dst;
98         struct scatterlist *sgde = scsi_prot_sglist(cmnd);
99
100         if (!_dump_buf_dif) {
101                 lpfc_printf_log(phba, KERN_ERR, LOG_BG,
102                         "9052 BLKGRD: ERROR %s _dump_buf_data is NULL\n",
103                                 __func__);
104                 return;
105         }
106
107         if (!sgde) {
108                 lpfc_printf_log(phba, KERN_ERR, LOG_BG,
109                         "9053 BLKGRD: ERROR: prot scatterlist is null\n");
110                 return;
111         }
112
113         dst = _dump_buf_dif;
114         while (sgde) {
115                 src = sg_virt(sgde);
116                 memcpy(dst, src, sgde->length);
117                 dst += sgde->length;
118                 sgde = sg_next(sgde);
119         }
120 }
121
122 /**
123  * lpfc_sli4_set_rsp_sgl_last - Set the last bit in the response sge.
124  * @phba: Pointer to HBA object.
125  * @lpfc_cmd: lpfc scsi command object pointer.
126  *
127  * This function is called from the lpfc_prep_task_mgmt_cmd function to
128  * set the last bit in the response sge entry.
129  **/
130 static void
131 lpfc_sli4_set_rsp_sgl_last(struct lpfc_hba *phba,
132                                 struct lpfc_scsi_buf *lpfc_cmd)
133 {
134         struct sli4_sge *sgl = (struct sli4_sge *)lpfc_cmd->fcp_bpl;
135         if (sgl) {
136                 sgl += 1;
137                 sgl->word2 = le32_to_cpu(sgl->word2);
138                 bf_set(lpfc_sli4_sge_last, sgl, 1);
139                 sgl->word2 = cpu_to_le32(sgl->word2);
140         }
141 }
142
143 /**
144  * lpfc_update_stats - Update statistical data for the command completion
145  * @phba: Pointer to HBA object.
146  * @lpfc_cmd: lpfc scsi command object pointer.
147  *
148  * This function is called when there is a command completion and this
149  * function updates the statistical data for the command completion.
150  **/
151 static void
152 lpfc_update_stats(struct lpfc_hba *phba, struct  lpfc_scsi_buf *lpfc_cmd)
153 {
154         struct lpfc_rport_data *rdata = lpfc_cmd->rdata;
155         struct lpfc_nodelist *pnode = rdata->pnode;
156         struct scsi_cmnd *cmd = lpfc_cmd->pCmd;
157         unsigned long flags;
158         struct Scsi_Host  *shost = cmd->device->host;
159         struct lpfc_vport *vport = (struct lpfc_vport *) shost->hostdata;
160         unsigned long latency;
161         int i;
162
163         if (cmd->result)
164                 return;
165
166         latency = jiffies_to_msecs((long)jiffies - (long)lpfc_cmd->start_time);
167
168         spin_lock_irqsave(shost->host_lock, flags);
169         if (!vport->stat_data_enabled ||
170                 vport->stat_data_blocked ||
171                 !pnode->lat_data ||
172                 (phba->bucket_type == LPFC_NO_BUCKET)) {
173                 spin_unlock_irqrestore(shost->host_lock, flags);
174                 return;
175         }
176
177         if (phba->bucket_type == LPFC_LINEAR_BUCKET) {
178                 i = (latency + phba->bucket_step - 1 - phba->bucket_base)/
179                         phba->bucket_step;
180                 /* check array subscript bounds */
181                 if (i < 0)
182                         i = 0;
183                 else if (i >= LPFC_MAX_BUCKET_COUNT)
184                         i = LPFC_MAX_BUCKET_COUNT - 1;
185         } else {
186                 for (i = 0; i < LPFC_MAX_BUCKET_COUNT-1; i++)
187                         if (latency <= (phba->bucket_base +
188                                 ((1<<i)*phba->bucket_step)))
189                                 break;
190         }
191
192         pnode->lat_data[i].cmd_count++;
193         spin_unlock_irqrestore(shost->host_lock, flags);
194 }
195
196 /**
197  * lpfc_send_sdev_queuedepth_change_event - Posts a queuedepth change event
198  * @phba: Pointer to HBA context object.
199  * @vport: Pointer to vport object.
200  * @ndlp: Pointer to FC node associated with the target.
201  * @lun: Lun number of the scsi device.
202  * @old_val: Old value of the queue depth.
203  * @new_val: New value of the queue depth.
204  *
205  * This function sends an event to the mgmt application indicating
206  * there is a change in the scsi device queue depth.
207  **/
208 static void
209 lpfc_send_sdev_queuedepth_change_event(struct lpfc_hba *phba,
210                 struct lpfc_vport  *vport,
211                 struct lpfc_nodelist *ndlp,
212                 uint32_t lun,
213                 uint32_t old_val,
214                 uint32_t new_val)
215 {
216         struct lpfc_fast_path_event *fast_path_evt;
217         unsigned long flags;
218
219         fast_path_evt = lpfc_alloc_fast_evt(phba);
220         if (!fast_path_evt)
221                 return;
222
223         fast_path_evt->un.queue_depth_evt.scsi_event.event_type =
224                 FC_REG_SCSI_EVENT;
225         fast_path_evt->un.queue_depth_evt.scsi_event.subcategory =
226                 LPFC_EVENT_VARQUEDEPTH;
227
228         /* Report all luns with change in queue depth */
229         fast_path_evt->un.queue_depth_evt.scsi_event.lun = lun;
230         if (ndlp && NLP_CHK_NODE_ACT(ndlp)) {
231                 memcpy(&fast_path_evt->un.queue_depth_evt.scsi_event.wwpn,
232                         &ndlp->nlp_portname, sizeof(struct lpfc_name));
233                 memcpy(&fast_path_evt->un.queue_depth_evt.scsi_event.wwnn,
234                         &ndlp->nlp_nodename, sizeof(struct lpfc_name));
235         }
236
237         fast_path_evt->un.queue_depth_evt.oldval = old_val;
238         fast_path_evt->un.queue_depth_evt.newval = new_val;
239         fast_path_evt->vport = vport;
240
241         fast_path_evt->work_evt.evt = LPFC_EVT_FASTPATH_MGMT_EVT;
242         spin_lock_irqsave(&phba->hbalock, flags);
243         list_add_tail(&fast_path_evt->work_evt.evt_listp, &phba->work_list);
244         spin_unlock_irqrestore(&phba->hbalock, flags);
245         lpfc_worker_wake_up(phba);
246
247         return;
248 }
249
250 /**
251  * lpfc_change_queue_depth - Alter scsi device queue depth
252  * @sdev: Pointer the scsi device on which to change the queue depth.
253  * @qdepth: New queue depth to set the sdev to.
254  * @reason: The reason for the queue depth change.
255  *
256  * This function is called by the midlayer and the LLD to alter the queue
257  * depth for a scsi device. This function sets the queue depth to the new
258  * value and sends an event out to log the queue depth change.
259  **/
260 int
261 lpfc_change_queue_depth(struct scsi_device *sdev, int qdepth, int reason)
262 {
263         struct lpfc_vport *vport = (struct lpfc_vport *) sdev->host->hostdata;
264         struct lpfc_hba   *phba = vport->phba;
265         struct lpfc_rport_data *rdata;
266         unsigned long new_queue_depth, old_queue_depth;
267
268         old_queue_depth = sdev->queue_depth;
269         scsi_adjust_queue_depth(sdev, scsi_get_tag_type(sdev), qdepth);
270         new_queue_depth = sdev->queue_depth;
271         rdata = sdev->hostdata;
272         if (rdata)
273                 lpfc_send_sdev_queuedepth_change_event(phba, vport,
274                                                        rdata->pnode, sdev->lun,
275                                                        old_queue_depth,
276                                                        new_queue_depth);
277         return sdev->queue_depth;
278 }
279
280 /**
281  * lpfc_rampdown_queue_depth - Post RAMP_DOWN_QUEUE event to worker thread
282  * @phba: The Hba for which this call is being executed.
283  *
284  * This routine is called when there is resource error in driver or firmware.
285  * This routine posts WORKER_RAMP_DOWN_QUEUE event for @phba. This routine
286  * posts at most 1 event each second. This routine wakes up worker thread of
287  * @phba to process WORKER_RAM_DOWN_EVENT event.
288  *
289  * This routine should be called with no lock held.
290  **/
291 void
292 lpfc_rampdown_queue_depth(struct lpfc_hba *phba)
293 {
294         unsigned long flags;
295         uint32_t evt_posted;
296
297         spin_lock_irqsave(&phba->hbalock, flags);
298         atomic_inc(&phba->num_rsrc_err);
299         phba->last_rsrc_error_time = jiffies;
300
301         if ((phba->last_ramp_down_time + QUEUE_RAMP_DOWN_INTERVAL) > jiffies) {
302                 spin_unlock_irqrestore(&phba->hbalock, flags);
303                 return;
304         }
305
306         phba->last_ramp_down_time = jiffies;
307
308         spin_unlock_irqrestore(&phba->hbalock, flags);
309
310         spin_lock_irqsave(&phba->pport->work_port_lock, flags);
311         evt_posted = phba->pport->work_port_events & WORKER_RAMP_DOWN_QUEUE;
312         if (!evt_posted)
313                 phba->pport->work_port_events |= WORKER_RAMP_DOWN_QUEUE;
314         spin_unlock_irqrestore(&phba->pport->work_port_lock, flags);
315
316         if (!evt_posted)
317                 lpfc_worker_wake_up(phba);
318         return;
319 }
320
321 /**
322  * lpfc_rampup_queue_depth - Post RAMP_UP_QUEUE event for worker thread
323  * @phba: The Hba for which this call is being executed.
324  *
325  * This routine post WORKER_RAMP_UP_QUEUE event for @phba vport. This routine
326  * post at most 1 event every 5 minute after last_ramp_up_time or
327  * last_rsrc_error_time.  This routine wakes up worker thread of @phba
328  * to process WORKER_RAM_DOWN_EVENT event.
329  *
330  * This routine should be called with no lock held.
331  **/
332 static inline void
333 lpfc_rampup_queue_depth(struct lpfc_vport  *vport,
334                         uint32_t queue_depth)
335 {
336         unsigned long flags;
337         struct lpfc_hba *phba = vport->phba;
338         uint32_t evt_posted;
339         atomic_inc(&phba->num_cmd_success);
340
341         if (vport->cfg_lun_queue_depth <= queue_depth)
342                 return;
343         spin_lock_irqsave(&phba->hbalock, flags);
344         if (time_before(jiffies,
345                         phba->last_ramp_up_time + QUEUE_RAMP_UP_INTERVAL) ||
346             time_before(jiffies,
347                         phba->last_rsrc_error_time + QUEUE_RAMP_UP_INTERVAL)) {
348                 spin_unlock_irqrestore(&phba->hbalock, flags);
349                 return;
350         }
351         phba->last_ramp_up_time = jiffies;
352         spin_unlock_irqrestore(&phba->hbalock, flags);
353
354         spin_lock_irqsave(&phba->pport->work_port_lock, flags);
355         evt_posted = phba->pport->work_port_events & WORKER_RAMP_UP_QUEUE;
356         if (!evt_posted)
357                 phba->pport->work_port_events |= WORKER_RAMP_UP_QUEUE;
358         spin_unlock_irqrestore(&phba->pport->work_port_lock, flags);
359
360         if (!evt_posted)
361                 lpfc_worker_wake_up(phba);
362         return;
363 }
364
365 /**
366  * lpfc_ramp_down_queue_handler - WORKER_RAMP_DOWN_QUEUE event handler
367  * @phba: The Hba for which this call is being executed.
368  *
369  * This routine is called to  process WORKER_RAMP_DOWN_QUEUE event for worker
370  * thread.This routine reduces queue depth for all scsi device on each vport
371  * associated with @phba.
372  **/
373 void
374 lpfc_ramp_down_queue_handler(struct lpfc_hba *phba)
375 {
376         struct lpfc_vport **vports;
377         struct Scsi_Host  *shost;
378         struct scsi_device *sdev;
379         unsigned long new_queue_depth;
380         unsigned long num_rsrc_err, num_cmd_success;
381         int i;
382
383         num_rsrc_err = atomic_read(&phba->num_rsrc_err);
384         num_cmd_success = atomic_read(&phba->num_cmd_success);
385
386         vports = lpfc_create_vport_work_array(phba);
387         if (vports != NULL)
388                 for (i = 0; i <= phba->max_vports && vports[i] != NULL; i++) {
389                         shost = lpfc_shost_from_vport(vports[i]);
390                         shost_for_each_device(sdev, shost) {
391                                 new_queue_depth =
392                                         sdev->queue_depth * num_rsrc_err /
393                                         (num_rsrc_err + num_cmd_success);
394                                 if (!new_queue_depth)
395                                         new_queue_depth = sdev->queue_depth - 1;
396                                 else
397                                         new_queue_depth = sdev->queue_depth -
398                                                                 new_queue_depth;
399                                 lpfc_change_queue_depth(sdev, new_queue_depth,
400                                                         SCSI_QDEPTH_DEFAULT);
401                         }
402                 }
403         lpfc_destroy_vport_work_array(phba, vports);
404         atomic_set(&phba->num_rsrc_err, 0);
405         atomic_set(&phba->num_cmd_success, 0);
406 }
407
408 /**
409  * lpfc_ramp_up_queue_handler - WORKER_RAMP_UP_QUEUE event handler
410  * @phba: The Hba for which this call is being executed.
411  *
412  * This routine is called to  process WORKER_RAMP_UP_QUEUE event for worker
413  * thread.This routine increases queue depth for all scsi device on each vport
414  * associated with @phba by 1. This routine also sets @phba num_rsrc_err and
415  * num_cmd_success to zero.
416  **/
417 void
418 lpfc_ramp_up_queue_handler(struct lpfc_hba *phba)
419 {
420         struct lpfc_vport **vports;
421         struct Scsi_Host  *shost;
422         struct scsi_device *sdev;
423         int i;
424
425         vports = lpfc_create_vport_work_array(phba);
426         if (vports != NULL)
427                 for (i = 0; i <= phba->max_vports && vports[i] != NULL; i++) {
428                         shost = lpfc_shost_from_vport(vports[i]);
429                         shost_for_each_device(sdev, shost) {
430                                 if (vports[i]->cfg_lun_queue_depth <=
431                                     sdev->queue_depth)
432                                         continue;
433                                 lpfc_change_queue_depth(sdev,
434                                                         sdev->queue_depth+1,
435                                                         SCSI_QDEPTH_RAMP_UP);
436                         }
437                 }
438         lpfc_destroy_vport_work_array(phba, vports);
439         atomic_set(&phba->num_rsrc_err, 0);
440         atomic_set(&phba->num_cmd_success, 0);
441 }
442
443 /**
444  * lpfc_scsi_dev_block - set all scsi hosts to block state
445  * @phba: Pointer to HBA context object.
446  *
447  * This function walks vport list and set each SCSI host to block state
448  * by invoking fc_remote_port_delete() routine. This function is invoked
449  * with EEH when device's PCI slot has been permanently disabled.
450  **/
451 void
452 lpfc_scsi_dev_block(struct lpfc_hba *phba)
453 {
454         struct lpfc_vport **vports;
455         struct Scsi_Host  *shost;
456         struct scsi_device *sdev;
457         struct fc_rport *rport;
458         int i;
459
460         vports = lpfc_create_vport_work_array(phba);
461         if (vports != NULL)
462                 for (i = 0; i <= phba->max_vports && vports[i] != NULL; i++) {
463                         shost = lpfc_shost_from_vport(vports[i]);
464                         shost_for_each_device(sdev, shost) {
465                                 rport = starget_to_rport(scsi_target(sdev));
466                                 fc_remote_port_delete(rport);
467                         }
468                 }
469         lpfc_destroy_vport_work_array(phba, vports);
470 }
471
472 /**
473  * lpfc_new_scsi_buf_s3 - Scsi buffer allocator for HBA with SLI3 IF spec
474  * @vport: The virtual port for which this call being executed.
475  * @num_to_allocate: The requested number of buffers to allocate.
476  *
477  * This routine allocates a scsi buffer for device with SLI-3 interface spec,
478  * the scsi buffer contains all the necessary information needed to initiate
479  * a SCSI I/O. The non-DMAable buffer region contains information to build
480  * the IOCB. The DMAable region contains memory for the FCP CMND, FCP RSP,
481  * and the initial BPL. In addition to allocating memory, the FCP CMND and
482  * FCP RSP BDEs are setup in the BPL and the BPL BDE is setup in the IOCB.
483  *
484  * Return codes:
485  *   int - number of scsi buffers that were allocated.
486  *   0 = failure, less than num_to_alloc is a partial failure.
487  **/
488 static int
489 lpfc_new_scsi_buf_s3(struct lpfc_vport *vport, int num_to_alloc)
490 {
491         struct lpfc_hba *phba = vport->phba;
492         struct lpfc_scsi_buf *psb;
493         struct ulp_bde64 *bpl;
494         IOCB_t *iocb;
495         dma_addr_t pdma_phys_fcp_cmd;
496         dma_addr_t pdma_phys_fcp_rsp;
497         dma_addr_t pdma_phys_bpl;
498         uint16_t iotag;
499         int bcnt;
500
501         for (bcnt = 0; bcnt < num_to_alloc; bcnt++) {
502                 psb = kzalloc(sizeof(struct lpfc_scsi_buf), GFP_KERNEL);
503                 if (!psb)
504                         break;
505
506                 /*
507                  * Get memory from the pci pool to map the virt space to pci
508                  * bus space for an I/O.  The DMA buffer includes space for the
509                  * struct fcp_cmnd, struct fcp_rsp and the number of bde's
510                  * necessary to support the sg_tablesize.
511                  */
512                 psb->data = pci_pool_alloc(phba->lpfc_scsi_dma_buf_pool,
513                                         GFP_KERNEL, &psb->dma_handle);
514                 if (!psb->data) {
515                         kfree(psb);
516                         break;
517                 }
518
519                 /* Initialize virtual ptrs to dma_buf region. */
520                 memset(psb->data, 0, phba->cfg_sg_dma_buf_size);
521
522                 /* Allocate iotag for psb->cur_iocbq. */
523                 iotag = lpfc_sli_next_iotag(phba, &psb->cur_iocbq);
524                 if (iotag == 0) {
525                         pci_pool_free(phba->lpfc_scsi_dma_buf_pool,
526                                         psb->data, psb->dma_handle);
527                         kfree(psb);
528                         break;
529                 }
530                 psb->cur_iocbq.iocb_flag |= LPFC_IO_FCP;
531
532                 psb->fcp_cmnd = psb->data;
533                 psb->fcp_rsp = psb->data + sizeof(struct fcp_cmnd);
534                 psb->fcp_bpl = psb->data + sizeof(struct fcp_cmnd) +
535                         sizeof(struct fcp_rsp);
536
537                 /* Initialize local short-hand pointers. */
538                 bpl = psb->fcp_bpl;
539                 pdma_phys_fcp_cmd = psb->dma_handle;
540                 pdma_phys_fcp_rsp = psb->dma_handle + sizeof(struct fcp_cmnd);
541                 pdma_phys_bpl = psb->dma_handle + sizeof(struct fcp_cmnd) +
542                         sizeof(struct fcp_rsp);
543
544                 /*
545                  * The first two bdes are the FCP_CMD and FCP_RSP. The balance
546                  * are sg list bdes.  Initialize the first two and leave the
547                  * rest for queuecommand.
548                  */
549                 bpl[0].addrHigh = le32_to_cpu(putPaddrHigh(pdma_phys_fcp_cmd));
550                 bpl[0].addrLow = le32_to_cpu(putPaddrLow(pdma_phys_fcp_cmd));
551                 bpl[0].tus.f.bdeSize = sizeof(struct fcp_cmnd);
552                 bpl[0].tus.f.bdeFlags = BUFF_TYPE_BDE_64;
553                 bpl[0].tus.w = le32_to_cpu(bpl[0].tus.w);
554
555                 /* Setup the physical region for the FCP RSP */
556                 bpl[1].addrHigh = le32_to_cpu(putPaddrHigh(pdma_phys_fcp_rsp));
557                 bpl[1].addrLow = le32_to_cpu(putPaddrLow(pdma_phys_fcp_rsp));
558                 bpl[1].tus.f.bdeSize = sizeof(struct fcp_rsp);
559                 bpl[1].tus.f.bdeFlags = BUFF_TYPE_BDE_64;
560                 bpl[1].tus.w = le32_to_cpu(bpl[1].tus.w);
561
562                 /*
563                  * Since the IOCB for the FCP I/O is built into this
564                  * lpfc_scsi_buf, initialize it with all known data now.
565                  */
566                 iocb = &psb->cur_iocbq.iocb;
567                 iocb->un.fcpi64.bdl.ulpIoTag32 = 0;
568                 if ((phba->sli_rev == 3) &&
569                                 !(phba->sli3_options & LPFC_SLI3_BG_ENABLED)) {
570                         /* fill in immediate fcp command BDE */
571                         iocb->un.fcpi64.bdl.bdeFlags = BUFF_TYPE_BDE_IMMED;
572                         iocb->un.fcpi64.bdl.bdeSize = sizeof(struct fcp_cmnd);
573                         iocb->un.fcpi64.bdl.addrLow = offsetof(IOCB_t,
574                                         unsli3.fcp_ext.icd);
575                         iocb->un.fcpi64.bdl.addrHigh = 0;
576                         iocb->ulpBdeCount = 0;
577                         iocb->ulpLe = 0;
578                         /* fill in responce BDE */
579                         iocb->unsli3.fcp_ext.rbde.tus.f.bdeFlags =
580                                                         BUFF_TYPE_BDE_64;
581                         iocb->unsli3.fcp_ext.rbde.tus.f.bdeSize =
582                                 sizeof(struct fcp_rsp);
583                         iocb->unsli3.fcp_ext.rbde.addrLow =
584                                 putPaddrLow(pdma_phys_fcp_rsp);
585                         iocb->unsli3.fcp_ext.rbde.addrHigh =
586                                 putPaddrHigh(pdma_phys_fcp_rsp);
587                 } else {
588                         iocb->un.fcpi64.bdl.bdeFlags = BUFF_TYPE_BLP_64;
589                         iocb->un.fcpi64.bdl.bdeSize =
590                                         (2 * sizeof(struct ulp_bde64));
591                         iocb->un.fcpi64.bdl.addrLow =
592                                         putPaddrLow(pdma_phys_bpl);
593                         iocb->un.fcpi64.bdl.addrHigh =
594                                         putPaddrHigh(pdma_phys_bpl);
595                         iocb->ulpBdeCount = 1;
596                         iocb->ulpLe = 1;
597                 }
598                 iocb->ulpClass = CLASS3;
599                 psb->status = IOSTAT_SUCCESS;
600                 /* Put it back into the SCSI buffer list */
601                 lpfc_release_scsi_buf_s3(phba, psb);
602
603         }
604
605         return bcnt;
606 }
607
608 /**
609  * lpfc_sli4_fcp_xri_aborted - Fast-path process of fcp xri abort
610  * @phba: pointer to lpfc hba data structure.
611  * @axri: pointer to the fcp xri abort wcqe structure.
612  *
613  * This routine is invoked by the worker thread to process a SLI4 fast-path
614  * FCP aborted xri.
615  **/
616 void
617 lpfc_sli4_fcp_xri_aborted(struct lpfc_hba *phba,
618                           struct sli4_wcqe_xri_aborted *axri)
619 {
620         uint16_t xri = bf_get(lpfc_wcqe_xa_xri, axri);
621         struct lpfc_scsi_buf *psb, *next_psb;
622         unsigned long iflag = 0;
623         struct lpfc_iocbq *iocbq;
624         int i;
625
626         spin_lock_irqsave(&phba->hbalock, iflag);
627         spin_lock(&phba->sli4_hba.abts_scsi_buf_list_lock);
628         list_for_each_entry_safe(psb, next_psb,
629                 &phba->sli4_hba.lpfc_abts_scsi_buf_list, list) {
630                 if (psb->cur_iocbq.sli4_xritag == xri) {
631                         list_del(&psb->list);
632                         psb->exch_busy = 0;
633                         psb->status = IOSTAT_SUCCESS;
634                         spin_unlock(
635                                 &phba->sli4_hba.abts_scsi_buf_list_lock);
636                         spin_unlock_irqrestore(&phba->hbalock, iflag);
637                         lpfc_release_scsi_buf_s4(phba, psb);
638                         return;
639                 }
640         }
641         spin_unlock(&phba->sli4_hba.abts_scsi_buf_list_lock);
642         for (i = 1; i <= phba->sli.last_iotag; i++) {
643                 iocbq = phba->sli.iocbq_lookup[i];
644
645                 if (!(iocbq->iocb_flag &  LPFC_IO_FCP) ||
646                         (iocbq->iocb_flag & LPFC_IO_LIBDFC))
647                         continue;
648                 if (iocbq->sli4_xritag != xri)
649                         continue;
650                 psb = container_of(iocbq, struct lpfc_scsi_buf, cur_iocbq);
651                 psb->exch_busy = 0;
652                 spin_unlock_irqrestore(&phba->hbalock, iflag);
653                 return;
654
655         }
656         spin_unlock_irqrestore(&phba->hbalock, iflag);
657 }
658
659 /**
660  * lpfc_sli4_repost_scsi_sgl_list - Repsot the Scsi buffers sgl pages as block
661  * @phba: pointer to lpfc hba data structure.
662  *
663  * This routine walks the list of scsi buffers that have been allocated and
664  * repost them to the HBA by using SGL block post. This is needed after a
665  * pci_function_reset/warm_start or start. The lpfc_hba_down_post_s4 routine
666  * is responsible for moving all scsi buffers on the lpfc_abts_scsi_sgl_list
667  * to the lpfc_scsi_buf_list. If the repost fails, reject all scsi buffers.
668  *
669  * Returns: 0 = success, non-zero failure.
670  **/
671 int
672 lpfc_sli4_repost_scsi_sgl_list(struct lpfc_hba *phba)
673 {
674         struct lpfc_scsi_buf *psb;
675         int index, status, bcnt = 0, rcnt = 0, rc = 0;
676         LIST_HEAD(sblist);
677
678         for (index = 0; index < phba->sli4_hba.scsi_xri_cnt; index++) {
679                 psb = phba->sli4_hba.lpfc_scsi_psb_array[index];
680                 if (psb) {
681                         /* Remove from SCSI buffer list */
682                         list_del(&psb->list);
683                         /* Add it to a local SCSI buffer list */
684                         list_add_tail(&psb->list, &sblist);
685                         if (++rcnt == LPFC_NEMBED_MBOX_SGL_CNT) {
686                                 bcnt = rcnt;
687                                 rcnt = 0;
688                         }
689                 } else
690                         /* A hole present in the XRI array, need to skip */
691                         bcnt = rcnt;
692
693                 if (index == phba->sli4_hba.scsi_xri_cnt - 1)
694                         /* End of XRI array for SCSI buffer, complete */
695                         bcnt = rcnt;
696
697                 /* Continue until collect up to a nembed page worth of sgls */
698                 if (bcnt == 0)
699                         continue;
700                 /* Now, post the SCSI buffer list sgls as a block */
701                 status = lpfc_sli4_post_scsi_sgl_block(phba, &sblist, bcnt);
702                 /* Reset SCSI buffer count for next round of posting */
703                 bcnt = 0;
704                 while (!list_empty(&sblist)) {
705                         list_remove_head(&sblist, psb, struct lpfc_scsi_buf,
706                                          list);
707                         if (status) {
708                                 /* Put this back on the abort scsi list */
709                                 psb->exch_busy = 1;
710                                 rc++;
711                         } else {
712                                 psb->exch_busy = 0;
713                                 psb->status = IOSTAT_SUCCESS;
714                         }
715                         /* Put it back into the SCSI buffer list */
716                         lpfc_release_scsi_buf_s4(phba, psb);
717                 }
718         }
719         return rc;
720 }
721
722 /**
723  * lpfc_new_scsi_buf_s4 - Scsi buffer allocator for HBA with SLI4 IF spec
724  * @vport: The virtual port for which this call being executed.
725  * @num_to_allocate: The requested number of buffers to allocate.
726  *
727  * This routine allocates a scsi buffer for device with SLI-4 interface spec,
728  * the scsi buffer contains all the necessary information needed to initiate
729  * a SCSI I/O.
730  *
731  * Return codes:
732  *   int - number of scsi buffers that were allocated.
733  *   0 = failure, less than num_to_alloc is a partial failure.
734  **/
735 static int
736 lpfc_new_scsi_buf_s4(struct lpfc_vport *vport, int num_to_alloc)
737 {
738         struct lpfc_hba *phba = vport->phba;
739         struct lpfc_scsi_buf *psb;
740         struct sli4_sge *sgl;
741         IOCB_t *iocb;
742         dma_addr_t pdma_phys_fcp_cmd;
743         dma_addr_t pdma_phys_fcp_rsp;
744         dma_addr_t pdma_phys_bpl, pdma_phys_bpl1;
745         uint16_t iotag, last_xritag = NO_XRI;
746         int status = 0, index;
747         int bcnt;
748         int non_sequential_xri = 0;
749         int rc = 0;
750         LIST_HEAD(sblist);
751
752         for (bcnt = 0; bcnt < num_to_alloc; bcnt++) {
753                 psb = kzalloc(sizeof(struct lpfc_scsi_buf), GFP_KERNEL);
754                 if (!psb)
755                         break;
756
757                 /*
758                  * Get memory from the pci pool to map the virt space to pci bus
759                  * space for an I/O.  The DMA buffer includes space for the
760                  * struct fcp_cmnd, struct fcp_rsp and the number of bde's
761                  * necessary to support the sg_tablesize.
762                  */
763                 psb->data = pci_pool_alloc(phba->lpfc_scsi_dma_buf_pool,
764                                                 GFP_KERNEL, &psb->dma_handle);
765                 if (!psb->data) {
766                         kfree(psb);
767                         break;
768                 }
769
770                 /* Initialize virtual ptrs to dma_buf region. */
771                 memset(psb->data, 0, phba->cfg_sg_dma_buf_size);
772
773                 /* Allocate iotag for psb->cur_iocbq. */
774                 iotag = lpfc_sli_next_iotag(phba, &psb->cur_iocbq);
775                 if (iotag == 0) {
776                         kfree(psb);
777                         break;
778                 }
779
780                 psb->cur_iocbq.sli4_xritag = lpfc_sli4_next_xritag(phba);
781                 if (psb->cur_iocbq.sli4_xritag == NO_XRI) {
782                         pci_pool_free(phba->lpfc_scsi_dma_buf_pool,
783                               psb->data, psb->dma_handle);
784                         kfree(psb);
785                         break;
786                 }
787                 if (last_xritag != NO_XRI
788                         && psb->cur_iocbq.sli4_xritag != (last_xritag+1)) {
789                         non_sequential_xri = 1;
790                 } else
791                         list_add_tail(&psb->list, &sblist);
792                 last_xritag = psb->cur_iocbq.sli4_xritag;
793
794                 index = phba->sli4_hba.scsi_xri_cnt++;
795                 psb->cur_iocbq.iocb_flag |= LPFC_IO_FCP;
796
797                 psb->fcp_bpl = psb->data;
798                 psb->fcp_cmnd = (psb->data + phba->cfg_sg_dma_buf_size)
799                         - (sizeof(struct fcp_cmnd) + sizeof(struct fcp_rsp));
800                 psb->fcp_rsp = (struct fcp_rsp *)((uint8_t *)psb->fcp_cmnd +
801                                         sizeof(struct fcp_cmnd));
802
803                 /* Initialize local short-hand pointers. */
804                 sgl = (struct sli4_sge *)psb->fcp_bpl;
805                 pdma_phys_bpl = psb->dma_handle;
806                 pdma_phys_fcp_cmd =
807                         (psb->dma_handle + phba->cfg_sg_dma_buf_size)
808                          - (sizeof(struct fcp_cmnd) + sizeof(struct fcp_rsp));
809                 pdma_phys_fcp_rsp = pdma_phys_fcp_cmd + sizeof(struct fcp_cmnd);
810
811                 /*
812                  * The first two bdes are the FCP_CMD and FCP_RSP.  The balance
813                  * are sg list bdes.  Initialize the first two and leave the
814                  * rest for queuecommand.
815                  */
816                 sgl->addr_hi = cpu_to_le32(putPaddrHigh(pdma_phys_fcp_cmd));
817                 sgl->addr_lo = cpu_to_le32(putPaddrLow(pdma_phys_fcp_cmd));
818                 bf_set(lpfc_sli4_sge_last, sgl, 0);
819                 sgl->word2 = cpu_to_le32(sgl->word2);
820                 sgl->sge_len = cpu_to_le32(sizeof(struct fcp_cmnd));
821                 sgl++;
822
823                 /* Setup the physical region for the FCP RSP */
824                 sgl->addr_hi = cpu_to_le32(putPaddrHigh(pdma_phys_fcp_rsp));
825                 sgl->addr_lo = cpu_to_le32(putPaddrLow(pdma_phys_fcp_rsp));
826                 bf_set(lpfc_sli4_sge_last, sgl, 1);
827                 sgl->word2 = cpu_to_le32(sgl->word2);
828                 sgl->sge_len = cpu_to_le32(sizeof(struct fcp_rsp));
829
830                 /*
831                  * Since the IOCB for the FCP I/O is built into this
832                  * lpfc_scsi_buf, initialize it with all known data now.
833                  */
834                 iocb = &psb->cur_iocbq.iocb;
835                 iocb->un.fcpi64.bdl.ulpIoTag32 = 0;
836                 iocb->un.fcpi64.bdl.bdeFlags = BUFF_TYPE_BDE_64;
837                 /* setting the BLP size to 2 * sizeof BDE may not be correct.
838                  * We are setting the bpl to point to out sgl. An sgl's
839                  * entries are 16 bytes, a bpl entries are 12 bytes.
840                  */
841                 iocb->un.fcpi64.bdl.bdeSize = sizeof(struct fcp_cmnd);
842                 iocb->un.fcpi64.bdl.addrLow = putPaddrLow(pdma_phys_fcp_cmd);
843                 iocb->un.fcpi64.bdl.addrHigh = putPaddrHigh(pdma_phys_fcp_cmd);
844                 iocb->ulpBdeCount = 1;
845                 iocb->ulpLe = 1;
846                 iocb->ulpClass = CLASS3;
847                 if (phba->cfg_sg_dma_buf_size > SGL_PAGE_SIZE)
848                         pdma_phys_bpl1 = pdma_phys_bpl + SGL_PAGE_SIZE;
849                 else
850                         pdma_phys_bpl1 = 0;
851                 psb->dma_phys_bpl = pdma_phys_bpl;
852                 phba->sli4_hba.lpfc_scsi_psb_array[index] = psb;
853                 if (non_sequential_xri) {
854                         status = lpfc_sli4_post_sgl(phba, pdma_phys_bpl,
855                                                 pdma_phys_bpl1,
856                                                 psb->cur_iocbq.sli4_xritag);
857                         if (status) {
858                                 /* Put this back on the abort scsi list */
859                                 psb->exch_busy = 1;
860                                 rc++;
861                         } else {
862                                 psb->exch_busy = 0;
863                                 psb->status = IOSTAT_SUCCESS;
864                         }
865                         /* Put it back into the SCSI buffer list */
866                         lpfc_release_scsi_buf_s4(phba, psb);
867                         break;
868                 }
869         }
870         if (bcnt) {
871                 status = lpfc_sli4_post_scsi_sgl_block(phba, &sblist, bcnt);
872                 /* Reset SCSI buffer count for next round of posting */
873                 while (!list_empty(&sblist)) {
874                         list_remove_head(&sblist, psb, struct lpfc_scsi_buf,
875                                  list);
876                         if (status) {
877                                 /* Put this back on the abort scsi list */
878                                 psb->exch_busy = 1;
879                                 rc++;
880                         } else {
881                                 psb->exch_busy = 0;
882                                 psb->status = IOSTAT_SUCCESS;
883                         }
884                         /* Put it back into the SCSI buffer list */
885                         lpfc_release_scsi_buf_s4(phba, psb);
886                 }
887         }
888
889         return bcnt + non_sequential_xri - rc;
890 }
891
892 /**
893  * lpfc_new_scsi_buf - Wrapper funciton for scsi buffer allocator
894  * @vport: The virtual port for which this call being executed.
895  * @num_to_allocate: The requested number of buffers to allocate.
896  *
897  * This routine wraps the actual SCSI buffer allocator function pointer from
898  * the lpfc_hba struct.
899  *
900  * Return codes:
901  *   int - number of scsi buffers that were allocated.
902  *   0 = failure, less than num_to_alloc is a partial failure.
903  **/
904 static inline int
905 lpfc_new_scsi_buf(struct lpfc_vport *vport, int num_to_alloc)
906 {
907         return vport->phba->lpfc_new_scsi_buf(vport, num_to_alloc);
908 }
909
910 /**
911  * lpfc_get_scsi_buf - Get a scsi buffer from lpfc_scsi_buf_list of the HBA
912  * @phba: The HBA for which this call is being executed.
913  *
914  * This routine removes a scsi buffer from head of @phba lpfc_scsi_buf_list list
915  * and returns to caller.
916  *
917  * Return codes:
918  *   NULL - Error
919  *   Pointer to lpfc_scsi_buf - Success
920  **/
921 static struct lpfc_scsi_buf*
922 lpfc_get_scsi_buf(struct lpfc_hba * phba)
923 {
924         struct  lpfc_scsi_buf * lpfc_cmd = NULL;
925         struct list_head *scsi_buf_list = &phba->lpfc_scsi_buf_list;
926         unsigned long iflag = 0;
927
928         spin_lock_irqsave(&phba->scsi_buf_list_lock, iflag);
929         list_remove_head(scsi_buf_list, lpfc_cmd, struct lpfc_scsi_buf, list);
930         if (lpfc_cmd) {
931                 lpfc_cmd->seg_cnt = 0;
932                 lpfc_cmd->nonsg_phys = 0;
933                 lpfc_cmd->prot_seg_cnt = 0;
934         }
935         spin_unlock_irqrestore(&phba->scsi_buf_list_lock, iflag);
936         return  lpfc_cmd;
937 }
938
939 /**
940  * lpfc_release_scsi_buf - Return a scsi buffer back to hba scsi buf list
941  * @phba: The Hba for which this call is being executed.
942  * @psb: The scsi buffer which is being released.
943  *
944  * This routine releases @psb scsi buffer by adding it to tail of @phba
945  * lpfc_scsi_buf_list list.
946  **/
947 static void
948 lpfc_release_scsi_buf_s3(struct lpfc_hba *phba, struct lpfc_scsi_buf *psb)
949 {
950         unsigned long iflag = 0;
951
952         spin_lock_irqsave(&phba->scsi_buf_list_lock, iflag);
953         psb->pCmd = NULL;
954         list_add_tail(&psb->list, &phba->lpfc_scsi_buf_list);
955         spin_unlock_irqrestore(&phba->scsi_buf_list_lock, iflag);
956 }
957
958 /**
959  * lpfc_release_scsi_buf_s4: Return a scsi buffer back to hba scsi buf list.
960  * @phba: The Hba for which this call is being executed.
961  * @psb: The scsi buffer which is being released.
962  *
963  * This routine releases @psb scsi buffer by adding it to tail of @phba
964  * lpfc_scsi_buf_list list. For SLI4 XRI's are tied to the scsi buffer
965  * and cannot be reused for at least RA_TOV amount of time if it was
966  * aborted.
967  **/
968 static void
969 lpfc_release_scsi_buf_s4(struct lpfc_hba *phba, struct lpfc_scsi_buf *psb)
970 {
971         unsigned long iflag = 0;
972
973         if (psb->exch_busy) {
974                 spin_lock_irqsave(&phba->sli4_hba.abts_scsi_buf_list_lock,
975                                         iflag);
976                 psb->pCmd = NULL;
977                 list_add_tail(&psb->list,
978                         &phba->sli4_hba.lpfc_abts_scsi_buf_list);
979                 spin_unlock_irqrestore(&phba->sli4_hba.abts_scsi_buf_list_lock,
980                                         iflag);
981         } else {
982
983                 spin_lock_irqsave(&phba->scsi_buf_list_lock, iflag);
984                 psb->pCmd = NULL;
985                 list_add_tail(&psb->list, &phba->lpfc_scsi_buf_list);
986                 spin_unlock_irqrestore(&phba->scsi_buf_list_lock, iflag);
987         }
988 }
989
990 /**
991  * lpfc_release_scsi_buf: Return a scsi buffer back to hba scsi buf list.
992  * @phba: The Hba for which this call is being executed.
993  * @psb: The scsi buffer which is being released.
994  *
995  * This routine releases @psb scsi buffer by adding it to tail of @phba
996  * lpfc_scsi_buf_list list.
997  **/
998 static void
999 lpfc_release_scsi_buf(struct lpfc_hba *phba, struct lpfc_scsi_buf *psb)
1000 {
1001
1002         phba->lpfc_release_scsi_buf(phba, psb);
1003 }
1004
1005 /**
1006  * lpfc_scsi_prep_dma_buf_s3 - DMA mapping for scsi buffer to SLI3 IF spec
1007  * @phba: The Hba for which this call is being executed.
1008  * @lpfc_cmd: The scsi buffer which is going to be mapped.
1009  *
1010  * This routine does the pci dma mapping for scatter-gather list of scsi cmnd
1011  * field of @lpfc_cmd for device with SLI-3 interface spec. This routine scans
1012  * through sg elements and format the bdea. This routine also initializes all
1013  * IOCB fields which are dependent on scsi command request buffer.
1014  *
1015  * Return codes:
1016  *   1 - Error
1017  *   0 - Success
1018  **/
1019 static int
1020 lpfc_scsi_prep_dma_buf_s3(struct lpfc_hba *phba, struct lpfc_scsi_buf *lpfc_cmd)
1021 {
1022         struct scsi_cmnd *scsi_cmnd = lpfc_cmd->pCmd;
1023         struct scatterlist *sgel = NULL;
1024         struct fcp_cmnd *fcp_cmnd = lpfc_cmd->fcp_cmnd;
1025         struct ulp_bde64 *bpl = lpfc_cmd->fcp_bpl;
1026         struct lpfc_iocbq *iocbq = &lpfc_cmd->cur_iocbq;
1027         IOCB_t *iocb_cmd = &lpfc_cmd->cur_iocbq.iocb;
1028         struct ulp_bde64 *data_bde = iocb_cmd->unsli3.fcp_ext.dbde;
1029         dma_addr_t physaddr;
1030         uint32_t num_bde = 0;
1031         int nseg, datadir = scsi_cmnd->sc_data_direction;
1032
1033         /*
1034          * There are three possibilities here - use scatter-gather segment, use
1035          * the single mapping, or neither.  Start the lpfc command prep by
1036          * bumping the bpl beyond the fcp_cmnd and fcp_rsp regions to the first
1037          * data bde entry.
1038          */
1039         bpl += 2;
1040         if (scsi_sg_count(scsi_cmnd)) {
1041                 /*
1042                  * The driver stores the segment count returned from pci_map_sg
1043                  * because this a count of dma-mappings used to map the use_sg
1044                  * pages.  They are not guaranteed to be the same for those
1045                  * architectures that implement an IOMMU.
1046                  */
1047
1048                 nseg = dma_map_sg(&phba->pcidev->dev, scsi_sglist(scsi_cmnd),
1049                                   scsi_sg_count(scsi_cmnd), datadir);
1050                 if (unlikely(!nseg))
1051                         return 1;
1052
1053                 lpfc_cmd->seg_cnt = nseg;
1054                 if (lpfc_cmd->seg_cnt > phba->cfg_sg_seg_cnt) {
1055                         lpfc_printf_log(phba, KERN_ERR, LOG_BG,
1056                                 "9064 BLKGRD: %s: Too many sg segments from "
1057                                "dma_map_sg.  Config %d, seg_cnt %d\n",
1058                                __func__, phba->cfg_sg_seg_cnt,
1059                                lpfc_cmd->seg_cnt);
1060                         scsi_dma_unmap(scsi_cmnd);
1061                         return 1;
1062                 }
1063
1064                 /*
1065                  * The driver established a maximum scatter-gather segment count
1066                  * during probe that limits the number of sg elements in any
1067                  * single scsi command.  Just run through the seg_cnt and format
1068                  * the bde's.
1069                  * When using SLI-3 the driver will try to fit all the BDEs into
1070                  * the IOCB. If it can't then the BDEs get added to a BPL as it
1071                  * does for SLI-2 mode.
1072                  */
1073                 scsi_for_each_sg(scsi_cmnd, sgel, nseg, num_bde) {
1074                         physaddr = sg_dma_address(sgel);
1075                         if (phba->sli_rev == 3 &&
1076                             !(phba->sli3_options & LPFC_SLI3_BG_ENABLED) &&
1077                             !(iocbq->iocb_flag & DSS_SECURITY_OP) &&
1078                             nseg <= LPFC_EXT_DATA_BDE_COUNT) {
1079                                 data_bde->tus.f.bdeFlags = BUFF_TYPE_BDE_64;
1080                                 data_bde->tus.f.bdeSize = sg_dma_len(sgel);
1081                                 data_bde->addrLow = putPaddrLow(physaddr);
1082                                 data_bde->addrHigh = putPaddrHigh(physaddr);
1083                                 data_bde++;
1084                         } else {
1085                                 bpl->tus.f.bdeFlags = BUFF_TYPE_BDE_64;
1086                                 bpl->tus.f.bdeSize = sg_dma_len(sgel);
1087                                 bpl->tus.w = le32_to_cpu(bpl->tus.w);
1088                                 bpl->addrLow =
1089                                         le32_to_cpu(putPaddrLow(physaddr));
1090                                 bpl->addrHigh =
1091                                         le32_to_cpu(putPaddrHigh(physaddr));
1092                                 bpl++;
1093                         }
1094                 }
1095         }
1096
1097         /*
1098          * Finish initializing those IOCB fields that are dependent on the
1099          * scsi_cmnd request_buffer.  Note that for SLI-2 the bdeSize is
1100          * explicitly reinitialized and for SLI-3 the extended bde count is
1101          * explicitly reinitialized since all iocb memory resources are reused.
1102          */
1103         if (phba->sli_rev == 3 &&
1104             !(phba->sli3_options & LPFC_SLI3_BG_ENABLED) &&
1105             !(iocbq->iocb_flag & DSS_SECURITY_OP)) {
1106                 if (num_bde > LPFC_EXT_DATA_BDE_COUNT) {
1107                         /*
1108                          * The extended IOCB format can only fit 3 BDE or a BPL.
1109                          * This I/O has more than 3 BDE so the 1st data bde will
1110                          * be a BPL that is filled in here.
1111                          */
1112                         physaddr = lpfc_cmd->dma_handle;
1113                         data_bde->tus.f.bdeFlags = BUFF_TYPE_BLP_64;
1114                         data_bde->tus.f.bdeSize = (num_bde *
1115                                                    sizeof(struct ulp_bde64));
1116                         physaddr += (sizeof(struct fcp_cmnd) +
1117                                      sizeof(struct fcp_rsp) +
1118                                      (2 * sizeof(struct ulp_bde64)));
1119                         data_bde->addrHigh = putPaddrHigh(physaddr);
1120                         data_bde->addrLow = putPaddrLow(physaddr);
1121                         /* ebde count includes the responce bde and data bpl */
1122                         iocb_cmd->unsli3.fcp_ext.ebde_count = 2;
1123                 } else {
1124                         /* ebde count includes the responce bde and data bdes */
1125                         iocb_cmd->unsli3.fcp_ext.ebde_count = (num_bde + 1);
1126                 }
1127         } else {
1128                 iocb_cmd->un.fcpi64.bdl.bdeSize =
1129                         ((num_bde + 2) * sizeof(struct ulp_bde64));
1130                 iocb_cmd->unsli3.fcp_ext.ebde_count = (num_bde + 1);
1131         }
1132         fcp_cmnd->fcpDl = cpu_to_be32(scsi_bufflen(scsi_cmnd));
1133
1134         /*
1135          * Due to difference in data length between DIF/non-DIF paths,
1136          * we need to set word 4 of IOCB here
1137          */
1138         iocb_cmd->un.fcpi.fcpi_parm = scsi_bufflen(scsi_cmnd);
1139         return 0;
1140 }
1141
1142 /*
1143  * Given a scsi cmnd, determine the BlockGuard profile to be used
1144  * with the cmd
1145  */
1146 static int
1147 lpfc_sc_to_sli_prof(struct lpfc_hba *phba, struct scsi_cmnd *sc)
1148 {
1149         uint8_t guard_type = scsi_host_get_guard(sc->device->host);
1150         uint8_t ret_prof = LPFC_PROF_INVALID;
1151
1152         if (guard_type == SHOST_DIX_GUARD_IP) {
1153                 switch (scsi_get_prot_op(sc)) {
1154                 case SCSI_PROT_READ_INSERT:
1155                 case SCSI_PROT_WRITE_STRIP:
1156                         ret_prof = LPFC_PROF_AST2;
1157                         break;
1158
1159                 case SCSI_PROT_READ_STRIP:
1160                 case SCSI_PROT_WRITE_INSERT:
1161                         ret_prof = LPFC_PROF_A1;
1162                         break;
1163
1164                 case SCSI_PROT_READ_PASS:
1165                 case SCSI_PROT_WRITE_PASS:
1166                         ret_prof = LPFC_PROF_AST1;
1167                         break;
1168
1169                 case SCSI_PROT_NORMAL:
1170                 default:
1171                         lpfc_printf_log(phba, KERN_ERR, LOG_BG,
1172                                 "9063 BLKGRD:Bad op/guard:%d/%d combination\n",
1173                                         scsi_get_prot_op(sc), guard_type);
1174                         break;
1175
1176                 }
1177         } else if (guard_type == SHOST_DIX_GUARD_CRC) {
1178                 switch (scsi_get_prot_op(sc)) {
1179                 case SCSI_PROT_READ_STRIP:
1180                 case SCSI_PROT_WRITE_INSERT:
1181                         ret_prof = LPFC_PROF_A1;
1182                         break;
1183
1184                 case SCSI_PROT_READ_PASS:
1185                 case SCSI_PROT_WRITE_PASS:
1186                         ret_prof = LPFC_PROF_C1;
1187                         break;
1188
1189                 case SCSI_PROT_READ_INSERT:
1190                 case SCSI_PROT_WRITE_STRIP:
1191                 case SCSI_PROT_NORMAL:
1192                 default:
1193                         lpfc_printf_log(phba, KERN_ERR, LOG_BG,
1194                                 "9075 BLKGRD: Bad op/guard:%d/%d combination\n",
1195                                         scsi_get_prot_op(sc), guard_type);
1196                         break;
1197                 }
1198         } else {
1199                 /* unsupported format */
1200                 BUG();
1201         }
1202
1203         return ret_prof;
1204 }
1205
1206 struct scsi_dif_tuple {
1207         __be16 guard_tag;       /* Checksum */
1208         __be16 app_tag;         /* Opaque storage */
1209         __be32 ref_tag;         /* Target LBA or indirect LBA */
1210 };
1211
1212 static inline unsigned
1213 lpfc_cmd_blksize(struct scsi_cmnd *sc)
1214 {
1215         return sc->device->sector_size;
1216 }
1217
1218 /**
1219  * lpfc_get_cmd_dif_parms - Extract DIF parameters from SCSI command
1220  * @sc:             in: SCSI command
1221  * @apptagmask:     out: app tag mask
1222  * @apptagval:      out: app tag value
1223  * @reftag:         out: ref tag (reference tag)
1224  *
1225  * Description:
1226  *   Extract DIF parameters from the command if possible.  Otherwise,
1227  *   use default parameters.
1228  *
1229  **/
1230 static inline void
1231 lpfc_get_cmd_dif_parms(struct scsi_cmnd *sc, uint16_t *apptagmask,
1232                 uint16_t *apptagval, uint32_t *reftag)
1233 {
1234         struct  scsi_dif_tuple *spt;
1235         unsigned char op = scsi_get_prot_op(sc);
1236         unsigned int protcnt = scsi_prot_sg_count(sc);
1237         static int cnt;
1238
1239         if (protcnt && (op == SCSI_PROT_WRITE_STRIP ||
1240                                 op == SCSI_PROT_WRITE_PASS)) {
1241
1242                 cnt++;
1243                 spt = page_address(sg_page(scsi_prot_sglist(sc))) +
1244                         scsi_prot_sglist(sc)[0].offset;
1245                 *apptagmask = 0;
1246                 *apptagval = 0;
1247                 *reftag = cpu_to_be32(spt->ref_tag);
1248
1249         } else {
1250                 /* SBC defines ref tag to be lower 32bits of LBA */
1251                 *reftag = (uint32_t) (0xffffffff & scsi_get_lba(sc));
1252                 *apptagmask = 0;
1253                 *apptagval = 0;
1254         }
1255 }
1256
1257 /*
1258  * This function sets up buffer list for protection groups of
1259  * type LPFC_PG_TYPE_NO_DIF
1260  *
1261  * This is usually used when the HBA is instructed to generate
1262  * DIFs and insert them into data stream (or strip DIF from
1263  * incoming data stream)
1264  *
1265  * The buffer list consists of just one protection group described
1266  * below:
1267  *                                +-------------------------+
1268  *   start of prot group  -->     |          PDE_1          |
1269  *                                +-------------------------+
1270  *                                |         Data BDE        |
1271  *                                +-------------------------+
1272  *                                |more Data BDE's ... (opt)|
1273  *                                +-------------------------+
1274  *
1275  * @sc: pointer to scsi command we're working on
1276  * @bpl: pointer to buffer list for protection groups
1277  * @datacnt: number of segments of data that have been dma mapped
1278  *
1279  * Note: Data s/g buffers have been dma mapped
1280  */
1281 static int
1282 lpfc_bg_setup_bpl(struct lpfc_hba *phba, struct scsi_cmnd *sc,
1283                 struct ulp_bde64 *bpl, int datasegcnt)
1284 {
1285         struct scatterlist *sgde = NULL; /* s/g data entry */
1286         struct lpfc_pde *pde1 = NULL;
1287         dma_addr_t physaddr;
1288         int i = 0, num_bde = 0;
1289         int datadir = sc->sc_data_direction;
1290         int prof = LPFC_PROF_INVALID;
1291         unsigned blksize;
1292         uint32_t reftag;
1293         uint16_t apptagmask, apptagval;
1294
1295         pde1 = (struct lpfc_pde *) bpl;
1296         prof = lpfc_sc_to_sli_prof(phba, sc);
1297
1298         if (prof == LPFC_PROF_INVALID)
1299                 goto out;
1300
1301         /* extract some info from the scsi command for PDE1*/
1302         blksize = lpfc_cmd_blksize(sc);
1303         lpfc_get_cmd_dif_parms(sc, &apptagmask, &apptagval, &reftag);
1304
1305         /* setup PDE1 with what we have */
1306         lpfc_pde_set_bg_parms(pde1, LPFC_PDE1_DESCRIPTOR, prof, blksize,
1307                         BG_EC_STOP_ERR);
1308         lpfc_pde_set_dif_parms(pde1, apptagmask, apptagval, reftag);
1309
1310         num_bde++;
1311         bpl++;
1312
1313         /* assumption: caller has already run dma_map_sg on command data */
1314         scsi_for_each_sg(sc, sgde, datasegcnt, i) {
1315                 physaddr = sg_dma_address(sgde);
1316                 bpl->addrLow = le32_to_cpu(putPaddrLow(physaddr));
1317                 bpl->addrHigh = le32_to_cpu(putPaddrHigh(physaddr));
1318                 bpl->tus.f.bdeSize = sg_dma_len(sgde);
1319                 if (datadir == DMA_TO_DEVICE)
1320                         bpl->tus.f.bdeFlags = BUFF_TYPE_BDE_64;
1321                 else
1322                         bpl->tus.f.bdeFlags = BUFF_TYPE_BDE_64I;
1323                 bpl->tus.w = le32_to_cpu(bpl->tus.w);
1324                 bpl++;
1325                 num_bde++;
1326         }
1327
1328 out:
1329         return num_bde;
1330 }
1331
1332 /*
1333  * This function sets up buffer list for protection groups of
1334  * type LPFC_PG_TYPE_DIF_BUF
1335  *
1336  * This is usually used when DIFs are in their own buffers,
1337  * separate from the data. The HBA can then by instructed
1338  * to place the DIFs in the outgoing stream.  For read operations,
1339  * The HBA could extract the DIFs and place it in DIF buffers.
1340  *
1341  * The buffer list for this type consists of one or more of the
1342  * protection groups described below:
1343  *                                    +-------------------------+
1344  *   start of first prot group  -->   |          PDE_1          |
1345  *                                    +-------------------------+
1346  *                                    |      PDE_3 (Prot BDE)   |
1347  *                                    +-------------------------+
1348  *                                    |        Data BDE         |
1349  *                                    +-------------------------+
1350  *                                    |more Data BDE's ... (opt)|
1351  *                                    +-------------------------+
1352  *   start of new  prot group  -->    |          PDE_1          |
1353  *                                    +-------------------------+
1354  *                                    |          ...            |
1355  *                                    +-------------------------+
1356  *
1357  * @sc: pointer to scsi command we're working on
1358  * @bpl: pointer to buffer list for protection groups
1359  * @datacnt: number of segments of data that have been dma mapped
1360  * @protcnt: number of segment of protection data that have been dma mapped
1361  *
1362  * Note: It is assumed that both data and protection s/g buffers have been
1363  *       mapped for DMA
1364  */
1365 static int
1366 lpfc_bg_setup_bpl_prot(struct lpfc_hba *phba, struct scsi_cmnd *sc,
1367                 struct ulp_bde64 *bpl, int datacnt, int protcnt)
1368 {
1369         struct scatterlist *sgde = NULL; /* s/g data entry */
1370         struct scatterlist *sgpe = NULL; /* s/g prot entry */
1371         struct lpfc_pde *pde1 = NULL;
1372         struct ulp_bde64 *prot_bde = NULL;
1373         dma_addr_t dataphysaddr, protphysaddr;
1374         unsigned short curr_data = 0, curr_prot = 0;
1375         unsigned int split_offset, protgroup_len;
1376         unsigned int protgrp_blks, protgrp_bytes;
1377         unsigned int remainder, subtotal;
1378         int prof = LPFC_PROF_INVALID;
1379         int datadir = sc->sc_data_direction;
1380         unsigned char pgdone = 0, alldone = 0;
1381         unsigned blksize;
1382         uint32_t reftag;
1383         uint16_t apptagmask, apptagval;
1384         int num_bde = 0;
1385
1386         sgpe = scsi_prot_sglist(sc);
1387         sgde = scsi_sglist(sc);
1388
1389         if (!sgpe || !sgde) {
1390                 lpfc_printf_log(phba, KERN_ERR, LOG_FCP,
1391                                 "9020 Invalid s/g entry: data=0x%p prot=0x%p\n",
1392                                 sgpe, sgde);
1393                 return 0;
1394         }
1395
1396         prof = lpfc_sc_to_sli_prof(phba, sc);
1397         if (prof == LPFC_PROF_INVALID)
1398                 goto out;
1399
1400         /* extract some info from the scsi command for PDE1*/
1401         blksize = lpfc_cmd_blksize(sc);
1402         lpfc_get_cmd_dif_parms(sc, &apptagmask, &apptagval, &reftag);
1403
1404         split_offset = 0;
1405         do {
1406                 /* setup the first PDE_1 */
1407                 pde1 = (struct lpfc_pde *) bpl;
1408
1409                 lpfc_pde_set_bg_parms(pde1, LPFC_PDE1_DESCRIPTOR, prof, blksize,
1410                                 BG_EC_STOP_ERR);
1411                 lpfc_pde_set_dif_parms(pde1, apptagmask, apptagval, reftag);
1412
1413                 num_bde++;
1414                 bpl++;
1415
1416                 /* setup the first BDE that points to protection buffer */
1417                 prot_bde = (struct ulp_bde64 *) bpl;
1418                 protphysaddr = sg_dma_address(sgpe);
1419                 prot_bde->addrLow = le32_to_cpu(putPaddrLow(protphysaddr));
1420                 prot_bde->addrHigh = le32_to_cpu(putPaddrHigh(protphysaddr));
1421                 protgroup_len = sg_dma_len(sgpe);
1422
1423
1424                 /* must be integer multiple of the DIF block length */
1425                 BUG_ON(protgroup_len % 8);
1426
1427                 protgrp_blks = protgroup_len / 8;
1428                 protgrp_bytes = protgrp_blks * blksize;
1429
1430                 prot_bde->tus.f.bdeSize = protgroup_len;
1431                 if (datadir == DMA_TO_DEVICE)
1432                         prot_bde->tus.f.bdeFlags = BUFF_TYPE_BDE_64;
1433                 else
1434                         prot_bde->tus.f.bdeFlags = BUFF_TYPE_BDE_64I;
1435                 prot_bde->tus.w = le32_to_cpu(bpl->tus.w);
1436
1437                 curr_prot++;
1438                 num_bde++;
1439
1440                 /* setup BDE's for data blocks associated with DIF data */
1441                 pgdone = 0;
1442                 subtotal = 0; /* total bytes processed for current prot grp */
1443                 while (!pgdone) {
1444                         if (!sgde) {
1445                                 lpfc_printf_log(phba, KERN_ERR, LOG_BG,
1446                                         "9065 BLKGRD:%s Invalid data segment\n",
1447                                                 __func__);
1448                                 return 0;
1449                         }
1450                         bpl++;
1451                         dataphysaddr = sg_dma_address(sgde) + split_offset;
1452                         bpl->addrLow = le32_to_cpu(putPaddrLow(dataphysaddr));
1453                         bpl->addrHigh = le32_to_cpu(putPaddrHigh(dataphysaddr));
1454
1455                         remainder = sg_dma_len(sgde) - split_offset;
1456
1457                         if ((subtotal + remainder) <= protgrp_bytes) {
1458                                 /* we can use this whole buffer */
1459                                 bpl->tus.f.bdeSize = remainder;
1460                                 split_offset = 0;
1461
1462                                 if ((subtotal + remainder) == protgrp_bytes)
1463                                         pgdone = 1;
1464                         } else {
1465                                 /* must split this buffer with next prot grp */
1466                                 bpl->tus.f.bdeSize = protgrp_bytes - subtotal;
1467                                 split_offset += bpl->tus.f.bdeSize;
1468                         }
1469
1470                         subtotal += bpl->tus.f.bdeSize;
1471
1472                         if (datadir == DMA_TO_DEVICE)
1473                                 bpl->tus.f.bdeFlags = BUFF_TYPE_BDE_64;
1474                         else
1475                                 bpl->tus.f.bdeFlags = BUFF_TYPE_BDE_64I;
1476                         bpl->tus.w = le32_to_cpu(bpl->tus.w);
1477
1478                         num_bde++;
1479                         curr_data++;
1480
1481                         if (split_offset)
1482                                 break;
1483
1484                         /* Move to the next s/g segment if possible */
1485                         sgde = sg_next(sgde);
1486                 }
1487
1488                 /* are we done ? */
1489                 if (curr_prot == protcnt) {
1490                         alldone = 1;
1491                 } else if (curr_prot < protcnt) {
1492                         /* advance to next prot buffer */
1493                         sgpe = sg_next(sgpe);
1494                         bpl++;
1495
1496                         /* update the reference tag */
1497                         reftag += protgrp_blks;
1498                 } else {
1499                         /* if we're here, we have a bug */
1500                         lpfc_printf_log(phba, KERN_ERR, LOG_BG,
1501                                 "9054 BLKGRD: bug in %s\n", __func__);
1502                 }
1503
1504         } while (!alldone);
1505
1506 out:
1507
1508
1509         return num_bde;
1510 }
1511 /*
1512  * Given a SCSI command that supports DIF, determine composition of protection
1513  * groups involved in setting up buffer lists
1514  *
1515  * Returns:
1516  *                            for DIF (for both read and write)
1517  * */
1518 static int
1519 lpfc_prot_group_type(struct lpfc_hba *phba, struct scsi_cmnd *sc)
1520 {
1521         int ret = LPFC_PG_TYPE_INVALID;
1522         unsigned char op = scsi_get_prot_op(sc);
1523
1524         switch (op) {
1525         case SCSI_PROT_READ_STRIP:
1526         case SCSI_PROT_WRITE_INSERT:
1527                 ret = LPFC_PG_TYPE_NO_DIF;
1528                 break;
1529         case SCSI_PROT_READ_INSERT:
1530         case SCSI_PROT_WRITE_STRIP:
1531         case SCSI_PROT_READ_PASS:
1532         case SCSI_PROT_WRITE_PASS:
1533                 ret = LPFC_PG_TYPE_DIF_BUF;
1534                 break;
1535         default:
1536                 lpfc_printf_log(phba, KERN_ERR, LOG_FCP,
1537                                 "9021 Unsupported protection op:%d\n", op);
1538                 break;
1539         }
1540
1541         return ret;
1542 }
1543
1544 /*
1545  * This is the protection/DIF aware version of
1546  * lpfc_scsi_prep_dma_buf(). It may be a good idea to combine the
1547  * two functions eventually, but for now, it's here
1548  */
1549 static int
1550 lpfc_bg_scsi_prep_dma_buf(struct lpfc_hba *phba,
1551                 struct lpfc_scsi_buf *lpfc_cmd)
1552 {
1553         struct scsi_cmnd *scsi_cmnd = lpfc_cmd->pCmd;
1554         struct fcp_cmnd *fcp_cmnd = lpfc_cmd->fcp_cmnd;
1555         struct ulp_bde64 *bpl = lpfc_cmd->fcp_bpl;
1556         IOCB_t *iocb_cmd = &lpfc_cmd->cur_iocbq.iocb;
1557         uint32_t num_bde = 0;
1558         int datasegcnt, protsegcnt, datadir = scsi_cmnd->sc_data_direction;
1559         int prot_group_type = 0;
1560         int diflen, fcpdl;
1561         unsigned blksize;
1562
1563         /*
1564          * Start the lpfc command prep by bumping the bpl beyond fcp_cmnd
1565          *  fcp_rsp regions to the first data bde entry
1566          */
1567         bpl += 2;
1568         if (scsi_sg_count(scsi_cmnd)) {
1569                 /*
1570                  * The driver stores the segment count returned from pci_map_sg
1571                  * because this a count of dma-mappings used to map the use_sg
1572                  * pages.  They are not guaranteed to be the same for those
1573                  * architectures that implement an IOMMU.
1574                  */
1575                 datasegcnt = dma_map_sg(&phba->pcidev->dev,
1576                                         scsi_sglist(scsi_cmnd),
1577                                         scsi_sg_count(scsi_cmnd), datadir);
1578                 if (unlikely(!datasegcnt))
1579                         return 1;
1580
1581                 lpfc_cmd->seg_cnt = datasegcnt;
1582                 if (lpfc_cmd->seg_cnt > phba->cfg_sg_seg_cnt) {
1583                         lpfc_printf_log(phba, KERN_ERR, LOG_BG,
1584                                         "9067 BLKGRD: %s: Too many sg segments"
1585                                         " from dma_map_sg.  Config %d, seg_cnt"
1586                                         " %d\n",
1587                                         __func__, phba->cfg_sg_seg_cnt,
1588                                         lpfc_cmd->seg_cnt);
1589                         scsi_dma_unmap(scsi_cmnd);
1590                         return 1;
1591                 }
1592
1593                 prot_group_type = lpfc_prot_group_type(phba, scsi_cmnd);
1594
1595                 switch (prot_group_type) {
1596                 case LPFC_PG_TYPE_NO_DIF:
1597                         num_bde = lpfc_bg_setup_bpl(phba, scsi_cmnd, bpl,
1598                                         datasegcnt);
1599                         /* we should have 2 or more entries in buffer list */
1600                         if (num_bde < 2)
1601                                 goto err;
1602                         break;
1603                 case LPFC_PG_TYPE_DIF_BUF:{
1604                         /*
1605                          * This type indicates that protection buffers are
1606                          * passed to the driver, so that needs to be prepared
1607                          * for DMA
1608                          */
1609                         protsegcnt = dma_map_sg(&phba->pcidev->dev,
1610                                         scsi_prot_sglist(scsi_cmnd),
1611                                         scsi_prot_sg_count(scsi_cmnd), datadir);
1612                         if (unlikely(!protsegcnt)) {
1613                                 scsi_dma_unmap(scsi_cmnd);
1614                                 return 1;
1615                         }
1616
1617                         lpfc_cmd->prot_seg_cnt = protsegcnt;
1618                         if (lpfc_cmd->prot_seg_cnt
1619                             > phba->cfg_prot_sg_seg_cnt) {
1620                                 lpfc_printf_log(phba, KERN_ERR, LOG_BG,
1621                                         "9068 BLKGRD: %s: Too many prot sg "
1622                                         "segments from dma_map_sg.  Config %d,"
1623                                                 "prot_seg_cnt %d\n", __func__,
1624                                                 phba->cfg_prot_sg_seg_cnt,
1625                                                 lpfc_cmd->prot_seg_cnt);
1626                                 dma_unmap_sg(&phba->pcidev->dev,
1627                                              scsi_prot_sglist(scsi_cmnd),
1628                                              scsi_prot_sg_count(scsi_cmnd),
1629                                              datadir);
1630                                 scsi_dma_unmap(scsi_cmnd);
1631                                 return 1;
1632                         }
1633
1634                         num_bde = lpfc_bg_setup_bpl_prot(phba, scsi_cmnd, bpl,
1635                                         datasegcnt, protsegcnt);
1636                         /* we should have 3 or more entries in buffer list */
1637                         if (num_bde < 3)
1638                                 goto err;
1639                         break;
1640                 }
1641                 case LPFC_PG_TYPE_INVALID:
1642                 default:
1643                         lpfc_printf_log(phba, KERN_ERR, LOG_FCP,
1644                                         "9022 Unexpected protection group %i\n",
1645                                         prot_group_type);
1646                         return 1;
1647                 }
1648         }
1649
1650         /*
1651          * Finish initializing those IOCB fields that are dependent on the
1652          * scsi_cmnd request_buffer.  Note that the bdeSize is explicitly
1653          * reinitialized since all iocb memory resources are used many times
1654          * for transmit, receive, and continuation bpl's.
1655          */
1656         iocb_cmd->un.fcpi64.bdl.bdeSize = (2 * sizeof(struct ulp_bde64));
1657         iocb_cmd->un.fcpi64.bdl.bdeSize += (num_bde * sizeof(struct ulp_bde64));
1658         iocb_cmd->ulpBdeCount = 1;
1659         iocb_cmd->ulpLe = 1;
1660
1661         fcpdl = scsi_bufflen(scsi_cmnd);
1662
1663         if (scsi_get_prot_type(scsi_cmnd) == SCSI_PROT_DIF_TYPE1) {
1664                 /*
1665                  * We are in DIF Type 1 mode
1666                  * Every data block has a 8 byte DIF (trailer)
1667                  * attached to it.  Must ajust FCP data length
1668                  */
1669                 blksize = lpfc_cmd_blksize(scsi_cmnd);
1670                 diflen = (fcpdl / blksize) * 8;
1671                 fcpdl += diflen;
1672         }
1673         fcp_cmnd->fcpDl = be32_to_cpu(fcpdl);
1674
1675         /*
1676          * Due to difference in data length between DIF/non-DIF paths,
1677          * we need to set word 4 of IOCB here
1678          */
1679         iocb_cmd->un.fcpi.fcpi_parm = fcpdl;
1680
1681         return 0;
1682 err:
1683         lpfc_printf_log(phba, KERN_ERR, LOG_FCP,
1684                         "9023 Could not setup all needed BDE's"
1685                         "prot_group_type=%d, num_bde=%d\n",
1686                         prot_group_type, num_bde);
1687         return 1;
1688 }
1689
1690 /*
1691  * This function checks for BlockGuard errors detected by
1692  * the HBA.  In case of errors, the ASC/ASCQ fields in the
1693  * sense buffer will be set accordingly, paired with
1694  * ILLEGAL_REQUEST to signal to the kernel that the HBA
1695  * detected corruption.
1696  *
1697  * Returns:
1698  *  0 - No error found
1699  *  1 - BlockGuard error found
1700  * -1 - Internal error (bad profile, ...etc)
1701  */
1702 static int
1703 lpfc_parse_bg_err(struct lpfc_hba *phba, struct lpfc_scsi_buf *lpfc_cmd,
1704                         struct lpfc_iocbq *pIocbOut)
1705 {
1706         struct scsi_cmnd *cmd = lpfc_cmd->pCmd;
1707         struct sli3_bg_fields *bgf = &pIocbOut->iocb.unsli3.sli3_bg;
1708         int ret = 0;
1709         uint32_t bghm = bgf->bghm;
1710         uint32_t bgstat = bgf->bgstat;
1711         uint64_t failing_sector = 0;
1712
1713         lpfc_printf_log(phba, KERN_ERR, LOG_BG, "9069 BLKGRD: BG ERROR in cmd"
1714                         " 0x%x lba 0x%llx blk cnt 0x%x "
1715                         "bgstat=0x%x bghm=0x%x\n",
1716                         cmd->cmnd[0], (unsigned long long)scsi_get_lba(cmd),
1717                         blk_rq_sectors(cmd->request), bgstat, bghm);
1718
1719         spin_lock(&_dump_buf_lock);
1720         if (!_dump_buf_done) {
1721                 lpfc_printf_log(phba, KERN_ERR, LOG_BG,  "9070 BLKGRD: Saving"
1722                         " Data for %u blocks to debugfs\n",
1723                                 (cmd->cmnd[7] << 8 | cmd->cmnd[8]));
1724                 lpfc_debug_save_data(phba, cmd);
1725
1726                 /* If we have a prot sgl, save the DIF buffer */
1727                 if (lpfc_prot_group_type(phba, cmd) ==
1728                                 LPFC_PG_TYPE_DIF_BUF) {
1729                         lpfc_printf_log(phba, KERN_ERR, LOG_BG, "9071 BLKGRD: "
1730                                 "Saving DIF for %u blocks to debugfs\n",
1731                                 (cmd->cmnd[7] << 8 | cmd->cmnd[8]));
1732                         lpfc_debug_save_dif(phba, cmd);
1733                 }
1734
1735                 _dump_buf_done = 1;
1736         }
1737         spin_unlock(&_dump_buf_lock);
1738
1739         if (lpfc_bgs_get_invalid_prof(bgstat)) {
1740                 cmd->result = ScsiResult(DID_ERROR, 0);
1741                 lpfc_printf_log(phba, KERN_ERR, LOG_BG, "9072 BLKGRD: Invalid"
1742                         " BlockGuard profile. bgstat:0x%x\n",
1743                         bgstat);
1744                 ret = (-1);
1745                 goto out;
1746         }
1747
1748         if (lpfc_bgs_get_uninit_dif_block(bgstat)) {
1749                 cmd->result = ScsiResult(DID_ERROR, 0);
1750                 lpfc_printf_log(phba, KERN_ERR, LOG_BG, "9073 BLKGRD: "
1751                                 "Invalid BlockGuard DIF Block. bgstat:0x%x\n",
1752                                 bgstat);
1753                 ret = (-1);
1754                 goto out;
1755         }
1756
1757         if (lpfc_bgs_get_guard_err(bgstat)) {
1758                 ret = 1;
1759
1760                 scsi_build_sense_buffer(1, cmd->sense_buffer, ILLEGAL_REQUEST,
1761                                 0x10, 0x1);
1762                 cmd->result = DRIVER_SENSE << 24
1763                         | ScsiResult(DID_ABORT, SAM_STAT_CHECK_CONDITION);
1764                 phba->bg_guard_err_cnt++;
1765                 lpfc_printf_log(phba, KERN_ERR, LOG_BG,
1766                         "9055 BLKGRD: guard_tag error\n");
1767         }
1768
1769         if (lpfc_bgs_get_reftag_err(bgstat)) {
1770                 ret = 1;
1771
1772                 scsi_build_sense_buffer(1, cmd->sense_buffer, ILLEGAL_REQUEST,
1773                                 0x10, 0x3);
1774                 cmd->result = DRIVER_SENSE << 24
1775                         | ScsiResult(DID_ABORT, SAM_STAT_CHECK_CONDITION);
1776
1777                 phba->bg_reftag_err_cnt++;
1778                 lpfc_printf_log(phba, KERN_ERR, LOG_BG,
1779                         "9056 BLKGRD: ref_tag error\n");
1780         }
1781
1782         if (lpfc_bgs_get_apptag_err(bgstat)) {
1783                 ret = 1;
1784
1785                 scsi_build_sense_buffer(1, cmd->sense_buffer, ILLEGAL_REQUEST,
1786                                 0x10, 0x2);
1787                 cmd->result = DRIVER_SENSE << 24
1788                         | ScsiResult(DID_ABORT, SAM_STAT_CHECK_CONDITION);
1789
1790                 phba->bg_apptag_err_cnt++;
1791                 lpfc_printf_log(phba, KERN_ERR, LOG_BG,
1792                         "9061 BLKGRD: app_tag error\n");
1793         }
1794
1795         if (lpfc_bgs_get_hi_water_mark_present(bgstat)) {
1796                 /*
1797                  * setup sense data descriptor 0 per SPC-4 as an information
1798                  * field, and put the failing LBA in it
1799                  */
1800                 cmd->sense_buffer[8] = 0;     /* Information */
1801                 cmd->sense_buffer[9] = 0xa;   /* Add. length */
1802                 bghm /= cmd->device->sector_size;
1803
1804                 failing_sector = scsi_get_lba(cmd);
1805                 failing_sector += bghm;
1806
1807                 put_unaligned_be64(failing_sector, &cmd->sense_buffer[10]);
1808         }
1809
1810         if (!ret) {
1811                 /* No error was reported - problem in FW? */
1812                 cmd->result = ScsiResult(DID_ERROR, 0);
1813                 lpfc_printf_log(phba, KERN_ERR, LOG_BG,
1814                         "9057 BLKGRD: no errors reported!\n");
1815         }
1816
1817 out:
1818         return ret;
1819 }
1820
1821 /**
1822  * lpfc_scsi_prep_dma_buf_s4 - DMA mapping for scsi buffer to SLI4 IF spec
1823  * @phba: The Hba for which this call is being executed.
1824  * @lpfc_cmd: The scsi buffer which is going to be mapped.
1825  *
1826  * This routine does the pci dma mapping for scatter-gather list of scsi cmnd
1827  * field of @lpfc_cmd for device with SLI-4 interface spec.
1828  *
1829  * Return codes:
1830  *      1 - Error
1831  *      0 - Success
1832  **/
1833 static int
1834 lpfc_scsi_prep_dma_buf_s4(struct lpfc_hba *phba, struct lpfc_scsi_buf *lpfc_cmd)
1835 {
1836         struct scsi_cmnd *scsi_cmnd = lpfc_cmd->pCmd;
1837         struct scatterlist *sgel = NULL;
1838         struct fcp_cmnd *fcp_cmnd = lpfc_cmd->fcp_cmnd;
1839         struct sli4_sge *sgl = (struct sli4_sge *)lpfc_cmd->fcp_bpl;
1840         IOCB_t *iocb_cmd = &lpfc_cmd->cur_iocbq.iocb;
1841         dma_addr_t physaddr;
1842         uint32_t num_bde = 0;
1843         uint32_t dma_len;
1844         uint32_t dma_offset = 0;
1845         int nseg;
1846
1847         /*
1848          * There are three possibilities here - use scatter-gather segment, use
1849          * the single mapping, or neither.  Start the lpfc command prep by
1850          * bumping the bpl beyond the fcp_cmnd and fcp_rsp regions to the first
1851          * data bde entry.
1852          */
1853         if (scsi_sg_count(scsi_cmnd)) {
1854                 /*
1855                  * The driver stores the segment count returned from pci_map_sg
1856                  * because this a count of dma-mappings used to map the use_sg
1857                  * pages.  They are not guaranteed to be the same for those
1858                  * architectures that implement an IOMMU.
1859                  */
1860
1861                 nseg = scsi_dma_map(scsi_cmnd);
1862                 if (unlikely(!nseg))
1863                         return 1;
1864                 sgl += 1;
1865                 /* clear the last flag in the fcp_rsp map entry */
1866                 sgl->word2 = le32_to_cpu(sgl->word2);
1867                 bf_set(lpfc_sli4_sge_last, sgl, 0);
1868                 sgl->word2 = cpu_to_le32(sgl->word2);
1869                 sgl += 1;
1870
1871                 lpfc_cmd->seg_cnt = nseg;
1872                 if (lpfc_cmd->seg_cnt > phba->cfg_sg_seg_cnt) {
1873                         lpfc_printf_log(phba, KERN_ERR, LOG_BG, "9074 BLKGRD:"
1874                                 " %s: Too many sg segments from "
1875                                 "dma_map_sg.  Config %d, seg_cnt %d\n",
1876                                 __func__, phba->cfg_sg_seg_cnt,
1877                                lpfc_cmd->seg_cnt);
1878                         scsi_dma_unmap(scsi_cmnd);
1879                         return 1;
1880                 }
1881
1882                 /*
1883                  * The driver established a maximum scatter-gather segment count
1884                  * during probe that limits the number of sg elements in any
1885                  * single scsi command.  Just run through the seg_cnt and format
1886                  * the sge's.
1887                  * When using SLI-3 the driver will try to fit all the BDEs into
1888                  * the IOCB. If it can't then the BDEs get added to a BPL as it
1889                  * does for SLI-2 mode.
1890                  */
1891                 scsi_for_each_sg(scsi_cmnd, sgel, nseg, num_bde) {
1892                         physaddr = sg_dma_address(sgel);
1893                         dma_len = sg_dma_len(sgel);
1894                         sgl->addr_lo = cpu_to_le32(putPaddrLow(physaddr));
1895                         sgl->addr_hi = cpu_to_le32(putPaddrHigh(physaddr));
1896                         if ((num_bde + 1) == nseg)
1897                                 bf_set(lpfc_sli4_sge_last, sgl, 1);
1898                         else
1899                                 bf_set(lpfc_sli4_sge_last, sgl, 0);
1900                         bf_set(lpfc_sli4_sge_offset, sgl, dma_offset);
1901                         sgl->word2 = cpu_to_le32(sgl->word2);
1902                         sgl->sge_len = cpu_to_le32(dma_len);
1903                         dma_offset += dma_len;
1904                         sgl++;
1905                 }
1906         } else {
1907                 sgl += 1;
1908                 /* clear the last flag in the fcp_rsp map entry */
1909                 sgl->word2 = le32_to_cpu(sgl->word2);
1910                 bf_set(lpfc_sli4_sge_last, sgl, 1);
1911                 sgl->word2 = cpu_to_le32(sgl->word2);
1912         }
1913
1914         /*
1915          * Finish initializing those IOCB fields that are dependent on the
1916          * scsi_cmnd request_buffer.  Note that for SLI-2 the bdeSize is
1917          * explicitly reinitialized.
1918          * all iocb memory resources are reused.
1919          */
1920         fcp_cmnd->fcpDl = cpu_to_be32(scsi_bufflen(scsi_cmnd));
1921
1922         /*
1923          * Due to difference in data length between DIF/non-DIF paths,
1924          * we need to set word 4 of IOCB here
1925          */
1926         iocb_cmd->un.fcpi.fcpi_parm = scsi_bufflen(scsi_cmnd);
1927         return 0;
1928 }
1929
1930 /**
1931  * lpfc_scsi_prep_dma_buf - Wrapper function for DMA mapping of scsi buffer
1932  * @phba: The Hba for which this call is being executed.
1933  * @lpfc_cmd: The scsi buffer which is going to be mapped.
1934  *
1935  * This routine wraps the actual DMA mapping function pointer from the
1936  * lpfc_hba struct.
1937  *
1938  * Return codes:
1939  *      1 - Error
1940  *      0 - Success
1941  **/
1942 static inline int
1943 lpfc_scsi_prep_dma_buf(struct lpfc_hba *phba, struct lpfc_scsi_buf *lpfc_cmd)
1944 {
1945         return phba->lpfc_scsi_prep_dma_buf(phba, lpfc_cmd);
1946 }
1947
1948 /**
1949  * lpfc_send_scsi_error_event - Posts an event when there is SCSI error
1950  * @phba: Pointer to hba context object.
1951  * @vport: Pointer to vport object.
1952  * @lpfc_cmd: Pointer to lpfc scsi command which reported the error.
1953  * @rsp_iocb: Pointer to response iocb object which reported error.
1954  *
1955  * This function posts an event when there is a SCSI command reporting
1956  * error from the scsi device.
1957  **/
1958 static void
1959 lpfc_send_scsi_error_event(struct lpfc_hba *phba, struct lpfc_vport *vport,
1960                 struct lpfc_scsi_buf *lpfc_cmd, struct lpfc_iocbq *rsp_iocb) {
1961         struct scsi_cmnd *cmnd = lpfc_cmd->pCmd;
1962         struct fcp_rsp *fcprsp = lpfc_cmd->fcp_rsp;
1963         uint32_t resp_info = fcprsp->rspStatus2;
1964         uint32_t scsi_status = fcprsp->rspStatus3;
1965         uint32_t fcpi_parm = rsp_iocb->iocb.un.fcpi.fcpi_parm;
1966         struct lpfc_fast_path_event *fast_path_evt = NULL;
1967         struct lpfc_nodelist *pnode = lpfc_cmd->rdata->pnode;
1968         unsigned long flags;
1969
1970         /* If there is queuefull or busy condition send a scsi event */
1971         if ((cmnd->result == SAM_STAT_TASK_SET_FULL) ||
1972                 (cmnd->result == SAM_STAT_BUSY)) {
1973                 fast_path_evt = lpfc_alloc_fast_evt(phba);
1974                 if (!fast_path_evt)
1975                         return;
1976                 fast_path_evt->un.scsi_evt.event_type =
1977                         FC_REG_SCSI_EVENT;
1978                 fast_path_evt->un.scsi_evt.subcategory =
1979                 (cmnd->result == SAM_STAT_TASK_SET_FULL) ?
1980                 LPFC_EVENT_QFULL : LPFC_EVENT_DEVBSY;
1981                 fast_path_evt->un.scsi_evt.lun = cmnd->device->lun;
1982                 memcpy(&fast_path_evt->un.scsi_evt.wwpn,
1983                         &pnode->nlp_portname, sizeof(struct lpfc_name));
1984                 memcpy(&fast_path_evt->un.scsi_evt.wwnn,
1985                         &pnode->nlp_nodename, sizeof(struct lpfc_name));
1986         } else if ((resp_info & SNS_LEN_VALID) && fcprsp->rspSnsLen &&
1987                 ((cmnd->cmnd[0] == READ_10) || (cmnd->cmnd[0] == WRITE_10))) {
1988                 fast_path_evt = lpfc_alloc_fast_evt(phba);
1989                 if (!fast_path_evt)
1990                         return;
1991                 fast_path_evt->un.check_cond_evt.scsi_event.event_type =
1992                         FC_REG_SCSI_EVENT;
1993                 fast_path_evt->un.check_cond_evt.scsi_event.subcategory =
1994                         LPFC_EVENT_CHECK_COND;
1995                 fast_path_evt->un.check_cond_evt.scsi_event.lun =
1996                         cmnd->device->lun;
1997                 memcpy(&fast_path_evt->un.check_cond_evt.scsi_event.wwpn,
1998                         &pnode->nlp_portname, sizeof(struct lpfc_name));
1999                 memcpy(&fast_path_evt->un.check_cond_evt.scsi_event.wwnn,
2000                         &pnode->nlp_nodename, sizeof(struct lpfc_name));
2001                 fast_path_evt->un.check_cond_evt.sense_key =
2002                         cmnd->sense_buffer[2] & 0xf;
2003                 fast_path_evt->un.check_cond_evt.asc = cmnd->sense_buffer[12];
2004                 fast_path_evt->un.check_cond_evt.ascq = cmnd->sense_buffer[13];
2005         } else if ((cmnd->sc_data_direction == DMA_FROM_DEVICE) &&
2006                      fcpi_parm &&
2007                      ((be32_to_cpu(fcprsp->rspResId) != fcpi_parm) ||
2008                         ((scsi_status == SAM_STAT_GOOD) &&
2009                         !(resp_info & (RESID_UNDER | RESID_OVER))))) {
2010                 /*
2011                  * If status is good or resid does not match with fcp_param and
2012                  * there is valid fcpi_parm, then there is a read_check error
2013                  */
2014                 fast_path_evt = lpfc_alloc_fast_evt(phba);
2015                 if (!fast_path_evt)
2016                         return;
2017                 fast_path_evt->un.read_check_error.header.event_type =
2018                         FC_REG_FABRIC_EVENT;
2019                 fast_path_evt->un.read_check_error.header.subcategory =
2020                         LPFC_EVENT_FCPRDCHKERR;
2021                 memcpy(&fast_path_evt->un.read_check_error.header.wwpn,
2022                         &pnode->nlp_portname, sizeof(struct lpfc_name));
2023                 memcpy(&fast_path_evt->un.read_check_error.header.wwnn,
2024                         &pnode->nlp_nodename, sizeof(struct lpfc_name));
2025                 fast_path_evt->un.read_check_error.lun = cmnd->device->lun;
2026                 fast_path_evt->un.read_check_error.opcode = cmnd->cmnd[0];
2027                 fast_path_evt->un.read_check_error.fcpiparam =
2028                         fcpi_parm;
2029         } else
2030                 return;
2031
2032         fast_path_evt->vport = vport;
2033         spin_lock_irqsave(&phba->hbalock, flags);
2034         list_add_tail(&fast_path_evt->work_evt.evt_listp, &phba->work_list);
2035         spin_unlock_irqrestore(&phba->hbalock, flags);
2036         lpfc_worker_wake_up(phba);
2037         return;
2038 }
2039
2040 /**
2041  * lpfc_scsi_unprep_dma_buf - Un-map DMA mapping of SG-list for dev
2042  * @phba: The HBA for which this call is being executed.
2043  * @psb: The scsi buffer which is going to be un-mapped.
2044  *
2045  * This routine does DMA un-mapping of scatter gather list of scsi command
2046  * field of @lpfc_cmd for device with SLI-3 interface spec.
2047  **/
2048 static void
2049 lpfc_scsi_unprep_dma_buf(struct lpfc_hba *phba, struct lpfc_scsi_buf *psb)
2050 {
2051         /*
2052          * There are only two special cases to consider.  (1) the scsi command
2053          * requested scatter-gather usage or (2) the scsi command allocated
2054          * a request buffer, but did not request use_sg.  There is a third
2055          * case, but it does not require resource deallocation.
2056          */
2057         if (psb->seg_cnt > 0)
2058                 scsi_dma_unmap(psb->pCmd);
2059         if (psb->prot_seg_cnt > 0)
2060                 dma_unmap_sg(&phba->pcidev->dev, scsi_prot_sglist(psb->pCmd),
2061                                 scsi_prot_sg_count(psb->pCmd),
2062                                 psb->pCmd->sc_data_direction);
2063 }
2064
2065 /**
2066  * lpfc_handler_fcp_err - FCP response handler
2067  * @vport: The virtual port for which this call is being executed.
2068  * @lpfc_cmd: Pointer to lpfc_scsi_buf data structure.
2069  * @rsp_iocb: The response IOCB which contains FCP error.
2070  *
2071  * This routine is called to process response IOCB with status field
2072  * IOSTAT_FCP_RSP_ERROR. This routine sets result field of scsi command
2073  * based upon SCSI and FCP error.
2074  **/
2075 static void
2076 lpfc_handle_fcp_err(struct lpfc_vport *vport, struct lpfc_scsi_buf *lpfc_cmd,
2077                     struct lpfc_iocbq *rsp_iocb)
2078 {
2079         struct scsi_cmnd *cmnd = lpfc_cmd->pCmd;
2080         struct fcp_cmnd *fcpcmd = lpfc_cmd->fcp_cmnd;
2081         struct fcp_rsp *fcprsp = lpfc_cmd->fcp_rsp;
2082         uint32_t fcpi_parm = rsp_iocb->iocb.un.fcpi.fcpi_parm;
2083         uint32_t resp_info = fcprsp->rspStatus2;
2084         uint32_t scsi_status = fcprsp->rspStatus3;
2085         uint32_t *lp;
2086         uint32_t host_status = DID_OK;
2087         uint32_t rsplen = 0;
2088         uint32_t logit = LOG_FCP | LOG_FCP_ERROR;
2089
2090
2091         /*
2092          *  If this is a task management command, there is no
2093          *  scsi packet associated with this lpfc_cmd.  The driver
2094          *  consumes it.
2095          */
2096         if (fcpcmd->fcpCntl2) {
2097                 scsi_status = 0;
2098                 goto out;
2099         }
2100
2101         if (resp_info & RSP_LEN_VALID) {
2102                 rsplen = be32_to_cpu(fcprsp->rspRspLen);
2103                 if (rsplen != 0 && rsplen != 4 && rsplen != 8) {
2104                         lpfc_printf_vlog(vport, KERN_ERR, LOG_FCP,
2105                                  "2719 Invalid response length: "
2106                                  "tgt x%x lun x%x cmnd x%x rsplen x%x\n",
2107                                  cmnd->device->id,
2108                                  cmnd->device->lun, cmnd->cmnd[0],
2109                                  rsplen);
2110                         host_status = DID_ERROR;
2111                         goto out;
2112                 }
2113                 if (fcprsp->rspInfo3 != RSP_NO_FAILURE) {
2114                         lpfc_printf_vlog(vport, KERN_ERR, LOG_FCP,
2115                                  "2757 Protocol failure detected during "
2116                                  "processing of FCP I/O op: "
2117                                  "tgt x%x lun x%x cmnd x%x rspInfo3 x%x\n",
2118                                  cmnd->device->id,
2119                                  cmnd->device->lun, cmnd->cmnd[0],
2120                                  fcprsp->rspInfo3);
2121                         host_status = DID_ERROR;
2122                         goto out;
2123                 }
2124         }
2125
2126         if ((resp_info & SNS_LEN_VALID) && fcprsp->rspSnsLen) {
2127                 uint32_t snslen = be32_to_cpu(fcprsp->rspSnsLen);
2128                 if (snslen > SCSI_SENSE_BUFFERSIZE)
2129                         snslen = SCSI_SENSE_BUFFERSIZE;
2130
2131                 if (resp_info & RSP_LEN_VALID)
2132                   rsplen = be32_to_cpu(fcprsp->rspRspLen);
2133                 memcpy(cmnd->sense_buffer, &fcprsp->rspInfo0 + rsplen, snslen);
2134         }
2135         lp = (uint32_t *)cmnd->sense_buffer;
2136
2137         if (!scsi_status && (resp_info & RESID_UNDER))
2138                 logit = LOG_FCP;
2139
2140         lpfc_printf_vlog(vport, KERN_WARNING, logit,
2141                          "9024 FCP command x%x failed: x%x SNS x%x x%x "
2142                          "Data: x%x x%x x%x x%x x%x\n",
2143                          cmnd->cmnd[0], scsi_status,
2144                          be32_to_cpu(*lp), be32_to_cpu(*(lp + 3)), resp_info,
2145                          be32_to_cpu(fcprsp->rspResId),
2146                          be32_to_cpu(fcprsp->rspSnsLen),
2147                          be32_to_cpu(fcprsp->rspRspLen),
2148                          fcprsp->rspInfo3);
2149
2150         scsi_set_resid(cmnd, 0);
2151         if (resp_info & RESID_UNDER) {
2152                 scsi_set_resid(cmnd, be32_to_cpu(fcprsp->rspResId));
2153
2154                 lpfc_printf_vlog(vport, KERN_INFO, LOG_FCP,
2155                                  "9025 FCP Read Underrun, expected %d, "
2156                                  "residual %d Data: x%x x%x x%x\n",
2157                                  be32_to_cpu(fcpcmd->fcpDl),
2158                                  scsi_get_resid(cmnd), fcpi_parm, cmnd->cmnd[0],
2159                                  cmnd->underflow);
2160
2161                 /*
2162                  * If there is an under run check if under run reported by
2163                  * storage array is same as the under run reported by HBA.
2164                  * If this is not same, there is a dropped frame.
2165                  */
2166                 if ((cmnd->sc_data_direction == DMA_FROM_DEVICE) &&
2167                         fcpi_parm &&
2168                         (scsi_get_resid(cmnd) != fcpi_parm)) {
2169                         lpfc_printf_vlog(vport, KERN_WARNING,
2170                                          LOG_FCP | LOG_FCP_ERROR,
2171                                          "9026 FCP Read Check Error "
2172                                          "and Underrun Data: x%x x%x x%x x%x\n",
2173                                          be32_to_cpu(fcpcmd->fcpDl),
2174                                          scsi_get_resid(cmnd), fcpi_parm,
2175                                          cmnd->cmnd[0]);
2176                         scsi_set_resid(cmnd, scsi_bufflen(cmnd));
2177                         host_status = DID_ERROR;
2178                 }
2179                 /*
2180                  * The cmnd->underflow is the minimum number of bytes that must
2181                  * be transfered for this command.  Provided a sense condition
2182                  * is not present, make sure the actual amount transferred is at
2183                  * least the underflow value or fail.
2184                  */
2185                 if (!(resp_info & SNS_LEN_VALID) &&
2186                     (scsi_status == SAM_STAT_GOOD) &&
2187                     (scsi_bufflen(cmnd) - scsi_get_resid(cmnd)
2188                      < cmnd->underflow)) {
2189                         lpfc_printf_vlog(vport, KERN_INFO, LOG_FCP,
2190                                          "9027 FCP command x%x residual "
2191                                          "underrun converted to error "
2192                                          "Data: x%x x%x x%x\n",
2193                                          cmnd->cmnd[0], scsi_bufflen(cmnd),
2194                                          scsi_get_resid(cmnd), cmnd->underflow);
2195                         host_status = DID_ERROR;
2196                 }
2197         } else if (resp_info & RESID_OVER) {
2198                 lpfc_printf_vlog(vport, KERN_WARNING, LOG_FCP,
2199                                  "9028 FCP command x%x residual overrun error. "
2200                                  "Data: x%x x%x\n", cmnd->cmnd[0],
2201                                  scsi_bufflen(cmnd), scsi_get_resid(cmnd));
2202                 host_status = DID_ERROR;
2203
2204         /*
2205          * Check SLI validation that all the transfer was actually done
2206          * (fcpi_parm should be zero). Apply check only to reads.
2207          */
2208         } else if ((scsi_status == SAM_STAT_GOOD) && fcpi_parm &&
2209                         (cmnd->sc_data_direction == DMA_FROM_DEVICE)) {
2210                 lpfc_printf_vlog(vport, KERN_WARNING, LOG_FCP | LOG_FCP_ERROR,
2211                                  "9029 FCP Read Check Error Data: "
2212                                  "x%x x%x x%x x%x\n",
2213                                  be32_to_cpu(fcpcmd->fcpDl),
2214                                  be32_to_cpu(fcprsp->rspResId),
2215                                  fcpi_parm, cmnd->cmnd[0]);
2216                 host_status = DID_ERROR;
2217                 scsi_set_resid(cmnd, scsi_bufflen(cmnd));
2218         }
2219
2220  out:
2221         cmnd->result = ScsiResult(host_status, scsi_status);
2222         lpfc_send_scsi_error_event(vport->phba, vport, lpfc_cmd, rsp_iocb);
2223 }
2224
2225 /**
2226  * lpfc_scsi_cmd_iocb_cmpl - Scsi cmnd IOCB completion routine
2227  * @phba: The Hba for which this call is being executed.
2228  * @pIocbIn: The command IOCBQ for the scsi cmnd.
2229  * @pIocbOut: The response IOCBQ for the scsi cmnd.
2230  *
2231  * This routine assigns scsi command result by looking into response IOCB
2232  * status field appropriately. This routine handles QUEUE FULL condition as
2233  * well by ramping down device queue depth.
2234  **/
2235 static void
2236 lpfc_scsi_cmd_iocb_cmpl(struct lpfc_hba *phba, struct lpfc_iocbq *pIocbIn,
2237                         struct lpfc_iocbq *pIocbOut)
2238 {
2239         struct lpfc_scsi_buf *lpfc_cmd =
2240                 (struct lpfc_scsi_buf *) pIocbIn->context1;
2241         struct lpfc_vport      *vport = pIocbIn->vport;
2242         struct lpfc_rport_data *rdata = lpfc_cmd->rdata;
2243         struct lpfc_nodelist *pnode = rdata->pnode;
2244         struct scsi_cmnd *cmd = lpfc_cmd->pCmd;
2245         int result;
2246         struct scsi_device *tmp_sdev;
2247         int depth;
2248         unsigned long flags;
2249         struct lpfc_fast_path_event *fast_path_evt;
2250         struct Scsi_Host *shost = cmd->device->host;
2251         uint32_t queue_depth, scsi_id;
2252
2253         lpfc_cmd->result = pIocbOut->iocb.un.ulpWord[4];
2254         lpfc_cmd->status = pIocbOut->iocb.ulpStatus;
2255         /* pick up SLI4 exhange busy status from HBA */
2256         lpfc_cmd->exch_busy = pIocbOut->iocb_flag & LPFC_EXCHANGE_BUSY;
2257
2258         if (pnode && NLP_CHK_NODE_ACT(pnode))
2259                 atomic_dec(&pnode->cmd_pending);
2260
2261         if (lpfc_cmd->status) {
2262                 if (lpfc_cmd->status == IOSTAT_LOCAL_REJECT &&
2263                     (lpfc_cmd->result & IOERR_DRVR_MASK))
2264                         lpfc_cmd->status = IOSTAT_DRIVER_REJECT;
2265                 else if (lpfc_cmd->status >= IOSTAT_CNT)
2266                         lpfc_cmd->status = IOSTAT_DEFAULT;
2267
2268                 lpfc_printf_vlog(vport, KERN_WARNING, LOG_FCP,
2269                                  "9030 FCP cmd x%x failed <%d/%d> "
2270                                  "status: x%x result: x%x Data: x%x x%x\n",
2271                                  cmd->cmnd[0],
2272                                  cmd->device ? cmd->device->id : 0xffff,
2273                                  cmd->device ? cmd->device->lun : 0xffff,
2274                                  lpfc_cmd->status, lpfc_cmd->result,
2275                                  pIocbOut->iocb.ulpContext,
2276                                  lpfc_cmd->cur_iocbq.iocb.ulpIoTag);
2277
2278                 switch (lpfc_cmd->status) {
2279                 case IOSTAT_FCP_RSP_ERROR:
2280                         /* Call FCP RSP handler to determine result */
2281                         lpfc_handle_fcp_err(vport, lpfc_cmd, pIocbOut);
2282                         break;
2283                 case IOSTAT_NPORT_BSY:
2284                 case IOSTAT_FABRIC_BSY:
2285                         cmd->result = ScsiResult(DID_TRANSPORT_DISRUPTED, 0);
2286                         fast_path_evt = lpfc_alloc_fast_evt(phba);
2287                         if (!fast_path_evt)
2288                                 break;
2289                         fast_path_evt->un.fabric_evt.event_type =
2290                                 FC_REG_FABRIC_EVENT;
2291                         fast_path_evt->un.fabric_evt.subcategory =
2292                                 (lpfc_cmd->status == IOSTAT_NPORT_BSY) ?
2293                                 LPFC_EVENT_PORT_BUSY : LPFC_EVENT_FABRIC_BUSY;
2294                         if (pnode && NLP_CHK_NODE_ACT(pnode)) {
2295                                 memcpy(&fast_path_evt->un.fabric_evt.wwpn,
2296                                         &pnode->nlp_portname,
2297                                         sizeof(struct lpfc_name));
2298                                 memcpy(&fast_path_evt->un.fabric_evt.wwnn,
2299                                         &pnode->nlp_nodename,
2300                                         sizeof(struct lpfc_name));
2301                         }
2302                         fast_path_evt->vport = vport;
2303                         fast_path_evt->work_evt.evt =
2304                                 LPFC_EVT_FASTPATH_MGMT_EVT;
2305                         spin_lock_irqsave(&phba->hbalock, flags);
2306                         list_add_tail(&fast_path_evt->work_evt.evt_listp,
2307                                 &phba->work_list);
2308                         spin_unlock_irqrestore(&phba->hbalock, flags);
2309                         lpfc_worker_wake_up(phba);
2310                         break;
2311                 case IOSTAT_LOCAL_REJECT:
2312                         if (lpfc_cmd->result == IOERR_INVALID_RPI ||
2313                             lpfc_cmd->result == IOERR_NO_RESOURCES ||
2314                             lpfc_cmd->result == IOERR_ABORT_REQUESTED) {
2315                                 cmd->result = ScsiResult(DID_REQUEUE, 0);
2316                                 break;
2317                         }
2318
2319                         if ((lpfc_cmd->result == IOERR_RX_DMA_FAILED ||
2320                              lpfc_cmd->result == IOERR_TX_DMA_FAILED) &&
2321                              pIocbOut->iocb.unsli3.sli3_bg.bgstat) {
2322                                 if (scsi_get_prot_op(cmd) != SCSI_PROT_NORMAL) {
2323                                         /*
2324                                          * This is a response for a BG enabled
2325                                          * cmd. Parse BG error
2326                                          */
2327                                         lpfc_parse_bg_err(phba, lpfc_cmd,
2328                                                         pIocbOut);
2329                                         break;
2330                                 } else {
2331                                         lpfc_printf_vlog(vport, KERN_WARNING,
2332                                                         LOG_BG,
2333                                                         "9031 non-zero BGSTAT "
2334                                                         "on unprotected cmd\n");
2335                                 }
2336                         }
2337
2338                 /* else: fall through */
2339                 default:
2340                         cmd->result = ScsiResult(DID_ERROR, 0);
2341                         break;
2342                 }
2343
2344                 if (!pnode || !NLP_CHK_NODE_ACT(pnode)
2345                     || (pnode->nlp_state != NLP_STE_MAPPED_NODE))
2346                         cmd->result = ScsiResult(DID_TRANSPORT_DISRUPTED,
2347                                                  SAM_STAT_BUSY);
2348         } else {
2349                 cmd->result = ScsiResult(DID_OK, 0);
2350         }
2351
2352         if (cmd->result || lpfc_cmd->fcp_rsp->rspSnsLen) {
2353                 uint32_t *lp = (uint32_t *)cmd->sense_buffer;
2354
2355                 lpfc_printf_vlog(vport, KERN_INFO, LOG_FCP,
2356                                  "0710 Iodone <%d/%d> cmd %p, error "
2357                                  "x%x SNS x%x x%x Data: x%x x%x\n",
2358                                  cmd->device->id, cmd->device->lun, cmd,
2359                                  cmd->result, *lp, *(lp + 3), cmd->retries,
2360                                  scsi_get_resid(cmd));
2361         }
2362
2363         lpfc_update_stats(phba, lpfc_cmd);
2364         result = cmd->result;
2365         if (vport->cfg_max_scsicmpl_time &&
2366            time_after(jiffies, lpfc_cmd->start_time +
2367                 msecs_to_jiffies(vport->cfg_max_scsicmpl_time))) {
2368                 spin_lock_irqsave(shost->host_lock, flags);
2369                 if (pnode && NLP_CHK_NODE_ACT(pnode)) {
2370                         if (pnode->cmd_qdepth >
2371                                 atomic_read(&pnode->cmd_pending) &&
2372                                 (atomic_read(&pnode->cmd_pending) >
2373                                 LPFC_MIN_TGT_QDEPTH) &&
2374                                 ((cmd->cmnd[0] == READ_10) ||
2375                                 (cmd->cmnd[0] == WRITE_10)))
2376                                 pnode->cmd_qdepth =
2377                                         atomic_read(&pnode->cmd_pending);
2378
2379                         pnode->last_change_time = jiffies;
2380                 }
2381                 spin_unlock_irqrestore(shost->host_lock, flags);
2382         } else if (pnode && NLP_CHK_NODE_ACT(pnode)) {
2383                 if ((pnode->cmd_qdepth < LPFC_MAX_TGT_QDEPTH) &&
2384                    time_after(jiffies, pnode->last_change_time +
2385                               msecs_to_jiffies(LPFC_TGTQ_INTERVAL))) {
2386                         spin_lock_irqsave(shost->host_lock, flags);
2387                         pnode->cmd_qdepth += pnode->cmd_qdepth *
2388                                 LPFC_TGTQ_RAMPUP_PCENT / 100;
2389                         if (pnode->cmd_qdepth > LPFC_MAX_TGT_QDEPTH)
2390                                 pnode->cmd_qdepth = LPFC_MAX_TGT_QDEPTH;
2391                         pnode->last_change_time = jiffies;
2392                         spin_unlock_irqrestore(shost->host_lock, flags);
2393                 }
2394         }
2395
2396         lpfc_scsi_unprep_dma_buf(phba, lpfc_cmd);
2397
2398         /* The sdev is not guaranteed to be valid post scsi_done upcall. */
2399         queue_depth = cmd->device->queue_depth;
2400         scsi_id = cmd->device->id;
2401         cmd->scsi_done(cmd);
2402
2403         if (phba->cfg_poll & ENABLE_FCP_RING_POLLING) {
2404                 /*
2405                  * If there is a thread waiting for command completion
2406                  * wake up the thread.
2407                  */
2408                 spin_lock_irqsave(shost->host_lock, flags);
2409                 lpfc_cmd->pCmd = NULL;
2410                 if (lpfc_cmd->waitq)
2411                         wake_up(lpfc_cmd->waitq);
2412                 spin_unlock_irqrestore(shost->host_lock, flags);
2413                 lpfc_release_scsi_buf(phba, lpfc_cmd);
2414                 return;
2415         }
2416
2417         if (!result)
2418                 lpfc_rampup_queue_depth(vport, queue_depth);
2419
2420         /*
2421          * Check for queue full.  If the lun is reporting queue full, then
2422          * back off the lun queue depth to prevent target overloads.
2423          */
2424         if (result == SAM_STAT_TASK_SET_FULL && pnode &&
2425             NLP_CHK_NODE_ACT(pnode)) {
2426                 shost_for_each_device(tmp_sdev, shost) {
2427                         if (tmp_sdev->id != scsi_id)
2428                                 continue;
2429                         depth = scsi_track_queue_full(tmp_sdev,
2430                                                       tmp_sdev->queue_depth-1);
2431                         if (depth <= 0)
2432                                 continue;
2433                         lpfc_printf_vlog(vport, KERN_WARNING, LOG_FCP,
2434                                          "0711 detected queue full - lun queue "
2435                                          "depth adjusted to %d.\n", depth);
2436                         lpfc_send_sdev_queuedepth_change_event(phba, vport,
2437                                                                pnode,
2438                                                                tmp_sdev->lun,
2439                                                                depth+1, depth);
2440                 }
2441         }
2442
2443         /*
2444          * If there is a thread waiting for command completion
2445          * wake up the thread.
2446          */
2447         spin_lock_irqsave(shost->host_lock, flags);
2448         lpfc_cmd->pCmd = NULL;
2449         if (lpfc_cmd->waitq)
2450                 wake_up(lpfc_cmd->waitq);
2451         spin_unlock_irqrestore(shost->host_lock, flags);
2452
2453         lpfc_release_scsi_buf(phba, lpfc_cmd);
2454 }
2455
2456 /**
2457  * lpfc_fcpcmd_to_iocb - copy the fcp_cmd data into the IOCB
2458  * @data: A pointer to the immediate command data portion of the IOCB.
2459  * @fcp_cmnd: The FCP Command that is provided by the SCSI layer.
2460  *
2461  * The routine copies the entire FCP command from @fcp_cmnd to @data while
2462  * byte swapping the data to big endian format for transmission on the wire.
2463  **/
2464 static void
2465 lpfc_fcpcmd_to_iocb(uint8_t *data, struct fcp_cmnd *fcp_cmnd)
2466 {
2467         int i, j;
2468         for (i = 0, j = 0; i < sizeof(struct fcp_cmnd);
2469              i += sizeof(uint32_t), j++) {
2470                 ((uint32_t *)data)[j] = cpu_to_be32(((uint32_t *)fcp_cmnd)[j]);
2471         }
2472 }
2473
2474 /**
2475  * lpfc_scsi_prep_cmnd - Wrapper func for convert scsi cmnd to FCP info unit
2476  * @vport: The virtual port for which this call is being executed.
2477  * @lpfc_cmd: The scsi command which needs to send.
2478  * @pnode: Pointer to lpfc_nodelist.
2479  *
2480  * This routine initializes fcp_cmnd and iocb data structure from scsi command
2481  * to transfer for device with SLI3 interface spec.
2482  **/
2483 static void
2484 lpfc_scsi_prep_cmnd(struct lpfc_vport *vport, struct lpfc_scsi_buf *lpfc_cmd,
2485                     struct lpfc_nodelist *pnode)
2486 {
2487         struct lpfc_hba *phba = vport->phba;
2488         struct scsi_cmnd *scsi_cmnd = lpfc_cmd->pCmd;
2489         struct fcp_cmnd *fcp_cmnd = lpfc_cmd->fcp_cmnd;
2490         IOCB_t *iocb_cmd = &lpfc_cmd->cur_iocbq.iocb;
2491         struct lpfc_iocbq *piocbq = &(lpfc_cmd->cur_iocbq);
2492         int datadir = scsi_cmnd->sc_data_direction;
2493         char tag[2];
2494
2495         if (!pnode || !NLP_CHK_NODE_ACT(pnode))
2496                 return;
2497
2498         lpfc_cmd->fcp_rsp->rspSnsLen = 0;
2499         /* clear task management bits */
2500         lpfc_cmd->fcp_cmnd->fcpCntl2 = 0;
2501
2502         int_to_scsilun(lpfc_cmd->pCmd->device->lun,
2503                         &lpfc_cmd->fcp_cmnd->fcp_lun);
2504
2505         memcpy(&fcp_cmnd->fcpCdb[0], scsi_cmnd->cmnd, 16);
2506
2507         if (scsi_populate_tag_msg(scsi_cmnd, tag)) {
2508                 switch (tag[0]) {
2509                 case HEAD_OF_QUEUE_TAG:
2510                         fcp_cmnd->fcpCntl1 = HEAD_OF_Q;
2511                         break;
2512                 case ORDERED_QUEUE_TAG:
2513                         fcp_cmnd->fcpCntl1 = ORDERED_Q;
2514                         break;
2515                 default:
2516                         fcp_cmnd->fcpCntl1 = SIMPLE_Q;
2517                         break;
2518                 }
2519         } else
2520                 fcp_cmnd->fcpCntl1 = 0;
2521
2522         /*
2523          * There are three possibilities here - use scatter-gather segment, use
2524          * the single mapping, or neither.  Start the lpfc command prep by
2525          * bumping the bpl beyond the fcp_cmnd and fcp_rsp regions to the first
2526          * data bde entry.
2527          */
2528         if (scsi_sg_count(scsi_cmnd)) {
2529                 if (datadir == DMA_TO_DEVICE) {
2530                         iocb_cmd->ulpCommand = CMD_FCP_IWRITE64_CR;
2531                         if (phba->sli_rev < LPFC_SLI_REV4) {
2532                                 iocb_cmd->un.fcpi.fcpi_parm = 0;
2533                                 iocb_cmd->ulpPU = 0;
2534                         } else
2535                                 iocb_cmd->ulpPU = PARM_READ_CHECK;
2536                         fcp_cmnd->fcpCntl3 = WRITE_DATA;
2537                         phba->fc4OutputRequests++;
2538                 } else {
2539                         iocb_cmd->ulpCommand = CMD_FCP_IREAD64_CR;
2540                         iocb_cmd->ulpPU = PARM_READ_CHECK;
2541                         fcp_cmnd->fcpCntl3 = READ_DATA;
2542                         phba->fc4InputRequests++;
2543                 }
2544         } else {
2545                 iocb_cmd->ulpCommand = CMD_FCP_ICMND64_CR;
2546                 iocb_cmd->un.fcpi.fcpi_parm = 0;
2547                 iocb_cmd->ulpPU = 0;
2548                 fcp_cmnd->fcpCntl3 = 0;
2549                 phba->fc4ControlRequests++;
2550         }
2551         if (phba->sli_rev == 3 &&
2552             !(phba->sli3_options & LPFC_SLI3_BG_ENABLED))
2553                 lpfc_fcpcmd_to_iocb(iocb_cmd->unsli3.fcp_ext.icd, fcp_cmnd);
2554         /*
2555          * Finish initializing those IOCB fields that are independent
2556          * of the scsi_cmnd request_buffer
2557          */
2558         piocbq->iocb.ulpContext = pnode->nlp_rpi;
2559         if (pnode->nlp_fcp_info & NLP_FCP_2_DEVICE)
2560                 piocbq->iocb.ulpFCP2Rcvy = 1;
2561         else
2562                 piocbq->iocb.ulpFCP2Rcvy = 0;
2563
2564         piocbq->iocb.ulpClass = (pnode->nlp_fcp_info & 0x0f);
2565         piocbq->context1  = lpfc_cmd;
2566         piocbq->iocb_cmpl = lpfc_scsi_cmd_iocb_cmpl;
2567         piocbq->iocb.ulpTimeout = lpfc_cmd->timeout;
2568         piocbq->vport = vport;
2569 }
2570
2571 /**
2572  * lpfc_scsi_prep_task_mgmt_cmnd - Convert SLI3 scsi TM cmd to FCP info unit
2573  * @vport: The virtual port for which this call is being executed.
2574  * @lpfc_cmd: Pointer to lpfc_scsi_buf data structure.
2575  * @lun: Logical unit number.
2576  * @task_mgmt_cmd: SCSI task management command.
2577  *
2578  * This routine creates FCP information unit corresponding to @task_mgmt_cmd
2579  * for device with SLI-3 interface spec.
2580  *
2581  * Return codes:
2582  *   0 - Error
2583  *   1 - Success
2584  **/
2585 static int
2586 lpfc_scsi_prep_task_mgmt_cmd(struct lpfc_vport *vport,
2587                              struct lpfc_scsi_buf *lpfc_cmd,
2588                              unsigned int lun,
2589                              uint8_t task_mgmt_cmd)
2590 {
2591         struct lpfc_iocbq *piocbq;
2592         IOCB_t *piocb;
2593         struct fcp_cmnd *fcp_cmnd;
2594         struct lpfc_rport_data *rdata = lpfc_cmd->rdata;
2595         struct lpfc_nodelist *ndlp = rdata->pnode;
2596
2597         if (!ndlp || !NLP_CHK_NODE_ACT(ndlp) ||
2598             ndlp->nlp_state != NLP_STE_MAPPED_NODE)
2599                 return 0;
2600
2601         piocbq = &(lpfc_cmd->cur_iocbq);
2602         piocbq->vport = vport;
2603
2604         piocb = &piocbq->iocb;
2605
2606         fcp_cmnd = lpfc_cmd->fcp_cmnd;
2607         /* Clear out any old data in the FCP command area */
2608         memset(fcp_cmnd, 0, sizeof(struct fcp_cmnd));
2609         int_to_scsilun(lun, &fcp_cmnd->fcp_lun);
2610         fcp_cmnd->fcpCntl2 = task_mgmt_cmd;
2611         if (vport->phba->sli_rev == 3 &&
2612             !(vport->phba->sli3_options & LPFC_SLI3_BG_ENABLED))
2613                 lpfc_fcpcmd_to_iocb(piocb->unsli3.fcp_ext.icd, fcp_cmnd);
2614         piocb->ulpCommand = CMD_FCP_ICMND64_CR;
2615         piocb->ulpContext = ndlp->nlp_rpi;
2616         if (ndlp->nlp_fcp_info & NLP_FCP_2_DEVICE) {
2617                 piocb->ulpFCP2Rcvy = 1;
2618         }
2619         piocb->ulpClass = (ndlp->nlp_fcp_info & 0x0f);
2620
2621         /* ulpTimeout is only one byte */
2622         if (lpfc_cmd->timeout > 0xff) {
2623                 /*
2624                  * Do not timeout the command at the firmware level.
2625                  * The driver will provide the timeout mechanism.
2626                  */
2627                 piocb->ulpTimeout = 0;
2628         } else
2629                 piocb->ulpTimeout = lpfc_cmd->timeout;
2630
2631         if (vport->phba->sli_rev == LPFC_SLI_REV4)
2632                 lpfc_sli4_set_rsp_sgl_last(vport->phba, lpfc_cmd);
2633
2634         return 1;
2635 }
2636
2637 /**
2638  * lpfc_scsi_api_table_setup - Set up scsi api fucntion jump table
2639  * @phba: The hba struct for which this call is being executed.
2640  * @dev_grp: The HBA PCI-Device group number.
2641  *
2642  * This routine sets up the SCSI interface API function jump table in @phba
2643  * struct.
2644  * Returns: 0 - success, -ENODEV - failure.
2645  **/
2646 int
2647 lpfc_scsi_api_table_setup(struct lpfc_hba *phba, uint8_t dev_grp)
2648 {
2649
2650         phba->lpfc_scsi_unprep_dma_buf = lpfc_scsi_unprep_dma_buf;
2651         phba->lpfc_scsi_prep_cmnd = lpfc_scsi_prep_cmnd;
2652         phba->lpfc_get_scsi_buf = lpfc_get_scsi_buf;
2653
2654         switch (dev_grp) {
2655         case LPFC_PCI_DEV_LP:
2656                 phba->lpfc_new_scsi_buf = lpfc_new_scsi_buf_s3;
2657                 phba->lpfc_scsi_prep_dma_buf = lpfc_scsi_prep_dma_buf_s3;
2658                 phba->lpfc_release_scsi_buf = lpfc_release_scsi_buf_s3;
2659                 break;
2660         case LPFC_PCI_DEV_OC:
2661                 phba->lpfc_new_scsi_buf = lpfc_new_scsi_buf_s4;
2662                 phba->lpfc_scsi_prep_dma_buf = lpfc_scsi_prep_dma_buf_s4;
2663                 phba->lpfc_release_scsi_buf = lpfc_release_scsi_buf_s4;
2664                 break;
2665         default:
2666                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
2667                                 "1418 Invalid HBA PCI-device group: 0x%x\n",
2668                                 dev_grp);
2669                 return -ENODEV;
2670                 break;
2671         }
2672         phba->lpfc_get_scsi_buf = lpfc_get_scsi_buf;
2673         phba->lpfc_rampdown_queue_depth = lpfc_rampdown_queue_depth;
2674         phba->lpfc_scsi_cmd_iocb_cmpl = lpfc_scsi_cmd_iocb_cmpl;
2675         return 0;
2676 }
2677
2678 /**
2679  * lpfc_taskmgmt_def_cmpl - IOCB completion routine for task management command
2680  * @phba: The Hba for which this call is being executed.
2681  * @cmdiocbq: Pointer to lpfc_iocbq data structure.
2682  * @rspiocbq: Pointer to lpfc_iocbq data structure.
2683  *
2684  * This routine is IOCB completion routine for device reset and target reset
2685  * routine. This routine release scsi buffer associated with lpfc_cmd.
2686  **/
2687 static void
2688 lpfc_tskmgmt_def_cmpl(struct lpfc_hba *phba,
2689                         struct lpfc_iocbq *cmdiocbq,
2690                         struct lpfc_iocbq *rspiocbq)
2691 {
2692         struct lpfc_scsi_buf *lpfc_cmd =
2693                 (struct lpfc_scsi_buf *) cmdiocbq->context1;
2694         if (lpfc_cmd)
2695                 lpfc_release_scsi_buf(phba, lpfc_cmd);
2696         return;
2697 }
2698
2699 /**
2700  * lpfc_info - Info entry point of scsi_host_template data structure
2701  * @host: The scsi host for which this call is being executed.
2702  *
2703  * This routine provides module information about hba.
2704  *
2705  * Reutrn code:
2706  *   Pointer to char - Success.
2707  **/
2708 const char *
2709 lpfc_info(struct Scsi_Host *host)
2710 {
2711         struct lpfc_vport *vport = (struct lpfc_vport *) host->hostdata;
2712         struct lpfc_hba   *phba = vport->phba;
2713         int len;
2714         static char  lpfcinfobuf[384];
2715
2716         memset(lpfcinfobuf,0,384);
2717         if (phba && phba->pcidev){
2718                 strncpy(lpfcinfobuf, phba->ModelDesc, 256);
2719                 len = strlen(lpfcinfobuf);
2720                 snprintf(lpfcinfobuf + len,
2721                         384-len,
2722                         " on PCI bus %02x device %02x irq %d",
2723                         phba->pcidev->bus->number,
2724                         phba->pcidev->devfn,
2725                         phba->pcidev->irq);
2726                 len = strlen(lpfcinfobuf);
2727                 if (phba->Port[0]) {
2728                         snprintf(lpfcinfobuf + len,
2729                                  384-len,
2730                                  " port %s",
2731                                  phba->Port);
2732                 }
2733                 len = strlen(lpfcinfobuf);
2734                 if (phba->sli4_hba.link_state.logical_speed) {
2735                         snprintf(lpfcinfobuf + len,
2736                                  384-len,
2737                                  " Logical Link Speed: %d Mbps",
2738                                  phba->sli4_hba.link_state.logical_speed * 10);
2739                 }
2740         }
2741         return lpfcinfobuf;
2742 }
2743
2744 /**
2745  * lpfc_poll_rearm_time - Routine to modify fcp_poll timer of hba
2746  * @phba: The Hba for which this call is being executed.
2747  *
2748  * This routine modifies fcp_poll_timer  field of @phba by cfg_poll_tmo.
2749  * The default value of cfg_poll_tmo is 10 milliseconds.
2750  **/
2751 static __inline__ void lpfc_poll_rearm_timer(struct lpfc_hba * phba)
2752 {
2753         unsigned long  poll_tmo_expires =
2754                 (jiffies + msecs_to_jiffies(phba->cfg_poll_tmo));
2755
2756         if (phba->sli.ring[LPFC_FCP_RING].txcmplq_cnt)
2757                 mod_timer(&phba->fcp_poll_timer,
2758                           poll_tmo_expires);
2759 }
2760
2761 /**
2762  * lpfc_poll_start_timer - Routine to start fcp_poll_timer of HBA
2763  * @phba: The Hba for which this call is being executed.
2764  *
2765  * This routine starts the fcp_poll_timer of @phba.
2766  **/
2767 void lpfc_poll_start_timer(struct lpfc_hba * phba)
2768 {
2769         lpfc_poll_rearm_timer(phba);
2770 }
2771
2772 /**
2773  * lpfc_poll_timeout - Restart polling timer
2774  * @ptr: Map to lpfc_hba data structure pointer.
2775  *
2776  * This routine restarts fcp_poll timer, when FCP ring  polling is enable
2777  * and FCP Ring interrupt is disable.
2778  **/
2779
2780 void lpfc_poll_timeout(unsigned long ptr)
2781 {
2782         struct lpfc_hba *phba = (struct lpfc_hba *) ptr;
2783
2784         if (phba->cfg_poll & ENABLE_FCP_RING_POLLING) {
2785                 lpfc_sli_handle_fast_ring_event(phba,
2786                         &phba->sli.ring[LPFC_FCP_RING], HA_R0RE_REQ);
2787
2788                 if (phba->cfg_poll & DISABLE_FCP_RING_INT)
2789                         lpfc_poll_rearm_timer(phba);
2790         }
2791 }
2792
2793 /**
2794  * lpfc_queuecommand - scsi_host_template queuecommand entry point
2795  * @cmnd: Pointer to scsi_cmnd data structure.
2796  * @done: Pointer to done routine.
2797  *
2798  * Driver registers this routine to scsi midlayer to submit a @cmd to process.
2799  * This routine prepares an IOCB from scsi command and provides to firmware.
2800  * The @done callback is invoked after driver finished processing the command.
2801  *
2802  * Return value :
2803  *   0 - Success
2804  *   SCSI_MLQUEUE_HOST_BUSY - Block all devices served by this host temporarily.
2805  **/
2806 static int
2807 lpfc_queuecommand(struct scsi_cmnd *cmnd, void (*done) (struct scsi_cmnd *))
2808 {
2809         struct Scsi_Host  *shost = cmnd->device->host;
2810         struct lpfc_vport *vport = (struct lpfc_vport *) shost->hostdata;
2811         struct lpfc_hba   *phba = vport->phba;
2812         struct lpfc_rport_data *rdata = cmnd->device->hostdata;
2813         struct lpfc_nodelist *ndlp;
2814         struct lpfc_scsi_buf *lpfc_cmd;
2815         struct fc_rport *rport = starget_to_rport(scsi_target(cmnd->device));
2816         int err;
2817
2818         err = fc_remote_port_chkready(rport);
2819         if (err) {
2820                 cmnd->result = err;
2821                 goto out_fail_command;
2822         }
2823         ndlp = rdata->pnode;
2824
2825         if (!(phba->sli3_options & LPFC_SLI3_BG_ENABLED) &&
2826                 scsi_get_prot_op(cmnd) != SCSI_PROT_NORMAL) {
2827
2828                 lpfc_printf_log(phba, KERN_ERR, LOG_BG,
2829                                 "9058 BLKGRD: ERROR: rcvd protected cmd:%02x"
2830                                 " op:%02x str=%s without registering for"
2831                                 " BlockGuard - Rejecting command\n",
2832                                 cmnd->cmnd[0], scsi_get_prot_op(cmnd),
2833                                 dif_op_str[scsi_get_prot_op(cmnd)]);
2834                 goto out_fail_command;
2835         }
2836
2837         /*
2838          * Catch race where our node has transitioned, but the
2839          * transport is still transitioning.
2840          */
2841         if (!ndlp || !NLP_CHK_NODE_ACT(ndlp)) {
2842                 cmnd->result = ScsiResult(DID_TRANSPORT_DISRUPTED, 0);
2843                 goto out_fail_command;
2844         }
2845         if (vport->cfg_max_scsicmpl_time &&
2846                 (atomic_read(&ndlp->cmd_pending) >= ndlp->cmd_qdepth))
2847                 goto out_host_busy;
2848
2849         lpfc_cmd = lpfc_get_scsi_buf(phba);
2850         if (lpfc_cmd == NULL) {
2851                 lpfc_rampdown_queue_depth(phba);
2852
2853                 lpfc_printf_vlog(vport, KERN_INFO, LOG_FCP,
2854                                  "0707 driver's buffer pool is empty, "
2855                                  "IO busied\n");
2856                 goto out_host_busy;
2857         }
2858
2859         /*
2860          * Store the midlayer's command structure for the completion phase
2861          * and complete the command initialization.
2862          */
2863         lpfc_cmd->pCmd  = cmnd;
2864         lpfc_cmd->rdata = rdata;
2865         lpfc_cmd->timeout = 0;
2866         lpfc_cmd->start_time = jiffies;
2867         cmnd->host_scribble = (unsigned char *)lpfc_cmd;
2868         cmnd->scsi_done = done;
2869
2870         if (scsi_get_prot_op(cmnd) != SCSI_PROT_NORMAL) {
2871                 if (vport->phba->cfg_enable_bg) {
2872                         lpfc_printf_vlog(vport, KERN_WARNING, LOG_BG,
2873                                 "9033 BLKGRD: rcvd protected cmd:%02x op:%02x "
2874                                 "str=%s\n",
2875                                 cmnd->cmnd[0], scsi_get_prot_op(cmnd),
2876                                 dif_op_str[scsi_get_prot_op(cmnd)]);
2877                         lpfc_printf_vlog(vport, KERN_WARNING, LOG_BG,
2878                                 "9034 BLKGRD: CDB: %02x %02x %02x %02x %02x "
2879                                 "%02x %02x %02x %02x %02x\n",
2880                                 cmnd->cmnd[0], cmnd->cmnd[1], cmnd->cmnd[2],
2881                                 cmnd->cmnd[3], cmnd->cmnd[4], cmnd->cmnd[5],
2882                                 cmnd->cmnd[6], cmnd->cmnd[7], cmnd->cmnd[8],
2883                                 cmnd->cmnd[9]);
2884                         if (cmnd->cmnd[0] == READ_10)
2885                                 lpfc_printf_vlog(vport, KERN_WARNING, LOG_BG,
2886                                         "9035 BLKGRD: READ @ sector %llu, "
2887                                         "count %u\n",
2888                                         (unsigned long long)scsi_get_lba(cmnd),
2889                                         blk_rq_sectors(cmnd->request));
2890                         else if (cmnd->cmnd[0] == WRITE_10)
2891                                 lpfc_printf_vlog(vport, KERN_WARNING, LOG_BG,
2892                                         "9036 BLKGRD: WRITE @ sector %llu, "
2893                                         "count %u cmd=%p\n",
2894                                         (unsigned long long)scsi_get_lba(cmnd),
2895                                         blk_rq_sectors(cmnd->request),
2896                                         cmnd);
2897                 }
2898
2899                 err = lpfc_bg_scsi_prep_dma_buf(phba, lpfc_cmd);
2900         } else {
2901                 if (vport->phba->cfg_enable_bg) {
2902                         lpfc_printf_vlog(vport, KERN_WARNING, LOG_BG,
2903                                         "9038 BLKGRD: rcvd unprotected cmd:"
2904                                         "%02x op:%02x str=%s\n",
2905                                         cmnd->cmnd[0], scsi_get_prot_op(cmnd),
2906                                         dif_op_str[scsi_get_prot_op(cmnd)]);
2907                                 lpfc_printf_vlog(vport, KERN_WARNING, LOG_BG,
2908                                         "9039 BLKGRD: CDB: %02x %02x %02x "
2909                                         "%02x %02x %02x %02x %02x %02x %02x\n",
2910                                         cmnd->cmnd[0], cmnd->cmnd[1],
2911                                         cmnd->cmnd[2], cmnd->cmnd[3],
2912                                         cmnd->cmnd[4], cmnd->cmnd[5],
2913                                         cmnd->cmnd[6], cmnd->cmnd[7],
2914                                         cmnd->cmnd[8], cmnd->cmnd[9]);
2915                         if (cmnd->cmnd[0] == READ_10)
2916                                 lpfc_printf_vlog(vport, KERN_WARNING, LOG_BG,
2917                                         "9040 dbg: READ @ sector %llu, "
2918                                         "count %u\n",
2919                                         (unsigned long long)scsi_get_lba(cmnd),
2920                                          blk_rq_sectors(cmnd->request));
2921                         else if (cmnd->cmnd[0] == WRITE_10)
2922                                 lpfc_printf_vlog(vport, KERN_WARNING, LOG_BG,
2923                                          "9041 dbg: WRITE @ sector %llu, "
2924                                          "count %u cmd=%p\n",
2925                                          (unsigned long long)scsi_get_lba(cmnd),
2926                                          blk_rq_sectors(cmnd->request), cmnd);
2927                         else
2928                                 lpfc_printf_vlog(vport, KERN_WARNING, LOG_BG,
2929                                          "9042 dbg: parser not implemented\n");
2930                 }
2931                 err = lpfc_scsi_prep_dma_buf(phba, lpfc_cmd);
2932         }
2933
2934         if (err)
2935                 goto out_host_busy_free_buf;
2936
2937         lpfc_scsi_prep_cmnd(vport, lpfc_cmd, ndlp);
2938
2939         atomic_inc(&ndlp->cmd_pending);
2940         err = lpfc_sli_issue_iocb(phba, LPFC_FCP_RING,
2941                                   &lpfc_cmd->cur_iocbq, SLI_IOCB_RET_IOCB);
2942         if (err) {
2943                 atomic_dec(&ndlp->cmd_pending);
2944                 goto out_host_busy_free_buf;
2945         }
2946         if (phba->cfg_poll & ENABLE_FCP_RING_POLLING) {
2947                 spin_unlock(shost->host_lock);
2948                 lpfc_sli_handle_fast_ring_event(phba,
2949                         &phba->sli.ring[LPFC_FCP_RING], HA_R0RE_REQ);
2950
2951                 spin_lock(shost->host_lock);
2952                 if (phba->cfg_poll & DISABLE_FCP_RING_INT)
2953                         lpfc_poll_rearm_timer(phba);
2954         }
2955
2956         return 0;
2957
2958  out_host_busy_free_buf:
2959         lpfc_scsi_unprep_dma_buf(phba, lpfc_cmd);
2960         lpfc_release_scsi_buf(phba, lpfc_cmd);
2961  out_host_busy:
2962         return SCSI_MLQUEUE_HOST_BUSY;
2963
2964  out_fail_command:
2965         done(cmnd);
2966         return 0;
2967 }
2968
2969 /**
2970  * lpfc_abort_handler - scsi_host_template eh_abort_handler entry point
2971  * @cmnd: Pointer to scsi_cmnd data structure.
2972  *
2973  * This routine aborts @cmnd pending in base driver.
2974  *
2975  * Return code :
2976  *   0x2003 - Error
2977  *   0x2002 - Success
2978  **/
2979 static int
2980 lpfc_abort_handler(struct scsi_cmnd *cmnd)
2981 {
2982         struct Scsi_Host  *shost = cmnd->device->host;
2983         struct lpfc_vport *vport = (struct lpfc_vport *) shost->hostdata;
2984         struct lpfc_hba   *phba = vport->phba;
2985         struct lpfc_iocbq *iocb;
2986         struct lpfc_iocbq *abtsiocb;
2987         struct lpfc_scsi_buf *lpfc_cmd;
2988         IOCB_t *cmd, *icmd;
2989         int ret = SUCCESS;
2990         DECLARE_WAIT_QUEUE_HEAD_ONSTACK(waitq);
2991
2992         fc_block_scsi_eh(cmnd);
2993         lpfc_cmd = (struct lpfc_scsi_buf *)cmnd->host_scribble;
2994         BUG_ON(!lpfc_cmd);
2995
2996         /*
2997          * If pCmd field of the corresponding lpfc_scsi_buf structure
2998          * points to a different SCSI command, then the driver has
2999          * already completed this command, but the midlayer did not
3000          * see the completion before the eh fired.  Just return
3001          * SUCCESS.
3002          */
3003         iocb = &lpfc_cmd->cur_iocbq;
3004         if (lpfc_cmd->pCmd != cmnd)
3005                 goto out;
3006
3007         BUG_ON(iocb->context1 != lpfc_cmd);
3008
3009         abtsiocb = lpfc_sli_get_iocbq(phba);
3010         if (abtsiocb == NULL) {
3011                 ret = FAILED;
3012                 goto out;
3013         }
3014
3015         /*
3016          * The scsi command can not be in txq and it is in flight because the
3017          * pCmd is still pointig at the SCSI command we have to abort. There
3018          * is no need to search the txcmplq. Just send an abort to the FW.
3019          */
3020
3021         cmd = &iocb->iocb;
3022         icmd = &abtsiocb->iocb;
3023         icmd->un.acxri.abortType = ABORT_TYPE_ABTS;
3024         icmd->un.acxri.abortContextTag = cmd->ulpContext;
3025         if (phba->sli_rev == LPFC_SLI_REV4)
3026                 icmd->un.acxri.abortIoTag = iocb->sli4_xritag;
3027         else
3028                 icmd->un.acxri.abortIoTag = cmd->ulpIoTag;
3029
3030         icmd->ulpLe = 1;
3031         icmd->ulpClass = cmd->ulpClass;
3032
3033         /* ABTS WQE must go to the same WQ as the WQE to be aborted */
3034         abtsiocb->fcp_wqidx = iocb->fcp_wqidx;
3035         abtsiocb->iocb_flag |= LPFC_USE_FCPWQIDX;
3036
3037         if (lpfc_is_link_up(phba))
3038                 icmd->ulpCommand = CMD_ABORT_XRI_CN;
3039         else
3040                 icmd->ulpCommand = CMD_CLOSE_XRI_CN;
3041
3042         abtsiocb->iocb_cmpl = lpfc_sli_abort_fcp_cmpl;
3043         abtsiocb->vport = vport;
3044         if (lpfc_sli_issue_iocb(phba, LPFC_FCP_RING, abtsiocb, 0) ==
3045             IOCB_ERROR) {
3046                 lpfc_sli_release_iocbq(phba, abtsiocb);
3047                 ret = FAILED;
3048                 goto out;
3049         }
3050
3051         if (phba->cfg_poll & DISABLE_FCP_RING_INT)
3052                 lpfc_sli_handle_fast_ring_event(phba,
3053                         &phba->sli.ring[LPFC_FCP_RING], HA_R0RE_REQ);
3054
3055         lpfc_cmd->waitq = &waitq;
3056         /* Wait for abort to complete */
3057         wait_event_timeout(waitq,
3058                           (lpfc_cmd->pCmd != cmnd),
3059                            (2*vport->cfg_devloss_tmo*HZ));
3060
3061         spin_lock_irq(shost->host_lock);
3062         lpfc_cmd->waitq = NULL;
3063         spin_unlock_irq(shost->host_lock);
3064
3065         if (lpfc_cmd->pCmd == cmnd) {
3066                 ret = FAILED;
3067                 lpfc_printf_vlog(vport, KERN_ERR, LOG_FCP,
3068                                  "0748 abort handler timed out waiting "
3069                                  "for abort to complete: ret %#x, ID %d, "
3070                                  "LUN %d, snum %#lx\n",
3071                                  ret, cmnd->device->id, cmnd->device->lun,
3072                                  cmnd->serial_number);
3073         }
3074
3075  out:
3076         lpfc_printf_vlog(vport, KERN_WARNING, LOG_FCP,
3077                          "0749 SCSI Layer I/O Abort Request Status x%x ID %d "
3078                          "LUN %d snum %#lx\n", ret, cmnd->device->id,
3079                          cmnd->device->lun, cmnd->serial_number);
3080         return ret;
3081 }
3082
3083 static char *
3084 lpfc_taskmgmt_name(uint8_t task_mgmt_cmd)
3085 {
3086         switch (task_mgmt_cmd) {
3087         case FCP_ABORT_TASK_SET:
3088                 return "ABORT_TASK_SET";
3089         case FCP_CLEAR_TASK_SET:
3090                 return "FCP_CLEAR_TASK_SET";
3091         case FCP_BUS_RESET:
3092                 return "FCP_BUS_RESET";
3093         case FCP_LUN_RESET:
3094                 return "FCP_LUN_RESET";
3095         case FCP_TARGET_RESET:
3096                 return "FCP_TARGET_RESET";
3097         case FCP_CLEAR_ACA:
3098                 return "FCP_CLEAR_ACA";
3099         case FCP_TERMINATE_TASK:
3100                 return "FCP_TERMINATE_TASK";
3101         default:
3102                 return "unknown";
3103         }
3104 }
3105
3106 /**
3107  * lpfc_send_taskmgmt - Generic SCSI Task Mgmt Handler
3108  * @vport: The virtual port for which this call is being executed.
3109  * @rdata: Pointer to remote port local data
3110  * @tgt_id: Target ID of remote device.
3111  * @lun_id: Lun number for the TMF
3112  * @task_mgmt_cmd: type of TMF to send
3113  *
3114  * This routine builds and sends a TMF (SCSI Task Mgmt Function) to
3115  * a remote port.
3116  *
3117  * Return Code:
3118  *   0x2003 - Error
3119  *   0x2002 - Success.
3120  **/
3121 static int
3122 lpfc_send_taskmgmt(struct lpfc_vport *vport, struct lpfc_rport_data *rdata,
3123                     unsigned  tgt_id, unsigned int lun_id,
3124                     uint8_t task_mgmt_cmd)
3125 {
3126         struct lpfc_hba   *phba = vport->phba;
3127         struct lpfc_scsi_buf *lpfc_cmd;
3128         struct lpfc_iocbq *iocbq;
3129         struct lpfc_iocbq *iocbqrsp;
3130         int ret;
3131         int status;
3132
3133         if (!rdata->pnode || !NLP_CHK_NODE_ACT(rdata->pnode))
3134                 return FAILED;
3135
3136         lpfc_cmd = lpfc_get_scsi_buf(phba);
3137         if (lpfc_cmd == NULL)
3138                 return FAILED;
3139         lpfc_cmd->timeout = 60;
3140         lpfc_cmd->rdata = rdata;
3141
3142         status = lpfc_scsi_prep_task_mgmt_cmd(vport, lpfc_cmd, lun_id,
3143                                            task_mgmt_cmd);
3144         if (!status) {
3145                 lpfc_release_scsi_buf(phba, lpfc_cmd);
3146                 return FAILED;
3147         }
3148
3149         iocbq = &lpfc_cmd->cur_iocbq;
3150         iocbqrsp = lpfc_sli_get_iocbq(phba);
3151         if (iocbqrsp == NULL) {
3152                 lpfc_release_scsi_buf(phba, lpfc_cmd);
3153                 return FAILED;
3154         }
3155
3156         lpfc_printf_vlog(vport, KERN_INFO, LOG_FCP,
3157                          "0702 Issue %s to TGT %d LUN %d "
3158                          "rpi x%x nlp_flag x%x\n",
3159                          lpfc_taskmgmt_name(task_mgmt_cmd), tgt_id, lun_id,
3160                          rdata->pnode->nlp_rpi, rdata->pnode->nlp_flag);
3161
3162         status = lpfc_sli_issue_iocb_wait(phba, LPFC_FCP_RING,
3163                                           iocbq, iocbqrsp, lpfc_cmd->timeout);
3164         if (status != IOCB_SUCCESS) {
3165                 if (status == IOCB_TIMEDOUT) {
3166                         iocbq->iocb_cmpl = lpfc_tskmgmt_def_cmpl;
3167                         ret = TIMEOUT_ERROR;
3168                 } else
3169                         ret = FAILED;
3170                 lpfc_cmd->status = IOSTAT_DRIVER_REJECT;
3171                 lpfc_printf_vlog(vport, KERN_ERR, LOG_FCP,
3172                          "0727 TMF %s to TGT %d LUN %d failed (%d, %d)\n",
3173                          lpfc_taskmgmt_name(task_mgmt_cmd),
3174                          tgt_id, lun_id, iocbqrsp->iocb.ulpStatus,
3175                          iocbqrsp->iocb.un.ulpWord[4]);
3176         } else
3177                 ret = SUCCESS;
3178
3179         lpfc_sli_release_iocbq(phba, iocbqrsp);
3180
3181         if (ret != TIMEOUT_ERROR)
3182                 lpfc_release_scsi_buf(phba, lpfc_cmd);
3183
3184         return ret;
3185 }
3186
3187 /**
3188  * lpfc_chk_tgt_mapped -
3189  * @vport: The virtual port to check on
3190  * @cmnd: Pointer to scsi_cmnd data structure.
3191  *
3192  * This routine delays until the scsi target (aka rport) for the
3193  * command exists (is present and logged in) or we declare it non-existent.
3194  *
3195  * Return code :
3196  *  0x2003 - Error
3197  *  0x2002 - Success
3198  **/
3199 static int
3200 lpfc_chk_tgt_mapped(struct lpfc_vport *vport, struct scsi_cmnd *cmnd)
3201 {
3202         struct lpfc_rport_data *rdata = cmnd->device->hostdata;
3203         struct lpfc_nodelist *pnode;
3204         unsigned long later;
3205
3206         if (!rdata) {
3207                 lpfc_printf_vlog(vport, KERN_INFO, LOG_FCP,
3208                         "0797 Tgt Map rport failure: rdata x%p\n", rdata);
3209                 return FAILED;
3210         }
3211         pnode = rdata->pnode;
3212         /*
3213          * If target is not in a MAPPED state, delay until
3214          * target is rediscovered or devloss timeout expires.
3215          */
3216         later = msecs_to_jiffies(2 * vport->cfg_devloss_tmo * 1000) + jiffies;
3217         while (time_after(later, jiffies)) {
3218                 if (!pnode || !NLP_CHK_NODE_ACT(pnode))
3219                         return FAILED;
3220                 if (pnode->nlp_state == NLP_STE_MAPPED_NODE)
3221                         return SUCCESS;
3222                 schedule_timeout_uninterruptible(msecs_to_jiffies(500));
3223                 rdata = cmnd->device->hostdata;
3224                 if (!rdata)
3225                         return FAILED;
3226                 pnode = rdata->pnode;
3227         }
3228         if (!pnode || !NLP_CHK_NODE_ACT(pnode) ||
3229             (pnode->nlp_state != NLP_STE_MAPPED_NODE))
3230                 return FAILED;
3231         return SUCCESS;
3232 }
3233
3234 /**
3235  * lpfc_reset_flush_io_context -
3236  * @vport: The virtual port (scsi_host) for the flush context
3237  * @tgt_id: If aborting by Target contect - specifies the target id
3238  * @lun_id: If aborting by Lun context - specifies the lun id
3239  * @context: specifies the context level to flush at.
3240  *
3241  * After a reset condition via TMF, we need to flush orphaned i/o
3242  * contexts from the adapter. This routine aborts any contexts
3243  * outstanding, then waits for their completions. The wait is
3244  * bounded by devloss_tmo though.
3245  *
3246  * Return code :
3247  *  0x2003 - Error
3248  *  0x2002 - Success
3249  **/
3250 static int
3251 lpfc_reset_flush_io_context(struct lpfc_vport *vport, uint16_t tgt_id,
3252                         uint64_t lun_id, lpfc_ctx_cmd context)
3253 {
3254         struct lpfc_hba   *phba = vport->phba;
3255         unsigned long later;
3256         int cnt;
3257
3258         cnt = lpfc_sli_sum_iocb(vport, tgt_id, lun_id, context);
3259         if (cnt)
3260                 lpfc_sli_abort_iocb(vport, &phba->sli.ring[phba->sli.fcp_ring],
3261                                     tgt_id, lun_id, context);
3262         later = msecs_to_jiffies(2 * vport->cfg_devloss_tmo * 1000) + jiffies;
3263         while (time_after(later, jiffies) && cnt) {
3264                 schedule_timeout_uninterruptible(msecs_to_jiffies(20));
3265                 cnt = lpfc_sli_sum_iocb(vport, tgt_id, lun_id, context);
3266         }
3267         if (cnt) {
3268                 lpfc_printf_vlog(vport, KERN_ERR, LOG_FCP,
3269                         "0724 I/O flush failure for context %s : cnt x%x\n",
3270                         ((context == LPFC_CTX_LUN) ? "LUN" :
3271                          ((context == LPFC_CTX_TGT) ? "TGT" :
3272                           ((context == LPFC_CTX_HOST) ? "HOST" : "Unknown"))),
3273                         cnt);
3274                 return FAILED;
3275         }
3276         return SUCCESS;
3277 }
3278
3279 /**
3280  * lpfc_device_reset_handler - scsi_host_template eh_device_reset entry point
3281  * @cmnd: Pointer to scsi_cmnd data structure.
3282  *
3283  * This routine does a device reset by sending a LUN_RESET task management
3284  * command.
3285  *
3286  * Return code :
3287  *  0x2003 - Error
3288  *  0x2002 - Success
3289  **/
3290 static int
3291 lpfc_device_reset_handler(struct scsi_cmnd *cmnd)
3292 {
3293         struct Scsi_Host  *shost = cmnd->device->host;
3294         struct lpfc_vport *vport = (struct lpfc_vport *) shost->hostdata;
3295         struct lpfc_rport_data *rdata = cmnd->device->hostdata;
3296         struct lpfc_nodelist *pnode;
3297         unsigned tgt_id = cmnd->device->id;
3298         unsigned int lun_id = cmnd->device->lun;
3299         struct lpfc_scsi_event_header scsi_event;
3300         int status;
3301
3302         if (!rdata) {
3303                 lpfc_printf_vlog(vport, KERN_ERR, LOG_FCP,
3304                         "0798 Device Reset rport failure: rdata x%p\n", rdata);
3305                 return FAILED;
3306         }
3307         pnode = rdata->pnode;
3308         fc_block_scsi_eh(cmnd);
3309
3310         status = lpfc_chk_tgt_mapped(vport, cmnd);
3311         if (status == FAILED) {
3312                 lpfc_printf_vlog(vport, KERN_ERR, LOG_FCP,
3313                         "0721 Device Reset rport failure: rdata x%p\n", rdata);
3314                 return FAILED;
3315         }
3316
3317         scsi_event.event_type = FC_REG_SCSI_EVENT;
3318         scsi_event.subcategory = LPFC_EVENT_LUNRESET;
3319         scsi_event.lun = lun_id;
3320         memcpy(scsi_event.wwpn, &pnode->nlp_portname, sizeof(struct lpfc_name));
3321         memcpy(scsi_event.wwnn, &pnode->nlp_nodename, sizeof(struct lpfc_name));
3322
3323         fc_host_post_vendor_event(shost, fc_get_event_number(),
3324                 sizeof(scsi_event), (char *)&scsi_event, LPFC_NL_VENDOR_ID);
3325
3326         status = lpfc_send_taskmgmt(vport, rdata, tgt_id, lun_id,
3327                                                 FCP_LUN_RESET);
3328
3329         lpfc_printf_vlog(vport, KERN_ERR, LOG_FCP,
3330                          "0713 SCSI layer issued Device Reset (%d, %d) "
3331                          "return x%x\n", tgt_id, lun_id, status);
3332
3333         /*
3334          * We have to clean up i/o as : they may be orphaned by the TMF;
3335          * or if the TMF failed, they may be in an indeterminate state.
3336          * So, continue on.
3337          * We will report success if all the i/o aborts successfully.
3338          */
3339         status = lpfc_reset_flush_io_context(vport, tgt_id, lun_id,
3340                                                 LPFC_CTX_LUN);
3341         return status;
3342 }
3343
3344 /**
3345  * lpfc_target_reset_handler - scsi_host_template eh_target_reset entry point
3346  * @cmnd: Pointer to scsi_cmnd data structure.
3347  *
3348  * This routine does a target reset by sending a TARGET_RESET task management
3349  * command.
3350  *
3351  * Return code :
3352  *  0x2003 - Error
3353  *  0x2002 - Success
3354  **/
3355 static int
3356 lpfc_target_reset_handler(struct scsi_cmnd *cmnd)
3357 {
3358         struct Scsi_Host  *shost = cmnd->device->host;
3359         struct lpfc_vport *vport = (struct lpfc_vport *) shost->hostdata;
3360         struct lpfc_rport_data *rdata = cmnd->device->hostdata;
3361         struct lpfc_nodelist *pnode;
3362         unsigned tgt_id = cmnd->device->id;
3363         unsigned int lun_id = cmnd->device->lun;
3364         struct lpfc_scsi_event_header scsi_event;
3365         int status;
3366
3367         if (!rdata) {
3368                 lpfc_printf_vlog(vport, KERN_ERR, LOG_FCP,
3369                         "0799 Target Reset rport failure: rdata x%p\n", rdata);
3370                 return FAILED;
3371         }
3372         pnode = rdata->pnode;
3373         fc_block_scsi_eh(cmnd);
3374
3375         status = lpfc_chk_tgt_mapped(vport, cmnd);
3376         if (status == FAILED) {
3377                 lpfc_printf_vlog(vport, KERN_ERR, LOG_FCP,
3378                         "0722 Target Reset rport failure: rdata x%p\n", rdata);
3379                 return FAILED;
3380         }
3381
3382         scsi_event.event_type = FC_REG_SCSI_EVENT;
3383         scsi_event.subcategory = LPFC_EVENT_TGTRESET;
3384         scsi_event.lun = 0;
3385         memcpy(scsi_event.wwpn, &pnode->nlp_portname, sizeof(struct lpfc_name));
3386         memcpy(scsi_event.wwnn, &pnode->nlp_nodename, sizeof(struct lpfc_name));
3387
3388         fc_host_post_vendor_event(shost, fc_get_event_number(),
3389                 sizeof(scsi_event), (char *)&scsi_event, LPFC_NL_VENDOR_ID);
3390
3391         status = lpfc_send_taskmgmt(vport, rdata, tgt_id, lun_id,
3392                                         FCP_TARGET_RESET);
3393
3394         lpfc_printf_vlog(vport, KERN_ERR, LOG_FCP,
3395                          "0723 SCSI layer issued Target Reset (%d, %d) "
3396                          "return x%x\n", tgt_id, lun_id, status);
3397
3398         /*
3399          * We have to clean up i/o as : they may be orphaned by the TMF;
3400          * or if the TMF failed, they may be in an indeterminate state.
3401          * So, continue on.
3402          * We will report success if all the i/o aborts successfully.
3403          */
3404         status = lpfc_reset_flush_io_context(vport, tgt_id, lun_id,
3405                                         LPFC_CTX_TGT);
3406         return status;
3407 }
3408
3409 /**
3410  * lpfc_bus_reset_handler - scsi_host_template eh_bus_reset_handler entry point
3411  * @cmnd: Pointer to scsi_cmnd data structure.
3412  *
3413  * This routine does target reset to all targets on @cmnd->device->host.
3414  * This emulates Parallel SCSI Bus Reset Semantics.
3415  *
3416  * Return code :
3417  *  0x2003 - Error
3418  *  0x2002 - Success
3419  **/
3420 static int
3421 lpfc_bus_reset_handler(struct scsi_cmnd *cmnd)
3422 {
3423         struct Scsi_Host  *shost = cmnd->device->host;
3424         struct lpfc_vport *vport = (struct lpfc_vport *) shost->hostdata;
3425         struct lpfc_nodelist *ndlp = NULL;
3426         struct lpfc_scsi_event_header scsi_event;
3427         int match;
3428         int ret = SUCCESS, status, i;
3429
3430         scsi_event.event_type = FC_REG_SCSI_EVENT;
3431         scsi_event.subcategory = LPFC_EVENT_BUSRESET;
3432         scsi_event.lun = 0;
3433         memcpy(scsi_event.wwpn, &vport->fc_portname, sizeof(struct lpfc_name));
3434         memcpy(scsi_event.wwnn, &vport->fc_nodename, sizeof(struct lpfc_name));
3435
3436         fc_host_post_vendor_event(shost, fc_get_event_number(),
3437                 sizeof(scsi_event), (char *)&scsi_event, LPFC_NL_VENDOR_ID);
3438
3439         fc_block_scsi_eh(cmnd);
3440
3441         /*
3442          * Since the driver manages a single bus device, reset all
3443          * targets known to the driver.  Should any target reset
3444          * fail, this routine returns failure to the midlayer.
3445          */
3446         for (i = 0; i < LPFC_MAX_TARGET; i++) {
3447                 /* Search for mapped node by target ID */
3448                 match = 0;
3449                 spin_lock_irq(shost->host_lock);
3450                 list_for_each_entry(ndlp, &vport->fc_nodes, nlp_listp) {
3451                         if (!NLP_CHK_NODE_ACT(ndlp))
3452                                 continue;
3453                         if (ndlp->nlp_state == NLP_STE_MAPPED_NODE &&
3454                             ndlp->nlp_sid == i &&
3455                             ndlp->rport) {
3456                                 match = 1;
3457                                 break;
3458                         }
3459                 }
3460                 spin_unlock_irq(shost->host_lock);
3461                 if (!match)
3462                         continue;
3463
3464                 status = lpfc_send_taskmgmt(vport, ndlp->rport->dd_data,
3465                                         i, 0, FCP_TARGET_RESET);
3466
3467                 if (status != SUCCESS) {
3468                         lpfc_printf_vlog(vport, KERN_ERR, LOG_FCP,
3469                                          "0700 Bus Reset on target %d failed\n",
3470                                          i);
3471                         ret = FAILED;
3472                 }
3473         }
3474         /*
3475          * We have to clean up i/o as : they may be orphaned by the TMFs
3476          * above; or if any of the TMFs failed, they may be in an
3477          * indeterminate state.
3478          * We will report success if all the i/o aborts successfully.
3479          */
3480
3481         status = lpfc_reset_flush_io_context(vport, 0, 0, LPFC_CTX_HOST);
3482         if (status != SUCCESS)
3483                 ret = FAILED;
3484
3485         lpfc_printf_vlog(vport, KERN_ERR, LOG_FCP,
3486                          "0714 SCSI layer issued Bus Reset Data: x%x\n", ret);
3487         return ret;
3488 }
3489
3490 /**
3491  * lpfc_slave_alloc - scsi_host_template slave_alloc entry point
3492  * @sdev: Pointer to scsi_device.
3493  *
3494  * This routine populates the cmds_per_lun count + 2 scsi_bufs into  this host's
3495  * globally available list of scsi buffers. This routine also makes sure scsi
3496  * buffer is not allocated more than HBA limit conveyed to midlayer. This list
3497  * of scsi buffer exists for the lifetime of the driver.
3498  *
3499  * Return codes:
3500  *   non-0 - Error
3501  *   0 - Success
3502  **/
3503 static int
3504 lpfc_slave_alloc(struct scsi_device *sdev)
3505 {
3506         struct lpfc_vport *vport = (struct lpfc_vport *) sdev->host->hostdata;
3507         struct lpfc_hba   *phba = vport->phba;
3508         struct fc_rport *rport = starget_to_rport(scsi_target(sdev));
3509         uint32_t total = 0;
3510         uint32_t num_to_alloc = 0;
3511         int num_allocated = 0;
3512
3513         if (!rport || fc_remote_port_chkready(rport))
3514                 return -ENXIO;
3515
3516         sdev->hostdata = rport->dd_data;
3517
3518         /*
3519          * Populate the cmds_per_lun count scsi_bufs into this host's globally
3520          * available list of scsi buffers.  Don't allocate more than the
3521          * HBA limit conveyed to the midlayer via the host structure.  The
3522          * formula accounts for the lun_queue_depth + error handlers + 1
3523          * extra.  This list of scsi bufs exists for the lifetime of the driver.
3524          */
3525         total = phba->total_scsi_bufs;
3526         num_to_alloc = vport->cfg_lun_queue_depth + 2;
3527
3528         /* Allow some exchanges to be available always to complete discovery */
3529         if (total >= phba->cfg_hba_queue_depth - LPFC_DISC_IOCB_BUFF_COUNT ) {
3530                 lpfc_printf_vlog(vport, KERN_WARNING, LOG_FCP,
3531                                  "0704 At limitation of %d preallocated "
3532                                  "command buffers\n", total);
3533                 return 0;
3534         /* Allow some exchanges to be available always to complete discovery */
3535         } else if (total + num_to_alloc >
3536                 phba->cfg_hba_queue_depth - LPFC_DISC_IOCB_BUFF_COUNT ) {
3537                 lpfc_printf_vlog(vport, KERN_WARNING, LOG_FCP,
3538                                  "0705 Allocation request of %d "
3539                                  "command buffers will exceed max of %d.  "
3540                                  "Reducing allocation request to %d.\n",
3541                                  num_to_alloc, phba->cfg_hba_queue_depth,
3542                                  (phba->cfg_hba_queue_depth - total));
3543                 num_to_alloc = phba->cfg_hba_queue_depth - total;
3544         }
3545         num_allocated = lpfc_new_scsi_buf(vport, num_to_alloc);
3546         if (num_to_alloc != num_allocated) {
3547                         lpfc_printf_vlog(vport, KERN_WARNING, LOG_FCP,
3548                                  "0708 Allocation request of %d "
3549                                  "command buffers did not succeed.  "
3550                                  "Allocated %d buffers.\n",
3551                                  num_to_alloc, num_allocated);
3552         }
3553         if (num_allocated > 0)
3554                 phba->total_scsi_bufs += num_allocated;
3555         return 0;
3556 }
3557
3558 /**
3559  * lpfc_slave_configure - scsi_host_template slave_configure entry point
3560  * @sdev: Pointer to scsi_device.
3561  *
3562  * This routine configures following items
3563  *   - Tag command queuing support for @sdev if supported.
3564  *   - Dev loss time out value of fc_rport.
3565  *   - Enable SLI polling for fcp ring if ENABLE_FCP_RING_POLLING flag is set.
3566  *
3567  * Return codes:
3568  *   0 - Success
3569  **/
3570 static int
3571 lpfc_slave_configure(struct scsi_device *sdev)
3572 {
3573         struct lpfc_vport *vport = (struct lpfc_vport *) sdev->host->hostdata;
3574         struct lpfc_hba   *phba = vport->phba;
3575         struct fc_rport   *rport = starget_to_rport(sdev->sdev_target);
3576
3577         if (sdev->tagged_supported)
3578                 scsi_activate_tcq(sdev, vport->cfg_lun_queue_depth);
3579         else
3580                 scsi_deactivate_tcq(sdev, vport->cfg_lun_queue_depth);
3581
3582         /*
3583          * Initialize the fc transport attributes for the target
3584          * containing this scsi device.  Also note that the driver's
3585          * target pointer is stored in the starget_data for the
3586          * driver's sysfs entry point functions.
3587          */
3588         rport->dev_loss_tmo = vport->cfg_devloss_tmo;
3589
3590         if (phba->cfg_poll & ENABLE_FCP_RING_POLLING) {
3591                 lpfc_sli_handle_fast_ring_event(phba,
3592                         &phba->sli.ring[LPFC_FCP_RING], HA_R0RE_REQ);
3593                 if (phba->cfg_poll & DISABLE_FCP_RING_INT)
3594                         lpfc_poll_rearm_timer(phba);
3595         }
3596
3597         return 0;
3598 }
3599
3600 /**
3601  * lpfc_slave_destroy - slave_destroy entry point of SHT data structure
3602  * @sdev: Pointer to scsi_device.
3603  *
3604  * This routine sets @sdev hostatdata filed to null.
3605  **/
3606 static void
3607 lpfc_slave_destroy(struct scsi_device *sdev)
3608 {
3609         sdev->hostdata = NULL;
3610         return;
3611 }
3612
3613
3614 struct scsi_host_template lpfc_template = {
3615         .module                 = THIS_MODULE,
3616         .name                   = LPFC_DRIVER_NAME,
3617         .info                   = lpfc_info,
3618         .queuecommand           = lpfc_queuecommand,
3619         .eh_abort_handler       = lpfc_abort_handler,
3620         .eh_device_reset_handler = lpfc_device_reset_handler,
3621         .eh_target_reset_handler = lpfc_target_reset_handler,
3622         .eh_bus_reset_handler   = lpfc_bus_reset_handler,
3623         .slave_alloc            = lpfc_slave_alloc,
3624         .slave_configure        = lpfc_slave_configure,
3625         .slave_destroy          = lpfc_slave_destroy,
3626         .scan_finished          = lpfc_scan_finished,
3627         .this_id                = -1,
3628         .sg_tablesize           = LPFC_DEFAULT_SG_SEG_CNT,
3629         .cmd_per_lun            = LPFC_CMD_PER_LUN,
3630         .use_clustering         = ENABLE_CLUSTERING,
3631         .shost_attrs            = lpfc_hba_attrs,
3632         .max_sectors            = 0xFFFF,
3633         .vendor_id              = LPFC_NL_VENDOR_ID,
3634         .change_queue_depth     = lpfc_change_queue_depth,
3635 };
3636
3637 struct scsi_host_template lpfc_vport_template = {
3638         .module                 = THIS_MODULE,
3639         .name                   = LPFC_DRIVER_NAME,
3640         .info                   = lpfc_info,
3641         .queuecommand           = lpfc_queuecommand,
3642         .eh_abort_handler       = lpfc_abort_handler,
3643         .eh_device_reset_handler = lpfc_device_reset_handler,
3644         .eh_target_reset_handler = lpfc_target_reset_handler,
3645         .eh_bus_reset_handler   = lpfc_bus_reset_handler,
3646         .slave_alloc            = lpfc_slave_alloc,
3647         .slave_configure        = lpfc_slave_configure,
3648         .slave_destroy          = lpfc_slave_destroy,
3649         .scan_finished          = lpfc_scan_finished,
3650         .this_id                = -1,
3651         .sg_tablesize           = LPFC_DEFAULT_SG_SEG_CNT,
3652         .cmd_per_lun            = LPFC_CMD_PER_LUN,
3653         .use_clustering         = ENABLE_CLUSTERING,
3654         .shost_attrs            = lpfc_vport_attrs,
3655         .max_sectors            = 0xFFFF,
3656         .change_queue_depth     = lpfc_change_queue_depth,
3657 };