Merge remote-tracking branches 'asoc/topic/rl6231', 'asoc/topic/rt5514' and 'asoc...
[sfrench/cifs-2.6.git] / drivers / scsi / libfc / fc_lport.c
1 /*
2  * Copyright(c) 2007 Intel Corporation. All rights reserved.
3  *
4  * This program is free software; you can redistribute it and/or modify it
5  * under the terms and conditions of the GNU General Public License,
6  * version 2, as published by the Free Software Foundation.
7  *
8  * This program is distributed in the hope it will be useful, but WITHOUT
9  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
10  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
11  * more details.
12  *
13  * You should have received a copy of the GNU General Public License along with
14  * this program; if not, write to the Free Software Foundation, Inc.,
15  * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
16  *
17  * Maintained at www.Open-FCoE.org
18  */
19
20 /*
21  * PORT LOCKING NOTES
22  *
23  * These comments only apply to the 'port code' which consists of the lport,
24  * disc and rport blocks.
25  *
26  * MOTIVATION
27  *
28  * The lport, disc and rport blocks all have mutexes that are used to protect
29  * those objects. The main motivation for these locks is to prevent from
30  * having an lport reset just before we send a frame. In that scenario the
31  * lport's FID would get set to zero and then we'd send a frame with an
32  * invalid SID. We also need to ensure that states don't change unexpectedly
33  * while processing another state.
34  *
35  * HIERARCHY
36  *
37  * The following hierarchy defines the locking rules. A greater lock
38  * may be held before acquiring a lesser lock, but a lesser lock should never
39  * be held while attempting to acquire a greater lock. Here is the hierarchy-
40  *
41  * lport > disc, lport > rport, disc > rport
42  *
43  * CALLBACKS
44  *
45  * The callbacks cause complications with this scheme. There is a callback
46  * from the rport (to either lport or disc) and a callback from disc
47  * (to the lport).
48  *
49  * As rports exit the rport state machine a callback is made to the owner of
50  * the rport to notify success or failure. Since the callback is likely to
51  * cause the lport or disc to grab its lock we cannot hold the rport lock
52  * while making the callback. To ensure that the rport is not free'd while
53  * processing the callback the rport callbacks are serialized through a
54  * single-threaded workqueue. An rport would never be free'd while in a
55  * callback handler because no other rport work in this queue can be executed
56  * at the same time.
57  *
58  * When discovery succeeds or fails a callback is made to the lport as
59  * notification. Currently, successful discovery causes the lport to take no
60  * action. A failure will cause the lport to reset. There is likely a circular
61  * locking problem with this implementation.
62  */
63
64 /*
65  * LPORT LOCKING
66  *
67  * The critical sections protected by the lport's mutex are quite broad and
68  * may be improved upon in the future. The lport code and its locking doesn't
69  * influence the I/O path, so excessive locking doesn't penalize I/O
70  * performance.
71  *
72  * The strategy is to lock whenever processing a request or response. Note
73  * that every _enter_* function corresponds to a state change. They generally
74  * change the lports state and then send a request out on the wire. We lock
75  * before calling any of these functions to protect that state change. This
76  * means that the entry points into the lport block manage the locks while
77  * the state machine can transition between states (i.e. _enter_* functions)
78  * while always staying protected.
79  *
80  * When handling responses we also hold the lport mutex broadly. When the
81  * lport receives the response frame it locks the mutex and then calls the
82  * appropriate handler for the particuar response. Generally a response will
83  * trigger a state change and so the lock must already be held.
84  *
85  * Retries also have to consider the locking. The retries occur from a work
86  * context and the work function will lock the lport and then retry the state
87  * (i.e. _enter_* function).
88  */
89
90 #include <linux/timer.h>
91 #include <linux/delay.h>
92 #include <linux/module.h>
93 #include <linux/slab.h>
94 #include <asm/unaligned.h>
95
96 #include <scsi/fc/fc_gs.h>
97
98 #include <scsi/libfc.h>
99 #include <scsi/fc_encode.h>
100 #include <linux/scatterlist.h>
101
102 #include "fc_libfc.h"
103
104 /* Fabric IDs to use for point-to-point mode, chosen on whims. */
105 #define FC_LOCAL_PTP_FID_LO   0x010101
106 #define FC_LOCAL_PTP_FID_HI   0x010102
107
108 #define DNS_DELAY             3 /* Discovery delay after RSCN (in seconds)*/
109
110 static void fc_lport_error(struct fc_lport *, struct fc_frame *);
111
112 static void fc_lport_enter_reset(struct fc_lport *);
113 static void fc_lport_enter_flogi(struct fc_lport *);
114 static void fc_lport_enter_dns(struct fc_lport *);
115 static void fc_lport_enter_ns(struct fc_lport *, enum fc_lport_state);
116 static void fc_lport_enter_scr(struct fc_lport *);
117 static void fc_lport_enter_ready(struct fc_lport *);
118 static void fc_lport_enter_logo(struct fc_lport *);
119 static void fc_lport_enter_fdmi(struct fc_lport *lport);
120 static void fc_lport_enter_ms(struct fc_lport *, enum fc_lport_state);
121
122 static const char *fc_lport_state_names[] = {
123         [LPORT_ST_DISABLED] = "disabled",
124         [LPORT_ST_FLOGI] =    "FLOGI",
125         [LPORT_ST_DNS] =      "dNS",
126         [LPORT_ST_RNN_ID] =   "RNN_ID",
127         [LPORT_ST_RSNN_NN] =  "RSNN_NN",
128         [LPORT_ST_RSPN_ID] =  "RSPN_ID",
129         [LPORT_ST_RFT_ID] =   "RFT_ID",
130         [LPORT_ST_RFF_ID] =   "RFF_ID",
131         [LPORT_ST_FDMI] =     "FDMI",
132         [LPORT_ST_RHBA] =     "RHBA",
133         [LPORT_ST_RPA] =      "RPA",
134         [LPORT_ST_DHBA] =     "DHBA",
135         [LPORT_ST_DPRT] =     "DPRT",
136         [LPORT_ST_SCR] =      "SCR",
137         [LPORT_ST_READY] =    "Ready",
138         [LPORT_ST_LOGO] =     "LOGO",
139         [LPORT_ST_RESET] =    "reset",
140 };
141
142 /**
143  * struct fc_bsg_info - FC Passthrough managemet structure
144  * @job:      The passthrough job
145  * @lport:    The local port to pass through a command
146  * @rsp_code: The expected response code
147  * @sg:       job->reply_payload.sg_list
148  * @nents:    job->reply_payload.sg_cnt
149  * @offset:   The offset into the response data
150  */
151 struct fc_bsg_info {
152         struct bsg_job *job;
153         struct fc_lport *lport;
154         u16 rsp_code;
155         struct scatterlist *sg;
156         u32 nents;
157         size_t offset;
158 };
159
160 /**
161  * fc_frame_drop() - Dummy frame handler
162  * @lport: The local port the frame was received on
163  * @fp:    The received frame
164  */
165 static int fc_frame_drop(struct fc_lport *lport, struct fc_frame *fp)
166 {
167         fc_frame_free(fp);
168         return 0;
169 }
170
171 /**
172  * fc_lport_rport_callback() - Event handler for rport events
173  * @lport: The lport which is receiving the event
174  * @rdata: private remote port data
175  * @event: The event that occurred
176  *
177  * Locking Note: The rport lock should not be held when calling
178  *               this function.
179  */
180 static void fc_lport_rport_callback(struct fc_lport *lport,
181                                     struct fc_rport_priv *rdata,
182                                     enum fc_rport_event event)
183 {
184         FC_LPORT_DBG(lport, "Received a %d event for port (%6.6x)\n", event,
185                      rdata->ids.port_id);
186
187         mutex_lock(&lport->lp_mutex);
188         switch (event) {
189         case RPORT_EV_READY:
190                 if (lport->state == LPORT_ST_DNS) {
191                         lport->dns_rdata = rdata;
192                         fc_lport_enter_ns(lport, LPORT_ST_RNN_ID);
193                 } else if (lport->state == LPORT_ST_FDMI) {
194                         lport->ms_rdata = rdata;
195                         fc_lport_enter_ms(lport, LPORT_ST_DHBA);
196                 } else {
197                         FC_LPORT_DBG(lport, "Received an READY event "
198                                      "on port (%6.6x) for the directory "
199                                      "server, but the lport is not "
200                                      "in the DNS or FDMI state, it's in the "
201                                      "%d state", rdata->ids.port_id,
202                                      lport->state);
203                         fc_rport_logoff(rdata);
204                 }
205                 break;
206         case RPORT_EV_LOGO:
207         case RPORT_EV_FAILED:
208         case RPORT_EV_STOP:
209                 if (rdata->ids.port_id == FC_FID_DIR_SERV)
210                         lport->dns_rdata = NULL;
211                 else if (rdata->ids.port_id == FC_FID_MGMT_SERV)
212                         lport->ms_rdata = NULL;
213                 break;
214         case RPORT_EV_NONE:
215                 break;
216         }
217         mutex_unlock(&lport->lp_mutex);
218 }
219
220 /**
221  * fc_lport_state() - Return a string which represents the lport's state
222  * @lport: The lport whose state is to converted to a string
223  */
224 static const char *fc_lport_state(struct fc_lport *lport)
225 {
226         const char *cp;
227
228         cp = fc_lport_state_names[lport->state];
229         if (!cp)
230                 cp = "unknown";
231         return cp;
232 }
233
234 /**
235  * fc_lport_ptp_setup() - Create an rport for point-to-point mode
236  * @lport:       The lport to attach the ptp rport to
237  * @remote_fid:  The FID of the ptp rport
238  * @remote_wwpn: The WWPN of the ptp rport
239  * @remote_wwnn: The WWNN of the ptp rport
240  *
241  * Locking Note: The lport lock is expected to be held before calling
242  * this routine.
243  */
244 static void fc_lport_ptp_setup(struct fc_lport *lport,
245                                u32 remote_fid, u64 remote_wwpn,
246                                u64 remote_wwnn)
247 {
248         if (lport->ptp_rdata) {
249                 fc_rport_logoff(lport->ptp_rdata);
250                 kref_put(&lport->ptp_rdata->kref, fc_rport_destroy);
251         }
252         mutex_lock(&lport->disc.disc_mutex);
253         lport->ptp_rdata = fc_rport_create(lport, remote_fid);
254         kref_get(&lport->ptp_rdata->kref);
255         lport->ptp_rdata->ids.port_name = remote_wwpn;
256         lport->ptp_rdata->ids.node_name = remote_wwnn;
257         mutex_unlock(&lport->disc.disc_mutex);
258
259         fc_rport_login(lport->ptp_rdata);
260
261         fc_lport_enter_ready(lport);
262 }
263
264 /**
265  * fc_get_host_port_state() - Return the port state of the given Scsi_Host
266  * @shost:  The SCSI host whose port state is to be determined
267  */
268 void fc_get_host_port_state(struct Scsi_Host *shost)
269 {
270         struct fc_lport *lport = shost_priv(shost);
271
272         mutex_lock(&lport->lp_mutex);
273         if (!lport->link_up)
274                 fc_host_port_state(shost) = FC_PORTSTATE_LINKDOWN;
275         else
276                 switch (lport->state) {
277                 case LPORT_ST_READY:
278                         fc_host_port_state(shost) = FC_PORTSTATE_ONLINE;
279                         break;
280                 default:
281                         fc_host_port_state(shost) = FC_PORTSTATE_OFFLINE;
282                 }
283         mutex_unlock(&lport->lp_mutex);
284 }
285 EXPORT_SYMBOL(fc_get_host_port_state);
286
287 /**
288  * fc_get_host_speed() - Return the speed of the given Scsi_Host
289  * @shost: The SCSI host whose port speed is to be determined
290  */
291 void fc_get_host_speed(struct Scsi_Host *shost)
292 {
293         struct fc_lport *lport = shost_priv(shost);
294
295         fc_host_speed(shost) = lport->link_speed;
296 }
297 EXPORT_SYMBOL(fc_get_host_speed);
298
299 /**
300  * fc_get_host_stats() - Return the Scsi_Host's statistics
301  * @shost: The SCSI host whose statistics are to be returned
302  */
303 struct fc_host_statistics *fc_get_host_stats(struct Scsi_Host *shost)
304 {
305         struct fc_host_statistics *fc_stats;
306         struct fc_lport *lport = shost_priv(shost);
307         unsigned int cpu;
308         u64 fcp_in_bytes = 0;
309         u64 fcp_out_bytes = 0;
310
311         fc_stats = &lport->host_stats;
312         memset(fc_stats, 0, sizeof(struct fc_host_statistics));
313
314         fc_stats->seconds_since_last_reset = (jiffies - lport->boot_time) / HZ;
315
316         for_each_possible_cpu(cpu) {
317                 struct fc_stats *stats;
318
319                 stats = per_cpu_ptr(lport->stats, cpu);
320
321                 fc_stats->tx_frames += stats->TxFrames;
322                 fc_stats->tx_words += stats->TxWords;
323                 fc_stats->rx_frames += stats->RxFrames;
324                 fc_stats->rx_words += stats->RxWords;
325                 fc_stats->error_frames += stats->ErrorFrames;
326                 fc_stats->invalid_crc_count += stats->InvalidCRCCount;
327                 fc_stats->fcp_input_requests += stats->InputRequests;
328                 fc_stats->fcp_output_requests += stats->OutputRequests;
329                 fc_stats->fcp_control_requests += stats->ControlRequests;
330                 fcp_in_bytes += stats->InputBytes;
331                 fcp_out_bytes += stats->OutputBytes;
332                 fc_stats->fcp_packet_alloc_failures += stats->FcpPktAllocFails;
333                 fc_stats->fcp_packet_aborts += stats->FcpPktAborts;
334                 fc_stats->fcp_frame_alloc_failures += stats->FcpFrameAllocFails;
335                 fc_stats->link_failure_count += stats->LinkFailureCount;
336         }
337         fc_stats->fcp_input_megabytes = div_u64(fcp_in_bytes, 1000000);
338         fc_stats->fcp_output_megabytes = div_u64(fcp_out_bytes, 1000000);
339         fc_stats->lip_count = -1;
340         fc_stats->nos_count = -1;
341         fc_stats->loss_of_sync_count = -1;
342         fc_stats->loss_of_signal_count = -1;
343         fc_stats->prim_seq_protocol_err_count = -1;
344         fc_stats->dumped_frames = -1;
345
346         /* update exches stats */
347         fc_exch_update_stats(lport);
348
349         return fc_stats;
350 }
351 EXPORT_SYMBOL(fc_get_host_stats);
352
353 /**
354  * fc_lport_flogi_fill() - Fill in FLOGI command for request
355  * @lport: The local port the FLOGI is for
356  * @flogi: The FLOGI command
357  * @op:    The opcode
358  */
359 static void fc_lport_flogi_fill(struct fc_lport *lport,
360                                 struct fc_els_flogi *flogi,
361                                 unsigned int op)
362 {
363         struct fc_els_csp *sp;
364         struct fc_els_cssp *cp;
365
366         memset(flogi, 0, sizeof(*flogi));
367         flogi->fl_cmd = (u8) op;
368         put_unaligned_be64(lport->wwpn, &flogi->fl_wwpn);
369         put_unaligned_be64(lport->wwnn, &flogi->fl_wwnn);
370         sp = &flogi->fl_csp;
371         sp->sp_hi_ver = 0x20;
372         sp->sp_lo_ver = 0x20;
373         sp->sp_bb_cred = htons(10);     /* this gets set by gateway */
374         sp->sp_bb_data = htons((u16) lport->mfs);
375         cp = &flogi->fl_cssp[3 - 1];    /* class 3 parameters */
376         cp->cp_class = htons(FC_CPC_VALID | FC_CPC_SEQ);
377         if (op != ELS_FLOGI) {
378                 sp->sp_features = htons(FC_SP_FT_CIRO);
379                 sp->sp_tot_seq = htons(255);    /* seq. we accept */
380                 sp->sp_rel_off = htons(0x1f);
381                 sp->sp_e_d_tov = htonl(lport->e_d_tov);
382
383                 cp->cp_rdfs = htons((u16) lport->mfs);
384                 cp->cp_con_seq = htons(255);
385                 cp->cp_open_seq = 1;
386         }
387 }
388
389 /**
390  * fc_lport_add_fc4_type() - Add a supported FC-4 type to a local port
391  * @lport: The local port to add a new FC-4 type to
392  * @type:  The new FC-4 type
393  */
394 static void fc_lport_add_fc4_type(struct fc_lport *lport, enum fc_fh_type type)
395 {
396         __be32 *mp;
397
398         mp = &lport->fcts.ff_type_map[type / FC_NS_BPW];
399         *mp = htonl(ntohl(*mp) | 1UL << (type % FC_NS_BPW));
400 }
401
402 /**
403  * fc_lport_recv_rlir_req() - Handle received Registered Link Incident Report.
404  * @lport: Fibre Channel local port receiving the RLIR
405  * @fp:    The RLIR request frame
406  *
407  * Locking Note: The lport lock is expected to be held before calling
408  * this function.
409  */
410 static void fc_lport_recv_rlir_req(struct fc_lport *lport, struct fc_frame *fp)
411 {
412         FC_LPORT_DBG(lport, "Received RLIR request while in state %s\n",
413                      fc_lport_state(lport));
414
415         fc_seq_els_rsp_send(fp, ELS_LS_ACC, NULL);
416         fc_frame_free(fp);
417 }
418
419 /**
420  * fc_lport_recv_echo_req() - Handle received ECHO request
421  * @lport: The local port receiving the ECHO
422  * @fp:    ECHO request frame
423  *
424  * Locking Note: The lport lock is expected to be held before calling
425  * this function.
426  */
427 static void fc_lport_recv_echo_req(struct fc_lport *lport,
428                                    struct fc_frame *in_fp)
429 {
430         struct fc_frame *fp;
431         unsigned int len;
432         void *pp;
433         void *dp;
434
435         FC_LPORT_DBG(lport, "Received ECHO request while in state %s\n",
436                      fc_lport_state(lport));
437
438         len = fr_len(in_fp) - sizeof(struct fc_frame_header);
439         pp = fc_frame_payload_get(in_fp, len);
440
441         if (len < sizeof(__be32))
442                 len = sizeof(__be32);
443
444         fp = fc_frame_alloc(lport, len);
445         if (fp) {
446                 dp = fc_frame_payload_get(fp, len);
447                 memcpy(dp, pp, len);
448                 *((__be32 *)dp) = htonl(ELS_LS_ACC << 24);
449                 fc_fill_reply_hdr(fp, in_fp, FC_RCTL_ELS_REP, 0);
450                 lport->tt.frame_send(lport, fp);
451         }
452         fc_frame_free(in_fp);
453 }
454
455 /**
456  * fc_lport_recv_rnid_req() - Handle received Request Node ID data request
457  * @lport: The local port receiving the RNID
458  * @fp:    The RNID request frame
459  *
460  * Locking Note: The lport lock is expected to be held before calling
461  * this function.
462  */
463 static void fc_lport_recv_rnid_req(struct fc_lport *lport,
464                                    struct fc_frame *in_fp)
465 {
466         struct fc_frame *fp;
467         struct fc_els_rnid *req;
468         struct {
469                 struct fc_els_rnid_resp rnid;
470                 struct fc_els_rnid_cid cid;
471                 struct fc_els_rnid_gen gen;
472         } *rp;
473         struct fc_seq_els_data rjt_data;
474         u8 fmt;
475         size_t len;
476
477         FC_LPORT_DBG(lport, "Received RNID request while in state %s\n",
478                      fc_lport_state(lport));
479
480         req = fc_frame_payload_get(in_fp, sizeof(*req));
481         if (!req) {
482                 rjt_data.reason = ELS_RJT_LOGIC;
483                 rjt_data.explan = ELS_EXPL_NONE;
484                 fc_seq_els_rsp_send(in_fp, ELS_LS_RJT, &rjt_data);
485         } else {
486                 fmt = req->rnid_fmt;
487                 len = sizeof(*rp);
488                 if (fmt != ELS_RNIDF_GEN ||
489                     ntohl(lport->rnid_gen.rnid_atype) == 0) {
490                         fmt = ELS_RNIDF_NONE;   /* nothing to provide */
491                         len -= sizeof(rp->gen);
492                 }
493                 fp = fc_frame_alloc(lport, len);
494                 if (fp) {
495                         rp = fc_frame_payload_get(fp, len);
496                         memset(rp, 0, len);
497                         rp->rnid.rnid_cmd = ELS_LS_ACC;
498                         rp->rnid.rnid_fmt = fmt;
499                         rp->rnid.rnid_cid_len = sizeof(rp->cid);
500                         rp->cid.rnid_wwpn = htonll(lport->wwpn);
501                         rp->cid.rnid_wwnn = htonll(lport->wwnn);
502                         if (fmt == ELS_RNIDF_GEN) {
503                                 rp->rnid.rnid_sid_len = sizeof(rp->gen);
504                                 memcpy(&rp->gen, &lport->rnid_gen,
505                                        sizeof(rp->gen));
506                         }
507                         fc_fill_reply_hdr(fp, in_fp, FC_RCTL_ELS_REP, 0);
508                         lport->tt.frame_send(lport, fp);
509                 }
510         }
511         fc_frame_free(in_fp);
512 }
513
514 /**
515  * fc_lport_recv_logo_req() - Handle received fabric LOGO request
516  * @lport: The local port receiving the LOGO
517  * @fp:    The LOGO request frame
518  *
519  * Locking Note: The lport lock is expected to be held before calling
520  * this function.
521  */
522 static void fc_lport_recv_logo_req(struct fc_lport *lport, struct fc_frame *fp)
523 {
524         fc_seq_els_rsp_send(fp, ELS_LS_ACC, NULL);
525         fc_lport_enter_reset(lport);
526         fc_frame_free(fp);
527 }
528
529 /**
530  * fc_fabric_login() - Start the lport state machine
531  * @lport: The local port that should log into the fabric
532  *
533  * Locking Note: This function should not be called
534  *               with the lport lock held.
535  */
536 int fc_fabric_login(struct fc_lport *lport)
537 {
538         int rc = -1;
539
540         mutex_lock(&lport->lp_mutex);
541         if (lport->state == LPORT_ST_DISABLED ||
542             lport->state == LPORT_ST_LOGO) {
543                 fc_lport_state_enter(lport, LPORT_ST_RESET);
544                 fc_lport_enter_reset(lport);
545                 rc = 0;
546         }
547         mutex_unlock(&lport->lp_mutex);
548
549         return rc;
550 }
551 EXPORT_SYMBOL(fc_fabric_login);
552
553 /**
554  * __fc_linkup() - Handler for transport linkup events
555  * @lport: The lport whose link is up
556  *
557  * Locking: must be called with the lp_mutex held
558  */
559 void __fc_linkup(struct fc_lport *lport)
560 {
561         if (!lport->link_up) {
562                 lport->link_up = 1;
563
564                 if (lport->state == LPORT_ST_RESET)
565                         fc_lport_enter_flogi(lport);
566         }
567 }
568
569 /**
570  * fc_linkup() - Handler for transport linkup events
571  * @lport: The local port whose link is up
572  */
573 void fc_linkup(struct fc_lport *lport)
574 {
575         printk(KERN_INFO "host%d: libfc: Link up on port (%6.6x)\n",
576                lport->host->host_no, lport->port_id);
577
578         mutex_lock(&lport->lp_mutex);
579         __fc_linkup(lport);
580         mutex_unlock(&lport->lp_mutex);
581 }
582 EXPORT_SYMBOL(fc_linkup);
583
584 /**
585  * __fc_linkdown() - Handler for transport linkdown events
586  * @lport: The lport whose link is down
587  *
588  * Locking: must be called with the lp_mutex held
589  */
590 void __fc_linkdown(struct fc_lport *lport)
591 {
592         if (lport->link_up) {
593                 lport->link_up = 0;
594                 fc_lport_enter_reset(lport);
595                 lport->tt.fcp_cleanup(lport);
596         }
597 }
598
599 /**
600  * fc_linkdown() - Handler for transport linkdown events
601  * @lport: The local port whose link is down
602  */
603 void fc_linkdown(struct fc_lport *lport)
604 {
605         printk(KERN_INFO "host%d: libfc: Link down on port (%6.6x)\n",
606                lport->host->host_no, lport->port_id);
607
608         mutex_lock(&lport->lp_mutex);
609         __fc_linkdown(lport);
610         mutex_unlock(&lport->lp_mutex);
611 }
612 EXPORT_SYMBOL(fc_linkdown);
613
614 /**
615  * fc_fabric_logoff() - Logout of the fabric
616  * @lport: The local port to logoff the fabric
617  *
618  * Return value:
619  *      0 for success, -1 for failure
620  */
621 int fc_fabric_logoff(struct fc_lport *lport)
622 {
623         lport->tt.disc_stop_final(lport);
624         mutex_lock(&lport->lp_mutex);
625         if (lport->dns_rdata)
626                 fc_rport_logoff(lport->dns_rdata);
627         mutex_unlock(&lport->lp_mutex);
628         fc_rport_flush_queue();
629         mutex_lock(&lport->lp_mutex);
630         fc_lport_enter_logo(lport);
631         mutex_unlock(&lport->lp_mutex);
632         cancel_delayed_work_sync(&lport->retry_work);
633         return 0;
634 }
635 EXPORT_SYMBOL(fc_fabric_logoff);
636
637 /**
638  * fc_lport_destroy() - Unregister a fc_lport
639  * @lport: The local port to unregister
640  *
641  * Note:
642  * exit routine for fc_lport instance
643  * clean-up all the allocated memory
644  * and free up other system resources.
645  *
646  */
647 int fc_lport_destroy(struct fc_lport *lport)
648 {
649         mutex_lock(&lport->lp_mutex);
650         lport->state = LPORT_ST_DISABLED;
651         lport->link_up = 0;
652         lport->tt.frame_send = fc_frame_drop;
653         mutex_unlock(&lport->lp_mutex);
654
655         lport->tt.fcp_abort_io(lport);
656         lport->tt.disc_stop_final(lport);
657         lport->tt.exch_mgr_reset(lport, 0, 0);
658         cancel_delayed_work_sync(&lport->retry_work);
659         fc_fc4_del_lport(lport);
660         return 0;
661 }
662 EXPORT_SYMBOL(fc_lport_destroy);
663
664 /**
665  * fc_set_mfs() - Set the maximum frame size for a local port
666  * @lport: The local port to set the MFS for
667  * @mfs:   The new MFS
668  */
669 int fc_set_mfs(struct fc_lport *lport, u32 mfs)
670 {
671         unsigned int old_mfs;
672         int rc = -EINVAL;
673
674         mutex_lock(&lport->lp_mutex);
675
676         old_mfs = lport->mfs;
677
678         if (mfs >= FC_MIN_MAX_FRAME) {
679                 mfs &= ~3;
680                 if (mfs > FC_MAX_FRAME)
681                         mfs = FC_MAX_FRAME;
682                 mfs -= sizeof(struct fc_frame_header);
683                 lport->mfs = mfs;
684                 rc = 0;
685         }
686
687         if (!rc && mfs < old_mfs)
688                 fc_lport_enter_reset(lport);
689
690         mutex_unlock(&lport->lp_mutex);
691
692         return rc;
693 }
694 EXPORT_SYMBOL(fc_set_mfs);
695
696 /**
697  * fc_lport_disc_callback() - Callback for discovery events
698  * @lport: The local port receiving the event
699  * @event: The discovery event
700  */
701 static void fc_lport_disc_callback(struct fc_lport *lport,
702                                    enum fc_disc_event event)
703 {
704         switch (event) {
705         case DISC_EV_SUCCESS:
706                 FC_LPORT_DBG(lport, "Discovery succeeded\n");
707                 break;
708         case DISC_EV_FAILED:
709                 printk(KERN_ERR "host%d: libfc: "
710                        "Discovery failed for port (%6.6x)\n",
711                        lport->host->host_no, lport->port_id);
712                 mutex_lock(&lport->lp_mutex);
713                 fc_lport_enter_reset(lport);
714                 mutex_unlock(&lport->lp_mutex);
715                 break;
716         case DISC_EV_NONE:
717                 WARN_ON(1);
718                 break;
719         }
720 }
721
722 /**
723  * fc_rport_enter_ready() - Enter the ready state and start discovery
724  * @lport: The local port that is ready
725  *
726  * Locking Note: The lport lock is expected to be held before calling
727  * this routine.
728  */
729 static void fc_lport_enter_ready(struct fc_lport *lport)
730 {
731         FC_LPORT_DBG(lport, "Entered READY from state %s\n",
732                      fc_lport_state(lport));
733
734         fc_lport_state_enter(lport, LPORT_ST_READY);
735         if (lport->vport)
736                 fc_vport_set_state(lport->vport, FC_VPORT_ACTIVE);
737         fc_vports_linkchange(lport);
738
739         if (!lport->ptp_rdata)
740                 lport->tt.disc_start(fc_lport_disc_callback, lport);
741 }
742
743 /**
744  * fc_lport_set_port_id() - set the local port Port ID
745  * @lport: The local port which will have its Port ID set.
746  * @port_id: The new port ID.
747  * @fp: The frame containing the incoming request, or NULL.
748  *
749  * Locking Note: The lport lock is expected to be held before calling
750  * this function.
751  */
752 static void fc_lport_set_port_id(struct fc_lport *lport, u32 port_id,
753                                  struct fc_frame *fp)
754 {
755         if (port_id)
756                 printk(KERN_INFO "host%d: Assigned Port ID %6.6x\n",
757                        lport->host->host_no, port_id);
758
759         lport->port_id = port_id;
760
761         /* Update the fc_host */
762         fc_host_port_id(lport->host) = port_id;
763
764         if (lport->tt.lport_set_port_id)
765                 lport->tt.lport_set_port_id(lport, port_id, fp);
766 }
767
768 /**
769  * fc_lport_set_port_id() - set the local port Port ID for point-to-multipoint
770  * @lport: The local port which will have its Port ID set.
771  * @port_id: The new port ID.
772  *
773  * Called by the lower-level driver when transport sets the local port_id.
774  * This is used in VN_port to VN_port mode for FCoE, and causes FLOGI and
775  * discovery to be skipped.
776  */
777 void fc_lport_set_local_id(struct fc_lport *lport, u32 port_id)
778 {
779         mutex_lock(&lport->lp_mutex);
780
781         fc_lport_set_port_id(lport, port_id, NULL);
782
783         switch (lport->state) {
784         case LPORT_ST_RESET:
785         case LPORT_ST_FLOGI:
786                 if (port_id)
787                         fc_lport_enter_ready(lport);
788                 break;
789         default:
790                 break;
791         }
792         mutex_unlock(&lport->lp_mutex);
793 }
794 EXPORT_SYMBOL(fc_lport_set_local_id);
795
796 /**
797  * fc_lport_recv_flogi_req() - Receive a FLOGI request
798  * @lport: The local port that received the request
799  * @rx_fp: The FLOGI frame
800  *
801  * A received FLOGI request indicates a point-to-point connection.
802  * Accept it with the common service parameters indicating our N port.
803  * Set up to do a PLOGI if we have the higher-number WWPN.
804  *
805  * Locking Note: The lport lock is expected to be held before calling
806  * this function.
807  */
808 static void fc_lport_recv_flogi_req(struct fc_lport *lport,
809                                     struct fc_frame *rx_fp)
810 {
811         struct fc_frame *fp;
812         struct fc_frame_header *fh;
813         struct fc_els_flogi *flp;
814         struct fc_els_flogi *new_flp;
815         u64 remote_wwpn;
816         u32 remote_fid;
817         u32 local_fid;
818
819         FC_LPORT_DBG(lport, "Received FLOGI request while in state %s\n",
820                      fc_lport_state(lport));
821
822         remote_fid = fc_frame_sid(rx_fp);
823         flp = fc_frame_payload_get(rx_fp, sizeof(*flp));
824         if (!flp)
825                 goto out;
826         remote_wwpn = get_unaligned_be64(&flp->fl_wwpn);
827         if (remote_wwpn == lport->wwpn) {
828                 printk(KERN_WARNING "host%d: libfc: Received FLOGI from port "
829                        "with same WWPN %16.16llx\n",
830                        lport->host->host_no, remote_wwpn);
831                 goto out;
832         }
833         FC_LPORT_DBG(lport, "FLOGI from port WWPN %16.16llx\n", remote_wwpn);
834
835         /*
836          * XXX what is the right thing to do for FIDs?
837          * The originator might expect our S_ID to be 0xfffffe.
838          * But if so, both of us could end up with the same FID.
839          */
840         local_fid = FC_LOCAL_PTP_FID_LO;
841         if (remote_wwpn < lport->wwpn) {
842                 local_fid = FC_LOCAL_PTP_FID_HI;
843                 if (!remote_fid || remote_fid == local_fid)
844                         remote_fid = FC_LOCAL_PTP_FID_LO;
845         } else if (!remote_fid) {
846                 remote_fid = FC_LOCAL_PTP_FID_HI;
847         }
848
849         fc_lport_set_port_id(lport, local_fid, rx_fp);
850
851         fp = fc_frame_alloc(lport, sizeof(*flp));
852         if (fp) {
853                 new_flp = fc_frame_payload_get(fp, sizeof(*flp));
854                 fc_lport_flogi_fill(lport, new_flp, ELS_FLOGI);
855                 new_flp->fl_cmd = (u8) ELS_LS_ACC;
856
857                 /*
858                  * Send the response.  If this fails, the originator should
859                  * repeat the sequence.
860                  */
861                 fc_fill_reply_hdr(fp, rx_fp, FC_RCTL_ELS_REP, 0);
862                 fh = fc_frame_header_get(fp);
863                 hton24(fh->fh_s_id, local_fid);
864                 hton24(fh->fh_d_id, remote_fid);
865                 lport->tt.frame_send(lport, fp);
866
867         } else {
868                 fc_lport_error(lport, fp);
869         }
870         fc_lport_ptp_setup(lport, remote_fid, remote_wwpn,
871                            get_unaligned_be64(&flp->fl_wwnn));
872 out:
873         fc_frame_free(rx_fp);
874 }
875
876 /**
877  * fc_lport_recv_els_req() - The generic lport ELS request handler
878  * @lport: The local port that received the request
879  * @fp:    The request frame
880  *
881  * This function will see if the lport handles the request or
882  * if an rport should handle the request.
883  *
884  * Locking Note: This function should not be called with the lport
885  *               lock held because it will grab the lock.
886  */
887 static void fc_lport_recv_els_req(struct fc_lport *lport,
888                                   struct fc_frame *fp)
889 {
890         mutex_lock(&lport->lp_mutex);
891
892         /*
893          * Handle special ELS cases like FLOGI, LOGO, and
894          * RSCN here.  These don't require a session.
895          * Even if we had a session, it might not be ready.
896          */
897         if (!lport->link_up)
898                 fc_frame_free(fp);
899         else {
900                 /*
901                  * Check opcode.
902                  */
903                 switch (fc_frame_payload_op(fp)) {
904                 case ELS_FLOGI:
905                         if (!lport->point_to_multipoint)
906                                 fc_lport_recv_flogi_req(lport, fp);
907                         else
908                                 fc_rport_recv_req(lport, fp);
909                         break;
910                 case ELS_LOGO:
911                         if (fc_frame_sid(fp) == FC_FID_FLOGI)
912                                 fc_lport_recv_logo_req(lport, fp);
913                         else
914                                 fc_rport_recv_req(lport, fp);
915                         break;
916                 case ELS_RSCN:
917                         lport->tt.disc_recv_req(lport, fp);
918                         break;
919                 case ELS_ECHO:
920                         fc_lport_recv_echo_req(lport, fp);
921                         break;
922                 case ELS_RLIR:
923                         fc_lport_recv_rlir_req(lport, fp);
924                         break;
925                 case ELS_RNID:
926                         fc_lport_recv_rnid_req(lport, fp);
927                         break;
928                 default:
929                         fc_rport_recv_req(lport, fp);
930                         break;
931                 }
932         }
933         mutex_unlock(&lport->lp_mutex);
934 }
935
936 static int fc_lport_els_prli(struct fc_rport_priv *rdata, u32 spp_len,
937                              const struct fc_els_spp *spp_in,
938                              struct fc_els_spp *spp_out)
939 {
940         return FC_SPP_RESP_INVL;
941 }
942
943 struct fc4_prov fc_lport_els_prov = {
944         .prli = fc_lport_els_prli,
945         .recv = fc_lport_recv_els_req,
946 };
947
948 /**
949  * fc_lport_recv() - The generic lport request handler
950  * @lport: The lport that received the request
951  * @fp: The frame the request is in
952  *
953  * Locking Note: This function should not be called with the lport
954  *               lock held because it may grab the lock.
955  */
956 void fc_lport_recv(struct fc_lport *lport, struct fc_frame *fp)
957 {
958         struct fc_frame_header *fh = fc_frame_header_get(fp);
959         struct fc_seq *sp = fr_seq(fp);
960         struct fc4_prov *prov;
961
962         /*
963          * Use RCU read lock and module_lock to be sure module doesn't
964          * deregister and get unloaded while we're calling it.
965          * try_module_get() is inlined and accepts a NULL parameter.
966          * Only ELSes and FCP target ops should come through here.
967          * The locking is unfortunate, and a better scheme is being sought.
968          */
969
970         rcu_read_lock();
971         if (fh->fh_type >= FC_FC4_PROV_SIZE)
972                 goto drop;
973         prov = rcu_dereference(fc_passive_prov[fh->fh_type]);
974         if (!prov || !try_module_get(prov->module))
975                 goto drop;
976         rcu_read_unlock();
977         prov->recv(lport, fp);
978         module_put(prov->module);
979         return;
980 drop:
981         rcu_read_unlock();
982         FC_LPORT_DBG(lport, "dropping unexpected frame type %x\n", fh->fh_type);
983         fc_frame_free(fp);
984         if (sp)
985                 fc_exch_done(sp);
986 }
987 EXPORT_SYMBOL(fc_lport_recv);
988
989 /**
990  * fc_lport_reset() - Reset a local port
991  * @lport: The local port which should be reset
992  *
993  * Locking Note: This functions should not be called with the
994  *               lport lock held.
995  */
996 int fc_lport_reset(struct fc_lport *lport)
997 {
998         cancel_delayed_work_sync(&lport->retry_work);
999         mutex_lock(&lport->lp_mutex);
1000         fc_lport_enter_reset(lport);
1001         mutex_unlock(&lport->lp_mutex);
1002         return 0;
1003 }
1004 EXPORT_SYMBOL(fc_lport_reset);
1005
1006 /**
1007  * fc_lport_reset_locked() - Reset the local port w/ the lport lock held
1008  * @lport: The local port to be reset
1009  *
1010  * Locking Note: The lport lock is expected to be held before calling
1011  * this routine.
1012  */
1013 static void fc_lport_reset_locked(struct fc_lport *lport)
1014 {
1015         if (lport->dns_rdata) {
1016                 fc_rport_logoff(lport->dns_rdata);
1017                 lport->dns_rdata = NULL;
1018         }
1019
1020         if (lport->ptp_rdata) {
1021                 fc_rport_logoff(lport->ptp_rdata);
1022                 kref_put(&lport->ptp_rdata->kref, fc_rport_destroy);
1023                 lport->ptp_rdata = NULL;
1024         }
1025
1026         lport->tt.disc_stop(lport);
1027
1028         lport->tt.exch_mgr_reset(lport, 0, 0);
1029         fc_host_fabric_name(lport->host) = 0;
1030
1031         if (lport->port_id && (!lport->point_to_multipoint || !lport->link_up))
1032                 fc_lport_set_port_id(lport, 0, NULL);
1033 }
1034
1035 /**
1036  * fc_lport_enter_reset() - Reset the local port
1037  * @lport: The local port to be reset
1038  *
1039  * Locking Note: The lport lock is expected to be held before calling
1040  * this routine.
1041  */
1042 static void fc_lport_enter_reset(struct fc_lport *lport)
1043 {
1044         FC_LPORT_DBG(lport, "Entered RESET state from %s state\n",
1045                      fc_lport_state(lport));
1046
1047         if (lport->state == LPORT_ST_DISABLED || lport->state == LPORT_ST_LOGO)
1048                 return;
1049
1050         if (lport->vport) {
1051                 if (lport->link_up)
1052                         fc_vport_set_state(lport->vport, FC_VPORT_INITIALIZING);
1053                 else
1054                         fc_vport_set_state(lport->vport, FC_VPORT_LINKDOWN);
1055         }
1056         fc_lport_state_enter(lport, LPORT_ST_RESET);
1057         fc_host_post_event(lport->host, fc_get_event_number(),
1058                            FCH_EVT_LIPRESET, 0);
1059         fc_vports_linkchange(lport);
1060         fc_lport_reset_locked(lport);
1061         if (lport->link_up)
1062                 fc_lport_enter_flogi(lport);
1063 }
1064
1065 /**
1066  * fc_lport_enter_disabled() - Disable the local port
1067  * @lport: The local port to be reset
1068  *
1069  * Locking Note: The lport lock is expected to be held before calling
1070  * this routine.
1071  */
1072 static void fc_lport_enter_disabled(struct fc_lport *lport)
1073 {
1074         FC_LPORT_DBG(lport, "Entered disabled state from %s state\n",
1075                      fc_lport_state(lport));
1076
1077         fc_lport_state_enter(lport, LPORT_ST_DISABLED);
1078         fc_vports_linkchange(lport);
1079         fc_lport_reset_locked(lport);
1080 }
1081
1082 /**
1083  * fc_lport_error() - Handler for any errors
1084  * @lport: The local port that the error was on
1085  * @fp:    The error code encoded in a frame pointer
1086  *
1087  * If the error was caused by a resource allocation failure
1088  * then wait for half a second and retry, otherwise retry
1089  * after the e_d_tov time.
1090  */
1091 static void fc_lport_error(struct fc_lport *lport, struct fc_frame *fp)
1092 {
1093         unsigned long delay = 0;
1094         FC_LPORT_DBG(lport, "Error %ld in state %s, retries %d\n",
1095                      IS_ERR(fp) ? -PTR_ERR(fp) : 0, fc_lport_state(lport),
1096                      lport->retry_count);
1097
1098         if (PTR_ERR(fp) == -FC_EX_CLOSED)
1099                 return;
1100
1101         /*
1102          * Memory allocation failure, or the exchange timed out
1103          * or we received LS_RJT.
1104          * Retry after delay
1105          */
1106         if (lport->retry_count < lport->max_retry_count) {
1107                 lport->retry_count++;
1108                 if (!fp)
1109                         delay = msecs_to_jiffies(500);
1110                 else
1111                         delay = msecs_to_jiffies(lport->e_d_tov);
1112
1113                 schedule_delayed_work(&lport->retry_work, delay);
1114         } else
1115                 fc_lport_enter_reset(lport);
1116 }
1117
1118 /**
1119  * fc_lport_ns_resp() - Handle response to a name server
1120  *                      registration exchange
1121  * @sp:     current sequence in exchange
1122  * @fp:     response frame
1123  * @lp_arg: Fibre Channel host port instance
1124  *
1125  * Locking Note: This function will be called without the lport lock
1126  * held, but it will lock, call an _enter_* function or fc_lport_error()
1127  * and then unlock the lport.
1128  */
1129 static void fc_lport_ns_resp(struct fc_seq *sp, struct fc_frame *fp,
1130                              void *lp_arg)
1131 {
1132         struct fc_lport *lport = lp_arg;
1133         struct fc_frame_header *fh;
1134         struct fc_ct_hdr *ct;
1135
1136         FC_LPORT_DBG(lport, "Received a ns %s\n", fc_els_resp_type(fp));
1137
1138         if (fp == ERR_PTR(-FC_EX_CLOSED))
1139                 return;
1140
1141         mutex_lock(&lport->lp_mutex);
1142
1143         if (lport->state < LPORT_ST_RNN_ID || lport->state > LPORT_ST_RFF_ID) {
1144                 FC_LPORT_DBG(lport, "Received a name server response, "
1145                              "but in state %s\n", fc_lport_state(lport));
1146                 if (IS_ERR(fp))
1147                         goto err;
1148                 goto out;
1149         }
1150
1151         if (IS_ERR(fp)) {
1152                 fc_lport_error(lport, fp);
1153                 goto err;
1154         }
1155
1156         fh = fc_frame_header_get(fp);
1157         ct = fc_frame_payload_get(fp, sizeof(*ct));
1158
1159         if (fh && ct && fh->fh_type == FC_TYPE_CT &&
1160             ct->ct_fs_type == FC_FST_DIR &&
1161             ct->ct_fs_subtype == FC_NS_SUBTYPE &&
1162             ntohs(ct->ct_cmd) == FC_FS_ACC)
1163                 switch (lport->state) {
1164                 case LPORT_ST_RNN_ID:
1165                         fc_lport_enter_ns(lport, LPORT_ST_RSNN_NN);
1166                         break;
1167                 case LPORT_ST_RSNN_NN:
1168                         fc_lport_enter_ns(lport, LPORT_ST_RSPN_ID);
1169                         break;
1170                 case LPORT_ST_RSPN_ID:
1171                         fc_lport_enter_ns(lport, LPORT_ST_RFT_ID);
1172                         break;
1173                 case LPORT_ST_RFT_ID:
1174                         fc_lport_enter_ns(lport, LPORT_ST_RFF_ID);
1175                         break;
1176                 case LPORT_ST_RFF_ID:
1177                         if (lport->fdmi_enabled)
1178                                 fc_lport_enter_fdmi(lport);
1179                         else
1180                                 fc_lport_enter_scr(lport);
1181                         break;
1182                 default:
1183                         /* should have already been caught by state checks */
1184                         break;
1185                 }
1186         else
1187                 fc_lport_error(lport, fp);
1188 out:
1189         fc_frame_free(fp);
1190 err:
1191         mutex_unlock(&lport->lp_mutex);
1192 }
1193
1194 /**
1195  * fc_lport_ms_resp() - Handle response to a management server
1196  *                      exchange
1197  * @sp:     current sequence in exchange
1198  * @fp:     response frame
1199  * @lp_arg: Fibre Channel host port instance
1200  *
1201  * Locking Note: This function will be called without the lport lock
1202  * held, but it will lock, call an _enter_* function or fc_lport_error()
1203  * and then unlock the lport.
1204  */
1205 static void fc_lport_ms_resp(struct fc_seq *sp, struct fc_frame *fp,
1206                              void *lp_arg)
1207 {
1208         struct fc_lport *lport = lp_arg;
1209         struct fc_frame_header *fh;
1210         struct fc_ct_hdr *ct;
1211
1212         FC_LPORT_DBG(lport, "Received a ms %s\n", fc_els_resp_type(fp));
1213
1214         if (fp == ERR_PTR(-FC_EX_CLOSED))
1215                 return;
1216
1217         mutex_lock(&lport->lp_mutex);
1218
1219         if (lport->state < LPORT_ST_RHBA || lport->state > LPORT_ST_DPRT) {
1220                 FC_LPORT_DBG(lport, "Received a management server response, "
1221                              "but in state %s\n", fc_lport_state(lport));
1222                 if (IS_ERR(fp))
1223                         goto err;
1224                 goto out;
1225         }
1226
1227         if (IS_ERR(fp)) {
1228                 fc_lport_error(lport, fp);
1229                 goto err;
1230         }
1231
1232         fh = fc_frame_header_get(fp);
1233         ct = fc_frame_payload_get(fp, sizeof(*ct));
1234
1235         if (fh && ct && fh->fh_type == FC_TYPE_CT &&
1236             ct->ct_fs_type == FC_FST_MGMT &&
1237             ct->ct_fs_subtype == FC_FDMI_SUBTYPE) {
1238                 FC_LPORT_DBG(lport, "Received a management server response, "
1239                                     "reason=%d explain=%d\n",
1240                                     ct->ct_reason,
1241                                     ct->ct_explan);
1242
1243                 switch (lport->state) {
1244                 case LPORT_ST_RHBA:
1245                         if (ntohs(ct->ct_cmd) == FC_FS_ACC)
1246                                 fc_lport_enter_ms(lport, LPORT_ST_RPA);
1247                         else /* Error Skip RPA */
1248                                 fc_lport_enter_scr(lport);
1249                         break;
1250                 case LPORT_ST_RPA:
1251                         fc_lport_enter_scr(lport);
1252                         break;
1253                 case LPORT_ST_DPRT:
1254                         fc_lport_enter_ms(lport, LPORT_ST_RHBA);
1255                         break;
1256                 case LPORT_ST_DHBA:
1257                         fc_lport_enter_ms(lport, LPORT_ST_DPRT);
1258                         break;
1259                 default:
1260                         /* should have already been caught by state checks */
1261                         break;
1262                 }
1263         } else {
1264                 /* Invalid Frame? */
1265                 fc_lport_error(lport, fp);
1266         }
1267 out:
1268         fc_frame_free(fp);
1269 err:
1270         mutex_unlock(&lport->lp_mutex);
1271 }
1272
1273 /**
1274  * fc_lport_scr_resp() - Handle response to State Change Register (SCR) request
1275  * @sp:     current sequence in SCR exchange
1276  * @fp:     response frame
1277  * @lp_arg: Fibre Channel lport port instance that sent the registration request
1278  *
1279  * Locking Note: This function will be called without the lport lock
1280  * held, but it will lock, call an _enter_* function or fc_lport_error
1281  * and then unlock the lport.
1282  */
1283 static void fc_lport_scr_resp(struct fc_seq *sp, struct fc_frame *fp,
1284                               void *lp_arg)
1285 {
1286         struct fc_lport *lport = lp_arg;
1287         u8 op;
1288
1289         FC_LPORT_DBG(lport, "Received a SCR %s\n", fc_els_resp_type(fp));
1290
1291         if (fp == ERR_PTR(-FC_EX_CLOSED))
1292                 return;
1293
1294         mutex_lock(&lport->lp_mutex);
1295
1296         if (lport->state != LPORT_ST_SCR) {
1297                 FC_LPORT_DBG(lport, "Received a SCR response, but in state "
1298                              "%s\n", fc_lport_state(lport));
1299                 if (IS_ERR(fp))
1300                         goto err;
1301                 goto out;
1302         }
1303
1304         if (IS_ERR(fp)) {
1305                 fc_lport_error(lport, fp);
1306                 goto err;
1307         }
1308
1309         op = fc_frame_payload_op(fp);
1310         if (op == ELS_LS_ACC)
1311                 fc_lport_enter_ready(lport);
1312         else
1313                 fc_lport_error(lport, fp);
1314
1315 out:
1316         fc_frame_free(fp);
1317 err:
1318         mutex_unlock(&lport->lp_mutex);
1319 }
1320
1321 /**
1322  * fc_lport_enter_scr() - Send a SCR (State Change Register) request
1323  * @lport: The local port to register for state changes
1324  *
1325  * Locking Note: The lport lock is expected to be held before calling
1326  * this routine.
1327  */
1328 static void fc_lport_enter_scr(struct fc_lport *lport)
1329 {
1330         struct fc_frame *fp;
1331
1332         FC_LPORT_DBG(lport, "Entered SCR state from %s state\n",
1333                      fc_lport_state(lport));
1334
1335         fc_lport_state_enter(lport, LPORT_ST_SCR);
1336
1337         fp = fc_frame_alloc(lport, sizeof(struct fc_els_scr));
1338         if (!fp) {
1339                 fc_lport_error(lport, fp);
1340                 return;
1341         }
1342
1343         if (!lport->tt.elsct_send(lport, FC_FID_FCTRL, fp, ELS_SCR,
1344                                   fc_lport_scr_resp, lport,
1345                                   2 * lport->r_a_tov))
1346                 fc_lport_error(lport, NULL);
1347 }
1348
1349 /**
1350  * fc_lport_enter_ns() - register some object with the name server
1351  * @lport: Fibre Channel local port to register
1352  *
1353  * Locking Note: The lport lock is expected to be held before calling
1354  * this routine.
1355  */
1356 static void fc_lport_enter_ns(struct fc_lport *lport, enum fc_lport_state state)
1357 {
1358         struct fc_frame *fp;
1359         enum fc_ns_req cmd;
1360         int size = sizeof(struct fc_ct_hdr);
1361         size_t len;
1362
1363         FC_LPORT_DBG(lport, "Entered %s state from %s state\n",
1364                      fc_lport_state_names[state],
1365                      fc_lport_state(lport));
1366
1367         fc_lport_state_enter(lport, state);
1368
1369         switch (state) {
1370         case LPORT_ST_RNN_ID:
1371                 cmd = FC_NS_RNN_ID;
1372                 size += sizeof(struct fc_ns_rn_id);
1373                 break;
1374         case LPORT_ST_RSNN_NN:
1375                 len = strnlen(fc_host_symbolic_name(lport->host), 255);
1376                 /* if there is no symbolic name, skip to RFT_ID */
1377                 if (!len)
1378                         return fc_lport_enter_ns(lport, LPORT_ST_RFT_ID);
1379                 cmd = FC_NS_RSNN_NN;
1380                 size += sizeof(struct fc_ns_rsnn) + len;
1381                 break;
1382         case LPORT_ST_RSPN_ID:
1383                 len = strnlen(fc_host_symbolic_name(lport->host), 255);
1384                 /* if there is no symbolic name, skip to RFT_ID */
1385                 if (!len)
1386                         return fc_lport_enter_ns(lport, LPORT_ST_RFT_ID);
1387                 cmd = FC_NS_RSPN_ID;
1388                 size += sizeof(struct fc_ns_rspn) + len;
1389                 break;
1390         case LPORT_ST_RFT_ID:
1391                 cmd = FC_NS_RFT_ID;
1392                 size += sizeof(struct fc_ns_rft);
1393                 break;
1394         case LPORT_ST_RFF_ID:
1395                 cmd = FC_NS_RFF_ID;
1396                 size += sizeof(struct fc_ns_rff_id);
1397                 break;
1398         default:
1399                 fc_lport_error(lport, NULL);
1400                 return;
1401         }
1402
1403         fp = fc_frame_alloc(lport, size);
1404         if (!fp) {
1405                 fc_lport_error(lport, fp);
1406                 return;
1407         }
1408
1409         if (!lport->tt.elsct_send(lport, FC_FID_DIR_SERV, fp, cmd,
1410                                   fc_lport_ns_resp,
1411                                   lport, 3 * lport->r_a_tov))
1412                 fc_lport_error(lport, fp);
1413 }
1414
1415 static struct fc_rport_operations fc_lport_rport_ops = {
1416         .event_callback = fc_lport_rport_callback,
1417 };
1418
1419 /**
1420  * fc_rport_enter_dns() - Create a fc_rport for the name server
1421  * @lport: The local port requesting a remote port for the name server
1422  *
1423  * Locking Note: The lport lock is expected to be held before calling
1424  * this routine.
1425  */
1426 static void fc_lport_enter_dns(struct fc_lport *lport)
1427 {
1428         struct fc_rport_priv *rdata;
1429
1430         FC_LPORT_DBG(lport, "Entered DNS state from %s state\n",
1431                      fc_lport_state(lport));
1432
1433         fc_lport_state_enter(lport, LPORT_ST_DNS);
1434
1435         mutex_lock(&lport->disc.disc_mutex);
1436         rdata = fc_rport_create(lport, FC_FID_DIR_SERV);
1437         mutex_unlock(&lport->disc.disc_mutex);
1438         if (!rdata)
1439                 goto err;
1440
1441         rdata->ops = &fc_lport_rport_ops;
1442         fc_rport_login(rdata);
1443         return;
1444
1445 err:
1446         fc_lport_error(lport, NULL);
1447 }
1448
1449 /**
1450  * fc_lport_enter_ms() - management server commands
1451  * @lport: Fibre Channel local port to register
1452  *
1453  * Locking Note: The lport lock is expected to be held before calling
1454  * this routine.
1455  */
1456 static void fc_lport_enter_ms(struct fc_lport *lport, enum fc_lport_state state)
1457 {
1458         struct fc_frame *fp;
1459         enum fc_fdmi_req cmd;
1460         int size = sizeof(struct fc_ct_hdr);
1461         size_t len;
1462         int numattrs;
1463
1464         FC_LPORT_DBG(lport, "Entered %s state from %s state\n",
1465                      fc_lport_state_names[state],
1466                      fc_lport_state(lport));
1467
1468         fc_lport_state_enter(lport, state);
1469
1470         switch (state) {
1471         case LPORT_ST_RHBA:
1472                 cmd = FC_FDMI_RHBA;
1473                 /* Number of HBA Attributes */
1474                 numattrs = 10;
1475                 len = sizeof(struct fc_fdmi_rhba);
1476                 len -= sizeof(struct fc_fdmi_attr_entry);
1477                 len += (numattrs * FC_FDMI_ATTR_ENTRY_HEADER_LEN);
1478                 len += FC_FDMI_HBA_ATTR_NODENAME_LEN;
1479                 len += FC_FDMI_HBA_ATTR_MANUFACTURER_LEN;
1480                 len += FC_FDMI_HBA_ATTR_SERIALNUMBER_LEN;
1481                 len += FC_FDMI_HBA_ATTR_MODEL_LEN;
1482                 len += FC_FDMI_HBA_ATTR_MODELDESCR_LEN;
1483                 len += FC_FDMI_HBA_ATTR_HARDWAREVERSION_LEN;
1484                 len += FC_FDMI_HBA_ATTR_DRIVERVERSION_LEN;
1485                 len += FC_FDMI_HBA_ATTR_OPTIONROMVERSION_LEN;
1486                 len += FC_FDMI_HBA_ATTR_FIRMWAREVERSION_LEN;
1487                 len += FC_FDMI_HBA_ATTR_OSNAMEVERSION_LEN;
1488
1489                 size += len;
1490                 break;
1491         case LPORT_ST_RPA:
1492                 cmd = FC_FDMI_RPA;
1493                 /* Number of Port Attributes */
1494                 numattrs = 6;
1495                 len = sizeof(struct fc_fdmi_rpa);
1496                 len -= sizeof(struct fc_fdmi_attr_entry);
1497                 len += (numattrs * FC_FDMI_ATTR_ENTRY_HEADER_LEN);
1498                 len += FC_FDMI_PORT_ATTR_FC4TYPES_LEN;
1499                 len += FC_FDMI_PORT_ATTR_SUPPORTEDSPEED_LEN;
1500                 len += FC_FDMI_PORT_ATTR_CURRENTPORTSPEED_LEN;
1501                 len += FC_FDMI_PORT_ATTR_MAXFRAMESIZE_LEN;
1502                 len += FC_FDMI_PORT_ATTR_OSDEVICENAME_LEN;
1503                 len += FC_FDMI_PORT_ATTR_HOSTNAME_LEN;
1504
1505                 size += len;
1506                 break;
1507         case LPORT_ST_DPRT:
1508                 cmd = FC_FDMI_DPRT;
1509                 len = sizeof(struct fc_fdmi_dprt);
1510                 size += len;
1511                 break;
1512         case LPORT_ST_DHBA:
1513                 cmd = FC_FDMI_DHBA;
1514                 len = sizeof(struct fc_fdmi_dhba);
1515                 size += len;
1516                 break;
1517         default:
1518                 fc_lport_error(lport, NULL);
1519                 return;
1520         }
1521
1522         FC_LPORT_DBG(lport, "Cmd=0x%x Len %d size %d\n",
1523                              cmd, (int)len, size);
1524         fp = fc_frame_alloc(lport, size);
1525         if (!fp) {
1526                 fc_lport_error(lport, fp);
1527                 return;
1528         }
1529
1530         if (!lport->tt.elsct_send(lport, FC_FID_MGMT_SERV, fp, cmd,
1531                                   fc_lport_ms_resp,
1532                                   lport, 3 * lport->r_a_tov))
1533                 fc_lport_error(lport, fp);
1534 }
1535
1536 /**
1537  * fc_rport_enter_fdmi() - Create a fc_rport for the management server
1538  * @lport: The local port requesting a remote port for the management server
1539  *
1540  * Locking Note: The lport lock is expected to be held before calling
1541  * this routine.
1542  */
1543 static void fc_lport_enter_fdmi(struct fc_lport *lport)
1544 {
1545         struct fc_rport_priv *rdata;
1546
1547         FC_LPORT_DBG(lport, "Entered FDMI state from %s state\n",
1548                      fc_lport_state(lport));
1549
1550         fc_lport_state_enter(lport, LPORT_ST_FDMI);
1551
1552         mutex_lock(&lport->disc.disc_mutex);
1553         rdata = fc_rport_create(lport, FC_FID_MGMT_SERV);
1554         mutex_unlock(&lport->disc.disc_mutex);
1555         if (!rdata)
1556                 goto err;
1557
1558         rdata->ops = &fc_lport_rport_ops;
1559         fc_rport_login(rdata);
1560         return;
1561
1562 err:
1563         fc_lport_error(lport, NULL);
1564 }
1565
1566 /**
1567  * fc_lport_timeout() - Handler for the retry_work timer
1568  * @work: The work struct of the local port
1569  */
1570 static void fc_lport_timeout(struct work_struct *work)
1571 {
1572         struct fc_lport *lport =
1573                 container_of(work, struct fc_lport,
1574                              retry_work.work);
1575
1576         mutex_lock(&lport->lp_mutex);
1577
1578         switch (lport->state) {
1579         case LPORT_ST_DISABLED:
1580                 break;
1581         case LPORT_ST_READY:
1582                 break;
1583         case LPORT_ST_RESET:
1584                 break;
1585         case LPORT_ST_FLOGI:
1586                 fc_lport_enter_flogi(lport);
1587                 break;
1588         case LPORT_ST_DNS:
1589                 fc_lport_enter_dns(lport);
1590                 break;
1591         case LPORT_ST_RNN_ID:
1592         case LPORT_ST_RSNN_NN:
1593         case LPORT_ST_RSPN_ID:
1594         case LPORT_ST_RFT_ID:
1595         case LPORT_ST_RFF_ID:
1596                 fc_lport_enter_ns(lport, lport->state);
1597                 break;
1598         case LPORT_ST_FDMI:
1599                 fc_lport_enter_fdmi(lport);
1600                 break;
1601         case LPORT_ST_RHBA:
1602         case LPORT_ST_RPA:
1603         case LPORT_ST_DHBA:
1604         case LPORT_ST_DPRT:
1605                 FC_LPORT_DBG(lport, "Skipping lport state %s to SCR\n",
1606                              fc_lport_state(lport));
1607                 /* fall thru */
1608         case LPORT_ST_SCR:
1609                 fc_lport_enter_scr(lport);
1610                 break;
1611         case LPORT_ST_LOGO:
1612                 fc_lport_enter_logo(lport);
1613                 break;
1614         }
1615
1616         mutex_unlock(&lport->lp_mutex);
1617 }
1618
1619 /**
1620  * fc_lport_logo_resp() - Handle response to LOGO request
1621  * @sp:     The sequence that the LOGO was on
1622  * @fp:     The LOGO frame
1623  * @lp_arg: The lport port that received the LOGO request
1624  *
1625  * Locking Note: This function will be called without the lport lock
1626  * held, but it will lock, call an _enter_* function or fc_lport_error()
1627  * and then unlock the lport.
1628  */
1629 void fc_lport_logo_resp(struct fc_seq *sp, struct fc_frame *fp,
1630                         void *lp_arg)
1631 {
1632         struct fc_lport *lport = lp_arg;
1633         u8 op;
1634
1635         FC_LPORT_DBG(lport, "Received a LOGO %s\n", fc_els_resp_type(fp));
1636
1637         if (fp == ERR_PTR(-FC_EX_CLOSED))
1638                 return;
1639
1640         mutex_lock(&lport->lp_mutex);
1641
1642         if (lport->state != LPORT_ST_LOGO) {
1643                 FC_LPORT_DBG(lport, "Received a LOGO response, but in state "
1644                              "%s\n", fc_lport_state(lport));
1645                 if (IS_ERR(fp))
1646                         goto err;
1647                 goto out;
1648         }
1649
1650         if (IS_ERR(fp)) {
1651                 fc_lport_error(lport, fp);
1652                 goto err;
1653         }
1654
1655         op = fc_frame_payload_op(fp);
1656         if (op == ELS_LS_ACC)
1657                 fc_lport_enter_disabled(lport);
1658         else
1659                 fc_lport_error(lport, fp);
1660
1661 out:
1662         fc_frame_free(fp);
1663 err:
1664         mutex_unlock(&lport->lp_mutex);
1665 }
1666 EXPORT_SYMBOL(fc_lport_logo_resp);
1667
1668 /**
1669  * fc_rport_enter_logo() - Logout of the fabric
1670  * @lport: The local port to be logged out
1671  *
1672  * Locking Note: The lport lock is expected to be held before calling
1673  * this routine.
1674  */
1675 static void fc_lport_enter_logo(struct fc_lport *lport)
1676 {
1677         struct fc_frame *fp;
1678         struct fc_els_logo *logo;
1679
1680         FC_LPORT_DBG(lport, "Entered LOGO state from %s state\n",
1681                      fc_lport_state(lport));
1682
1683         fc_lport_state_enter(lport, LPORT_ST_LOGO);
1684         fc_vports_linkchange(lport);
1685
1686         fp = fc_frame_alloc(lport, sizeof(*logo));
1687         if (!fp) {
1688                 fc_lport_error(lport, fp);
1689                 return;
1690         }
1691
1692         if (!lport->tt.elsct_send(lport, FC_FID_FLOGI, fp, ELS_LOGO,
1693                                   fc_lport_logo_resp, lport,
1694                                   2 * lport->r_a_tov))
1695                 fc_lport_error(lport, NULL);
1696 }
1697
1698 /**
1699  * fc_lport_flogi_resp() - Handle response to FLOGI request
1700  * @sp:     The sequence that the FLOGI was on
1701  * @fp:     The FLOGI response frame
1702  * @lp_arg: The lport port that received the FLOGI response
1703  *
1704  * Locking Note: This function will be called without the lport lock
1705  * held, but it will lock, call an _enter_* function or fc_lport_error()
1706  * and then unlock the lport.
1707  */
1708 void fc_lport_flogi_resp(struct fc_seq *sp, struct fc_frame *fp,
1709                          void *lp_arg)
1710 {
1711         struct fc_lport *lport = lp_arg;
1712         struct fc_frame_header *fh;
1713         struct fc_els_flogi *flp;
1714         u32 did;
1715         u16 csp_flags;
1716         unsigned int r_a_tov;
1717         unsigned int e_d_tov;
1718         u16 mfs;
1719
1720         FC_LPORT_DBG(lport, "Received a FLOGI %s\n", fc_els_resp_type(fp));
1721
1722         if (fp == ERR_PTR(-FC_EX_CLOSED))
1723                 return;
1724
1725         mutex_lock(&lport->lp_mutex);
1726
1727         if (lport->state != LPORT_ST_FLOGI) {
1728                 FC_LPORT_DBG(lport, "Received a FLOGI response, but in state "
1729                              "%s\n", fc_lport_state(lport));
1730                 if (IS_ERR(fp))
1731                         goto err;
1732                 goto out;
1733         }
1734
1735         if (IS_ERR(fp)) {
1736                 fc_lport_error(lport, fp);
1737                 goto err;
1738         }
1739
1740         fh = fc_frame_header_get(fp);
1741         did = fc_frame_did(fp);
1742         if (fh->fh_r_ctl != FC_RCTL_ELS_REP || did == 0 ||
1743             fc_frame_payload_op(fp) != ELS_LS_ACC) {
1744                 FC_LPORT_DBG(lport, "FLOGI not accepted or bad response\n");
1745                 fc_lport_error(lport, fp);
1746                 goto err;
1747         }
1748
1749         flp = fc_frame_payload_get(fp, sizeof(*flp));
1750         if (!flp) {
1751                 FC_LPORT_DBG(lport, "FLOGI bad response\n");
1752                 fc_lport_error(lport, fp);
1753                 goto err;
1754         }
1755
1756         mfs = ntohs(flp->fl_csp.sp_bb_data) &
1757                 FC_SP_BB_DATA_MASK;
1758
1759         if (mfs < FC_SP_MIN_MAX_PAYLOAD || mfs > FC_SP_MAX_MAX_PAYLOAD) {
1760                 FC_LPORT_DBG(lport, "FLOGI bad mfs:%hu response, "
1761                              "lport->mfs:%hu\n", mfs, lport->mfs);
1762                 fc_lport_error(lport, fp);
1763                 goto err;
1764         }
1765
1766         if (mfs <= lport->mfs) {
1767                 lport->mfs = mfs;
1768                 fc_host_maxframe_size(lport->host) = mfs;
1769         }
1770
1771         csp_flags = ntohs(flp->fl_csp.sp_features);
1772         r_a_tov = ntohl(flp->fl_csp.sp_r_a_tov);
1773         e_d_tov = ntohl(flp->fl_csp.sp_e_d_tov);
1774         if (csp_flags & FC_SP_FT_EDTR)
1775                 e_d_tov /= 1000000;
1776
1777         lport->npiv_enabled = !!(csp_flags & FC_SP_FT_NPIV_ACC);
1778
1779         if ((csp_flags & FC_SP_FT_FPORT) == 0) {
1780                 if (e_d_tov > lport->e_d_tov)
1781                         lport->e_d_tov = e_d_tov;
1782                 lport->r_a_tov = 2 * lport->e_d_tov;
1783                 fc_lport_set_port_id(lport, did, fp);
1784                 printk(KERN_INFO "host%d: libfc: "
1785                        "Port (%6.6x) entered "
1786                        "point-to-point mode\n",
1787                        lport->host->host_no, did);
1788                 fc_lport_ptp_setup(lport, fc_frame_sid(fp),
1789                                    get_unaligned_be64(
1790                                            &flp->fl_wwpn),
1791                                    get_unaligned_be64(
1792                                            &flp->fl_wwnn));
1793         } else {
1794                 if (e_d_tov > lport->e_d_tov)
1795                         lport->e_d_tov = e_d_tov;
1796                 if (r_a_tov > lport->r_a_tov)
1797                         lport->r_a_tov = r_a_tov;
1798                 fc_host_fabric_name(lport->host) =
1799                         get_unaligned_be64(&flp->fl_wwnn);
1800                 fc_lport_set_port_id(lport, did, fp);
1801                 fc_lport_enter_dns(lport);
1802         }
1803
1804 out:
1805         fc_frame_free(fp);
1806 err:
1807         mutex_unlock(&lport->lp_mutex);
1808 }
1809 EXPORT_SYMBOL(fc_lport_flogi_resp);
1810
1811 /**
1812  * fc_rport_enter_flogi() - Send a FLOGI request to the fabric manager
1813  * @lport: Fibre Channel local port to be logged in to the fabric
1814  *
1815  * Locking Note: The lport lock is expected to be held before calling
1816  * this routine.
1817  */
1818 static void fc_lport_enter_flogi(struct fc_lport *lport)
1819 {
1820         struct fc_frame *fp;
1821
1822         FC_LPORT_DBG(lport, "Entered FLOGI state from %s state\n",
1823                      fc_lport_state(lport));
1824
1825         fc_lport_state_enter(lport, LPORT_ST_FLOGI);
1826
1827         if (lport->point_to_multipoint) {
1828                 if (lport->port_id)
1829                         fc_lport_enter_ready(lport);
1830                 return;
1831         }
1832
1833         fp = fc_frame_alloc(lport, sizeof(struct fc_els_flogi));
1834         if (!fp)
1835                 return fc_lport_error(lport, fp);
1836
1837         if (!lport->tt.elsct_send(lport, FC_FID_FLOGI, fp,
1838                                   lport->vport ? ELS_FDISC : ELS_FLOGI,
1839                                   fc_lport_flogi_resp, lport,
1840                                   lport->vport ? 2 * lport->r_a_tov :
1841                                   lport->e_d_tov))
1842                 fc_lport_error(lport, NULL);
1843 }
1844
1845 /**
1846  * fc_lport_config() - Configure a fc_lport
1847  * @lport: The local port to be configured
1848  */
1849 int fc_lport_config(struct fc_lport *lport)
1850 {
1851         INIT_DELAYED_WORK(&lport->retry_work, fc_lport_timeout);
1852         mutex_init(&lport->lp_mutex);
1853
1854         fc_lport_state_enter(lport, LPORT_ST_DISABLED);
1855
1856         fc_lport_add_fc4_type(lport, FC_TYPE_FCP);
1857         fc_lport_add_fc4_type(lport, FC_TYPE_CT);
1858         fc_fc4_conf_lport_params(lport, FC_TYPE_FCP);
1859
1860         return 0;
1861 }
1862 EXPORT_SYMBOL(fc_lport_config);
1863
1864 /**
1865  * fc_lport_init() - Initialize the lport layer for a local port
1866  * @lport: The local port to initialize the exchange layer for
1867  */
1868 int fc_lport_init(struct fc_lport *lport)
1869 {
1870         fc_host_port_type(lport->host) = FC_PORTTYPE_NPORT;
1871         fc_host_node_name(lport->host) = lport->wwnn;
1872         fc_host_port_name(lport->host) = lport->wwpn;
1873         fc_host_supported_classes(lport->host) = FC_COS_CLASS3;
1874         memset(fc_host_supported_fc4s(lport->host), 0,
1875                sizeof(fc_host_supported_fc4s(lport->host)));
1876         fc_host_supported_fc4s(lport->host)[2] = 1;
1877         fc_host_supported_fc4s(lport->host)[7] = 1;
1878
1879         /* This value is also unchanging */
1880         memset(fc_host_active_fc4s(lport->host), 0,
1881                sizeof(fc_host_active_fc4s(lport->host)));
1882         fc_host_active_fc4s(lport->host)[2] = 1;
1883         fc_host_active_fc4s(lport->host)[7] = 1;
1884         fc_host_maxframe_size(lport->host) = lport->mfs;
1885         fc_host_supported_speeds(lport->host) = 0;
1886         if (lport->link_supported_speeds & FC_PORTSPEED_1GBIT)
1887                 fc_host_supported_speeds(lport->host) |= FC_PORTSPEED_1GBIT;
1888         if (lport->link_supported_speeds & FC_PORTSPEED_10GBIT)
1889                 fc_host_supported_speeds(lport->host) |= FC_PORTSPEED_10GBIT;
1890         fc_fc4_add_lport(lport);
1891
1892         return 0;
1893 }
1894 EXPORT_SYMBOL(fc_lport_init);
1895
1896 /**
1897  * fc_lport_bsg_resp() - The common response handler for FC Passthrough requests
1898  * @sp:       The sequence for the FC Passthrough response
1899  * @fp:       The response frame
1900  * @info_arg: The BSG info that the response is for
1901  */
1902 static void fc_lport_bsg_resp(struct fc_seq *sp, struct fc_frame *fp,
1903                               void *info_arg)
1904 {
1905         struct fc_bsg_info *info = info_arg;
1906         struct bsg_job *job = info->job;
1907         struct fc_bsg_reply *bsg_reply = job->reply;
1908         struct fc_lport *lport = info->lport;
1909         struct fc_frame_header *fh;
1910         size_t len;
1911         void *buf;
1912
1913         if (IS_ERR(fp)) {
1914                 bsg_reply->result = (PTR_ERR(fp) == -FC_EX_CLOSED) ?
1915                         -ECONNABORTED : -ETIMEDOUT;
1916                 job->reply_len = sizeof(uint32_t);
1917                 bsg_job_done(job, bsg_reply->result,
1918                                bsg_reply->reply_payload_rcv_len);
1919                 kfree(info);
1920                 return;
1921         }
1922
1923         mutex_lock(&lport->lp_mutex);
1924         fh = fc_frame_header_get(fp);
1925         len = fr_len(fp) - sizeof(*fh);
1926         buf = fc_frame_payload_get(fp, 0);
1927
1928         if (fr_sof(fp) == FC_SOF_I3 && !ntohs(fh->fh_seq_cnt)) {
1929                 /* Get the response code from the first frame payload */
1930                 unsigned short cmd = (info->rsp_code == FC_FS_ACC) ?
1931                         ntohs(((struct fc_ct_hdr *)buf)->ct_cmd) :
1932                         (unsigned short)fc_frame_payload_op(fp);
1933
1934                 /* Save the reply status of the job */
1935                 bsg_reply->reply_data.ctels_reply.status =
1936                         (cmd == info->rsp_code) ?
1937                         FC_CTELS_STATUS_OK : FC_CTELS_STATUS_REJECT;
1938         }
1939
1940         bsg_reply->reply_payload_rcv_len +=
1941                 fc_copy_buffer_to_sglist(buf, len, info->sg, &info->nents,
1942                                          &info->offset, NULL);
1943
1944         if (fr_eof(fp) == FC_EOF_T &&
1945             (ntoh24(fh->fh_f_ctl) & (FC_FC_LAST_SEQ | FC_FC_END_SEQ)) ==
1946             (FC_FC_LAST_SEQ | FC_FC_END_SEQ)) {
1947                 if (bsg_reply->reply_payload_rcv_len >
1948                     job->reply_payload.payload_len)
1949                         bsg_reply->reply_payload_rcv_len =
1950                                 job->reply_payload.payload_len;
1951                 bsg_reply->result = 0;
1952                 bsg_job_done(job, bsg_reply->result,
1953                                bsg_reply->reply_payload_rcv_len);
1954                 kfree(info);
1955         }
1956         fc_frame_free(fp);
1957         mutex_unlock(&lport->lp_mutex);
1958 }
1959
1960 /**
1961  * fc_lport_els_request() - Send ELS passthrough request
1962  * @job:   The BSG Passthrough job
1963  * @lport: The local port sending the request
1964  * @did:   The destination port id
1965  *
1966  * Locking Note: The lport lock is expected to be held before calling
1967  * this routine.
1968  */
1969 static int fc_lport_els_request(struct bsg_job *job,
1970                                 struct fc_lport *lport,
1971                                 u32 did, u32 tov)
1972 {
1973         struct fc_bsg_info *info;
1974         struct fc_frame *fp;
1975         struct fc_frame_header *fh;
1976         char *pp;
1977         int len;
1978
1979         fp = fc_frame_alloc(lport, job->request_payload.payload_len);
1980         if (!fp)
1981                 return -ENOMEM;
1982
1983         len = job->request_payload.payload_len;
1984         pp = fc_frame_payload_get(fp, len);
1985
1986         sg_copy_to_buffer(job->request_payload.sg_list,
1987                           job->request_payload.sg_cnt,
1988                           pp, len);
1989
1990         fh = fc_frame_header_get(fp);
1991         fh->fh_r_ctl = FC_RCTL_ELS_REQ;
1992         hton24(fh->fh_d_id, did);
1993         hton24(fh->fh_s_id, lport->port_id);
1994         fh->fh_type = FC_TYPE_ELS;
1995         hton24(fh->fh_f_ctl, FC_FCTL_REQ);
1996         fh->fh_cs_ctl = 0;
1997         fh->fh_df_ctl = 0;
1998         fh->fh_parm_offset = 0;
1999
2000         info = kzalloc(sizeof(struct fc_bsg_info), GFP_KERNEL);
2001         if (!info) {
2002                 fc_frame_free(fp);
2003                 return -ENOMEM;
2004         }
2005
2006         info->job = job;
2007         info->lport = lport;
2008         info->rsp_code = ELS_LS_ACC;
2009         info->nents = job->reply_payload.sg_cnt;
2010         info->sg = job->reply_payload.sg_list;
2011
2012         if (!fc_exch_seq_send(lport, fp, fc_lport_bsg_resp,
2013                               NULL, info, tov)) {
2014                 kfree(info);
2015                 return -ECOMM;
2016         }
2017         return 0;
2018 }
2019
2020 /**
2021  * fc_lport_ct_request() - Send CT Passthrough request
2022  * @job:   The BSG Passthrough job
2023  * @lport: The local port sending the request
2024  * @did:   The destination FC-ID
2025  * @tov:   The timeout period to wait for the response
2026  *
2027  * Locking Note: The lport lock is expected to be held before calling
2028  * this routine.
2029  */
2030 static int fc_lport_ct_request(struct bsg_job *job,
2031                                struct fc_lport *lport, u32 did, u32 tov)
2032 {
2033         struct fc_bsg_info *info;
2034         struct fc_frame *fp;
2035         struct fc_frame_header *fh;
2036         struct fc_ct_req *ct;
2037         size_t len;
2038
2039         fp = fc_frame_alloc(lport, sizeof(struct fc_ct_hdr) +
2040                             job->request_payload.payload_len);
2041         if (!fp)
2042                 return -ENOMEM;
2043
2044         len = job->request_payload.payload_len;
2045         ct = fc_frame_payload_get(fp, len);
2046
2047         sg_copy_to_buffer(job->request_payload.sg_list,
2048                           job->request_payload.sg_cnt,
2049                           ct, len);
2050
2051         fh = fc_frame_header_get(fp);
2052         fh->fh_r_ctl = FC_RCTL_DD_UNSOL_CTL;
2053         hton24(fh->fh_d_id, did);
2054         hton24(fh->fh_s_id, lport->port_id);
2055         fh->fh_type = FC_TYPE_CT;
2056         hton24(fh->fh_f_ctl, FC_FCTL_REQ);
2057         fh->fh_cs_ctl = 0;
2058         fh->fh_df_ctl = 0;
2059         fh->fh_parm_offset = 0;
2060
2061         info = kzalloc(sizeof(struct fc_bsg_info), GFP_KERNEL);
2062         if (!info) {
2063                 fc_frame_free(fp);
2064                 return -ENOMEM;
2065         }
2066
2067         info->job = job;
2068         info->lport = lport;
2069         info->rsp_code = FC_FS_ACC;
2070         info->nents = job->reply_payload.sg_cnt;
2071         info->sg = job->reply_payload.sg_list;
2072
2073         if (!fc_exch_seq_send(lport, fp, fc_lport_bsg_resp,
2074                               NULL, info, tov)) {
2075                 kfree(info);
2076                 return -ECOMM;
2077         }
2078         return 0;
2079 }
2080
2081 /**
2082  * fc_lport_bsg_request() - The common entry point for sending
2083  *                          FC Passthrough requests
2084  * @job: The BSG passthrough job
2085  */
2086 int fc_lport_bsg_request(struct bsg_job *job)
2087 {
2088         struct fc_bsg_request *bsg_request = job->request;
2089         struct fc_bsg_reply *bsg_reply = job->reply;
2090         struct Scsi_Host *shost = fc_bsg_to_shost(job);
2091         struct fc_lport *lport = shost_priv(shost);
2092         struct fc_rport *rport;
2093         struct fc_rport_priv *rdata;
2094         int rc = -EINVAL;
2095         u32 did, tov;
2096
2097         bsg_reply->reply_payload_rcv_len = 0;
2098
2099         mutex_lock(&lport->lp_mutex);
2100
2101         switch (bsg_request->msgcode) {
2102         case FC_BSG_RPT_ELS:
2103                 rport = fc_bsg_to_rport(job);
2104                 if (!rport)
2105                         break;
2106
2107                 rdata = rport->dd_data;
2108                 rc = fc_lport_els_request(job, lport, rport->port_id,
2109                                           rdata->e_d_tov);
2110                 break;
2111
2112         case FC_BSG_RPT_CT:
2113                 rport = fc_bsg_to_rport(job);
2114                 if (!rport)
2115                         break;
2116
2117                 rdata = rport->dd_data;
2118                 rc = fc_lport_ct_request(job, lport, rport->port_id,
2119                                          rdata->e_d_tov);
2120                 break;
2121
2122         case FC_BSG_HST_CT:
2123                 did = ntoh24(bsg_request->rqst_data.h_ct.port_id);
2124                 if (did == FC_FID_DIR_SERV) {
2125                         rdata = lport->dns_rdata;
2126                         if (!rdata)
2127                                 break;
2128                         tov = rdata->e_d_tov;
2129                 } else {
2130                         rdata = fc_rport_lookup(lport, did);
2131                         if (!rdata)
2132                                 break;
2133                         tov = rdata->e_d_tov;
2134                         kref_put(&rdata->kref, fc_rport_destroy);
2135                 }
2136
2137                 rc = fc_lport_ct_request(job, lport, did, tov);
2138                 break;
2139
2140         case FC_BSG_HST_ELS_NOLOGIN:
2141                 did = ntoh24(bsg_request->rqst_data.h_els.port_id);
2142                 rc = fc_lport_els_request(job, lport, did, lport->e_d_tov);
2143                 break;
2144         }
2145
2146         mutex_unlock(&lport->lp_mutex);
2147         return rc;
2148 }
2149 EXPORT_SYMBOL(fc_lport_bsg_request);