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