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