Merge git://git.kernel.org/pub/scm/linux/kernel/git/sfrench/cifs-2.6
[pandora-kernel.git] / drivers / scsi / lpfc / lpfc_ct.c
1 /*******************************************************************
2  * This file is part of the Emulex Linux Device Driver for         *
3  * Fibre Channel Host Bus Adapters.                                *
4  * Copyright (C) 2004-2007 Emulex.  All rights reserved.           *
5  * EMULEX and SLI are trademarks of Emulex.                        *
6  * www.emulex.com                                                  *
7  *                                                                 *
8  * This program is free software; you can redistribute it and/or   *
9  * modify it under the terms of version 2 of the GNU General       *
10  * Public License as published by the Free Software Foundation.    *
11  * This program is distributed in the hope that it will be useful. *
12  * ALL EXPRESS OR IMPLIED CONDITIONS, REPRESENTATIONS AND          *
13  * WARRANTIES, INCLUDING ANY IMPLIED WARRANTY OF MERCHANTABILITY,  *
14  * FITNESS FOR A PARTICULAR PURPOSE, OR NON-INFRINGEMENT, ARE      *
15  * DISCLAIMED, EXCEPT TO THE EXTENT THAT SUCH DISCLAIMERS ARE HELD *
16  * TO BE LEGALLY INVALID.  See the GNU General Public License for  *
17  * more details, a copy of which can be found in the file COPYING  *
18  * included with this package.                                     *
19  *******************************************************************/
20
21 /*
22  * Fibre Channel SCSI LAN Device Driver CT support: FC Generic Services FC-GS
23  */
24
25 #include <linux/blkdev.h>
26 #include <linux/pci.h>
27 #include <linux/interrupt.h>
28 #include <linux/utsname.h>
29
30 #include <scsi/scsi.h>
31 #include <scsi/scsi_device.h>
32 #include <scsi/scsi_host.h>
33 #include <scsi/scsi_transport_fc.h>
34
35 #include "lpfc_hw.h"
36 #include "lpfc_sli.h"
37 #include "lpfc_disc.h"
38 #include "lpfc_scsi.h"
39 #include "lpfc.h"
40 #include "lpfc_logmsg.h"
41 #include "lpfc_crtn.h"
42 #include "lpfc_version.h"
43 #include "lpfc_vport.h"
44 #include "lpfc_debugfs.h"
45
46 #define HBA_PORTSPEED_UNKNOWN               0   /* Unknown - transceiver
47                                                  * incapable of reporting */
48 #define HBA_PORTSPEED_1GBIT                 1   /* 1 GBit/sec */
49 #define HBA_PORTSPEED_2GBIT                 2   /* 2 GBit/sec */
50 #define HBA_PORTSPEED_4GBIT                 8   /* 4 GBit/sec */
51 #define HBA_PORTSPEED_8GBIT                16   /* 8 GBit/sec */
52 #define HBA_PORTSPEED_10GBIT                4   /* 10 GBit/sec */
53 #define HBA_PORTSPEED_NOT_NEGOTIATED        5   /* Speed not established */
54
55 #define FOURBYTES       4
56
57
58 static char *lpfc_release_version = LPFC_DRIVER_VERSION;
59
60 static void
61 lpfc_ct_ignore_hbq_buffer(struct lpfc_hba *phba, struct lpfc_iocbq *piocbq,
62                           struct lpfc_dmabuf *mp, uint32_t size)
63 {
64         if (!mp) {
65                 lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
66                                 "0146 Ignoring unsolicted CT No HBQ "
67                                 "status = x%x\n",
68                                 piocbq->iocb.ulpStatus);
69         }
70         lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
71                         "0145 Ignoring unsolicted CT HBQ Size:%d "
72                         "status = x%x\n",
73                         size, piocbq->iocb.ulpStatus);
74 }
75
76 static void
77 lpfc_ct_unsol_buffer(struct lpfc_hba *phba, struct lpfc_iocbq *piocbq,
78                      struct lpfc_dmabuf *mp, uint32_t size)
79 {
80         lpfc_ct_ignore_hbq_buffer(phba, piocbq, mp, size);
81 }
82
83 void
84 lpfc_ct_unsol_event(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
85                     struct lpfc_iocbq *piocbq)
86 {
87
88         struct lpfc_dmabuf *mp = NULL;
89         IOCB_t *icmd = &piocbq->iocb;
90         int i;
91         struct lpfc_iocbq *iocbq;
92         dma_addr_t paddr;
93         uint32_t size;
94         struct list_head head;
95         struct lpfc_dmabuf *bdeBuf;
96
97         if (unlikely(icmd->ulpStatus == IOSTAT_NEED_BUFFER)) {
98                 lpfc_sli_hbqbuf_add_hbqs(phba, LPFC_ELS_HBQ);
99         } else if ((icmd->ulpStatus == IOSTAT_LOCAL_REJECT) &&
100                 ((icmd->un.ulpWord[4] & 0xff) == IOERR_RCV_BUFFER_WAITING)) {
101                 /* Not enough posted buffers; Try posting more buffers */
102                 phba->fc_stat.NoRcvBuf++;
103                 if (!(phba->sli3_options & LPFC_SLI3_HBQ_ENABLED))
104                         lpfc_post_buffer(phba, pring, 2, 1);
105                 return;
106         }
107
108         /* If there are no BDEs associated with this IOCB,
109          * there is nothing to do.
110          */
111         if (icmd->ulpBdeCount == 0)
112                 return;
113
114         if (phba->sli3_options & LPFC_SLI3_HBQ_ENABLED) {
115                 INIT_LIST_HEAD(&head);
116                 list_add_tail(&head, &piocbq->list);
117                 list_for_each_entry(iocbq, &head, list) {
118                         icmd = &iocbq->iocb;
119                         if (icmd->ulpBdeCount == 0)
120                                 continue;
121                         bdeBuf = iocbq->context2;
122                         iocbq->context2 = NULL;
123                         size  = icmd->un.cont64[0].tus.f.bdeSize;
124                         lpfc_ct_unsol_buffer(phba, piocbq, bdeBuf, size);
125                         lpfc_in_buf_free(phba, bdeBuf);
126                         if (icmd->ulpBdeCount == 2) {
127                                 bdeBuf = iocbq->context3;
128                                 iocbq->context3 = NULL;
129                                 size  = icmd->unsli3.rcvsli3.bde2.tus.f.bdeSize;
130                                 lpfc_ct_unsol_buffer(phba, piocbq, bdeBuf,
131                                                      size);
132                                 lpfc_in_buf_free(phba, bdeBuf);
133                         }
134                 }
135                 list_del(&head);
136         } else {
137                 struct lpfc_iocbq  *next;
138
139                 list_for_each_entry_safe(iocbq, next, &piocbq->list, list) {
140                         icmd = &iocbq->iocb;
141                         if (icmd->ulpBdeCount == 0)
142                                 lpfc_ct_unsol_buffer(phba, piocbq, NULL, 0);
143                         for (i = 0; i < icmd->ulpBdeCount; i++) {
144                                 paddr = getPaddr(icmd->un.cont64[i].addrHigh,
145                                                  icmd->un.cont64[i].addrLow);
146                                 mp = lpfc_sli_ringpostbuf_get(phba, pring,
147                                                               paddr);
148                                 size = icmd->un.cont64[i].tus.f.bdeSize;
149                                 lpfc_ct_unsol_buffer(phba, piocbq, mp, size);
150                                 lpfc_in_buf_free(phba, mp);
151                         }
152                         list_del(&iocbq->list);
153                         lpfc_sli_release_iocbq(phba, iocbq);
154                         lpfc_post_buffer(phba, pring, i, 1);
155                 }
156         }
157 }
158
159 static void
160 lpfc_free_ct_rsp(struct lpfc_hba *phba, struct lpfc_dmabuf *mlist)
161 {
162         struct lpfc_dmabuf *mlast, *next_mlast;
163
164         list_for_each_entry_safe(mlast, next_mlast, &mlist->list, list) {
165                 lpfc_mbuf_free(phba, mlast->virt, mlast->phys);
166                 list_del(&mlast->list);
167                 kfree(mlast);
168         }
169         lpfc_mbuf_free(phba, mlist->virt, mlist->phys);
170         kfree(mlist);
171         return;
172 }
173
174 static struct lpfc_dmabuf *
175 lpfc_alloc_ct_rsp(struct lpfc_hba *phba, int cmdcode, struct ulp_bde64 *bpl,
176                   uint32_t size, int *entries)
177 {
178         struct lpfc_dmabuf *mlist = NULL;
179         struct lpfc_dmabuf *mp;
180         int cnt, i = 0;
181
182         /* We get chunks of FCELSSIZE */
183         cnt = size > FCELSSIZE ? FCELSSIZE: size;
184
185         while (size) {
186                 /* Allocate buffer for rsp payload */
187                 mp = kmalloc(sizeof(struct lpfc_dmabuf), GFP_KERNEL);
188                 if (!mp) {
189                         if (mlist)
190                                 lpfc_free_ct_rsp(phba, mlist);
191                         return NULL;
192                 }
193
194                 INIT_LIST_HEAD(&mp->list);
195
196                 if (cmdcode == be16_to_cpu(SLI_CTNS_GID_FT) ||
197                     cmdcode == be16_to_cpu(SLI_CTNS_GFF_ID))
198                         mp->virt = lpfc_mbuf_alloc(phba, MEM_PRI, &(mp->phys));
199                 else
200                         mp->virt = lpfc_mbuf_alloc(phba, 0, &(mp->phys));
201
202                 if (!mp->virt) {
203                         kfree(mp);
204                         if (mlist)
205                                 lpfc_free_ct_rsp(phba, mlist);
206                         return NULL;
207                 }
208
209                 /* Queue it to a linked list */
210                 if (!mlist)
211                         mlist = mp;
212                 else
213                         list_add_tail(&mp->list, &mlist->list);
214
215                 bpl->tus.f.bdeFlags = BUFF_USE_RCV;
216                 /* build buffer ptr list for IOCB */
217                 bpl->addrLow = le32_to_cpu(putPaddrLow(mp->phys) );
218                 bpl->addrHigh = le32_to_cpu(putPaddrHigh(mp->phys) );
219                 bpl->tus.f.bdeSize = (uint16_t) cnt;
220                 bpl->tus.w = le32_to_cpu(bpl->tus.w);
221                 bpl++;
222
223                 i++;
224                 size -= cnt;
225         }
226
227         *entries = i;
228         return mlist;
229 }
230
231 int
232 lpfc_ct_free_iocb(struct lpfc_hba *phba, struct lpfc_iocbq *ctiocb)
233 {
234         struct lpfc_dmabuf *buf_ptr;
235
236         if (ctiocb->context_un.ndlp) {
237                 lpfc_nlp_put(ctiocb->context_un.ndlp);
238                 ctiocb->context_un.ndlp = NULL;
239         }
240         if (ctiocb->context1) {
241                 buf_ptr = (struct lpfc_dmabuf *) ctiocb->context1;
242                 lpfc_mbuf_free(phba, buf_ptr->virt, buf_ptr->phys);
243                 kfree(buf_ptr);
244                 ctiocb->context1 = NULL;
245         }
246         if (ctiocb->context2) {
247                 lpfc_free_ct_rsp(phba, (struct lpfc_dmabuf *) ctiocb->context2);
248                 ctiocb->context2 = NULL;
249         }
250
251         if (ctiocb->context3) {
252                 buf_ptr = (struct lpfc_dmabuf *) ctiocb->context3;
253                 lpfc_mbuf_free(phba, buf_ptr->virt, buf_ptr->phys);
254                 kfree(buf_ptr);
255                 ctiocb->context1 = NULL;
256         }
257         lpfc_sli_release_iocbq(phba, ctiocb);
258         return 0;
259 }
260
261 static int
262 lpfc_gen_req(struct lpfc_vport *vport, struct lpfc_dmabuf *bmp,
263              struct lpfc_dmabuf *inp, struct lpfc_dmabuf *outp,
264              void (*cmpl) (struct lpfc_hba *, struct lpfc_iocbq *,
265                      struct lpfc_iocbq *),
266              struct lpfc_nodelist *ndlp, uint32_t usr_flg, uint32_t num_entry,
267              uint32_t tmo, uint8_t retry)
268 {
269         struct lpfc_hba  *phba = vport->phba;
270         struct lpfc_sli  *psli = &phba->sli;
271         struct lpfc_sli_ring *pring = &psli->ring[LPFC_ELS_RING];
272         IOCB_t *icmd;
273         struct lpfc_iocbq *geniocb;
274         int rc;
275
276         /* Allocate buffer for  command iocb */
277         geniocb = lpfc_sli_get_iocbq(phba);
278
279         if (geniocb == NULL)
280                 return 1;
281
282         icmd = &geniocb->iocb;
283         icmd->un.genreq64.bdl.ulpIoTag32 = 0;
284         icmd->un.genreq64.bdl.addrHigh = putPaddrHigh(bmp->phys);
285         icmd->un.genreq64.bdl.addrLow = putPaddrLow(bmp->phys);
286         icmd->un.genreq64.bdl.bdeFlags = BUFF_TYPE_BDL;
287         icmd->un.genreq64.bdl.bdeSize = (num_entry * sizeof (struct ulp_bde64));
288
289         if (usr_flg)
290                 geniocb->context3 = NULL;
291         else
292                 geniocb->context3 = (uint8_t *) bmp;
293
294         /* Save for completion so we can release these resources */
295         geniocb->context1 = (uint8_t *) inp;
296         geniocb->context2 = (uint8_t *) outp;
297         geniocb->context_un.ndlp = ndlp;
298
299         /* Fill in payload, bp points to frame payload */
300         icmd->ulpCommand = CMD_GEN_REQUEST64_CR;
301
302         /* Fill in rest of iocb */
303         icmd->un.genreq64.w5.hcsw.Fctl = (SI | LA);
304         icmd->un.genreq64.w5.hcsw.Dfctl = 0;
305         icmd->un.genreq64.w5.hcsw.Rctl = FC_UNSOL_CTL;
306         icmd->un.genreq64.w5.hcsw.Type = FC_COMMON_TRANSPORT_ULP;
307
308         if (!tmo) {
309                  /* FC spec states we need 3 * ratov for CT requests */
310                 tmo = (3 * phba->fc_ratov);
311         }
312         icmd->ulpTimeout = tmo;
313         icmd->ulpBdeCount = 1;
314         icmd->ulpLe = 1;
315         icmd->ulpClass = CLASS3;
316         icmd->ulpContext = ndlp->nlp_rpi;
317
318         if (phba->sli3_options & LPFC_SLI3_NPIV_ENABLED) {
319                 /* For GEN_REQUEST64_CR, use the RPI */
320                 icmd->ulpCt_h = 0;
321                 icmd->ulpCt_l = 0;
322         }
323
324         /* Issue GEN REQ IOCB for NPORT <did> */
325         lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,
326                          "0119 Issue GEN REQ IOCB to NPORT x%x "
327                          "Data: x%x x%x\n",
328                          ndlp->nlp_DID, icmd->ulpIoTag,
329                          vport->port_state);
330         geniocb->iocb_cmpl = cmpl;
331         geniocb->drvrTimeout = icmd->ulpTimeout + LPFC_DRVR_TIMEOUT;
332         geniocb->vport = vport;
333         geniocb->retry = retry;
334         rc = lpfc_sli_issue_iocb(phba, pring, geniocb, 0);
335
336         if (rc == IOCB_ERROR) {
337                 lpfc_sli_release_iocbq(phba, geniocb);
338                 return 1;
339         }
340
341         return 0;
342 }
343
344 static int
345 lpfc_ct_cmd(struct lpfc_vport *vport, struct lpfc_dmabuf *inmp,
346             struct lpfc_dmabuf *bmp, struct lpfc_nodelist *ndlp,
347             void (*cmpl) (struct lpfc_hba *, struct lpfc_iocbq *,
348                           struct lpfc_iocbq *),
349             uint32_t rsp_size, uint8_t retry)
350 {
351         struct lpfc_hba  *phba = vport->phba;
352         struct ulp_bde64 *bpl = (struct ulp_bde64 *) bmp->virt;
353         struct lpfc_dmabuf *outmp;
354         int cnt = 0, status;
355         int cmdcode = ((struct lpfc_sli_ct_request *) inmp->virt)->
356                 CommandResponse.bits.CmdRsp;
357
358         bpl++;                  /* Skip past ct request */
359
360         /* Put buffer(s) for ct rsp in bpl */
361         outmp = lpfc_alloc_ct_rsp(phba, cmdcode, bpl, rsp_size, &cnt);
362         if (!outmp)
363                 return -ENOMEM;
364
365         status = lpfc_gen_req(vport, bmp, inmp, outmp, cmpl, ndlp, 0,
366                               cnt+1, 0, retry);
367         if (status) {
368                 lpfc_free_ct_rsp(phba, outmp);
369                 return -ENOMEM;
370         }
371         return 0;
372 }
373
374 struct lpfc_vport *
375 lpfc_find_vport_by_did(struct lpfc_hba *phba, uint32_t did) {
376         struct lpfc_vport *vport_curr;
377         unsigned long flags;
378
379         spin_lock_irqsave(&phba->hbalock, flags);
380         list_for_each_entry(vport_curr, &phba->port_list, listentry) {
381                 if ((vport_curr->fc_myDID) && (vport_curr->fc_myDID == did)) {
382                         spin_unlock_irqrestore(&phba->hbalock, flags);
383                         return vport_curr;
384                 }
385         }
386         spin_unlock_irqrestore(&phba->hbalock, flags);
387         return NULL;
388 }
389
390 static int
391 lpfc_ns_rsp(struct lpfc_vport *vport, struct lpfc_dmabuf *mp, uint32_t Size)
392 {
393         struct lpfc_hba  *phba = vport->phba;
394         struct lpfc_sli_ct_request *Response =
395                 (struct lpfc_sli_ct_request *) mp->virt;
396         struct lpfc_nodelist *ndlp = NULL;
397         struct lpfc_dmabuf *mlast, *next_mp;
398         uint32_t *ctptr = (uint32_t *) & Response->un.gid.PortType;
399         uint32_t Did, CTentry;
400         int Cnt;
401         struct list_head head;
402
403         lpfc_set_disctmo(vport);
404         vport->num_disc_nodes = 0;
405         vport->fc_ns_retry = 0;
406
407
408         list_add_tail(&head, &mp->list);
409         list_for_each_entry_safe(mp, next_mp, &head, list) {
410                 mlast = mp;
411
412                 Cnt = Size  > FCELSSIZE ? FCELSSIZE : Size;
413
414                 Size -= Cnt;
415
416                 if (!ctptr) {
417                         ctptr = (uint32_t *) mlast->virt;
418                 } else
419                         Cnt -= 16;      /* subtract length of CT header */
420
421                 /* Loop through entire NameServer list of DIDs */
422                 while (Cnt >= sizeof (uint32_t)) {
423                         /* Get next DID from NameServer List */
424                         CTentry = *ctptr++;
425                         Did = ((be32_to_cpu(CTentry)) & Mask_DID);
426
427                         ndlp = NULL;
428
429                         /*
430                          * Check for rscn processing or not
431                          * To conserve rpi's, filter out addresses for other
432                          * vports on the same physical HBAs.
433                          */
434                         if ((Did != vport->fc_myDID) &&
435                             ((lpfc_find_vport_by_did(phba, Did) == NULL) ||
436                              vport->cfg_peer_port_login)) {
437                                 if ((vport->port_type != LPFC_NPIV_PORT) ||
438                                     (!(vport->ct_flags & FC_CT_RFF_ID)) ||
439                                     (!vport->cfg_restrict_login)) {
440                                         ndlp = lpfc_setup_disc_node(vport, Did);
441                                         if (ndlp) {
442                                                 lpfc_debugfs_disc_trc(vport,
443                                                 LPFC_DISC_TRC_CT,
444                                                 "Parse GID_FTrsp: "
445                                                 "did:x%x flg:x%x x%x",
446                                                 Did, ndlp->nlp_flag,
447                                                 vport->fc_flag);
448
449                                                 lpfc_printf_vlog(vport,
450                                                         KERN_INFO,
451                                                         LOG_DISCOVERY,
452                                                         "0238 Process "
453                                                         "x%x NameServer Rsp"
454                                                         "Data: x%x x%x x%x\n",
455                                                         Did, ndlp->nlp_flag,
456                                                         vport->fc_flag,
457                                                         vport->fc_rscn_id_cnt);
458                                         } else {
459                                                 lpfc_debugfs_disc_trc(vport,
460                                                 LPFC_DISC_TRC_CT,
461                                                 "Skip1 GID_FTrsp: "
462                                                 "did:x%x flg:x%x cnt:%d",
463                                                 Did, vport->fc_flag,
464                                                 vport->fc_rscn_id_cnt);
465
466                                                 lpfc_printf_vlog(vport,
467                                                         KERN_INFO,
468                                                         LOG_DISCOVERY,
469                                                         "0239 Skip x%x "
470                                                         "NameServer Rsp Data: "
471                                                         "x%x x%x\n",
472                                                         Did, vport->fc_flag,
473                                                         vport->fc_rscn_id_cnt);
474                                         }
475
476                                 } else {
477                                         if (!(vport->fc_flag & FC_RSCN_MODE) ||
478                                         (lpfc_rscn_payload_check(vport, Did))) {
479                                                 lpfc_debugfs_disc_trc(vport,
480                                                 LPFC_DISC_TRC_CT,
481                                                 "Query GID_FTrsp: "
482                                                 "did:x%x flg:x%x cnt:%d",
483                                                 Did, vport->fc_flag,
484                                                 vport->fc_rscn_id_cnt);
485
486                                                 /* This NPortID was previously
487                                                  * a FCP target, * Don't even
488                                                  * bother to send GFF_ID.
489                                                  */
490                                                 ndlp = lpfc_findnode_did(vport,
491                                                         Did);
492                                                 if (ndlp && (ndlp->nlp_type &
493                                                         NLP_FCP_TARGET))
494                                                         lpfc_setup_disc_node
495                                                                 (vport, Did);
496                                                 else if (lpfc_ns_cmd(vport,
497                                                         SLI_CTNS_GFF_ID,
498                                                         0, Did) == 0)
499                                                         vport->num_disc_nodes++;
500                                         }
501                                         else {
502                                                 lpfc_debugfs_disc_trc(vport,
503                                                 LPFC_DISC_TRC_CT,
504                                                 "Skip2 GID_FTrsp: "
505                                                 "did:x%x flg:x%x cnt:%d",
506                                                 Did, vport->fc_flag,
507                                                 vport->fc_rscn_id_cnt);
508
509                                                 lpfc_printf_vlog(vport,
510                                                         KERN_INFO,
511                                                         LOG_DISCOVERY,
512                                                         "0245 Skip x%x "
513                                                         "NameServer Rsp Data: "
514                                                         "x%x x%x\n",
515                                                         Did, vport->fc_flag,
516                                                         vport->fc_rscn_id_cnt);
517                                         }
518                                 }
519                         }
520                         if (CTentry & (be32_to_cpu(SLI_CT_LAST_ENTRY)))
521                                 goto nsout1;
522                         Cnt -= sizeof (uint32_t);
523                 }
524                 ctptr = NULL;
525
526         }
527
528 nsout1:
529         list_del(&head);
530         return 0;
531 }
532
533 static void
534 lpfc_cmpl_ct_cmd_gid_ft(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
535                         struct lpfc_iocbq *rspiocb)
536 {
537         struct lpfc_vport *vport = cmdiocb->vport;
538         struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
539         IOCB_t *irsp;
540         struct lpfc_dmabuf *bmp;
541         struct lpfc_dmabuf *outp;
542         struct lpfc_sli_ct_request *CTrsp;
543         struct lpfc_nodelist *ndlp;
544         int rc, retry;
545
546         /* First save ndlp, before we overwrite it */
547         ndlp = cmdiocb->context_un.ndlp;
548
549         /* we pass cmdiocb to state machine which needs rspiocb as well */
550         cmdiocb->context_un.rsp_iocb = rspiocb;
551
552         outp = (struct lpfc_dmabuf *) cmdiocb->context2;
553         bmp = (struct lpfc_dmabuf *) cmdiocb->context3;
554         irsp = &rspiocb->iocb;
555
556         lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_CT,
557                  "GID_FT cmpl:     status:x%x/x%x rtry:%d",
558                 irsp->ulpStatus, irsp->un.ulpWord[4], vport->fc_ns_retry);
559
560         /* Don't bother processing response if vport is being torn down. */
561         if (vport->load_flag & FC_UNLOADING)
562                 goto out;
563
564         if (lpfc_els_chk_latt(vport) || lpfc_error_lost_link(irsp)) {
565                 lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
566                                  "0216 Link event during NS query\n");
567                 lpfc_vport_set_state(vport, FC_VPORT_FAILED);
568                 goto out;
569         }
570
571         if (irsp->ulpStatus) {
572                 /* Check for retry */
573                 if (vport->fc_ns_retry < LPFC_MAX_NS_RETRY) {
574                         retry = 1;
575                         if (irsp->ulpStatus == IOSTAT_LOCAL_REJECT) {
576                                 switch (irsp->un.ulpWord[4]) {
577                                 case IOERR_NO_RESOURCES:
578                                         /* We don't increment the retry
579                                          * count for this case.
580                                          */
581                                         break;
582                                 case IOERR_LINK_DOWN:
583                                 case IOERR_SLI_ABORTED:
584                                 case IOERR_SLI_DOWN:
585                                         retry = 0;
586                                         break;
587                                 default:
588                                         vport->fc_ns_retry++;
589                                 }
590                         }
591                         else
592                                 vport->fc_ns_retry++;
593
594                         if (retry) {
595                                 /* CT command is being retried */
596                                 rc = lpfc_ns_cmd(vport, SLI_CTNS_GID_FT,
597                                          vport->fc_ns_retry, 0);
598                                 if (rc == 0) {
599                                         /* success */
600                                         goto out;
601                                 }
602                         }
603                 }
604                 lpfc_vport_set_state(vport, FC_VPORT_FAILED);
605                 lpfc_printf_vlog(vport, KERN_ERR, LOG_ELS,
606                                  "0257 GID_FT Query error: 0x%x 0x%x\n",
607                                  irsp->ulpStatus, vport->fc_ns_retry);
608         } else {
609                 /* Good status, continue checking */
610                 CTrsp = (struct lpfc_sli_ct_request *) outp->virt;
611                 if (CTrsp->CommandResponse.bits.CmdRsp ==
612                     be16_to_cpu(SLI_CT_RESPONSE_FS_ACC)) {
613                         lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
614                                          "0208 NameServer Rsp Data: x%x\n",
615                                          vport->fc_flag);
616                         lpfc_ns_rsp(vport, outp,
617                                     (uint32_t) (irsp->un.genreq64.bdl.bdeSize));
618                 } else if (CTrsp->CommandResponse.bits.CmdRsp ==
619                            be16_to_cpu(SLI_CT_RESPONSE_FS_RJT)) {
620                         /* NameServer Rsp Error */
621                         if ((CTrsp->ReasonCode == SLI_CT_UNABLE_TO_PERFORM_REQ)
622                             && (CTrsp->Explanation == SLI_CT_NO_FC4_TYPES)) {
623                                 lpfc_printf_vlog(vport, KERN_INFO,
624                                         LOG_DISCOVERY,
625                                         "0269 No NameServer Entries "
626                                         "Data: x%x x%x x%x x%x\n",
627                                         CTrsp->CommandResponse.bits.CmdRsp,
628                                         (uint32_t) CTrsp->ReasonCode,
629                                         (uint32_t) CTrsp->Explanation,
630                                         vport->fc_flag);
631
632                                 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_CT,
633                                 "GID_FT no entry  cmd:x%x rsn:x%x exp:x%x",
634                                 (uint32_t)CTrsp->CommandResponse.bits.CmdRsp,
635                                 (uint32_t) CTrsp->ReasonCode,
636                                 (uint32_t) CTrsp->Explanation);
637                         } else {
638                                 lpfc_printf_vlog(vport, KERN_INFO,
639                                         LOG_DISCOVERY,
640                                         "0240 NameServer Rsp Error "
641                                         "Data: x%x x%x x%x x%x\n",
642                                         CTrsp->CommandResponse.bits.CmdRsp,
643                                         (uint32_t) CTrsp->ReasonCode,
644                                         (uint32_t) CTrsp->Explanation,
645                                         vport->fc_flag);
646
647                                 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_CT,
648                                 "GID_FT rsp err1  cmd:x%x rsn:x%x exp:x%x",
649                                 (uint32_t)CTrsp->CommandResponse.bits.CmdRsp,
650                                 (uint32_t) CTrsp->ReasonCode,
651                                 (uint32_t) CTrsp->Explanation);
652                         }
653
654
655                 } else {
656                         /* NameServer Rsp Error */
657                         lpfc_printf_vlog(vport, KERN_ERR, LOG_DISCOVERY,
658                                         "0241 NameServer Rsp Error "
659                                         "Data: x%x x%x x%x x%x\n",
660                                         CTrsp->CommandResponse.bits.CmdRsp,
661                                         (uint32_t) CTrsp->ReasonCode,
662                                         (uint32_t) CTrsp->Explanation,
663                                         vport->fc_flag);
664
665                         lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_CT,
666                                 "GID_FT rsp err2  cmd:x%x rsn:x%x exp:x%x",
667                                 (uint32_t)CTrsp->CommandResponse.bits.CmdRsp,
668                                 (uint32_t) CTrsp->ReasonCode,
669                                 (uint32_t) CTrsp->Explanation);
670                 }
671         }
672         /* Link up / RSCN discovery */
673         if (vport->num_disc_nodes == 0) {
674                 /*
675                  * The driver has cycled through all Nports in the RSCN payload.
676                  * Complete the handling by cleaning up and marking the
677                  * current driver state.
678                  */
679                 if (vport->port_state >= LPFC_DISC_AUTH) {
680                         if (vport->fc_flag & FC_RSCN_MODE) {
681                                 lpfc_els_flush_rscn(vport);
682                                 spin_lock_irq(shost->host_lock);
683                                 vport->fc_flag |= FC_RSCN_MODE; /* RSCN still */
684                                 spin_unlock_irq(shost->host_lock);
685                         }
686                         else
687                                 lpfc_els_flush_rscn(vport);
688                 }
689
690                 lpfc_disc_start(vport);
691         }
692 out:
693         cmdiocb->context_un.ndlp = ndlp; /* Now restore ndlp for free */
694         lpfc_ct_free_iocb(phba, cmdiocb);
695         return;
696 }
697
698 static void
699 lpfc_cmpl_ct_cmd_gff_id(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
700                         struct lpfc_iocbq *rspiocb)
701 {
702         struct lpfc_vport *vport = cmdiocb->vport;
703         struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
704         IOCB_t *irsp = &rspiocb->iocb;
705         struct lpfc_dmabuf *inp = (struct lpfc_dmabuf *) cmdiocb->context1;
706         struct lpfc_dmabuf *outp = (struct lpfc_dmabuf *) cmdiocb->context2;
707         struct lpfc_sli_ct_request *CTrsp;
708         int did, rc, retry;
709         uint8_t fbits;
710         struct lpfc_nodelist *ndlp;
711
712         did = ((struct lpfc_sli_ct_request *) inp->virt)->un.gff.PortId;
713         did = be32_to_cpu(did);
714
715         lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_CT,
716                 "GFF_ID cmpl:     status:x%x/x%x did:x%x",
717                 irsp->ulpStatus, irsp->un.ulpWord[4], did);
718
719         if (irsp->ulpStatus == IOSTAT_SUCCESS) {
720                 /* Good status, continue checking */
721                 CTrsp = (struct lpfc_sli_ct_request *) outp->virt;
722                 fbits = CTrsp->un.gff_acc.fbits[FCP_TYPE_FEATURE_OFFSET];
723
724                 if (CTrsp->CommandResponse.bits.CmdRsp ==
725                     be16_to_cpu(SLI_CT_RESPONSE_FS_ACC)) {
726                         if ((fbits & FC4_FEATURE_INIT) &&
727                             !(fbits & FC4_FEATURE_TARGET)) {
728                                 lpfc_printf_vlog(vport, KERN_INFO,
729                                                  LOG_DISCOVERY,
730                                                  "0270 Skip x%x GFF "
731                                                  "NameServer Rsp Data: (init) "
732                                                  "x%x x%x\n", did, fbits,
733                                                  vport->fc_rscn_id_cnt);
734                                 goto out;
735                         }
736                 }
737         }
738         else {
739                 /* Check for retry */
740                 if (cmdiocb->retry < LPFC_MAX_NS_RETRY) {
741                         retry = 1;
742                         if (irsp->ulpStatus == IOSTAT_LOCAL_REJECT) {
743                                 switch (irsp->un.ulpWord[4]) {
744                                 case IOERR_NO_RESOURCES:
745                                         /* We don't increment the retry
746                                          * count for this case.
747                                          */
748                                         break;
749                                 case IOERR_LINK_DOWN:
750                                 case IOERR_SLI_ABORTED:
751                                 case IOERR_SLI_DOWN:
752                                         retry = 0;
753                                         break;
754                                 default:
755                                         cmdiocb->retry++;
756                                 }
757                         }
758                         else
759                                 cmdiocb->retry++;
760
761                         if (retry) {
762                                 /* CT command is being retried */
763                                 rc = lpfc_ns_cmd(vport, SLI_CTNS_GFF_ID,
764                                          cmdiocb->retry, did);
765                                 if (rc == 0) {
766                                         /* success */
767                                         lpfc_ct_free_iocb(phba, cmdiocb);
768                                         return;
769                                 }
770                         }
771                 }
772                 lpfc_printf_vlog(vport, KERN_ERR, LOG_DISCOVERY,
773                                  "0267 NameServer GFF Rsp "
774                                  "x%x Error (%d %d) Data: x%x x%x\n",
775                                  did, irsp->ulpStatus, irsp->un.ulpWord[4],
776                                  vport->fc_flag, vport->fc_rscn_id_cnt)
777         }
778
779         /* This is a target port, unregistered port, or the GFF_ID failed */
780         ndlp = lpfc_setup_disc_node(vport, did);
781         if (ndlp) {
782                 lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
783                                  "0242 Process x%x GFF "
784                                  "NameServer Rsp Data: x%x x%x x%x\n",
785                                  did, ndlp->nlp_flag, vport->fc_flag,
786                                  vport->fc_rscn_id_cnt);
787         } else {
788                 lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
789                                  "0243 Skip x%x GFF "
790                                  "NameServer Rsp Data: x%x x%x\n", did,
791                                  vport->fc_flag, vport->fc_rscn_id_cnt);
792         }
793 out:
794         /* Link up / RSCN discovery */
795         if (vport->num_disc_nodes)
796                 vport->num_disc_nodes--;
797         if (vport->num_disc_nodes == 0) {
798                 /*
799                  * The driver has cycled through all Nports in the RSCN payload.
800                  * Complete the handling by cleaning up and marking the
801                  * current driver state.
802                  */
803                 if (vport->port_state >= LPFC_DISC_AUTH) {
804                         if (vport->fc_flag & FC_RSCN_MODE) {
805                                 lpfc_els_flush_rscn(vport);
806                                 spin_lock_irq(shost->host_lock);
807                                 vport->fc_flag |= FC_RSCN_MODE; /* RSCN still */
808                                 spin_unlock_irq(shost->host_lock);
809                         }
810                         else
811                                 lpfc_els_flush_rscn(vport);
812                 }
813                 lpfc_disc_start(vport);
814         }
815         lpfc_ct_free_iocb(phba, cmdiocb);
816         return;
817 }
818
819
820 static void
821 lpfc_cmpl_ct(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
822              struct lpfc_iocbq *rspiocb)
823 {
824         struct lpfc_vport *vport = cmdiocb->vport;
825         struct lpfc_dmabuf *inp;
826         struct lpfc_dmabuf *outp;
827         IOCB_t *irsp;
828         struct lpfc_sli_ct_request *CTrsp;
829         struct lpfc_nodelist *ndlp;
830         int cmdcode, rc;
831         uint8_t retry;
832         uint32_t latt;
833
834         /* First save ndlp, before we overwrite it */
835         ndlp = cmdiocb->context_un.ndlp;
836
837         /* we pass cmdiocb to state machine which needs rspiocb as well */
838         cmdiocb->context_un.rsp_iocb = rspiocb;
839
840         inp = (struct lpfc_dmabuf *) cmdiocb->context1;
841         outp = (struct lpfc_dmabuf *) cmdiocb->context2;
842         irsp = &rspiocb->iocb;
843
844         cmdcode = be16_to_cpu(((struct lpfc_sli_ct_request *) inp->virt)->
845                                         CommandResponse.bits.CmdRsp);
846         CTrsp = (struct lpfc_sli_ct_request *) outp->virt;
847
848         latt = lpfc_els_chk_latt(vport);
849
850         /* RFT request completes status <ulpStatus> CmdRsp <CmdRsp> */
851         lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
852                          "0209 CT Request completes, latt %d, "
853                          "ulpStatus x%x CmdRsp x%x, Context x%x, Tag x%x\n",
854                          latt, irsp->ulpStatus,
855                          CTrsp->CommandResponse.bits.CmdRsp,
856                          cmdiocb->iocb.ulpContext, cmdiocb->iocb.ulpIoTag);
857
858         lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_CT,
859                 "CT cmd cmpl:     status:x%x/x%x cmd:x%x",
860                 irsp->ulpStatus, irsp->un.ulpWord[4], cmdcode);
861
862         if (irsp->ulpStatus) {
863                 lpfc_printf_vlog(vport, KERN_ERR, LOG_DISCOVERY,
864                                  "0268 NS cmd %x Error (%d %d)\n",
865                                  cmdcode, irsp->ulpStatus, irsp->un.ulpWord[4]);
866
867                 if ((irsp->ulpStatus == IOSTAT_LOCAL_REJECT) &&
868                         ((irsp->un.ulpWord[4] == IOERR_SLI_DOWN) ||
869                          (irsp->un.ulpWord[4] == IOERR_SLI_ABORTED)))
870                         goto out;
871
872                 retry = cmdiocb->retry;
873                 if (retry >= LPFC_MAX_NS_RETRY)
874                         goto out;
875
876                 retry++;
877                 lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
878                                  "0216 Retrying NS cmd %x\n", cmdcode);
879                 rc = lpfc_ns_cmd(vport, cmdcode, retry, 0);
880                 if (rc == 0)
881                         goto out;
882         }
883
884 out:
885         cmdiocb->context_un.ndlp = ndlp; /* Now restore ndlp for free */
886         lpfc_ct_free_iocb(phba, cmdiocb);
887         return;
888 }
889
890 static void
891 lpfc_cmpl_ct_cmd_rft_id(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
892                         struct lpfc_iocbq *rspiocb)
893 {
894         IOCB_t *irsp = &rspiocb->iocb;
895         struct lpfc_vport *vport = cmdiocb->vport;
896
897         if (irsp->ulpStatus == IOSTAT_SUCCESS) {
898                 struct lpfc_dmabuf *outp;
899                 struct lpfc_sli_ct_request *CTrsp;
900
901                 outp = (struct lpfc_dmabuf *) cmdiocb->context2;
902                 CTrsp = (struct lpfc_sli_ct_request *) outp->virt;
903                 if (CTrsp->CommandResponse.bits.CmdRsp ==
904                     be16_to_cpu(SLI_CT_RESPONSE_FS_ACC))
905                         vport->ct_flags |= FC_CT_RFT_ID;
906         }
907         lpfc_cmpl_ct(phba, cmdiocb, rspiocb);
908         return;
909 }
910
911 static void
912 lpfc_cmpl_ct_cmd_rnn_id(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
913                         struct lpfc_iocbq *rspiocb)
914 {
915         IOCB_t *irsp = &rspiocb->iocb;
916         struct lpfc_vport *vport = cmdiocb->vport;
917
918         if (irsp->ulpStatus == IOSTAT_SUCCESS) {
919                 struct lpfc_dmabuf *outp;
920                 struct lpfc_sli_ct_request *CTrsp;
921
922                 outp = (struct lpfc_dmabuf *) cmdiocb->context2;
923                 CTrsp = (struct lpfc_sli_ct_request *) outp->virt;
924                 if (CTrsp->CommandResponse.bits.CmdRsp ==
925                     be16_to_cpu(SLI_CT_RESPONSE_FS_ACC))
926                         vport->ct_flags |= FC_CT_RNN_ID;
927         }
928         lpfc_cmpl_ct(phba, cmdiocb, rspiocb);
929         return;
930 }
931
932 static void
933 lpfc_cmpl_ct_cmd_rspn_id(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
934                          struct lpfc_iocbq *rspiocb)
935 {
936         IOCB_t *irsp = &rspiocb->iocb;
937         struct lpfc_vport *vport = cmdiocb->vport;
938
939         if (irsp->ulpStatus == IOSTAT_SUCCESS) {
940                 struct lpfc_dmabuf *outp;
941                 struct lpfc_sli_ct_request *CTrsp;
942
943                 outp = (struct lpfc_dmabuf *) cmdiocb->context2;
944                 CTrsp = (struct lpfc_sli_ct_request *) outp->virt;
945                 if (CTrsp->CommandResponse.bits.CmdRsp ==
946                     be16_to_cpu(SLI_CT_RESPONSE_FS_ACC))
947                         vport->ct_flags |= FC_CT_RSPN_ID;
948         }
949         lpfc_cmpl_ct(phba, cmdiocb, rspiocb);
950         return;
951 }
952
953 static void
954 lpfc_cmpl_ct_cmd_rsnn_nn(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
955                          struct lpfc_iocbq *rspiocb)
956 {
957         IOCB_t *irsp = &rspiocb->iocb;
958         struct lpfc_vport *vport = cmdiocb->vport;
959
960         if (irsp->ulpStatus == IOSTAT_SUCCESS) {
961                 struct lpfc_dmabuf *outp;
962                 struct lpfc_sli_ct_request *CTrsp;
963
964                 outp = (struct lpfc_dmabuf *) cmdiocb->context2;
965                 CTrsp = (struct lpfc_sli_ct_request *) outp->virt;
966                 if (CTrsp->CommandResponse.bits.CmdRsp ==
967                     be16_to_cpu(SLI_CT_RESPONSE_FS_ACC))
968                         vport->ct_flags |= FC_CT_RSNN_NN;
969         }
970         lpfc_cmpl_ct(phba, cmdiocb, rspiocb);
971         return;
972 }
973
974 static void
975 lpfc_cmpl_ct_cmd_da_id(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
976  struct lpfc_iocbq *rspiocb)
977 {
978         struct lpfc_vport *vport = cmdiocb->vport;
979
980         /* even if it fails we will act as though it succeeded. */
981         vport->ct_flags = 0;
982         lpfc_cmpl_ct(phba, cmdiocb, rspiocb);
983         return;
984 }
985
986 static void
987 lpfc_cmpl_ct_cmd_rff_id(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
988                         struct lpfc_iocbq *rspiocb)
989 {
990         IOCB_t *irsp = &rspiocb->iocb;
991         struct lpfc_vport *vport = cmdiocb->vport;
992
993         if (irsp->ulpStatus == IOSTAT_SUCCESS) {
994                 struct lpfc_dmabuf *outp;
995                 struct lpfc_sli_ct_request *CTrsp;
996
997                 outp = (struct lpfc_dmabuf *) cmdiocb->context2;
998                 CTrsp = (struct lpfc_sli_ct_request *) outp->virt;
999                 if (CTrsp->CommandResponse.bits.CmdRsp ==
1000                     be16_to_cpu(SLI_CT_RESPONSE_FS_ACC))
1001                         vport->ct_flags |= FC_CT_RFF_ID;
1002         }
1003         lpfc_cmpl_ct(phba, cmdiocb, rspiocb);
1004         return;
1005 }
1006
1007 static int
1008 lpfc_vport_symbolic_port_name(struct lpfc_vport *vport, char *symbol,
1009         size_t size)
1010 {
1011         int n;
1012         uint8_t *wwn = vport->phba->wwpn;
1013
1014         n = snprintf(symbol, size,
1015                      "Emulex PPN-%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x",
1016                      wwn[0], wwn[1], wwn[2], wwn[3],
1017                      wwn[4], wwn[5], wwn[6], wwn[7]);
1018
1019         if (vport->port_type == LPFC_PHYSICAL_PORT)
1020                 return n;
1021
1022         if (n < size)
1023                 n += snprintf(symbol + n, size - n, " VPort-%d", vport->vpi);
1024
1025         if (n < size && vport->vname)
1026                 n += snprintf(symbol + n, size - n, " VName-%s", vport->vname);
1027         return n;
1028 }
1029
1030 int
1031 lpfc_vport_symbolic_node_name(struct lpfc_vport *vport, char *symbol,
1032         size_t size)
1033 {
1034         char fwrev[16];
1035         int n;
1036
1037         lpfc_decode_firmware_rev(vport->phba, fwrev, 0);
1038
1039         n = snprintf(symbol, size, "Emulex %s FV%s DV%s",
1040                 vport->phba->ModelName, fwrev, lpfc_release_version);
1041         return n;
1042 }
1043
1044 /*
1045  * lpfc_ns_cmd
1046  * Description:
1047  *    Issue Cmd to NameServer
1048  *       SLI_CTNS_GID_FT
1049  *       LI_CTNS_RFT_ID
1050  */
1051 int
1052 lpfc_ns_cmd(struct lpfc_vport *vport, int cmdcode,
1053             uint8_t retry, uint32_t context)
1054 {
1055         struct lpfc_nodelist * ndlp;
1056         struct lpfc_hba *phba = vport->phba;
1057         struct lpfc_dmabuf *mp, *bmp;
1058         struct lpfc_sli_ct_request *CtReq;
1059         struct ulp_bde64 *bpl;
1060         void (*cmpl) (struct lpfc_hba *, struct lpfc_iocbq *,
1061                       struct lpfc_iocbq *) = NULL;
1062         uint32_t rsp_size = 1024;
1063         size_t   size;
1064         int rc = 0;
1065
1066         ndlp = lpfc_findnode_did(vport, NameServer_DID);
1067         if (ndlp == NULL || ndlp->nlp_state != NLP_STE_UNMAPPED_NODE) {
1068                 rc=1;
1069                 goto ns_cmd_exit;
1070         }
1071
1072         /* fill in BDEs for command */
1073         /* Allocate buffer for command payload */
1074         mp = kmalloc(sizeof (struct lpfc_dmabuf), GFP_KERNEL);
1075         if (!mp) {
1076                 rc=2;
1077                 goto ns_cmd_exit;
1078         }
1079
1080         INIT_LIST_HEAD(&mp->list);
1081         mp->virt = lpfc_mbuf_alloc(phba, MEM_PRI, &(mp->phys));
1082         if (!mp->virt) {
1083                 rc=3;
1084                 goto ns_cmd_free_mp;
1085         }
1086
1087         /* Allocate buffer for Buffer ptr list */
1088         bmp = kmalloc(sizeof (struct lpfc_dmabuf), GFP_KERNEL);
1089         if (!bmp) {
1090                 rc=4;
1091                 goto ns_cmd_free_mpvirt;
1092         }
1093
1094         INIT_LIST_HEAD(&bmp->list);
1095         bmp->virt = lpfc_mbuf_alloc(phba, MEM_PRI, &(bmp->phys));
1096         if (!bmp->virt) {
1097                 rc=5;
1098                 goto ns_cmd_free_bmp;
1099         }
1100
1101         /* NameServer Req */
1102         lpfc_printf_vlog(vport, KERN_INFO ,LOG_DISCOVERY,
1103                          "0236 NameServer Req Data: x%x x%x x%x\n",
1104                          cmdcode, vport->fc_flag, vport->fc_rscn_id_cnt);
1105
1106         bpl = (struct ulp_bde64 *) bmp->virt;
1107         memset(bpl, 0, sizeof(struct ulp_bde64));
1108         bpl->addrHigh = le32_to_cpu(putPaddrHigh(mp->phys) );
1109         bpl->addrLow = le32_to_cpu(putPaddrLow(mp->phys) );
1110         bpl->tus.f.bdeFlags = 0;
1111         if (cmdcode == SLI_CTNS_GID_FT)
1112                 bpl->tus.f.bdeSize = GID_REQUEST_SZ;
1113         else if (cmdcode == SLI_CTNS_GFF_ID)
1114                 bpl->tus.f.bdeSize = GFF_REQUEST_SZ;
1115         else if (cmdcode == SLI_CTNS_RFT_ID)
1116                 bpl->tus.f.bdeSize = RFT_REQUEST_SZ;
1117         else if (cmdcode == SLI_CTNS_RNN_ID)
1118                 bpl->tus.f.bdeSize = RNN_REQUEST_SZ;
1119         else if (cmdcode == SLI_CTNS_RSPN_ID)
1120                 bpl->tus.f.bdeSize = RSPN_REQUEST_SZ;
1121         else if (cmdcode == SLI_CTNS_RSNN_NN)
1122                 bpl->tus.f.bdeSize = RSNN_REQUEST_SZ;
1123         else if (cmdcode == SLI_CTNS_DA_ID)
1124                 bpl->tus.f.bdeSize = DA_ID_REQUEST_SZ;
1125         else if (cmdcode == SLI_CTNS_RFF_ID)
1126                 bpl->tus.f.bdeSize = RFF_REQUEST_SZ;
1127         else
1128                 bpl->tus.f.bdeSize = 0;
1129         bpl->tus.w = le32_to_cpu(bpl->tus.w);
1130
1131         CtReq = (struct lpfc_sli_ct_request *) mp->virt;
1132         memset(CtReq, 0, sizeof (struct lpfc_sli_ct_request));
1133         CtReq->RevisionId.bits.Revision = SLI_CT_REVISION;
1134         CtReq->RevisionId.bits.InId = 0;
1135         CtReq->FsType = SLI_CT_DIRECTORY_SERVICE;
1136         CtReq->FsSubType = SLI_CT_DIRECTORY_NAME_SERVER;
1137         CtReq->CommandResponse.bits.Size = 0;
1138         switch (cmdcode) {
1139         case SLI_CTNS_GID_FT:
1140                 CtReq->CommandResponse.bits.CmdRsp =
1141                     be16_to_cpu(SLI_CTNS_GID_FT);
1142                 CtReq->un.gid.Fc4Type = SLI_CTPT_FCP;
1143                 if (vport->port_state < LPFC_NS_QRY)
1144                         vport->port_state = LPFC_NS_QRY;
1145                 lpfc_set_disctmo(vport);
1146                 cmpl = lpfc_cmpl_ct_cmd_gid_ft;
1147                 rsp_size = FC_MAX_NS_RSP;
1148                 break;
1149
1150         case SLI_CTNS_GFF_ID:
1151                 CtReq->CommandResponse.bits.CmdRsp =
1152                         be16_to_cpu(SLI_CTNS_GFF_ID);
1153                 CtReq->un.gff.PortId = cpu_to_be32(context);
1154                 cmpl = lpfc_cmpl_ct_cmd_gff_id;
1155                 break;
1156
1157         case SLI_CTNS_RFT_ID:
1158                 vport->ct_flags &= ~FC_CT_RFT_ID;
1159                 CtReq->CommandResponse.bits.CmdRsp =
1160                     be16_to_cpu(SLI_CTNS_RFT_ID);
1161                 CtReq->un.rft.PortId = cpu_to_be32(vport->fc_myDID);
1162                 CtReq->un.rft.fcpReg = 1;
1163                 cmpl = lpfc_cmpl_ct_cmd_rft_id;
1164                 break;
1165
1166         case SLI_CTNS_RNN_ID:
1167                 vport->ct_flags &= ~FC_CT_RNN_ID;
1168                 CtReq->CommandResponse.bits.CmdRsp =
1169                     be16_to_cpu(SLI_CTNS_RNN_ID);
1170                 CtReq->un.rnn.PortId = cpu_to_be32(vport->fc_myDID);
1171                 memcpy(CtReq->un.rnn.wwnn,  &vport->fc_nodename,
1172                        sizeof (struct lpfc_name));
1173                 cmpl = lpfc_cmpl_ct_cmd_rnn_id;
1174                 break;
1175
1176         case SLI_CTNS_RSPN_ID:
1177                 vport->ct_flags &= ~FC_CT_RSPN_ID;
1178                 CtReq->CommandResponse.bits.CmdRsp =
1179                     be16_to_cpu(SLI_CTNS_RSPN_ID);
1180                 CtReq->un.rspn.PortId = cpu_to_be32(vport->fc_myDID);
1181                 size = sizeof(CtReq->un.rspn.symbname);
1182                 CtReq->un.rspn.len =
1183                         lpfc_vport_symbolic_port_name(vport,
1184                         CtReq->un.rspn.symbname, size);
1185                 cmpl = lpfc_cmpl_ct_cmd_rspn_id;
1186                 break;
1187         case SLI_CTNS_RSNN_NN:
1188                 vport->ct_flags &= ~FC_CT_RSNN_NN;
1189                 CtReq->CommandResponse.bits.CmdRsp =
1190                     be16_to_cpu(SLI_CTNS_RSNN_NN);
1191                 memcpy(CtReq->un.rsnn.wwnn, &vport->fc_nodename,
1192                        sizeof (struct lpfc_name));
1193                 size = sizeof(CtReq->un.rsnn.symbname);
1194                 CtReq->un.rsnn.len =
1195                         lpfc_vport_symbolic_node_name(vport,
1196                         CtReq->un.rsnn.symbname, size);
1197                 cmpl = lpfc_cmpl_ct_cmd_rsnn_nn;
1198                 break;
1199         case SLI_CTNS_DA_ID:
1200                 /* Implement DA_ID Nameserver request */
1201                 CtReq->CommandResponse.bits.CmdRsp =
1202                         be16_to_cpu(SLI_CTNS_DA_ID);
1203                 CtReq->un.da_id.port_id = cpu_to_be32(vport->fc_myDID);
1204                 cmpl = lpfc_cmpl_ct_cmd_da_id;
1205                 break;
1206         case SLI_CTNS_RFF_ID:
1207                 vport->ct_flags &= ~FC_CT_RFF_ID;
1208                 CtReq->CommandResponse.bits.CmdRsp =
1209                     be16_to_cpu(SLI_CTNS_RFF_ID);
1210                 CtReq->un.rff.PortId = cpu_to_be32(vport->fc_myDID);;
1211                 CtReq->un.rff.fbits = FC4_FEATURE_INIT;
1212                 CtReq->un.rff.type_code = FC_FCP_DATA;
1213                 cmpl = lpfc_cmpl_ct_cmd_rff_id;
1214                 break;
1215         }
1216         lpfc_nlp_get(ndlp);
1217
1218         if (!lpfc_ct_cmd(vport, mp, bmp, ndlp, cmpl, rsp_size, retry)) {
1219                 /* On success, The cmpl function will free the buffers */
1220                 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_CT,
1221                         "Issue CT cmd:    cmd:x%x did:x%x",
1222                         cmdcode, ndlp->nlp_DID, 0);
1223                 return 0;
1224         }
1225
1226         rc=6;
1227         lpfc_nlp_put(ndlp);
1228         lpfc_mbuf_free(phba, bmp->virt, bmp->phys);
1229 ns_cmd_free_bmp:
1230         kfree(bmp);
1231 ns_cmd_free_mpvirt:
1232         lpfc_mbuf_free(phba, mp->virt, mp->phys);
1233 ns_cmd_free_mp:
1234         kfree(mp);
1235 ns_cmd_exit:
1236         lpfc_printf_vlog(vport, KERN_ERR, LOG_DISCOVERY,
1237                          "0266 Issue NameServer Req x%x err %d Data: x%x x%x\n",
1238                          cmdcode, rc, vport->fc_flag, vport->fc_rscn_id_cnt);
1239         return 1;
1240 }
1241
1242 static void
1243 lpfc_cmpl_ct_cmd_fdmi(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
1244                       struct lpfc_iocbq * rspiocb)
1245 {
1246         struct lpfc_dmabuf *inp = cmdiocb->context1;
1247         struct lpfc_dmabuf *outp = cmdiocb->context2;
1248         struct lpfc_sli_ct_request *CTrsp = outp->virt;
1249         struct lpfc_sli_ct_request *CTcmd = inp->virt;
1250         struct lpfc_nodelist *ndlp;
1251         uint16_t fdmi_cmd = CTcmd->CommandResponse.bits.CmdRsp;
1252         uint16_t fdmi_rsp = CTrsp->CommandResponse.bits.CmdRsp;
1253         struct lpfc_vport *vport = cmdiocb->vport;
1254         IOCB_t *irsp = &rspiocb->iocb;
1255         uint32_t latt;
1256
1257         latt = lpfc_els_chk_latt(vport);
1258
1259         lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_CT,
1260                 "FDMI cmpl:       status:x%x/x%x latt:%d",
1261                 irsp->ulpStatus, irsp->un.ulpWord[4], latt);
1262
1263         if (latt || irsp->ulpStatus) {
1264                 lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
1265                                  "0229 FDMI cmd %04x failed, latt = %d "
1266                                  "ulpStatus: x%x, rid x%x\n",
1267                                  be16_to_cpu(fdmi_cmd), latt, irsp->ulpStatus,
1268                                  irsp->un.ulpWord[4]);
1269                 lpfc_ct_free_iocb(phba, cmdiocb);
1270                 return;
1271         }
1272
1273         ndlp = lpfc_findnode_did(vport, FDMI_DID);
1274         if (fdmi_rsp == be16_to_cpu(SLI_CT_RESPONSE_FS_RJT)) {
1275                 /* FDMI rsp failed */
1276                 lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
1277                                  "0220 FDMI rsp failed Data: x%x\n",
1278                                  be16_to_cpu(fdmi_cmd));
1279         }
1280
1281         switch (be16_to_cpu(fdmi_cmd)) {
1282         case SLI_MGMT_RHBA:
1283                 lpfc_fdmi_cmd(vport, ndlp, SLI_MGMT_RPA);
1284                 break;
1285
1286         case SLI_MGMT_RPA:
1287                 break;
1288
1289         case SLI_MGMT_DHBA:
1290                 lpfc_fdmi_cmd(vport, ndlp, SLI_MGMT_DPRT);
1291                 break;
1292
1293         case SLI_MGMT_DPRT:
1294                 lpfc_fdmi_cmd(vport, ndlp, SLI_MGMT_RHBA);
1295                 break;
1296         }
1297         lpfc_ct_free_iocb(phba, cmdiocb);
1298         return;
1299 }
1300
1301 int
1302 lpfc_fdmi_cmd(struct lpfc_vport *vport, struct lpfc_nodelist *ndlp, int cmdcode)
1303 {
1304         struct lpfc_hba *phba = vport->phba;
1305         struct lpfc_dmabuf *mp, *bmp;
1306         struct lpfc_sli_ct_request *CtReq;
1307         struct ulp_bde64 *bpl;
1308         uint32_t size;
1309         REG_HBA *rh;
1310         PORT_ENTRY *pe;
1311         REG_PORT_ATTRIBUTE *pab;
1312         ATTRIBUTE_BLOCK *ab;
1313         ATTRIBUTE_ENTRY *ae;
1314         void (*cmpl) (struct lpfc_hba *, struct lpfc_iocbq *,
1315                       struct lpfc_iocbq *);
1316
1317
1318         /* fill in BDEs for command */
1319         /* Allocate buffer for command payload */
1320         mp = kmalloc(sizeof (struct lpfc_dmabuf), GFP_KERNEL);
1321         if (!mp)
1322                 goto fdmi_cmd_exit;
1323
1324         mp->virt = lpfc_mbuf_alloc(phba, 0, &(mp->phys));
1325         if (!mp->virt)
1326                 goto fdmi_cmd_free_mp;
1327
1328         /* Allocate buffer for Buffer ptr list */
1329         bmp = kmalloc(sizeof (struct lpfc_dmabuf), GFP_KERNEL);
1330         if (!bmp)
1331                 goto fdmi_cmd_free_mpvirt;
1332
1333         bmp->virt = lpfc_mbuf_alloc(phba, 0, &(bmp->phys));
1334         if (!bmp->virt)
1335                 goto fdmi_cmd_free_bmp;
1336
1337         INIT_LIST_HEAD(&mp->list);
1338         INIT_LIST_HEAD(&bmp->list);
1339
1340         /* FDMI request */
1341         lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
1342                          "0218 FDMI Request Data: x%x x%x x%x\n",
1343                          vport->fc_flag, vport->port_state, cmdcode);
1344         CtReq = (struct lpfc_sli_ct_request *) mp->virt;
1345
1346         memset(CtReq, 0, sizeof(struct lpfc_sli_ct_request));
1347         CtReq->RevisionId.bits.Revision = SLI_CT_REVISION;
1348         CtReq->RevisionId.bits.InId = 0;
1349
1350         CtReq->FsType = SLI_CT_MANAGEMENT_SERVICE;
1351         CtReq->FsSubType = SLI_CT_FDMI_Subtypes;
1352         size = 0;
1353
1354         switch (cmdcode) {
1355         case SLI_MGMT_RHBA:
1356                 {
1357                         lpfc_vpd_t *vp = &phba->vpd;
1358                         uint32_t i, j, incr;
1359                         int len;
1360
1361                         CtReq->CommandResponse.bits.CmdRsp =
1362                             be16_to_cpu(SLI_MGMT_RHBA);
1363                         CtReq->CommandResponse.bits.Size = 0;
1364                         rh = (REG_HBA *) & CtReq->un.PortID;
1365                         memcpy(&rh->hi.PortName, &vport->fc_sparam.portName,
1366                                sizeof (struct lpfc_name));
1367                         /* One entry (port) per adapter */
1368                         rh->rpl.EntryCnt = be32_to_cpu(1);
1369                         memcpy(&rh->rpl.pe, &vport->fc_sparam.portName,
1370                                sizeof (struct lpfc_name));
1371
1372                         /* point to the HBA attribute block */
1373                         size = 2 * sizeof (struct lpfc_name) + FOURBYTES;
1374                         ab = (ATTRIBUTE_BLOCK *) ((uint8_t *) rh + size);
1375                         ab->EntryCnt = 0;
1376
1377                         /* Point to the beginning of the first HBA attribute
1378                            entry */
1379                         /* #1 HBA attribute entry */
1380                         size += FOURBYTES;
1381                         ae = (ATTRIBUTE_ENTRY *) ((uint8_t *) rh + size);
1382                         ae->ad.bits.AttrType = be16_to_cpu(NODE_NAME);
1383                         ae->ad.bits.AttrLen =  be16_to_cpu(FOURBYTES
1384                                                 + sizeof (struct lpfc_name));
1385                         memcpy(&ae->un.NodeName, &vport->fc_sparam.nodeName,
1386                                sizeof (struct lpfc_name));
1387                         ab->EntryCnt++;
1388                         size += FOURBYTES + sizeof (struct lpfc_name);
1389
1390                         /* #2 HBA attribute entry */
1391                         ae = (ATTRIBUTE_ENTRY *) ((uint8_t *) rh + size);
1392                         ae->ad.bits.AttrType = be16_to_cpu(MANUFACTURER);
1393                         strcpy(ae->un.Manufacturer, "Emulex Corporation");
1394                         len = strlen(ae->un.Manufacturer);
1395                         len += (len & 3) ? (4 - (len & 3)) : 4;
1396                         ae->ad.bits.AttrLen = be16_to_cpu(FOURBYTES + len);
1397                         ab->EntryCnt++;
1398                         size += FOURBYTES + len;
1399
1400                         /* #3 HBA attribute entry */
1401                         ae = (ATTRIBUTE_ENTRY *) ((uint8_t *) rh + size);
1402                         ae->ad.bits.AttrType = be16_to_cpu(SERIAL_NUMBER);
1403                         strcpy(ae->un.SerialNumber, phba->SerialNumber);
1404                         len = strlen(ae->un.SerialNumber);
1405                         len += (len & 3) ? (4 - (len & 3)) : 4;
1406                         ae->ad.bits.AttrLen = be16_to_cpu(FOURBYTES + len);
1407                         ab->EntryCnt++;
1408                         size += FOURBYTES + len;
1409
1410                         /* #4 HBA attribute entry */
1411                         ae = (ATTRIBUTE_ENTRY *) ((uint8_t *) rh + size);
1412                         ae->ad.bits.AttrType = be16_to_cpu(MODEL);
1413                         strcpy(ae->un.Model, phba->ModelName);
1414                         len = strlen(ae->un.Model);
1415                         len += (len & 3) ? (4 - (len & 3)) : 4;
1416                         ae->ad.bits.AttrLen = be16_to_cpu(FOURBYTES + len);
1417                         ab->EntryCnt++;
1418                         size += FOURBYTES + len;
1419
1420                         /* #5 HBA attribute entry */
1421                         ae = (ATTRIBUTE_ENTRY *) ((uint8_t *) rh + size);
1422                         ae->ad.bits.AttrType = be16_to_cpu(MODEL_DESCRIPTION);
1423                         strcpy(ae->un.ModelDescription, phba->ModelDesc);
1424                         len = strlen(ae->un.ModelDescription);
1425                         len += (len & 3) ? (4 - (len & 3)) : 4;
1426                         ae->ad.bits.AttrLen = be16_to_cpu(FOURBYTES + len);
1427                         ab->EntryCnt++;
1428                         size += FOURBYTES + len;
1429
1430                         /* #6 HBA attribute entry */
1431                         ae = (ATTRIBUTE_ENTRY *) ((uint8_t *) rh + size);
1432                         ae->ad.bits.AttrType = be16_to_cpu(HARDWARE_VERSION);
1433                         ae->ad.bits.AttrLen = be16_to_cpu(FOURBYTES + 8);
1434                         /* Convert JEDEC ID to ascii for hardware version */
1435                         incr = vp->rev.biuRev;
1436                         for (i = 0; i < 8; i++) {
1437                                 j = (incr & 0xf);
1438                                 if (j <= 9)
1439                                         ae->un.HardwareVersion[7 - i] =
1440                                             (char)((uint8_t) 0x30 +
1441                                                    (uint8_t) j);
1442                                 else
1443                                         ae->un.HardwareVersion[7 - i] =
1444                                             (char)((uint8_t) 0x61 +
1445                                                    (uint8_t) (j - 10));
1446                                 incr = (incr >> 4);
1447                         }
1448                         ab->EntryCnt++;
1449                         size += FOURBYTES + 8;
1450
1451                         /* #7 HBA attribute entry */
1452                         ae = (ATTRIBUTE_ENTRY *) ((uint8_t *) rh + size);
1453                         ae->ad.bits.AttrType = be16_to_cpu(DRIVER_VERSION);
1454                         strcpy(ae->un.DriverVersion, lpfc_release_version);
1455                         len = strlen(ae->un.DriverVersion);
1456                         len += (len & 3) ? (4 - (len & 3)) : 4;
1457                         ae->ad.bits.AttrLen = be16_to_cpu(FOURBYTES + len);
1458                         ab->EntryCnt++;
1459                         size += FOURBYTES + len;
1460
1461                         /* #8 HBA attribute entry */
1462                         ae = (ATTRIBUTE_ENTRY *) ((uint8_t *) rh + size);
1463                         ae->ad.bits.AttrType = be16_to_cpu(OPTION_ROM_VERSION);
1464                         strcpy(ae->un.OptionROMVersion, phba->OptionROMVersion);
1465                         len = strlen(ae->un.OptionROMVersion);
1466                         len += (len & 3) ? (4 - (len & 3)) : 4;
1467                         ae->ad.bits.AttrLen = be16_to_cpu(FOURBYTES + len);
1468                         ab->EntryCnt++;
1469                         size += FOURBYTES + len;
1470
1471                         /* #9 HBA attribute entry */
1472                         ae = (ATTRIBUTE_ENTRY *) ((uint8_t *) rh + size);
1473                         ae->ad.bits.AttrType = be16_to_cpu(FIRMWARE_VERSION);
1474                         lpfc_decode_firmware_rev(phba, ae->un.FirmwareVersion,
1475                                 1);
1476                         len = strlen(ae->un.FirmwareVersion);
1477                         len += (len & 3) ? (4 - (len & 3)) : 4;
1478                         ae->ad.bits.AttrLen = be16_to_cpu(FOURBYTES + len);
1479                         ab->EntryCnt++;
1480                         size += FOURBYTES + len;
1481
1482                         /* #10 HBA attribute entry */
1483                         ae = (ATTRIBUTE_ENTRY *) ((uint8_t *) rh + size);
1484                         ae->ad.bits.AttrType = be16_to_cpu(OS_NAME_VERSION);
1485                         sprintf(ae->un.OsNameVersion, "%s %s %s",
1486                                 init_utsname()->sysname,
1487                                 init_utsname()->release,
1488                                 init_utsname()->version);
1489                         len = strlen(ae->un.OsNameVersion);
1490                         len += (len & 3) ? (4 - (len & 3)) : 4;
1491                         ae->ad.bits.AttrLen = be16_to_cpu(FOURBYTES + len);
1492                         ab->EntryCnt++;
1493                         size += FOURBYTES + len;
1494
1495                         /* #11 HBA attribute entry */
1496                         ae = (ATTRIBUTE_ENTRY *) ((uint8_t *) rh + size);
1497                         ae->ad.bits.AttrType = be16_to_cpu(MAX_CT_PAYLOAD_LEN);
1498                         ae->ad.bits.AttrLen = be16_to_cpu(FOURBYTES + 4);
1499                         ae->un.MaxCTPayloadLen = (65 * 4096);
1500                         ab->EntryCnt++;
1501                         size += FOURBYTES + 4;
1502
1503                         ab->EntryCnt = be32_to_cpu(ab->EntryCnt);
1504                         /* Total size */
1505                         size = GID_REQUEST_SZ - 4 + size;
1506                 }
1507                 break;
1508
1509         case SLI_MGMT_RPA:
1510                 {
1511                         lpfc_vpd_t *vp;
1512                         struct serv_parm *hsp;
1513                         int len;
1514
1515                         vp = &phba->vpd;
1516
1517                         CtReq->CommandResponse.bits.CmdRsp =
1518                             be16_to_cpu(SLI_MGMT_RPA);
1519                         CtReq->CommandResponse.bits.Size = 0;
1520                         pab = (REG_PORT_ATTRIBUTE *) & CtReq->un.PortID;
1521                         size = sizeof (struct lpfc_name) + FOURBYTES;
1522                         memcpy((uint8_t *) & pab->PortName,
1523                                (uint8_t *) & vport->fc_sparam.portName,
1524                                sizeof (struct lpfc_name));
1525                         pab->ab.EntryCnt = 0;
1526
1527                         /* #1 Port attribute entry */
1528                         ae = (ATTRIBUTE_ENTRY *) ((uint8_t *) pab + size);
1529                         ae->ad.bits.AttrType = be16_to_cpu(SUPPORTED_FC4_TYPES);
1530                         ae->ad.bits.AttrLen = be16_to_cpu(FOURBYTES + 32);
1531                         ae->un.SupportFC4Types[2] = 1;
1532                         ae->un.SupportFC4Types[7] = 1;
1533                         pab->ab.EntryCnt++;
1534                         size += FOURBYTES + 32;
1535
1536                         /* #2 Port attribute entry */
1537                         ae = (ATTRIBUTE_ENTRY *) ((uint8_t *) pab + size);
1538                         ae->ad.bits.AttrType = be16_to_cpu(SUPPORTED_SPEED);
1539                         ae->ad.bits.AttrLen = be16_to_cpu(FOURBYTES + 4);
1540
1541                         ae->un.SupportSpeed = 0;
1542                         if (phba->lmt & LMT_10Gb)
1543                                 ae->un.SupportSpeed = HBA_PORTSPEED_10GBIT;
1544                         if (phba->lmt & LMT_8Gb)
1545                                 ae->un.SupportSpeed |= HBA_PORTSPEED_8GBIT;
1546                         if (phba->lmt & LMT_4Gb)
1547                                 ae->un.SupportSpeed |= HBA_PORTSPEED_4GBIT;
1548                         if (phba->lmt & LMT_2Gb)
1549                                 ae->un.SupportSpeed |= HBA_PORTSPEED_2GBIT;
1550                         if (phba->lmt & LMT_1Gb)
1551                                 ae->un.SupportSpeed |= HBA_PORTSPEED_1GBIT;
1552
1553                         pab->ab.EntryCnt++;
1554                         size += FOURBYTES + 4;
1555
1556                         /* #3 Port attribute entry */
1557                         ae = (ATTRIBUTE_ENTRY *) ((uint8_t *) pab + size);
1558                         ae->ad.bits.AttrType = be16_to_cpu(PORT_SPEED);
1559                         ae->ad.bits.AttrLen = be16_to_cpu(FOURBYTES + 4);
1560                         switch(phba->fc_linkspeed) {
1561                                 case LA_1GHZ_LINK:
1562                                         ae->un.PortSpeed = HBA_PORTSPEED_1GBIT;
1563                                 break;
1564                                 case LA_2GHZ_LINK:
1565                                         ae->un.PortSpeed = HBA_PORTSPEED_2GBIT;
1566                                 break;
1567                                 case LA_4GHZ_LINK:
1568                                         ae->un.PortSpeed = HBA_PORTSPEED_4GBIT;
1569                                 break;
1570                                 case LA_8GHZ_LINK:
1571                                         ae->un.PortSpeed = HBA_PORTSPEED_8GBIT;
1572                                 break;
1573                                 default:
1574                                         ae->un.PortSpeed =
1575                                                 HBA_PORTSPEED_UNKNOWN;
1576                                 break;
1577                         }
1578                         pab->ab.EntryCnt++;
1579                         size += FOURBYTES + 4;
1580
1581                         /* #4 Port attribute entry */
1582                         ae = (ATTRIBUTE_ENTRY *) ((uint8_t *) pab + size);
1583                         ae->ad.bits.AttrType = be16_to_cpu(MAX_FRAME_SIZE);
1584                         ae->ad.bits.AttrLen = be16_to_cpu(FOURBYTES + 4);
1585                         hsp = (struct serv_parm *) & vport->fc_sparam;
1586                         ae->un.MaxFrameSize =
1587                             (((uint32_t) hsp->cmn.
1588                               bbRcvSizeMsb) << 8) | (uint32_t) hsp->cmn.
1589                             bbRcvSizeLsb;
1590                         pab->ab.EntryCnt++;
1591                         size += FOURBYTES + 4;
1592
1593                         /* #5 Port attribute entry */
1594                         ae = (ATTRIBUTE_ENTRY *) ((uint8_t *) pab + size);
1595                         ae->ad.bits.AttrType = be16_to_cpu(OS_DEVICE_NAME);
1596                         strcpy((char *)ae->un.OsDeviceName, LPFC_DRIVER_NAME);
1597                         len = strlen((char *)ae->un.OsDeviceName);
1598                         len += (len & 3) ? (4 - (len & 3)) : 4;
1599                         ae->ad.bits.AttrLen = be16_to_cpu(FOURBYTES + len);
1600                         pab->ab.EntryCnt++;
1601                         size += FOURBYTES + len;
1602
1603                         if (vport->cfg_fdmi_on == 2) {
1604                                 /* #6 Port attribute entry */
1605                                 ae = (ATTRIBUTE_ENTRY *) ((uint8_t *) pab +
1606                                                           size);
1607                                 ae->ad.bits.AttrType = be16_to_cpu(HOST_NAME);
1608                                 sprintf(ae->un.HostName, "%s",
1609                                         init_utsname()->nodename);
1610                                 len = strlen(ae->un.HostName);
1611                                 len += (len & 3) ? (4 - (len & 3)) : 4;
1612                                 ae->ad.bits.AttrLen =
1613                                     be16_to_cpu(FOURBYTES + len);
1614                                 pab->ab.EntryCnt++;
1615                                 size += FOURBYTES + len;
1616                         }
1617
1618                         pab->ab.EntryCnt = be32_to_cpu(pab->ab.EntryCnt);
1619                         /* Total size */
1620                         size = GID_REQUEST_SZ - 4 + size;
1621                 }
1622                 break;
1623
1624         case SLI_MGMT_DHBA:
1625                 CtReq->CommandResponse.bits.CmdRsp = be16_to_cpu(SLI_MGMT_DHBA);
1626                 CtReq->CommandResponse.bits.Size = 0;
1627                 pe = (PORT_ENTRY *) & CtReq->un.PortID;
1628                 memcpy((uint8_t *) & pe->PortName,
1629                        (uint8_t *) & vport->fc_sparam.portName,
1630                        sizeof (struct lpfc_name));
1631                 size = GID_REQUEST_SZ - 4 + sizeof (struct lpfc_name);
1632                 break;
1633
1634         case SLI_MGMT_DPRT:
1635                 CtReq->CommandResponse.bits.CmdRsp = be16_to_cpu(SLI_MGMT_DPRT);
1636                 CtReq->CommandResponse.bits.Size = 0;
1637                 pe = (PORT_ENTRY *) & CtReq->un.PortID;
1638                 memcpy((uint8_t *) & pe->PortName,
1639                        (uint8_t *) & vport->fc_sparam.portName,
1640                        sizeof (struct lpfc_name));
1641                 size = GID_REQUEST_SZ - 4 + sizeof (struct lpfc_name);
1642                 break;
1643         }
1644
1645         bpl = (struct ulp_bde64 *) bmp->virt;
1646         bpl->addrHigh = le32_to_cpu(putPaddrHigh(mp->phys) );
1647         bpl->addrLow = le32_to_cpu(putPaddrLow(mp->phys) );
1648         bpl->tus.f.bdeFlags = 0;
1649         bpl->tus.f.bdeSize = size;
1650         bpl->tus.w = le32_to_cpu(bpl->tus.w);
1651
1652         cmpl = lpfc_cmpl_ct_cmd_fdmi;
1653         lpfc_nlp_get(ndlp);
1654
1655         if (!lpfc_ct_cmd(vport, mp, bmp, ndlp, cmpl, FC_MAX_NS_RSP, 0))
1656                 return 0;
1657
1658         lpfc_nlp_put(ndlp);
1659         lpfc_mbuf_free(phba, bmp->virt, bmp->phys);
1660 fdmi_cmd_free_bmp:
1661         kfree(bmp);
1662 fdmi_cmd_free_mpvirt:
1663         lpfc_mbuf_free(phba, mp->virt, mp->phys);
1664 fdmi_cmd_free_mp:
1665         kfree(mp);
1666 fdmi_cmd_exit:
1667         /* Issue FDMI request failed */
1668         lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
1669                          "0244 Issue FDMI request failed Data: x%x\n",
1670                          cmdcode);
1671         return 1;
1672 }
1673
1674 void
1675 lpfc_fdmi_tmo(unsigned long ptr)
1676 {
1677         struct lpfc_vport *vport = (struct lpfc_vport *)ptr;
1678         struct lpfc_hba   *phba = vport->phba;
1679         unsigned long iflag;
1680
1681         spin_lock_irqsave(&vport->work_port_lock, iflag);
1682         if (!(vport->work_port_events & WORKER_FDMI_TMO)) {
1683                 vport->work_port_events |= WORKER_FDMI_TMO;
1684                 spin_unlock_irqrestore(&vport->work_port_lock, iflag);
1685
1686                 spin_lock_irqsave(&phba->hbalock, iflag);
1687                 if (phba->work_wait)
1688                         lpfc_worker_wake_up(phba);
1689                 spin_unlock_irqrestore(&phba->hbalock, iflag);
1690         }
1691         else
1692                 spin_unlock_irqrestore(&vport->work_port_lock, iflag);
1693 }
1694
1695 void
1696 lpfc_fdmi_timeout_handler(struct lpfc_vport *vport)
1697 {
1698         struct lpfc_nodelist *ndlp;
1699
1700         ndlp = lpfc_findnode_did(vport, FDMI_DID);
1701         if (ndlp) {
1702                 if (init_utsname()->nodename[0] != '\0')
1703                         lpfc_fdmi_cmd(vport, ndlp, SLI_MGMT_DHBA);
1704                 else
1705                         mod_timer(&vport->fc_fdmitmo, jiffies + HZ * 60);
1706         }
1707         return;
1708 }
1709
1710 void
1711 lpfc_decode_firmware_rev(struct lpfc_hba *phba, char *fwrevision, int flag)
1712 {
1713         struct lpfc_sli *psli = &phba->sli;
1714         lpfc_vpd_t *vp = &phba->vpd;
1715         uint32_t b1, b2, b3, b4, i, rev;
1716         char c;
1717         uint32_t *ptr, str[4];
1718         uint8_t *fwname;
1719
1720         if (vp->rev.rBit) {
1721                 if (psli->sli_flag & LPFC_SLI2_ACTIVE)
1722                         rev = vp->rev.sli2FwRev;
1723                 else
1724                         rev = vp->rev.sli1FwRev;
1725
1726                 b1 = (rev & 0x0000f000) >> 12;
1727                 b2 = (rev & 0x00000f00) >> 8;
1728                 b3 = (rev & 0x000000c0) >> 6;
1729                 b4 = (rev & 0x00000030) >> 4;
1730
1731                 switch (b4) {
1732                 case 0:
1733                         c = 'N';
1734                         break;
1735                 case 1:
1736                         c = 'A';
1737                         break;
1738                 case 2:
1739                         c = 'B';
1740                         break;
1741                 default:
1742                         c = 0;
1743                         break;
1744                 }
1745                 b4 = (rev & 0x0000000f);
1746
1747                 if (psli->sli_flag & LPFC_SLI2_ACTIVE)
1748                         fwname = vp->rev.sli2FwName;
1749                 else
1750                         fwname = vp->rev.sli1FwName;
1751
1752                 for (i = 0; i < 16; i++)
1753                         if (fwname[i] == 0x20)
1754                                 fwname[i] = 0;
1755
1756                 ptr = (uint32_t*)fwname;
1757
1758                 for (i = 0; i < 3; i++)
1759                         str[i] = be32_to_cpu(*ptr++);
1760
1761                 if (c == 0) {
1762                         if (flag)
1763                                 sprintf(fwrevision, "%d.%d%d (%s)",
1764                                         b1, b2, b3, (char *)str);
1765                         else
1766                                 sprintf(fwrevision, "%d.%d%d", b1,
1767                                         b2, b3);
1768                 } else {
1769                         if (flag)
1770                                 sprintf(fwrevision, "%d.%d%d%c%d (%s)",
1771                                         b1, b2, b3, c,
1772                                         b4, (char *)str);
1773                         else
1774                                 sprintf(fwrevision, "%d.%d%d%c%d",
1775                                         b1, b2, b3, c, b4);
1776                 }
1777         } else {
1778                 rev = vp->rev.smFwRev;
1779
1780                 b1 = (rev & 0xff000000) >> 24;
1781                 b2 = (rev & 0x00f00000) >> 20;
1782                 b3 = (rev & 0x000f0000) >> 16;
1783                 c  = (rev & 0x0000ff00) >> 8;
1784                 b4 = (rev & 0x000000ff);
1785
1786                 if (flag)
1787                         sprintf(fwrevision, "%d.%d%d%c%d ", b1,
1788                                 b2, b3, c, b4);
1789                 else
1790                         sprintf(fwrevision, "%d.%d%d%c%d ", b1,
1791                                 b2, b3, c, b4);
1792         }
1793         return;
1794 }