c797f6b48f05bccff273e06964c0dc06508de174
[linux-flexiantxendom0-natty.git] / drivers / scsi / libfc / fc_fcp.c
1 /*
2  * Copyright(c) 2007 Intel Corporation. All rights reserved.
3  * Copyright(c) 2008 Red Hat, Inc.  All rights reserved.
4  * Copyright(c) 2008 Mike Christie
5  *
6  * This program is free software; you can redistribute it and/or modify it
7  * under the terms and conditions of the GNU General Public License,
8  * version 2, as published by the Free Software Foundation.
9  *
10  * This program is distributed in the hope it will be useful, but WITHOUT
11  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
12  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
13  * more details.
14  *
15  * You should have received a copy of the GNU General Public License along with
16  * this program; if not, write to the Free Software Foundation, Inc.,
17  * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
18  *
19  * Maintained at www.Open-FCoE.org
20  */
21
22 #include <linux/module.h>
23 #include <linux/delay.h>
24 #include <linux/kernel.h>
25 #include <linux/types.h>
26 #include <linux/spinlock.h>
27 #include <linux/scatterlist.h>
28 #include <linux/err.h>
29 #include <linux/crc32.h>
30 #include <linux/slab.h>
31
32 #include <scsi/scsi_tcq.h>
33 #include <scsi/scsi.h>
34 #include <scsi/scsi_host.h>
35 #include <scsi/scsi_device.h>
36 #include <scsi/scsi_cmnd.h>
37
38 #include <scsi/fc/fc_fc2.h>
39
40 #include <scsi/libfc.h>
41 #include <scsi/fc_encode.h>
42
43 #include "fc_libfc.h"
44
45 struct kmem_cache *scsi_pkt_cachep;
46
47 /* SRB state definitions */
48 #define FC_SRB_FREE             0               /* cmd is free */
49 #define FC_SRB_CMD_SENT         (1 << 0)        /* cmd has been sent */
50 #define FC_SRB_RCV_STATUS       (1 << 1)        /* response has arrived */
51 #define FC_SRB_ABORT_PENDING    (1 << 2)        /* cmd abort sent to device */
52 #define FC_SRB_ABORTED          (1 << 3)        /* abort acknowledged */
53 #define FC_SRB_DISCONTIG        (1 << 4)        /* non-sequential data recvd */
54 #define FC_SRB_COMPL            (1 << 5)        /* fc_io_compl has been run */
55 #define FC_SRB_FCP_PROCESSING_TMO (1 << 6)      /* timer function processing */
56
57 #define FC_SRB_READ             (1 << 1)
58 #define FC_SRB_WRITE            (1 << 0)
59
60 /*
61  * The SCp.ptr should be tested and set under the host lock. NULL indicates
62  * that the command has been retruned to the scsi layer.
63  */
64 #define CMD_SP(Cmnd)                ((struct fc_fcp_pkt *)(Cmnd)->SCp.ptr)
65 #define CMD_ENTRY_STATUS(Cmnd)      ((Cmnd)->SCp.have_data_in)
66 #define CMD_COMPL_STATUS(Cmnd)      ((Cmnd)->SCp.this_residual)
67 #define CMD_SCSI_STATUS(Cmnd)       ((Cmnd)->SCp.Status)
68 #define CMD_RESID_LEN(Cmnd)         ((Cmnd)->SCp.buffers_residual)
69
70 /**
71  * struct fc_fcp_internal - FCP layer internal data
72  * @scsi_pkt_pool: Memory pool to draw FCP packets from
73  * @scsi_queue_lock: Protects the scsi_pkt_queue
74  * @scsi_pkt_queue: Current FCP packets
75  * @last_can_queue_ramp_down_time: ramp down time
76  * @last_can_queue_ramp_up_time: ramp up time
77  * @max_can_queue: max can_queue size
78  */
79 struct fc_fcp_internal {
80         mempool_t               *scsi_pkt_pool;
81         spinlock_t              scsi_queue_lock;
82         struct list_head        scsi_pkt_queue;
83         unsigned long           last_can_queue_ramp_down_time;
84         unsigned long           last_can_queue_ramp_up_time;
85         int                     max_can_queue;
86 };
87
88 #define fc_get_scsi_internal(x) ((struct fc_fcp_internal *)(x)->scsi_priv)
89
90 /*
91  * function prototypes
92  * FC scsi I/O related functions
93  */
94 static void fc_fcp_recv_data(struct fc_fcp_pkt *, struct fc_frame *);
95 static void fc_fcp_recv(struct fc_seq *, struct fc_frame *, void *);
96 static void fc_fcp_resp(struct fc_fcp_pkt *, struct fc_frame *);
97 static void fc_fcp_complete_locked(struct fc_fcp_pkt *);
98 static void fc_tm_done(struct fc_seq *, struct fc_frame *, void *);
99 static void fc_fcp_error(struct fc_fcp_pkt *, struct fc_frame *);
100 static void fc_fcp_recovery(struct fc_fcp_pkt *);
101 static void fc_fcp_timeout(unsigned long);
102 static void fc_fcp_rec(struct fc_fcp_pkt *);
103 static void fc_fcp_rec_error(struct fc_fcp_pkt *, struct fc_frame *);
104 static void fc_fcp_rec_resp(struct fc_seq *, struct fc_frame *, void *);
105 static void fc_io_compl(struct fc_fcp_pkt *);
106
107 static void fc_fcp_srr(struct fc_fcp_pkt *, enum fc_rctl, u32);
108 static void fc_fcp_srr_resp(struct fc_seq *, struct fc_frame *, void *);
109 static void fc_fcp_srr_error(struct fc_fcp_pkt *, struct fc_frame *);
110
111 /*
112  * command status codes
113  */
114 #define FC_COMPLETE             0
115 #define FC_CMD_ABORTED          1
116 #define FC_CMD_RESET            2
117 #define FC_CMD_PLOGO            3
118 #define FC_SNS_RCV              4
119 #define FC_TRANS_ERR            5
120 #define FC_DATA_OVRRUN          6
121 #define FC_DATA_UNDRUN          7
122 #define FC_ERROR                8
123 #define FC_HRD_ERROR            9
124 #define FC_CMD_RECOVERY         10
125
126 /*
127  * Error recovery timeout values.
128  */
129 #define FC_SCSI_ER_TIMEOUT      (10 * HZ)
130 #define FC_SCSI_TM_TOV          (10 * HZ)
131 #define FC_SCSI_REC_TOV         (2 * HZ)
132 #define FC_HOST_RESET_TIMEOUT   (30 * HZ)
133 #define FC_CAN_QUEUE_PERIOD     (60 * HZ)
134
135 #define FC_MAX_ERROR_CNT        5
136 #define FC_MAX_RECOV_RETRY      3
137
138 #define FC_FCP_DFLT_QUEUE_DEPTH 32
139
140 /**
141  * fc_fcp_pkt_alloc() - Allocate a fcp_pkt
142  * @lport: The local port that the FCP packet is for
143  * @gfp:   GFP flags for allocation
144  *
145  * Return value: fcp_pkt structure or null on allocation failure.
146  * Context:      Can be called from process context, no lock is required.
147  */
148 static struct fc_fcp_pkt *fc_fcp_pkt_alloc(struct fc_lport *lport, gfp_t gfp)
149 {
150         struct fc_fcp_internal *si = fc_get_scsi_internal(lport);
151         struct fc_fcp_pkt *fsp;
152
153         fsp = mempool_alloc(si->scsi_pkt_pool, gfp);
154         if (fsp) {
155                 memset(fsp, 0, sizeof(*fsp));
156                 fsp->lp = lport;
157                 atomic_set(&fsp->ref_cnt, 1);
158                 init_timer(&fsp->timer);
159                 INIT_LIST_HEAD(&fsp->list);
160                 spin_lock_init(&fsp->scsi_pkt_lock);
161         }
162         return fsp;
163 }
164
165 /**
166  * fc_fcp_pkt_release() - Release hold on a fcp_pkt
167  * @fsp: The FCP packet to be released
168  *
169  * Context: Can be called from process or interrupt context,
170  *          no lock is required.
171  */
172 static void fc_fcp_pkt_release(struct fc_fcp_pkt *fsp)
173 {
174         if (atomic_dec_and_test(&fsp->ref_cnt)) {
175                 struct fc_fcp_internal *si = fc_get_scsi_internal(fsp->lp);
176
177                 mempool_free(fsp, si->scsi_pkt_pool);
178         }
179 }
180
181 /**
182  * fc_fcp_pkt_hold() - Hold a fcp_pkt
183  * @fsp: The FCP packet to be held
184  */
185 static void fc_fcp_pkt_hold(struct fc_fcp_pkt *fsp)
186 {
187         atomic_inc(&fsp->ref_cnt);
188 }
189
190 /**
191  * fc_fcp_pkt_destory() - Release hold on a fcp_pkt
192  * @seq: The sequence that the FCP packet is on (required by destructor API)
193  * @fsp: The FCP packet to be released
194  *
195  * This routine is called by a destructor callback in the exch_seq_send()
196  * routine of the libfc Transport Template. The 'struct fc_seq' is a required
197  * argument even though it is not used by this routine.
198  *
199  * Context: No locking required.
200  */
201 static void fc_fcp_pkt_destroy(struct fc_seq *seq, void *fsp)
202 {
203         fc_fcp_pkt_release(fsp);
204 }
205
206 /**
207  * fc_fcp_lock_pkt() - Lock a fcp_pkt and increase its reference count
208  * @fsp: The FCP packet to be locked and incremented
209  *
210  * We should only return error if we return a command to SCSI-ml before
211  * getting a response. This can happen in cases where we send a abort, but
212  * do not wait for the response and the abort and command can be passing
213  * each other on the wire/network-layer.
214  *
215  * Note: this function locks the packet and gets a reference to allow
216  * callers to call the completion function while the lock is held and
217  * not have to worry about the packets refcount.
218  *
219  * TODO: Maybe we should just have callers grab/release the lock and
220  * have a function that they call to verify the fsp and grab a ref if
221  * needed.
222  */
223 static inline int fc_fcp_lock_pkt(struct fc_fcp_pkt *fsp)
224 {
225         spin_lock_bh(&fsp->scsi_pkt_lock);
226         if (fsp->state & FC_SRB_COMPL) {
227                 spin_unlock_bh(&fsp->scsi_pkt_lock);
228                 return -EPERM;
229         }
230
231         fc_fcp_pkt_hold(fsp);
232         return 0;
233 }
234
235 /**
236  * fc_fcp_unlock_pkt() - Release a fcp_pkt's lock and decrement its
237  *                       reference count
238  * @fsp: The FCP packet to be unlocked and decremented
239  */
240 static inline void fc_fcp_unlock_pkt(struct fc_fcp_pkt *fsp)
241 {
242         spin_unlock_bh(&fsp->scsi_pkt_lock);
243         fc_fcp_pkt_release(fsp);
244 }
245
246 /**
247  * fc_fcp_timer_set() - Start a timer for a fcp_pkt
248  * @fsp:   The FCP packet to start a timer for
249  * @delay: The timeout period for the timer
250  */
251 static void fc_fcp_timer_set(struct fc_fcp_pkt *fsp, unsigned long delay)
252 {
253         if (!(fsp->state & FC_SRB_COMPL))
254                 mod_timer(&fsp->timer, jiffies + delay);
255 }
256
257 /**
258  * fc_fcp_send_abort() - Send an abort for exchanges associated with a
259  *                       fcp_pkt
260  * @fsp: The FCP packet to abort exchanges on
261  */
262 static int fc_fcp_send_abort(struct fc_fcp_pkt *fsp)
263 {
264         if (!fsp->seq_ptr)
265                 return -EINVAL;
266
267         fsp->state |= FC_SRB_ABORT_PENDING;
268         return fsp->lp->tt.seq_exch_abort(fsp->seq_ptr, 0);
269 }
270
271 /**
272  * fc_fcp_retry_cmd() - Retry a fcp_pkt
273  * @fsp: The FCP packet to be retried
274  *
275  * Sets the status code to be FC_ERROR and then calls
276  * fc_fcp_complete_locked() which in turn calls fc_io_compl().
277  * fc_io_compl() will notify the SCSI-ml that the I/O is done.
278  * The SCSI-ml will retry the command.
279  */
280 static void fc_fcp_retry_cmd(struct fc_fcp_pkt *fsp)
281 {
282         if (fsp->seq_ptr) {
283                 fsp->lp->tt.exch_done(fsp->seq_ptr);
284                 fsp->seq_ptr = NULL;
285         }
286
287         fsp->state &= ~FC_SRB_ABORT_PENDING;
288         fsp->io_status = 0;
289         fsp->status_code = FC_ERROR;
290         fc_fcp_complete_locked(fsp);
291 }
292
293 /**
294  * fc_fcp_ddp_setup() - Calls a LLD's ddp_setup routine to set up DDP context
295  * @fsp: The FCP packet that will manage the DDP frames
296  * @xid: The XID that will be used for the DDP exchange
297  */
298 void fc_fcp_ddp_setup(struct fc_fcp_pkt *fsp, u16 xid)
299 {
300         struct fc_lport *lport;
301
302         lport = fsp->lp;
303         if ((fsp->req_flags & FC_SRB_READ) &&
304             (lport->lro_enabled) && (lport->tt.ddp_setup)) {
305                 if (lport->tt.ddp_setup(lport, xid, scsi_sglist(fsp->cmd),
306                                         scsi_sg_count(fsp->cmd)))
307                         fsp->xfer_ddp = xid;
308         }
309 }
310
311 /**
312  * fc_fcp_ddp_done() - Calls a LLD's ddp_done routine to release any
313  *                     DDP related resources for a fcp_pkt
314  * @fsp: The FCP packet that DDP had been used on
315  */
316 static void fc_fcp_ddp_done(struct fc_fcp_pkt *fsp)
317 {
318         struct fc_lport *lport;
319
320         if (!fsp)
321                 return;
322
323         if (fsp->xfer_ddp == FC_XID_UNKNOWN)
324                 return;
325
326         lport = fsp->lp;
327         if (lport->tt.ddp_done) {
328                 fsp->xfer_len = lport->tt.ddp_done(lport, fsp->xfer_ddp);
329                 fsp->xfer_ddp = FC_XID_UNKNOWN;
330         }
331 }
332
333 /**
334  * fc_fcp_can_queue_ramp_up() - increases can_queue
335  * @lport: lport to ramp up can_queue
336  *
337  * Locking notes: Called with Scsi_Host lock held
338  */
339 static void fc_fcp_can_queue_ramp_up(struct fc_lport *lport)
340 {
341         struct fc_fcp_internal *si = fc_get_scsi_internal(lport);
342         int can_queue;
343
344         if (si->last_can_queue_ramp_up_time &&
345             (time_before(jiffies, si->last_can_queue_ramp_up_time +
346                          FC_CAN_QUEUE_PERIOD)))
347                 return;
348
349         if (time_before(jiffies, si->last_can_queue_ramp_down_time +
350                         FC_CAN_QUEUE_PERIOD))
351                 return;
352
353         si->last_can_queue_ramp_up_time = jiffies;
354
355         can_queue = lport->host->can_queue << 1;
356         if (can_queue >= si->max_can_queue) {
357                 can_queue = si->max_can_queue;
358                 si->last_can_queue_ramp_down_time = 0;
359         }
360         lport->host->can_queue = can_queue;
361         shost_printk(KERN_ERR, lport->host, "libfc: increased "
362                      "can_queue to %d.\n", can_queue);
363 }
364
365 /**
366  * fc_fcp_can_queue_ramp_down() - reduces can_queue
367  * @lport: lport to reduce can_queue
368  *
369  * If we are getting memory allocation failures, then we may
370  * be trying to execute too many commands. We let the running
371  * commands complete or timeout, then try again with a reduced
372  * can_queue. Eventually we will hit the point where we run
373  * on all reserved structs.
374  *
375  * Locking notes: Called with Scsi_Host lock held
376  */
377 static void fc_fcp_can_queue_ramp_down(struct fc_lport *lport)
378 {
379         struct fc_fcp_internal *si = fc_get_scsi_internal(lport);
380         int can_queue;
381
382         if (si->last_can_queue_ramp_down_time &&
383             (time_before(jiffies, si->last_can_queue_ramp_down_time +
384                          FC_CAN_QUEUE_PERIOD)))
385                 return;
386
387         si->last_can_queue_ramp_down_time = jiffies;
388
389         can_queue = lport->host->can_queue;
390         can_queue >>= 1;
391         if (!can_queue)
392                 can_queue = 1;
393         lport->host->can_queue = can_queue;
394         shost_printk(KERN_ERR, lport->host, "libfc: Could not allocate frame.\n"
395                      "Reducing can_queue to %d.\n", can_queue);
396 }
397
398 /*
399  * fc_fcp_frame_alloc() -  Allocates fc_frame structure and buffer.
400  * @lport:      fc lport struct
401  * @len:        payload length
402  *
403  * Allocates fc_frame structure and buffer but if fails to allocate
404  * then reduce can_queue.
405  */
406 static inline struct fc_frame *fc_fcp_frame_alloc(struct fc_lport *lport,
407                                                   size_t len)
408 {
409         struct fc_frame *fp;
410         unsigned long flags;
411
412         fp = fc_frame_alloc(lport, len);
413         if (likely(fp))
414                 return fp;
415
416         /* error case */
417         spin_lock_irqsave(lport->host->host_lock, flags);
418         fc_fcp_can_queue_ramp_down(lport);
419         spin_unlock_irqrestore(lport->host->host_lock, flags);
420         return NULL;
421 }
422
423 /**
424  * fc_fcp_recv_data() - Handler for receiving SCSI-FCP data from a target
425  * @fsp: The FCP packet the data is on
426  * @fp:  The data frame
427  */
428 static void fc_fcp_recv_data(struct fc_fcp_pkt *fsp, struct fc_frame *fp)
429 {
430         struct scsi_cmnd *sc = fsp->cmd;
431         struct fc_lport *lport = fsp->lp;
432         struct fcoe_dev_stats *stats;
433         struct fc_frame_header *fh;
434         size_t start_offset;
435         size_t offset;
436         u32 crc;
437         u32 copy_len = 0;
438         size_t len;
439         void *buf;
440         struct scatterlist *sg;
441         u32 nents;
442
443         fh = fc_frame_header_get(fp);
444         offset = ntohl(fh->fh_parm_offset);
445         start_offset = offset;
446         len = fr_len(fp) - sizeof(*fh);
447         buf = fc_frame_payload_get(fp, 0);
448
449         /*
450          * if this I/O is ddped then clear it
451          * and initiate recovery since data
452          * frames are expected to be placed
453          * directly in that case.
454          */
455         if (fsp->xfer_ddp != FC_XID_UNKNOWN) {
456                 fc_fcp_ddp_done(fsp);
457                 goto err;
458         }
459         if (offset + len > fsp->data_len) {
460                 /* this should never happen */
461                 if ((fr_flags(fp) & FCPHF_CRC_UNCHECKED) &&
462                     fc_frame_crc_check(fp))
463                         goto crc_err;
464                 FC_FCP_DBG(fsp, "data received past end. len %zx offset %zx "
465                            "data_len %x\n", len, offset, fsp->data_len);
466                 goto err;
467         }
468         if (offset != fsp->xfer_len)
469                 fsp->state |= FC_SRB_DISCONTIG;
470
471         sg = scsi_sglist(sc);
472         nents = scsi_sg_count(sc);
473
474         if (!(fr_flags(fp) & FCPHF_CRC_UNCHECKED)) {
475                 copy_len = fc_copy_buffer_to_sglist(buf, len, sg, &nents,
476                                                     &offset, KM_SOFTIRQ0, NULL);
477         } else {
478                 crc = crc32(~0, (u8 *) fh, sizeof(*fh));
479                 copy_len = fc_copy_buffer_to_sglist(buf, len, sg, &nents,
480                                                     &offset, KM_SOFTIRQ0, &crc);
481                 buf = fc_frame_payload_get(fp, 0);
482                 if (len % 4)
483                         crc = crc32(crc, buf + len, 4 - (len % 4));
484
485                 if (~crc != le32_to_cpu(fr_crc(fp))) {
486 crc_err:
487                         stats = per_cpu_ptr(lport->dev_stats, get_cpu());
488                         stats->ErrorFrames++;
489                         /* per cpu count, not total count, but OK for limit */
490                         if (stats->InvalidCRCCount++ < 5)
491                                 printk(KERN_WARNING "libfc: CRC error on data "
492                                        "frame for port (%6.6x)\n",
493                                        lport->port_id);
494                         put_cpu();
495                         /*
496                          * Assume the frame is total garbage.
497                          * We may have copied it over the good part
498                          * of the buffer.
499                          * If so, we need to retry the entire operation.
500                          * Otherwise, ignore it.
501                          */
502                         if (fsp->state & FC_SRB_DISCONTIG)
503                                 goto err;
504                         return;
505                 }
506         }
507
508         if (fsp->xfer_contig_end == start_offset)
509                 fsp->xfer_contig_end += copy_len;
510         fsp->xfer_len += copy_len;
511
512         /*
513          * In the very rare event that this data arrived after the response
514          * and completes the transfer, call the completion handler.
515          */
516         if (unlikely(fsp->state & FC_SRB_RCV_STATUS) &&
517             fsp->xfer_len == fsp->data_len - fsp->scsi_resid)
518                 fc_fcp_complete_locked(fsp);
519         return;
520 err:
521         fc_fcp_recovery(fsp);
522 }
523
524 /**
525  * fc_fcp_send_data() - Send SCSI data to a target
526  * @fsp:      The FCP packet the data is on
527  * @sp:       The sequence the data is to be sent on
528  * @offset:   The starting offset for this data request
529  * @seq_blen: The burst length for this data request
530  *
531  * Called after receiving a Transfer Ready data descriptor.
532  * If the LLD is capable of sequence offload then send down the
533  * seq_blen amount of data in single frame, otherwise send
534  * multiple frames of the maximum frame payload supported by
535  * the target port.
536  */
537 static int fc_fcp_send_data(struct fc_fcp_pkt *fsp, struct fc_seq *seq,
538                             size_t offset, size_t seq_blen)
539 {
540         struct fc_exch *ep;
541         struct scsi_cmnd *sc;
542         struct scatterlist *sg;
543         struct fc_frame *fp = NULL;
544         struct fc_lport *lport = fsp->lp;
545         struct page *page;
546         size_t remaining;
547         size_t t_blen;
548         size_t tlen;
549         size_t sg_bytes;
550         size_t frame_offset, fh_parm_offset;
551         size_t off;
552         int error;
553         void *data = NULL;
554         void *page_addr;
555         int using_sg = lport->sg_supp;
556         u32 f_ctl;
557
558         WARN_ON(seq_blen <= 0);
559         if (unlikely(offset + seq_blen > fsp->data_len)) {
560                 /* this should never happen */
561                 FC_FCP_DBG(fsp, "xfer-ready past end. seq_blen %zx "
562                            "offset %zx\n", seq_blen, offset);
563                 fc_fcp_send_abort(fsp);
564                 return 0;
565         } else if (offset != fsp->xfer_len) {
566                 /* Out of Order Data Request - no problem, but unexpected. */
567                 FC_FCP_DBG(fsp, "xfer-ready non-contiguous. "
568                            "seq_blen %zx offset %zx\n", seq_blen, offset);
569         }
570
571         /*
572          * if LLD is capable of seq_offload then set transport
573          * burst length (t_blen) to seq_blen, otherwise set t_blen
574          * to max FC frame payload previously set in fsp->max_payload.
575          */
576         t_blen = fsp->max_payload;
577         if (lport->seq_offload) {
578                 t_blen = min(seq_blen, (size_t)lport->lso_max);
579                 FC_FCP_DBG(fsp, "fsp=%p:lso:blen=%zx lso_max=0x%x t_blen=%zx\n",
580                            fsp, seq_blen, lport->lso_max, t_blen);
581         }
582
583         if (t_blen > 512)
584                 t_blen &= ~(512 - 1);   /* round down to block size */
585         sc = fsp->cmd;
586
587         remaining = seq_blen;
588         fh_parm_offset = frame_offset = offset;
589         tlen = 0;
590         seq = lport->tt.seq_start_next(seq);
591         f_ctl = FC_FC_REL_OFF;
592         WARN_ON(!seq);
593
594         sg = scsi_sglist(sc);
595
596         while (remaining > 0 && sg) {
597                 if (offset >= sg->length) {
598                         offset -= sg->length;
599                         sg = sg_next(sg);
600                         continue;
601                 }
602                 if (!fp) {
603                         tlen = min(t_blen, remaining);
604
605                         /*
606                          * TODO.  Temporary workaround.  fc_seq_send() can't
607                          * handle odd lengths in non-linear skbs.
608                          * This will be the final fragment only.
609                          */
610                         if (tlen % 4)
611                                 using_sg = 0;
612                         fp = fc_frame_alloc(lport, using_sg ? 0 : tlen);
613                         if (!fp)
614                                 return -ENOMEM;
615
616                         data = fc_frame_header_get(fp) + 1;
617                         fh_parm_offset = frame_offset;
618                         fr_max_payload(fp) = fsp->max_payload;
619                 }
620
621                 off = offset + sg->offset;
622                 sg_bytes = min(tlen, sg->length - offset);
623                 sg_bytes = min(sg_bytes,
624                                (size_t) (PAGE_SIZE - (off & ~PAGE_MASK)));
625                 page = sg_page(sg) + (off >> PAGE_SHIFT);
626                 if (using_sg) {
627                         get_page(page);
628                         skb_fill_page_desc(fp_skb(fp),
629                                            skb_shinfo(fp_skb(fp))->nr_frags,
630                                            page, off & ~PAGE_MASK, sg_bytes);
631                         fp_skb(fp)->data_len += sg_bytes;
632                         fr_len(fp) += sg_bytes;
633                         fp_skb(fp)->truesize += PAGE_SIZE;
634                 } else {
635                         /*
636                          * The scatterlist item may be bigger than PAGE_SIZE,
637                          * but we must not cross pages inside the kmap.
638                          */
639                         page_addr = kmap_atomic(page, KM_SOFTIRQ0);
640                         memcpy(data, (char *)page_addr + (off & ~PAGE_MASK),
641                                sg_bytes);
642                         kunmap_atomic(page_addr, KM_SOFTIRQ0);
643                         data += sg_bytes;
644                 }
645                 offset += sg_bytes;
646                 frame_offset += sg_bytes;
647                 tlen -= sg_bytes;
648                 remaining -= sg_bytes;
649
650                 if ((skb_shinfo(fp_skb(fp))->nr_frags < FC_FRAME_SG_LEN) &&
651                     (tlen))
652                         continue;
653
654                 /*
655                  * Send sequence with transfer sequence initiative in case
656                  * this is last FCP frame of the sequence.
657                  */
658                 if (remaining == 0)
659                         f_ctl |= FC_FC_SEQ_INIT | FC_FC_END_SEQ;
660
661                 ep = fc_seq_exch(seq);
662                 fc_fill_fc_hdr(fp, FC_RCTL_DD_SOL_DATA, ep->did, ep->sid,
663                                FC_TYPE_FCP, f_ctl, fh_parm_offset);
664
665                 /*
666                  * send fragment using for a sequence.
667                  */
668                 error = lport->tt.seq_send(lport, seq, fp);
669                 if (error) {
670                         WARN_ON(1);             /* send error should be rare */
671                         fc_fcp_retry_cmd(fsp);
672                         return 0;
673                 }
674                 fp = NULL;
675         }
676         fsp->xfer_len += seq_blen;      /* premature count? */
677         return 0;
678 }
679
680 /**
681  * fc_fcp_abts_resp() - Send an ABTS response
682  * @fsp: The FCP packet that is being aborted
683  * @fp:  The response frame
684  */
685 static void fc_fcp_abts_resp(struct fc_fcp_pkt *fsp, struct fc_frame *fp)
686 {
687         int ba_done = 1;
688         struct fc_ba_rjt *brp;
689         struct fc_frame_header *fh;
690
691         fh = fc_frame_header_get(fp);
692         switch (fh->fh_r_ctl) {
693         case FC_RCTL_BA_ACC:
694                 break;
695         case FC_RCTL_BA_RJT:
696                 brp = fc_frame_payload_get(fp, sizeof(*brp));
697                 if (brp && brp->br_reason == FC_BA_RJT_LOG_ERR)
698                         break;
699                 /* fall thru */
700         default:
701                 /*
702                  * we will let the command timeout
703                  * and scsi-ml recover in this case,
704                  * therefore cleared the ba_done flag.
705                  */
706                 ba_done = 0;
707         }
708
709         if (ba_done) {
710                 fsp->state |= FC_SRB_ABORTED;
711                 fsp->state &= ~FC_SRB_ABORT_PENDING;
712
713                 if (fsp->wait_for_comp)
714                         complete(&fsp->tm_done);
715                 else
716                         fc_fcp_complete_locked(fsp);
717         }
718 }
719
720 /**
721  * fc_fcp_recv() - Reveive an FCP frame
722  * @seq: The sequence the frame is on
723  * @fp:  The received frame
724  * @arg: The related FCP packet
725  *
726  * Context: Called from Soft IRQ context. Can not be called
727  *          holding the FCP packet list lock.
728  */
729 static void fc_fcp_recv(struct fc_seq *seq, struct fc_frame *fp, void *arg)
730 {
731         struct fc_fcp_pkt *fsp = (struct fc_fcp_pkt *)arg;
732         struct fc_lport *lport = fsp->lp;
733         struct fc_frame_header *fh;
734         struct fcp_txrdy *dd;
735         u8 r_ctl;
736         int rc = 0;
737
738         if (IS_ERR(fp)) {
739                 fc_fcp_error(fsp, fp);
740                 return;
741         }
742
743         fh = fc_frame_header_get(fp);
744         r_ctl = fh->fh_r_ctl;
745
746         if (lport->state != LPORT_ST_READY)
747                 goto out;
748         if (fc_fcp_lock_pkt(fsp))
749                 goto out;
750         fsp->last_pkt_time = jiffies;
751
752         if (fh->fh_type == FC_TYPE_BLS) {
753                 fc_fcp_abts_resp(fsp, fp);
754                 goto unlock;
755         }
756
757         if (fsp->state & (FC_SRB_ABORTED | FC_SRB_ABORT_PENDING))
758                 goto unlock;
759
760         if (r_ctl == FC_RCTL_DD_DATA_DESC) {
761                 /*
762                  * received XFER RDY from the target
763                  * need to send data to the target
764                  */
765                 WARN_ON(fr_flags(fp) & FCPHF_CRC_UNCHECKED);
766                 dd = fc_frame_payload_get(fp, sizeof(*dd));
767                 WARN_ON(!dd);
768
769                 rc = fc_fcp_send_data(fsp, seq,
770                                       (size_t) ntohl(dd->ft_data_ro),
771                                       (size_t) ntohl(dd->ft_burst_len));
772                 if (!rc)
773                         seq->rec_data = fsp->xfer_len;
774         } else if (r_ctl == FC_RCTL_DD_SOL_DATA) {
775                 /*
776                  * received a DATA frame
777                  * next we will copy the data to the system buffer
778                  */
779                 WARN_ON(fr_len(fp) < sizeof(*fh));      /* len may be 0 */
780                 fc_fcp_recv_data(fsp, fp);
781                 seq->rec_data = fsp->xfer_contig_end;
782         } else if (r_ctl == FC_RCTL_DD_CMD_STATUS) {
783                 WARN_ON(fr_flags(fp) & FCPHF_CRC_UNCHECKED);
784
785                 fc_fcp_resp(fsp, fp);
786         } else {
787                 FC_FCP_DBG(fsp, "unexpected frame.  r_ctl %x\n", r_ctl);
788         }
789 unlock:
790         fc_fcp_unlock_pkt(fsp);
791 out:
792         fc_frame_free(fp);
793 }
794
795 /**
796  * fc_fcp_resp() - Handler for FCP responses
797  * @fsp: The FCP packet the response is for
798  * @fp:  The response frame
799  */
800 static void fc_fcp_resp(struct fc_fcp_pkt *fsp, struct fc_frame *fp)
801 {
802         struct fc_frame_header *fh;
803         struct fcp_resp *fc_rp;
804         struct fcp_resp_ext *rp_ex;
805         struct fcp_resp_rsp_info *fc_rp_info;
806         u32 plen;
807         u32 expected_len;
808         u32 respl = 0;
809         u32 snsl = 0;
810         u8 flags = 0;
811
812         plen = fr_len(fp);
813         fh = (struct fc_frame_header *)fr_hdr(fp);
814         if (unlikely(plen < sizeof(*fh) + sizeof(*fc_rp)))
815                 goto len_err;
816         plen -= sizeof(*fh);
817         fc_rp = (struct fcp_resp *)(fh + 1);
818         fsp->cdb_status = fc_rp->fr_status;
819         flags = fc_rp->fr_flags;
820         fsp->scsi_comp_flags = flags;
821         expected_len = fsp->data_len;
822
823         /* if ddp, update xfer len */
824         fc_fcp_ddp_done(fsp);
825
826         if (unlikely((flags & ~FCP_CONF_REQ) || fc_rp->fr_status)) {
827                 rp_ex = (void *)(fc_rp + 1);
828                 if (flags & (FCP_RSP_LEN_VAL | FCP_SNS_LEN_VAL)) {
829                         if (plen < sizeof(*fc_rp) + sizeof(*rp_ex))
830                                 goto len_err;
831                         fc_rp_info = (struct fcp_resp_rsp_info *)(rp_ex + 1);
832                         if (flags & FCP_RSP_LEN_VAL) {
833                                 respl = ntohl(rp_ex->fr_rsp_len);
834                                 if (respl != sizeof(*fc_rp_info))
835                                         goto len_err;
836                                 if (fsp->wait_for_comp) {
837                                         /* Abuse cdb_status for rsp code */
838                                         fsp->cdb_status = fc_rp_info->rsp_code;
839                                         complete(&fsp->tm_done);
840                                         /*
841                                          * tmfs will not have any scsi cmd so
842                                          * exit here
843                                          */
844                                         return;
845                                 }
846                         }
847                         if (flags & FCP_SNS_LEN_VAL) {
848                                 snsl = ntohl(rp_ex->fr_sns_len);
849                                 if (snsl > SCSI_SENSE_BUFFERSIZE)
850                                         snsl = SCSI_SENSE_BUFFERSIZE;
851                                 memcpy(fsp->cmd->sense_buffer,
852                                        (char *)fc_rp_info + respl, snsl);
853                         }
854                 }
855                 if (flags & (FCP_RESID_UNDER | FCP_RESID_OVER)) {
856                         if (plen < sizeof(*fc_rp) + sizeof(rp_ex->fr_resid))
857                                 goto len_err;
858                         if (flags & FCP_RESID_UNDER) {
859                                 fsp->scsi_resid = ntohl(rp_ex->fr_resid);
860                                 /*
861                                  * The cmnd->underflow is the minimum number of
862                                  * bytes that must be transfered for this
863                                  * command.  Provided a sense condition is not
864                                  * present, make sure the actual amount
865                                  * transferred is at least the underflow value
866                                  * or fail.
867                                  */
868                                 if (!(flags & FCP_SNS_LEN_VAL) &&
869                                     (fc_rp->fr_status == 0) &&
870                                     (scsi_bufflen(fsp->cmd) -
871                                      fsp->scsi_resid) < fsp->cmd->underflow)
872                                         goto err;
873                                 expected_len -= fsp->scsi_resid;
874                         } else {
875                                 fsp->status_code = FC_ERROR;
876                         }
877                 }
878         }
879         fsp->state |= FC_SRB_RCV_STATUS;
880
881         /*
882          * Check for missing or extra data frames.
883          */
884         if (unlikely(fsp->xfer_len != expected_len)) {
885                 if (fsp->xfer_len < expected_len) {
886                         /*
887                          * Some data may be queued locally,
888                          * Wait a at least one jiffy to see if it is delivered.
889                          * If this expires without data, we may do SRR.
890                          */
891                         fc_fcp_timer_set(fsp, 2);
892                         return;
893                 }
894                 fsp->status_code = FC_DATA_OVRRUN;
895                 FC_FCP_DBG(fsp, "tgt %6.6x xfer len %zx greater than expected, "
896                            "len %x, data len %x\n",
897                            fsp->rport->port_id,
898                            fsp->xfer_len, expected_len, fsp->data_len);
899         }
900         fc_fcp_complete_locked(fsp);
901         return;
902
903 len_err:
904         FC_FCP_DBG(fsp, "short FCP response. flags 0x%x len %u respl %u "
905                    "snsl %u\n", flags, fr_len(fp), respl, snsl);
906 err:
907         fsp->status_code = FC_ERROR;
908         fc_fcp_complete_locked(fsp);
909 }
910
911 /**
912  * fc_fcp_complete_locked() - Complete processing of a fcp_pkt with the
913  *                            fcp_pkt lock held
914  * @fsp: The FCP packet to be completed
915  *
916  * This function may sleep if a timer is pending. The packet lock must be
917  * held, and the host lock must not be held.
918  */
919 static void fc_fcp_complete_locked(struct fc_fcp_pkt *fsp)
920 {
921         struct fc_lport *lport = fsp->lp;
922         struct fc_seq *seq;
923         struct fc_exch *ep;
924         u32 f_ctl;
925
926         if (fsp->state & FC_SRB_ABORT_PENDING)
927                 return;
928
929         if (fsp->state & FC_SRB_ABORTED) {
930                 if (!fsp->status_code)
931                         fsp->status_code = FC_CMD_ABORTED;
932         } else {
933                 /*
934                  * Test for transport underrun, independent of response
935                  * underrun status.
936                  */
937                 if (fsp->xfer_len < fsp->data_len && !fsp->io_status &&
938                     (!(fsp->scsi_comp_flags & FCP_RESID_UNDER) ||
939                      fsp->xfer_len < fsp->data_len - fsp->scsi_resid)) {
940                         fsp->status_code = FC_DATA_UNDRUN;
941                         fsp->io_status = 0;
942                 }
943         }
944
945         seq = fsp->seq_ptr;
946         if (seq) {
947                 fsp->seq_ptr = NULL;
948                 if (unlikely(fsp->scsi_comp_flags & FCP_CONF_REQ)) {
949                         struct fc_frame *conf_frame;
950                         struct fc_seq *csp;
951
952                         csp = lport->tt.seq_start_next(seq);
953                         conf_frame = fc_fcp_frame_alloc(fsp->lp, 0);
954                         if (conf_frame) {
955                                 f_ctl = FC_FC_SEQ_INIT;
956                                 f_ctl |= FC_FC_LAST_SEQ | FC_FC_END_SEQ;
957                                 ep = fc_seq_exch(seq);
958                                 fc_fill_fc_hdr(conf_frame, FC_RCTL_DD_SOL_CTL,
959                                                ep->did, ep->sid,
960                                                FC_TYPE_FCP, f_ctl, 0);
961                                 lport->tt.seq_send(lport, csp, conf_frame);
962                         }
963                 }
964                 lport->tt.exch_done(seq);
965         }
966         fc_io_compl(fsp);
967 }
968
969 /**
970  * fc_fcp_cleanup_cmd() - Cancel the active exchange on a fcp_pkt
971  * @fsp:   The FCP packet whose exchanges should be canceled
972  * @error: The reason for the cancellation
973  */
974 static void fc_fcp_cleanup_cmd(struct fc_fcp_pkt *fsp, int error)
975 {
976         struct fc_lport *lport = fsp->lp;
977
978         if (fsp->seq_ptr) {
979                 lport->tt.exch_done(fsp->seq_ptr);
980                 fsp->seq_ptr = NULL;
981         }
982         fsp->status_code = error;
983 }
984
985 /**
986  * fc_fcp_cleanup_each_cmd() - Cancel all exchanges on a local port
987  * @lport: The local port whose exchanges should be canceled
988  * @id:    The target's ID
989  * @lun:   The LUN
990  * @error: The reason for cancellation
991  *
992  * If lun or id is -1, they are ignored.
993  */
994 static void fc_fcp_cleanup_each_cmd(struct fc_lport *lport, unsigned int id,
995                                     unsigned int lun, int error)
996 {
997         struct fc_fcp_internal *si = fc_get_scsi_internal(lport);
998         struct fc_fcp_pkt *fsp;
999         struct scsi_cmnd *sc_cmd;
1000         unsigned long flags;
1001
1002         spin_lock_irqsave(&si->scsi_queue_lock, flags);
1003 restart:
1004         list_for_each_entry(fsp, &si->scsi_pkt_queue, list) {
1005                 sc_cmd = fsp->cmd;
1006                 if (id != -1 && scmd_id(sc_cmd) != id)
1007                         continue;
1008
1009                 if (lun != -1 && sc_cmd->device->lun != lun)
1010                         continue;
1011
1012                 fc_fcp_pkt_hold(fsp);
1013                 spin_unlock_irqrestore(&si->scsi_queue_lock, flags);
1014
1015                 if (!fc_fcp_lock_pkt(fsp)) {
1016                         fc_fcp_cleanup_cmd(fsp, error);
1017                         fc_io_compl(fsp);
1018                         fc_fcp_unlock_pkt(fsp);
1019                 }
1020
1021                 fc_fcp_pkt_release(fsp);
1022                 spin_lock_irqsave(&si->scsi_queue_lock, flags);
1023                 /*
1024                  * while we dropped the lock multiple pkts could
1025                  * have been released, so we have to start over.
1026                  */
1027                 goto restart;
1028         }
1029         spin_unlock_irqrestore(&si->scsi_queue_lock, flags);
1030 }
1031
1032 /**
1033  * fc_fcp_abort_io() - Abort all FCP-SCSI exchanges on a local port
1034  * @lport: The local port whose exchanges are to be aborted
1035  */
1036 static void fc_fcp_abort_io(struct fc_lport *lport)
1037 {
1038         fc_fcp_cleanup_each_cmd(lport, -1, -1, FC_HRD_ERROR);
1039 }
1040
1041 /**
1042  * fc_fcp_pkt_send() - Send a fcp_pkt
1043  * @lport: The local port to send the FCP packet on
1044  * @fsp:   The FCP packet to send
1045  *
1046  * Return:  Zero for success and -1 for failure
1047  * Locks:   Called without locks held
1048  */
1049 static int fc_fcp_pkt_send(struct fc_lport *lport, struct fc_fcp_pkt *fsp)
1050 {
1051         struct fc_fcp_internal *si = fc_get_scsi_internal(lport);
1052         unsigned long flags;
1053         int rc;
1054
1055         fsp->cmd->SCp.ptr = (char *)fsp;
1056         fsp->cdb_cmd.fc_dl = htonl(fsp->data_len);
1057         fsp->cdb_cmd.fc_flags = fsp->req_flags & ~FCP_CFL_LEN_MASK;
1058
1059         int_to_scsilun(fsp->cmd->device->lun,
1060                        (struct scsi_lun *)fsp->cdb_cmd.fc_lun);
1061         memcpy(fsp->cdb_cmd.fc_cdb, fsp->cmd->cmnd, fsp->cmd->cmd_len);
1062
1063         spin_lock_irqsave(&si->scsi_queue_lock, flags);
1064         list_add_tail(&fsp->list, &si->scsi_pkt_queue);
1065         spin_unlock_irqrestore(&si->scsi_queue_lock, flags);
1066         rc = lport->tt.fcp_cmd_send(lport, fsp, fc_fcp_recv);
1067         if (unlikely(rc)) {
1068                 spin_lock_irqsave(&si->scsi_queue_lock, flags);
1069                 list_del(&fsp->list);
1070                 spin_unlock_irqrestore(&si->scsi_queue_lock, flags);
1071         }
1072
1073         return rc;
1074 }
1075
1076 /**
1077  * fc_fcp_cmd_send() - Send a FCP command
1078  * @lport: The local port to send the command on
1079  * @fsp:   The FCP packet the command is on
1080  * @resp:  The handler for the response
1081  */
1082 static int fc_fcp_cmd_send(struct fc_lport *lport, struct fc_fcp_pkt *fsp,
1083                            void (*resp)(struct fc_seq *,
1084                                         struct fc_frame *fp,
1085                                         void *arg))
1086 {
1087         struct fc_frame *fp;
1088         struct fc_seq *seq;
1089         struct fc_rport *rport;
1090         struct fc_rport_libfc_priv *rpriv;
1091         const size_t len = sizeof(fsp->cdb_cmd);
1092         int rc = 0;
1093
1094         if (fc_fcp_lock_pkt(fsp))
1095                 return 0;
1096
1097         fp = fc_fcp_frame_alloc(lport, sizeof(fsp->cdb_cmd));
1098         if (!fp) {
1099                 rc = -1;
1100                 goto unlock;
1101         }
1102
1103         memcpy(fc_frame_payload_get(fp, len), &fsp->cdb_cmd, len);
1104         fr_fsp(fp) = fsp;
1105         rport = fsp->rport;
1106         fsp->max_payload = rport->maxframe_size;
1107         rpriv = rport->dd_data;
1108
1109         fc_fill_fc_hdr(fp, FC_RCTL_DD_UNSOL_CMD, rport->port_id,
1110                        rpriv->local_port->port_id, FC_TYPE_FCP,
1111                        FC_FCTL_REQ, 0);
1112
1113         seq = lport->tt.exch_seq_send(lport, fp, resp, fc_fcp_pkt_destroy,
1114                                       fsp, 0);
1115         if (!seq) {
1116                 rc = -1;
1117                 goto unlock;
1118         }
1119         fsp->last_pkt_time = jiffies;
1120         fsp->seq_ptr = seq;
1121         fc_fcp_pkt_hold(fsp);   /* hold for fc_fcp_pkt_destroy */
1122
1123         setup_timer(&fsp->timer, fc_fcp_timeout, (unsigned long)fsp);
1124         fc_fcp_timer_set(fsp,
1125                          (fsp->tgt_flags & FC_RP_FLAGS_REC_SUPPORTED) ?
1126                          FC_SCSI_REC_TOV : FC_SCSI_ER_TIMEOUT);
1127 unlock:
1128         fc_fcp_unlock_pkt(fsp);
1129         return rc;
1130 }
1131
1132 /**
1133  * fc_fcp_error() - Handler for FCP layer errors
1134  * @fsp: The FCP packet the error is on
1135  * @fp:  The frame that has errored
1136  */
1137 static void fc_fcp_error(struct fc_fcp_pkt *fsp, struct fc_frame *fp)
1138 {
1139         int error = PTR_ERR(fp);
1140
1141         if (fc_fcp_lock_pkt(fsp))
1142                 return;
1143
1144         if (error == -FC_EX_CLOSED) {
1145                 fc_fcp_retry_cmd(fsp);
1146                 goto unlock;
1147         }
1148
1149         /*
1150          * clear abort pending, because the lower layer
1151          * decided to force completion.
1152          */
1153         fsp->state &= ~FC_SRB_ABORT_PENDING;
1154         fsp->status_code = FC_CMD_PLOGO;
1155         fc_fcp_complete_locked(fsp);
1156 unlock:
1157         fc_fcp_unlock_pkt(fsp);
1158 }
1159
1160 /**
1161  * fc_fcp_pkt_abort() - Abort a fcp_pkt
1162  * @fsp:   The FCP packet to abort on
1163  *
1164  * Called to send an abort and then wait for abort completion
1165  */
1166 static int fc_fcp_pkt_abort(struct fc_fcp_pkt *fsp)
1167 {
1168         int rc = FAILED;
1169
1170         if (fc_fcp_send_abort(fsp))
1171                 return FAILED;
1172
1173         init_completion(&fsp->tm_done);
1174         fsp->wait_for_comp = 1;
1175
1176         spin_unlock_bh(&fsp->scsi_pkt_lock);
1177         rc = wait_for_completion_timeout(&fsp->tm_done, FC_SCSI_TM_TOV);
1178         spin_lock_bh(&fsp->scsi_pkt_lock);
1179         fsp->wait_for_comp = 0;
1180
1181         if (!rc) {
1182                 FC_FCP_DBG(fsp, "target abort cmd  failed\n");
1183                 rc = FAILED;
1184         } else if (fsp->state & FC_SRB_ABORTED) {
1185                 FC_FCP_DBG(fsp, "target abort cmd  passed\n");
1186                 rc = SUCCESS;
1187                 fc_fcp_complete_locked(fsp);
1188         }
1189
1190         return rc;
1191 }
1192
1193 /**
1194  * fc_lun_reset_send() - Send LUN reset command
1195  * @data: The FCP packet that identifies the LUN to be reset
1196  */
1197 static void fc_lun_reset_send(unsigned long data)
1198 {
1199         struct fc_fcp_pkt *fsp = (struct fc_fcp_pkt *)data;
1200         struct fc_lport *lport = fsp->lp;
1201         if (lport->tt.fcp_cmd_send(lport, fsp, fc_tm_done)) {
1202                 if (fsp->recov_retry++ >= FC_MAX_RECOV_RETRY)
1203                         return;
1204                 if (fc_fcp_lock_pkt(fsp))
1205                         return;
1206                 setup_timer(&fsp->timer, fc_lun_reset_send, (unsigned long)fsp);
1207                 fc_fcp_timer_set(fsp, FC_SCSI_REC_TOV);
1208                 fc_fcp_unlock_pkt(fsp);
1209         }
1210 }
1211
1212 /**
1213  * fc_lun_reset() - Send a LUN RESET command to a device
1214  *                  and wait for the reply
1215  * @lport: The local port to sent the comand on
1216  * @fsp:   The FCP packet that identifies the LUN to be reset
1217  * @id:    The SCSI command ID
1218  * @lun:   The LUN ID to be reset
1219  */
1220 static int fc_lun_reset(struct fc_lport *lport, struct fc_fcp_pkt *fsp,
1221                         unsigned int id, unsigned int lun)
1222 {
1223         int rc;
1224
1225         fsp->cdb_cmd.fc_dl = htonl(fsp->data_len);
1226         fsp->cdb_cmd.fc_tm_flags = FCP_TMF_LUN_RESET;
1227         int_to_scsilun(lun, (struct scsi_lun *)fsp->cdb_cmd.fc_lun);
1228
1229         fsp->wait_for_comp = 1;
1230         init_completion(&fsp->tm_done);
1231
1232         fc_lun_reset_send((unsigned long)fsp);
1233
1234         /*
1235          * wait for completion of reset
1236          * after that make sure all commands are terminated
1237          */
1238         rc = wait_for_completion_timeout(&fsp->tm_done, FC_SCSI_TM_TOV);
1239
1240         spin_lock_bh(&fsp->scsi_pkt_lock);
1241         fsp->state |= FC_SRB_COMPL;
1242         spin_unlock_bh(&fsp->scsi_pkt_lock);
1243
1244         del_timer_sync(&fsp->timer);
1245
1246         spin_lock_bh(&fsp->scsi_pkt_lock);
1247         if (fsp->seq_ptr) {
1248                 lport->tt.exch_done(fsp->seq_ptr);
1249                 fsp->seq_ptr = NULL;
1250         }
1251         fsp->wait_for_comp = 0;
1252         spin_unlock_bh(&fsp->scsi_pkt_lock);
1253
1254         if (!rc) {
1255                 FC_SCSI_DBG(lport, "lun reset failed\n");
1256                 return FAILED;
1257         }
1258
1259         /* cdb_status holds the tmf's rsp code */
1260         if (fsp->cdb_status != FCP_TMF_CMPL)
1261                 return FAILED;
1262
1263         FC_SCSI_DBG(lport, "lun reset to lun %u completed\n", lun);
1264         fc_fcp_cleanup_each_cmd(lport, id, lun, FC_CMD_ABORTED);
1265         return SUCCESS;
1266 }
1267
1268 /**
1269  * fc_tm_done() - Task Managment response handler
1270  * @seq: The sequence that the response is on
1271  * @fp:  The response frame
1272  * @arg: The FCP packet the response is for
1273  */
1274 static void fc_tm_done(struct fc_seq *seq, struct fc_frame *fp, void *arg)
1275 {
1276         struct fc_fcp_pkt *fsp = arg;
1277         struct fc_frame_header *fh;
1278
1279         if (IS_ERR(fp)) {
1280                 /*
1281                  * If there is an error just let it timeout or wait
1282                  * for TMF to be aborted if it timedout.
1283                  *
1284                  * scsi-eh will escalate for when either happens.
1285                  */
1286                 return;
1287         }
1288
1289         if (fc_fcp_lock_pkt(fsp))
1290                 return;
1291
1292         /*
1293          * raced with eh timeout handler.
1294          */
1295         if (!fsp->seq_ptr || !fsp->wait_for_comp) {
1296                 spin_unlock_bh(&fsp->scsi_pkt_lock);
1297                 return;
1298         }
1299
1300         fh = fc_frame_header_get(fp);
1301         if (fh->fh_type != FC_TYPE_BLS)
1302                 fc_fcp_resp(fsp, fp);
1303         fsp->seq_ptr = NULL;
1304         fsp->lp->tt.exch_done(seq);
1305         fc_frame_free(fp);
1306         fc_fcp_unlock_pkt(fsp);
1307 }
1308
1309 /**
1310  * fc_fcp_cleanup() - Cleanup all FCP exchanges on a local port
1311  * @lport: The local port to be cleaned up
1312  */
1313 static void fc_fcp_cleanup(struct fc_lport *lport)
1314 {
1315         fc_fcp_cleanup_each_cmd(lport, -1, -1, FC_ERROR);
1316 }
1317
1318 /**
1319  * fc_fcp_timeout() - Handler for fcp_pkt timeouts
1320  * @data: The FCP packet that has timed out
1321  *
1322  * If REC is supported then just issue it and return. The REC exchange will
1323  * complete or time out and recovery can continue at that point. Otherwise,
1324  * if the response has been received without all the data it has been
1325  * ER_TIMEOUT since the response was received. If the response has not been
1326  * received we see if data was received recently. If it has been then we
1327  * continue waiting, otherwise, we abort the command.
1328  */
1329 static void fc_fcp_timeout(unsigned long data)
1330 {
1331         struct fc_fcp_pkt *fsp = (struct fc_fcp_pkt *)data;
1332         struct fc_rport *rport = fsp->rport;
1333         struct fc_rport_libfc_priv *rpriv = rport->dd_data;
1334
1335         if (fc_fcp_lock_pkt(fsp))
1336                 return;
1337
1338         if (fsp->cdb_cmd.fc_tm_flags)
1339                 goto unlock;
1340
1341         fsp->state |= FC_SRB_FCP_PROCESSING_TMO;
1342
1343         if (rpriv->flags & FC_RP_FLAGS_REC_SUPPORTED)
1344                 fc_fcp_rec(fsp);
1345         else if (time_after_eq(fsp->last_pkt_time + (FC_SCSI_ER_TIMEOUT / 2),
1346                                jiffies))
1347                 fc_fcp_timer_set(fsp, FC_SCSI_ER_TIMEOUT);
1348         else if (fsp->state & FC_SRB_RCV_STATUS)
1349                 fc_fcp_complete_locked(fsp);
1350         else
1351                 fc_fcp_recovery(fsp);
1352         fsp->state &= ~FC_SRB_FCP_PROCESSING_TMO;
1353 unlock:
1354         fc_fcp_unlock_pkt(fsp);
1355 }
1356
1357 /**
1358  * fc_fcp_rec() - Send a REC ELS request
1359  * @fsp: The FCP packet to send the REC request on
1360  */
1361 static void fc_fcp_rec(struct fc_fcp_pkt *fsp)
1362 {
1363         struct fc_lport *lport;
1364         struct fc_frame *fp;
1365         struct fc_rport *rport;
1366         struct fc_rport_libfc_priv *rpriv;
1367
1368         lport = fsp->lp;
1369         rport = fsp->rport;
1370         rpriv = rport->dd_data;
1371         if (!fsp->seq_ptr || rpriv->rp_state != RPORT_ST_READY) {
1372                 fsp->status_code = FC_HRD_ERROR;
1373                 fsp->io_status = 0;
1374                 fc_fcp_complete_locked(fsp);
1375                 return;
1376         }
1377         fp = fc_fcp_frame_alloc(lport, sizeof(struct fc_els_rec));
1378         if (!fp)
1379                 goto retry;
1380
1381         fr_seq(fp) = fsp->seq_ptr;
1382         fc_fill_fc_hdr(fp, FC_RCTL_ELS_REQ, rport->port_id,
1383                        rpriv->local_port->port_id, FC_TYPE_ELS,
1384                        FC_FCTL_REQ, 0);
1385         if (lport->tt.elsct_send(lport, rport->port_id, fp, ELS_REC,
1386                                  fc_fcp_rec_resp, fsp,
1387                                  jiffies_to_msecs(FC_SCSI_REC_TOV))) {
1388                 fc_fcp_pkt_hold(fsp);           /* hold while REC outstanding */
1389                 return;
1390         }
1391 retry:
1392         if (fsp->recov_retry++ < FC_MAX_RECOV_RETRY)
1393                 fc_fcp_timer_set(fsp, FC_SCSI_REC_TOV);
1394         else
1395                 fc_fcp_recovery(fsp);
1396 }
1397
1398 /**
1399  * fc_fcp_rec_resp() - Handler for REC ELS responses
1400  * @seq: The sequence the response is on
1401  * @fp:  The response frame
1402  * @arg: The FCP packet the response is on
1403  *
1404  * If the response is a reject then the scsi layer will handle
1405  * the timeout. If the response is a LS_ACC then if the I/O was not completed
1406  * set the timeout and return. If the I/O was completed then complete the
1407  * exchange and tell the SCSI layer.
1408  */
1409 static void fc_fcp_rec_resp(struct fc_seq *seq, struct fc_frame *fp, void *arg)
1410 {
1411         struct fc_fcp_pkt *fsp = (struct fc_fcp_pkt *)arg;
1412         struct fc_els_rec_acc *recp;
1413         struct fc_els_ls_rjt *rjt;
1414         u32 e_stat;
1415         u8 opcode;
1416         u32 offset;
1417         enum dma_data_direction data_dir;
1418         enum fc_rctl r_ctl;
1419         struct fc_rport_libfc_priv *rpriv;
1420
1421         if (IS_ERR(fp)) {
1422                 fc_fcp_rec_error(fsp, fp);
1423                 return;
1424         }
1425
1426         if (fc_fcp_lock_pkt(fsp))
1427                 goto out;
1428
1429         fsp->recov_retry = 0;
1430         opcode = fc_frame_payload_op(fp);
1431         if (opcode == ELS_LS_RJT) {
1432                 rjt = fc_frame_payload_get(fp, sizeof(*rjt));
1433                 switch (rjt->er_reason) {
1434                 default:
1435                         FC_FCP_DBG(fsp, "device %x unexpected REC reject "
1436                                    "reason %d expl %d\n",
1437                                    fsp->rport->port_id, rjt->er_reason,
1438                                    rjt->er_explan);
1439                         /* fall through */
1440                 case ELS_RJT_UNSUP:
1441                         FC_FCP_DBG(fsp, "device does not support REC\n");
1442                         rpriv = fsp->rport->dd_data;
1443                         /*
1444                          * if we do not spport RECs or got some bogus
1445                          * reason then resetup timer so we check for
1446                          * making progress.
1447                          */
1448                         rpriv->flags &= ~FC_RP_FLAGS_REC_SUPPORTED;
1449                         fc_fcp_timer_set(fsp, FC_SCSI_ER_TIMEOUT);
1450                         break;
1451                 case ELS_RJT_LOGIC:
1452                 case ELS_RJT_UNAB:
1453                         /*
1454                          * If no data transfer, the command frame got dropped
1455                          * so we just retry.  If data was transferred, we
1456                          * lost the response but the target has no record,
1457                          * so we abort and retry.
1458                          */
1459                         if (rjt->er_explan == ELS_EXPL_OXID_RXID &&
1460                             fsp->xfer_len == 0) {
1461                                 fc_fcp_retry_cmd(fsp);
1462                                 break;
1463                         }
1464                         fc_fcp_recovery(fsp);
1465                         break;
1466                 }
1467         } else if (opcode == ELS_LS_ACC) {
1468                 if (fsp->state & FC_SRB_ABORTED)
1469                         goto unlock_out;
1470
1471                 data_dir = fsp->cmd->sc_data_direction;
1472                 recp = fc_frame_payload_get(fp, sizeof(*recp));
1473                 offset = ntohl(recp->reca_fc4value);
1474                 e_stat = ntohl(recp->reca_e_stat);
1475
1476                 if (e_stat & ESB_ST_COMPLETE) {
1477
1478                         /*
1479                          * The exchange is complete.
1480                          *
1481                          * For output, we must've lost the response.
1482                          * For input, all data must've been sent.
1483                          * We lost may have lost the response
1484                          * (and a confirmation was requested) and maybe
1485                          * some data.
1486                          *
1487                          * If all data received, send SRR
1488                          * asking for response.  If partial data received,
1489                          * or gaps, SRR requests data at start of gap.
1490                          * Recovery via SRR relies on in-order-delivery.
1491                          */
1492                         if (data_dir == DMA_TO_DEVICE) {
1493                                 r_ctl = FC_RCTL_DD_CMD_STATUS;
1494                         } else if (fsp->xfer_contig_end == offset) {
1495                                 r_ctl = FC_RCTL_DD_CMD_STATUS;
1496                         } else {
1497                                 offset = fsp->xfer_contig_end;
1498                                 r_ctl = FC_RCTL_DD_SOL_DATA;
1499                         }
1500                         fc_fcp_srr(fsp, r_ctl, offset);
1501                 } else if (e_stat & ESB_ST_SEQ_INIT) {
1502
1503                         /*
1504                          * The remote port has the initiative, so just
1505                          * keep waiting for it to complete.
1506                          */
1507                         fc_fcp_timer_set(fsp, FC_SCSI_REC_TOV);
1508                 } else {
1509
1510                         /*
1511                          * The exchange is incomplete, we have seq. initiative.
1512                          * Lost response with requested confirmation,
1513                          * lost confirmation, lost transfer ready or
1514                          * lost write data.
1515                          *
1516                          * For output, if not all data was received, ask
1517                          * for transfer ready to be repeated.
1518                          *
1519                          * If we received or sent all the data, send SRR to
1520                          * request response.
1521                          *
1522                          * If we lost a response, we may have lost some read
1523                          * data as well.
1524                          */
1525                         r_ctl = FC_RCTL_DD_SOL_DATA;
1526                         if (data_dir == DMA_TO_DEVICE) {
1527                                 r_ctl = FC_RCTL_DD_CMD_STATUS;
1528                                 if (offset < fsp->data_len)
1529                                         r_ctl = FC_RCTL_DD_DATA_DESC;
1530                         } else if (offset == fsp->xfer_contig_end) {
1531                                 r_ctl = FC_RCTL_DD_CMD_STATUS;
1532                         } else if (fsp->xfer_contig_end < offset) {
1533                                 offset = fsp->xfer_contig_end;
1534                         }
1535                         fc_fcp_srr(fsp, r_ctl, offset);
1536                 }
1537         }
1538 unlock_out:
1539         fc_fcp_unlock_pkt(fsp);
1540 out:
1541         fc_fcp_pkt_release(fsp);        /* drop hold for outstanding REC */
1542         fc_frame_free(fp);
1543 }
1544
1545 /**
1546  * fc_fcp_rec_error() - Handler for REC errors
1547  * @fsp: The FCP packet the error is on
1548  * @fp:  The REC frame
1549  */
1550 static void fc_fcp_rec_error(struct fc_fcp_pkt *fsp, struct fc_frame *fp)
1551 {
1552         int error = PTR_ERR(fp);
1553
1554         if (fc_fcp_lock_pkt(fsp))
1555                 goto out;
1556
1557         switch (error) {
1558         case -FC_EX_CLOSED:
1559                 fc_fcp_retry_cmd(fsp);
1560                 break;
1561
1562         default:
1563                 FC_FCP_DBG(fsp, "REC %p fid %6.6x error unexpected error %d\n",
1564                            fsp, fsp->rport->port_id, error);
1565                 fsp->status_code = FC_CMD_PLOGO;
1566                 /* fall through */
1567
1568         case -FC_EX_TIMEOUT:
1569                 /*
1570                  * Assume REC or LS_ACC was lost.
1571                  * The exchange manager will have aborted REC, so retry.
1572                  */
1573                 FC_FCP_DBG(fsp, "REC fid %6.6x error error %d retry %d/%d\n",
1574                            fsp->rport->port_id, error, fsp->recov_retry,
1575                            FC_MAX_RECOV_RETRY);
1576                 if (fsp->recov_retry++ < FC_MAX_RECOV_RETRY)
1577                         fc_fcp_rec(fsp);
1578                 else
1579                         fc_fcp_recovery(fsp);
1580                 break;
1581         }
1582         fc_fcp_unlock_pkt(fsp);
1583 out:
1584         fc_fcp_pkt_release(fsp);        /* drop hold for outstanding REC */
1585 }
1586
1587 /**
1588  * fc_fcp_recovery() - Handler for fcp_pkt recovery
1589  * @fsp: The FCP pkt that needs to be aborted
1590  */
1591 static void fc_fcp_recovery(struct fc_fcp_pkt *fsp)
1592 {
1593         fsp->status_code = FC_CMD_RECOVERY;
1594         fsp->cdb_status = 0;
1595         fsp->io_status = 0;
1596         /*
1597          * if this fails then we let the scsi command timer fire and
1598          * scsi-ml escalate.
1599          */
1600         fc_fcp_send_abort(fsp);
1601 }
1602
1603 /**
1604  * fc_fcp_srr() - Send a SRR request (Sequence Retransmission Request)
1605  * @fsp:   The FCP packet the SRR is to be sent on
1606  * @r_ctl: The R_CTL field for the SRR request
1607  * This is called after receiving status but insufficient data, or
1608  * when expecting status but the request has timed out.
1609  */
1610 static void fc_fcp_srr(struct fc_fcp_pkt *fsp, enum fc_rctl r_ctl, u32 offset)
1611 {
1612         struct fc_lport *lport = fsp->lp;
1613         struct fc_rport *rport;
1614         struct fc_rport_libfc_priv *rpriv;
1615         struct fc_exch *ep = fc_seq_exch(fsp->seq_ptr);
1616         struct fc_seq *seq;
1617         struct fcp_srr *srr;
1618         struct fc_frame *fp;
1619         u8 cdb_op;
1620
1621         rport = fsp->rport;
1622         rpriv = rport->dd_data;
1623         cdb_op = fsp->cdb_cmd.fc_cdb[0];
1624
1625         if (!(rpriv->flags & FC_RP_FLAGS_RETRY) ||
1626             rpriv->rp_state != RPORT_ST_READY)
1627                 goto retry;                     /* shouldn't happen */
1628         fp = fc_fcp_frame_alloc(lport, sizeof(*srr));
1629         if (!fp)
1630                 goto retry;
1631
1632         srr = fc_frame_payload_get(fp, sizeof(*srr));
1633         memset(srr, 0, sizeof(*srr));
1634         srr->srr_op = ELS_SRR;
1635         srr->srr_ox_id = htons(ep->oxid);
1636         srr->srr_rx_id = htons(ep->rxid);
1637         srr->srr_r_ctl = r_ctl;
1638         srr->srr_rel_off = htonl(offset);
1639
1640         fc_fill_fc_hdr(fp, FC_RCTL_ELS4_REQ, rport->port_id,
1641                        rpriv->local_port->port_id, FC_TYPE_FCP,
1642                        FC_FCTL_REQ, 0);
1643
1644         seq = lport->tt.exch_seq_send(lport, fp, fc_fcp_srr_resp, NULL,
1645                                       fsp, jiffies_to_msecs(FC_SCSI_REC_TOV));
1646         if (!seq)
1647                 goto retry;
1648
1649         fsp->recov_seq = seq;
1650         fsp->xfer_len = offset;
1651         fsp->xfer_contig_end = offset;
1652         fsp->state &= ~FC_SRB_RCV_STATUS;
1653         fc_fcp_pkt_hold(fsp);           /* hold for outstanding SRR */
1654         return;
1655 retry:
1656         fc_fcp_retry_cmd(fsp);
1657 }
1658
1659 /**
1660  * fc_fcp_srr_resp() - Handler for SRR response
1661  * @seq: The sequence the SRR is on
1662  * @fp:  The SRR frame
1663  * @arg: The FCP packet the SRR is on
1664  */
1665 static void fc_fcp_srr_resp(struct fc_seq *seq, struct fc_frame *fp, void *arg)
1666 {
1667         struct fc_fcp_pkt *fsp = arg;
1668         struct fc_frame_header *fh;
1669
1670         if (IS_ERR(fp)) {
1671                 fc_fcp_srr_error(fsp, fp);
1672                 return;
1673         }
1674
1675         if (fc_fcp_lock_pkt(fsp))
1676                 goto out;
1677
1678         fh = fc_frame_header_get(fp);
1679         /*
1680          * BUG? fc_fcp_srr_error calls exch_done which would release
1681          * the ep. But if fc_fcp_srr_error had got -FC_EX_TIMEOUT,
1682          * then fc_exch_timeout would be sending an abort. The exch_done
1683          * call by fc_fcp_srr_error would prevent fc_exch.c from seeing
1684          * an abort response though.
1685          */
1686         if (fh->fh_type == FC_TYPE_BLS) {
1687                 fc_fcp_unlock_pkt(fsp);
1688                 return;
1689         }
1690
1691         fsp->recov_seq = NULL;
1692         switch (fc_frame_payload_op(fp)) {
1693         case ELS_LS_ACC:
1694                 fsp->recov_retry = 0;
1695                 fc_fcp_timer_set(fsp, FC_SCSI_REC_TOV);
1696                 break;
1697         case ELS_LS_RJT:
1698         default:
1699                 fc_fcp_recovery(fsp);
1700                 break;
1701         }
1702         fc_fcp_unlock_pkt(fsp);
1703         fsp->lp->tt.exch_done(seq);
1704 out:
1705         fc_frame_free(fp);
1706         fc_fcp_pkt_release(fsp);        /* drop hold for outstanding SRR */
1707 }
1708
1709 /**
1710  * fc_fcp_srr_error() - Handler for SRR errors
1711  * @fsp: The FCP packet that the SRR error is on
1712  * @fp:  The SRR frame
1713  */
1714 static void fc_fcp_srr_error(struct fc_fcp_pkt *fsp, struct fc_frame *fp)
1715 {
1716         if (fc_fcp_lock_pkt(fsp))
1717                 goto out;
1718         fsp->lp->tt.exch_done(fsp->recov_seq);
1719         fsp->recov_seq = NULL;
1720         switch (PTR_ERR(fp)) {
1721         case -FC_EX_TIMEOUT:
1722                 if (fsp->recov_retry++ < FC_MAX_RECOV_RETRY)
1723                         fc_fcp_rec(fsp);
1724                 else
1725                         fc_fcp_recovery(fsp);
1726                 break;
1727         case -FC_EX_CLOSED:                     /* e.g., link failure */
1728                 /* fall through */
1729         default:
1730                 fc_fcp_retry_cmd(fsp);
1731                 break;
1732         }
1733         fc_fcp_unlock_pkt(fsp);
1734 out:
1735         fc_fcp_pkt_release(fsp);        /* drop hold for outstanding SRR */
1736 }
1737
1738 /**
1739  * fc_fcp_lport_queue_ready() - Determine if the lport and it's queue is ready
1740  * @lport: The local port to be checked
1741  */
1742 static inline int fc_fcp_lport_queue_ready(struct fc_lport *lport)
1743 {
1744         /* lock ? */
1745         return (lport->state == LPORT_ST_READY) &&
1746                 lport->link_up && !lport->qfull;
1747 }
1748
1749 /**
1750  * fc_queuecommand() - The queuecommand function of the SCSI template
1751  * @cmd:   The scsi_cmnd to be executed
1752  * @done:  The callback function to be called when the scsi_cmnd is complete
1753  *
1754  * This is the i/o strategy routine, called by the SCSI layer. This routine
1755  * is called with the host_lock held.
1756  */
1757 int fc_queuecommand(struct scsi_cmnd *sc_cmd, void (*done)(struct scsi_cmnd *))
1758 {
1759         struct fc_lport *lport;
1760         struct fc_rport *rport = starget_to_rport(scsi_target(sc_cmd->device));
1761         struct fc_fcp_pkt *fsp;
1762         struct fc_rport_libfc_priv *rpriv;
1763         int rval;
1764         int rc = 0;
1765         struct fcoe_dev_stats *stats;
1766
1767         lport = shost_priv(sc_cmd->device->host);
1768
1769         rval = fc_remote_port_chkready(rport);
1770         if (rval) {
1771                 sc_cmd->result = rval;
1772                 done(sc_cmd);
1773                 return 0;
1774         }
1775         spin_unlock_irq(lport->host->host_lock);
1776
1777         if (!*(struct fc_remote_port **)rport->dd_data) {
1778                 /*
1779                  * rport is transitioning from blocked/deleted to
1780                  * online
1781                  */
1782                 sc_cmd->result = DID_IMM_RETRY << 16;
1783                 done(sc_cmd);
1784                 goto out;
1785         }
1786
1787         rpriv = rport->dd_data;
1788
1789         if (!fc_fcp_lport_queue_ready(lport)) {
1790                 if (lport->qfull)
1791                         fc_fcp_can_queue_ramp_down(lport);
1792                 rc = SCSI_MLQUEUE_HOST_BUSY;
1793                 goto out;
1794         }
1795
1796         fsp = fc_fcp_pkt_alloc(lport, GFP_ATOMIC);
1797         if (fsp == NULL) {
1798                 rc = SCSI_MLQUEUE_HOST_BUSY;
1799                 goto out;
1800         }
1801
1802         /*
1803          * build the libfc request pkt
1804          */
1805         fsp->cmd = sc_cmd;      /* save the cmd */
1806         fsp->lp = lport;        /* save the softc ptr */
1807         fsp->rport = rport;     /* set the remote port ptr */
1808         fsp->xfer_ddp = FC_XID_UNKNOWN;
1809         sc_cmd->scsi_done = done;
1810
1811         /*
1812          * set up the transfer length
1813          */
1814         fsp->data_len = scsi_bufflen(sc_cmd);
1815         fsp->xfer_len = 0;
1816
1817         /*
1818          * setup the data direction
1819          */
1820         stats = per_cpu_ptr(lport->dev_stats, get_cpu());
1821         if (sc_cmd->sc_data_direction == DMA_FROM_DEVICE) {
1822                 fsp->req_flags = FC_SRB_READ;
1823                 stats->InputRequests++;
1824                 stats->InputMegabytes = fsp->data_len;
1825         } else if (sc_cmd->sc_data_direction == DMA_TO_DEVICE) {
1826                 fsp->req_flags = FC_SRB_WRITE;
1827                 stats->OutputRequests++;
1828                 stats->OutputMegabytes = fsp->data_len;
1829         } else {
1830                 fsp->req_flags = 0;
1831                 stats->ControlRequests++;
1832         }
1833         put_cpu();
1834
1835         fsp->tgt_flags = rpriv->flags;
1836
1837         init_timer(&fsp->timer);
1838         fsp->timer.data = (unsigned long)fsp;
1839
1840         /*
1841          * send it to the lower layer
1842          * if we get -1 return then put the request in the pending
1843          * queue.
1844          */
1845         rval = fc_fcp_pkt_send(lport, fsp);
1846         if (rval != 0) {
1847                 fsp->state = FC_SRB_FREE;
1848                 fc_fcp_pkt_release(fsp);
1849                 rc = SCSI_MLQUEUE_HOST_BUSY;
1850         }
1851 out:
1852         spin_lock_irq(lport->host->host_lock);
1853         return rc;
1854 }
1855 EXPORT_SYMBOL(fc_queuecommand);
1856
1857 /**
1858  * fc_io_compl() - Handle responses for completed commands
1859  * @fsp: The FCP packet that is complete
1860  *
1861  * Translates fcp_pkt errors to a Linux SCSI errors.
1862  * The fcp packet lock must be held when calling.
1863  */
1864 static void fc_io_compl(struct fc_fcp_pkt *fsp)
1865 {
1866         struct fc_fcp_internal *si;
1867         struct scsi_cmnd *sc_cmd;
1868         struct fc_lport *lport;
1869         unsigned long flags;
1870
1871         /* release outstanding ddp context */
1872         fc_fcp_ddp_done(fsp);
1873
1874         fsp->state |= FC_SRB_COMPL;
1875         if (!(fsp->state & FC_SRB_FCP_PROCESSING_TMO)) {
1876                 spin_unlock_bh(&fsp->scsi_pkt_lock);
1877                 del_timer_sync(&fsp->timer);
1878                 spin_lock_bh(&fsp->scsi_pkt_lock);
1879         }
1880
1881         lport = fsp->lp;
1882         si = fc_get_scsi_internal(lport);
1883         if (!fsp->cmd)
1884                 return;
1885
1886         /*
1887          * if can_queue ramp down is done then try can_queue ramp up
1888          * since commands are completing now.
1889          */
1890         if (si->last_can_queue_ramp_down_time)
1891                 fc_fcp_can_queue_ramp_up(lport);
1892
1893         sc_cmd = fsp->cmd;
1894         fsp->cmd = NULL;
1895
1896         if (!sc_cmd->SCp.ptr)
1897                 return;
1898
1899         CMD_SCSI_STATUS(sc_cmd) = fsp->cdb_status;
1900         switch (fsp->status_code) {
1901         case FC_COMPLETE:
1902                 if (fsp->cdb_status == 0) {
1903                         /*
1904                          * good I/O status
1905                          */
1906                         sc_cmd->result = DID_OK << 16;
1907                         if (fsp->scsi_resid)
1908                                 CMD_RESID_LEN(sc_cmd) = fsp->scsi_resid;
1909                 } else {
1910                         /*
1911                          * transport level I/O was ok but scsi
1912                          * has non zero status
1913                          */
1914                         sc_cmd->result = (DID_OK << 16) | fsp->cdb_status;
1915                 }
1916                 break;
1917         case FC_ERROR:
1918                 FC_FCP_DBG(fsp, "Returning DID_ERROR to scsi-ml "
1919                            "due to FC_ERROR\n");
1920                 sc_cmd->result = DID_ERROR << 16;
1921                 break;
1922         case FC_DATA_UNDRUN:
1923                 if ((fsp->cdb_status == 0) && !(fsp->req_flags & FC_SRB_READ)) {
1924                         /*
1925                          * scsi status is good but transport level
1926                          * underrun.
1927                          */
1928                         if (fsp->state & FC_SRB_RCV_STATUS) {
1929                                 sc_cmd->result = DID_OK << 16;
1930                         } else {
1931                                 FC_FCP_DBG(fsp, "Returning DID_ERROR to scsi-ml"
1932                                            " due to FC_DATA_UNDRUN (trans)\n");
1933                                 sc_cmd->result = DID_ERROR << 16;
1934                         }
1935                 } else {
1936                         /*
1937                          * scsi got underrun, this is an error
1938                          */
1939                         FC_FCP_DBG(fsp, "Returning DID_ERROR to scsi-ml "
1940                                    "due to FC_DATA_UNDRUN (scsi)\n");
1941                         CMD_RESID_LEN(sc_cmd) = fsp->scsi_resid;
1942                         sc_cmd->result = (DID_ERROR << 16) | fsp->cdb_status;
1943                 }
1944                 break;
1945         case FC_DATA_OVRRUN:
1946                 /*
1947                  * overrun is an error
1948                  */
1949                 FC_FCP_DBG(fsp, "Returning DID_ERROR to scsi-ml "
1950                            "due to FC_DATA_OVRRUN\n");
1951                 sc_cmd->result = (DID_ERROR << 16) | fsp->cdb_status;
1952                 break;
1953         case FC_CMD_ABORTED:
1954                 FC_FCP_DBG(fsp, "Returning DID_ERROR to scsi-ml "
1955                            "due to FC_CMD_ABORTED\n");
1956                 sc_cmd->result = (DID_ERROR << 16) | fsp->io_status;
1957                 break;
1958         case FC_CMD_RECOVERY:
1959                 sc_cmd->result = (DID_BUS_BUSY << 16) | fsp->io_status;
1960                 break;
1961         case FC_CMD_RESET:
1962                 sc_cmd->result = (DID_RESET << 16);
1963                 break;
1964         case FC_HRD_ERROR:
1965                 sc_cmd->result = (DID_NO_CONNECT << 16);
1966                 break;
1967         default:
1968                 FC_FCP_DBG(fsp, "Returning DID_ERROR to scsi-ml "
1969                            "due to unknown error\n");
1970                 sc_cmd->result = (DID_ERROR << 16);
1971                 break;
1972         }
1973
1974         if (lport->state != LPORT_ST_READY && fsp->status_code != FC_COMPLETE) {
1975                 sc_cmd->result = (DID_REQUEUE << 16);
1976                 FC_FCP_DBG(fsp, "Returning DID_REQUEUE to scsi-ml\n");
1977         }
1978
1979         spin_lock_irqsave(&si->scsi_queue_lock, flags);
1980         list_del(&fsp->list);
1981         spin_unlock_irqrestore(&si->scsi_queue_lock, flags);
1982         sc_cmd->SCp.ptr = NULL;
1983         sc_cmd->scsi_done(sc_cmd);
1984
1985         /* release ref from initial allocation in queue command */
1986         fc_fcp_pkt_release(fsp);
1987 }
1988
1989 /**
1990  * fc_eh_abort() - Abort a command
1991  * @sc_cmd: The SCSI command to abort
1992  *
1993  * From SCSI host template.
1994  * Send an ABTS to the target device and wait for the response.
1995  */
1996 int fc_eh_abort(struct scsi_cmnd *sc_cmd)
1997 {
1998         struct fc_fcp_pkt *fsp;
1999         struct fc_lport *lport;
2000         int rc = FAILED;
2001         unsigned long flags;
2002
2003         lport = shost_priv(sc_cmd->device->host);
2004         if (lport->state != LPORT_ST_READY)
2005                 return rc;
2006         else if (!lport->link_up)
2007                 return rc;
2008
2009         spin_lock_irqsave(lport->host->host_lock, flags);
2010         fsp = CMD_SP(sc_cmd);
2011         if (!fsp) {
2012                 /* command completed while scsi eh was setting up */
2013                 spin_unlock_irqrestore(lport->host->host_lock, flags);
2014                 return SUCCESS;
2015         }
2016         /* grab a ref so the fsp and sc_cmd cannot be relased from under us */
2017         fc_fcp_pkt_hold(fsp);
2018         spin_unlock_irqrestore(lport->host->host_lock, flags);
2019
2020         if (fc_fcp_lock_pkt(fsp)) {
2021                 /* completed while we were waiting for timer to be deleted */
2022                 rc = SUCCESS;
2023                 goto release_pkt;
2024         }
2025
2026         rc = fc_fcp_pkt_abort(fsp);
2027         fc_fcp_unlock_pkt(fsp);
2028
2029 release_pkt:
2030         fc_fcp_pkt_release(fsp);
2031         return rc;
2032 }
2033 EXPORT_SYMBOL(fc_eh_abort);
2034
2035 /**
2036  * fc_eh_device_reset() - Reset a single LUN
2037  * @sc_cmd: The SCSI command which identifies the device whose
2038  *          LUN is to be reset
2039  *
2040  * Set from SCSI host template.
2041  */
2042 int fc_eh_device_reset(struct scsi_cmnd *sc_cmd)
2043 {
2044         struct fc_lport *lport;
2045         struct fc_fcp_pkt *fsp;
2046         struct fc_rport *rport = starget_to_rport(scsi_target(sc_cmd->device));
2047         int rc = FAILED;
2048         int rval;
2049
2050         rval = fc_remote_port_chkready(rport);
2051         if (rval)
2052                 goto out;
2053
2054         lport = shost_priv(sc_cmd->device->host);
2055
2056         if (lport->state != LPORT_ST_READY)
2057                 return rc;
2058
2059         FC_SCSI_DBG(lport, "Resetting rport (%6.6x)\n", rport->port_id);
2060
2061         fsp = fc_fcp_pkt_alloc(lport, GFP_NOIO);
2062         if (fsp == NULL) {
2063                 printk(KERN_WARNING "libfc: could not allocate scsi_pkt\n");
2064                 goto out;
2065         }
2066
2067         /*
2068          * Build the libfc request pkt. Do not set the scsi cmnd, because
2069          * the sc passed in is not setup for execution like when sent
2070          * through the queuecommand callout.
2071          */
2072         fsp->lp = lport;        /* save the softc ptr */
2073         fsp->rport = rport;     /* set the remote port ptr */
2074
2075         /*
2076          * flush outstanding commands
2077          */
2078         rc = fc_lun_reset(lport, fsp, scmd_id(sc_cmd), sc_cmd->device->lun);
2079         fsp->state = FC_SRB_FREE;
2080         fc_fcp_pkt_release(fsp);
2081
2082 out:
2083         return rc;
2084 }
2085 EXPORT_SYMBOL(fc_eh_device_reset);
2086
2087 /**
2088  * fc_eh_host_reset() - Reset a Scsi_Host.
2089  * @sc_cmd: The SCSI command that identifies the SCSI host to be reset
2090  */
2091 int fc_eh_host_reset(struct scsi_cmnd *sc_cmd)
2092 {
2093         struct Scsi_Host *shost = sc_cmd->device->host;
2094         struct fc_lport *lport = shost_priv(shost);
2095         unsigned long wait_tmo;
2096
2097         FC_SCSI_DBG(lport, "Resetting host\n");
2098
2099         lport->tt.lport_reset(lport);
2100         wait_tmo = jiffies + FC_HOST_RESET_TIMEOUT;
2101         while (!fc_fcp_lport_queue_ready(lport) && time_before(jiffies,
2102                                                                wait_tmo))
2103                 msleep(1000);
2104
2105         if (fc_fcp_lport_queue_ready(lport)) {
2106                 shost_printk(KERN_INFO, shost, "libfc: Host reset succeeded "
2107                              "on port (%6.6x)\n", lport->port_id);
2108                 return SUCCESS;
2109         } else {
2110                 shost_printk(KERN_INFO, shost, "libfc: Host reset failed, "
2111                              "port (%6.6x) is not ready.\n",
2112                              lport->port_id);
2113                 return FAILED;
2114         }
2115 }
2116 EXPORT_SYMBOL(fc_eh_host_reset);
2117
2118 /**
2119  * fc_slave_alloc() - Configure the queue depth of a Scsi_Host
2120  * @sdev: The SCSI device that identifies the SCSI host
2121  *
2122  * Configures queue depth based on host's cmd_per_len. If not set
2123  * then we use the libfc default.
2124  */
2125 int fc_slave_alloc(struct scsi_device *sdev)
2126 {
2127         struct fc_rport *rport = starget_to_rport(scsi_target(sdev));
2128
2129         if (!rport || fc_remote_port_chkready(rport))
2130                 return -ENXIO;
2131
2132         if (sdev->tagged_supported)
2133                 scsi_activate_tcq(sdev, FC_FCP_DFLT_QUEUE_DEPTH);
2134         else
2135                 scsi_adjust_queue_depth(sdev, scsi_get_tag_type(sdev),
2136                                         FC_FCP_DFLT_QUEUE_DEPTH);
2137
2138         return 0;
2139 }
2140 EXPORT_SYMBOL(fc_slave_alloc);
2141
2142 /**
2143  * fc_change_queue_depth() - Change a device's queue depth
2144  * @sdev:   The SCSI device whose queue depth is to change
2145  * @qdepth: The new queue depth
2146  * @reason: The resason for the change
2147  */
2148 int fc_change_queue_depth(struct scsi_device *sdev, int qdepth, int reason)
2149 {
2150         switch (reason) {
2151         case SCSI_QDEPTH_DEFAULT:
2152                 scsi_adjust_queue_depth(sdev, scsi_get_tag_type(sdev), qdepth);
2153                 break;
2154         case SCSI_QDEPTH_QFULL:
2155                 scsi_track_queue_full(sdev, qdepth);
2156                 break;
2157         case SCSI_QDEPTH_RAMP_UP:
2158                 scsi_adjust_queue_depth(sdev, scsi_get_tag_type(sdev), qdepth);
2159                 break;
2160         default:
2161                 return -EOPNOTSUPP;
2162         }
2163         return sdev->queue_depth;
2164 }
2165 EXPORT_SYMBOL(fc_change_queue_depth);
2166
2167 /**
2168  * fc_change_queue_type() - Change a device's queue type
2169  * @sdev:     The SCSI device whose queue depth is to change
2170  * @tag_type: Identifier for queue type
2171  */
2172 int fc_change_queue_type(struct scsi_device *sdev, int tag_type)
2173 {
2174         if (sdev->tagged_supported) {
2175                 scsi_set_tag_type(sdev, tag_type);
2176                 if (tag_type)
2177                         scsi_activate_tcq(sdev, sdev->queue_depth);
2178                 else
2179                         scsi_deactivate_tcq(sdev, sdev->queue_depth);
2180         } else
2181                 tag_type = 0;
2182
2183         return tag_type;
2184 }
2185 EXPORT_SYMBOL(fc_change_queue_type);
2186
2187 /**
2188  * fc_fcp_destory() - Tear down the FCP layer for a given local port
2189  * @lport: The local port that no longer needs the FCP layer
2190  */
2191 void fc_fcp_destroy(struct fc_lport *lport)
2192 {
2193         struct fc_fcp_internal *si = fc_get_scsi_internal(lport);
2194
2195         if (!list_empty(&si->scsi_pkt_queue))
2196                 printk(KERN_ERR "libfc: Leaked SCSI packets when destroying "
2197                        "port (%6.6x)\n", lport->port_id);
2198
2199         mempool_destroy(si->scsi_pkt_pool);
2200         kfree(si);
2201         lport->scsi_priv = NULL;
2202 }
2203 EXPORT_SYMBOL(fc_fcp_destroy);
2204
2205 int fc_setup_fcp()
2206 {
2207         int rc = 0;
2208
2209         scsi_pkt_cachep = kmem_cache_create("libfc_fcp_pkt",
2210                                             sizeof(struct fc_fcp_pkt),
2211                                             0, SLAB_HWCACHE_ALIGN, NULL);
2212         if (!scsi_pkt_cachep) {
2213                 printk(KERN_ERR "libfc: Unable to allocate SRB cache, "
2214                        "module load failed!");
2215                 rc = -ENOMEM;
2216         }
2217
2218         return rc;
2219 }
2220
2221 void fc_destroy_fcp()
2222 {
2223         if (scsi_pkt_cachep)
2224                 kmem_cache_destroy(scsi_pkt_cachep);
2225 }
2226
2227 /**
2228  * fc_fcp_init() - Initialize the FCP layer for a local port
2229  * @lport: The local port to initialize the exchange layer for
2230  */
2231 int fc_fcp_init(struct fc_lport *lport)
2232 {
2233         int rc;
2234         struct fc_fcp_internal *si;
2235
2236         if (!lport->tt.fcp_cmd_send)
2237                 lport->tt.fcp_cmd_send = fc_fcp_cmd_send;
2238
2239         if (!lport->tt.fcp_cleanup)
2240                 lport->tt.fcp_cleanup = fc_fcp_cleanup;
2241
2242         if (!lport->tt.fcp_abort_io)
2243                 lport->tt.fcp_abort_io = fc_fcp_abort_io;
2244
2245         si = kzalloc(sizeof(struct fc_fcp_internal), GFP_KERNEL);
2246         if (!si)
2247                 return -ENOMEM;
2248         lport->scsi_priv = si;
2249         si->max_can_queue = lport->host->can_queue;
2250         INIT_LIST_HEAD(&si->scsi_pkt_queue);
2251         spin_lock_init(&si->scsi_queue_lock);
2252
2253         si->scsi_pkt_pool = mempool_create_slab_pool(2, scsi_pkt_cachep);
2254         if (!si->scsi_pkt_pool) {
2255                 rc = -ENOMEM;
2256                 goto free_internal;
2257         }
2258         return 0;
2259
2260 free_internal:
2261         kfree(si);
2262         return rc;
2263 }
2264 EXPORT_SYMBOL(fc_fcp_init);