V4L/DVB (8866): Add dummy FE to the Kconfig-file and fix it
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / drivers / scsi / lpfc / lpfc_els.c
blobf54e0f7eaee3222d5e8251f84d0ad09adbe34d53
1 /*******************************************************************
2 * This file is part of the Emulex Linux Device Driver for *
3 * Fibre Channel Host Bus Adapters. *
4 * Copyright (C) 2004-2008 Emulex. All rights reserved. *
5 * EMULEX and SLI are trademarks of Emulex. *
6 * www.emulex.com *
7 * Portions Copyright (C) 2004-2005 Christoph Hellwig *
8 * *
9 * This program is free software; you can redistribute it and/or *
10 * modify it under the terms of version 2 of the GNU General *
11 * Public License as published by the Free Software Foundation. *
12 * This program is distributed in the hope that it will be useful. *
13 * ALL EXPRESS OR IMPLIED CONDITIONS, REPRESENTATIONS AND *
14 * WARRANTIES, INCLUDING ANY IMPLIED WARRANTY OF MERCHANTABILITY, *
15 * FITNESS FOR A PARTICULAR PURPOSE, OR NON-INFRINGEMENT, ARE *
16 * DISCLAIMED, EXCEPT TO THE EXTENT THAT SUCH DISCLAIMERS ARE HELD *
17 * TO BE LEGALLY INVALID. See the GNU General Public License for *
18 * more details, a copy of which can be found in the file COPYING *
19 * included with this package. *
20 *******************************************************************/
21 /* See Fibre Channel protocol T11 FC-LS for details */
22 #include <linux/blkdev.h>
23 #include <linux/pci.h>
24 #include <linux/interrupt.h>
26 #include <scsi/scsi.h>
27 #include <scsi/scsi_device.h>
28 #include <scsi/scsi_host.h>
29 #include <scsi/scsi_transport_fc.h>
31 #include "lpfc_hw.h"
32 #include "lpfc_sli.h"
33 #include "lpfc_disc.h"
34 #include "lpfc_scsi.h"
35 #include "lpfc.h"
36 #include "lpfc_logmsg.h"
37 #include "lpfc_crtn.h"
38 #include "lpfc_vport.h"
39 #include "lpfc_debugfs.h"
41 static int lpfc_els_retry(struct lpfc_hba *, struct lpfc_iocbq *,
42 struct lpfc_iocbq *);
43 static void lpfc_cmpl_fabric_iocb(struct lpfc_hba *, struct lpfc_iocbq *,
44 struct lpfc_iocbq *);
45 static void lpfc_fabric_abort_vport(struct lpfc_vport *vport);
46 static int lpfc_issue_els_fdisc(struct lpfc_vport *vport,
47 struct lpfc_nodelist *ndlp, uint8_t retry);
48 static int lpfc_issue_fabric_iocb(struct lpfc_hba *phba,
49 struct lpfc_iocbq *iocb);
50 static void lpfc_register_new_vport(struct lpfc_hba *phba,
51 struct lpfc_vport *vport,
52 struct lpfc_nodelist *ndlp);
54 static int lpfc_max_els_tries = 3;
56 int
57 lpfc_els_chk_latt(struct lpfc_vport *vport)
59 struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
60 struct lpfc_hba *phba = vport->phba;
61 uint32_t ha_copy;
63 if (vport->port_state >= LPFC_VPORT_READY ||
64 phba->link_state == LPFC_LINK_DOWN)
65 return 0;
67 /* Read the HBA Host Attention Register */
68 ha_copy = readl(phba->HAregaddr);
70 if (!(ha_copy & HA_LATT))
71 return 0;
73 /* Pending Link Event during Discovery */
74 lpfc_printf_vlog(vport, KERN_ERR, LOG_DISCOVERY,
75 "0237 Pending Link Event during "
76 "Discovery: State x%x\n",
77 phba->pport->port_state);
79 /* CLEAR_LA should re-enable link attention events and
80 * we should then imediately take a LATT event. The
81 * LATT processing should call lpfc_linkdown() which
82 * will cleanup any left over in-progress discovery
83 * events.
85 spin_lock_irq(shost->host_lock);
86 vport->fc_flag |= FC_ABORT_DISCOVERY;
87 spin_unlock_irq(shost->host_lock);
89 if (phba->link_state != LPFC_CLEAR_LA)
90 lpfc_issue_clear_la(phba, vport);
92 return 1;
95 static struct lpfc_iocbq *
96 lpfc_prep_els_iocb(struct lpfc_vport *vport, uint8_t expectRsp,
97 uint16_t cmdSize, uint8_t retry,
98 struct lpfc_nodelist *ndlp, uint32_t did,
99 uint32_t elscmd)
101 struct lpfc_hba *phba = vport->phba;
102 struct lpfc_iocbq *elsiocb;
103 struct lpfc_dmabuf *pcmd, *prsp, *pbuflist;
104 struct ulp_bde64 *bpl;
105 IOCB_t *icmd;
108 if (!lpfc_is_link_up(phba))
109 return NULL;
111 /* Allocate buffer for command iocb */
112 elsiocb = lpfc_sli_get_iocbq(phba);
114 if (elsiocb == NULL)
115 return NULL;
117 icmd = &elsiocb->iocb;
119 /* fill in BDEs for command */
120 /* Allocate buffer for command payload */
121 pcmd = kmalloc(sizeof(struct lpfc_dmabuf), GFP_KERNEL);
122 if (pcmd)
123 pcmd->virt = lpfc_mbuf_alloc(phba, MEM_PRI, &pcmd->phys);
124 if (!pcmd || !pcmd->virt)
125 goto els_iocb_free_pcmb_exit;
127 INIT_LIST_HEAD(&pcmd->list);
129 /* Allocate buffer for response payload */
130 if (expectRsp) {
131 prsp = kmalloc(sizeof(struct lpfc_dmabuf), GFP_KERNEL);
132 if (prsp)
133 prsp->virt = lpfc_mbuf_alloc(phba, MEM_PRI,
134 &prsp->phys);
135 if (!prsp || !prsp->virt)
136 goto els_iocb_free_prsp_exit;
137 INIT_LIST_HEAD(&prsp->list);
138 } else
139 prsp = NULL;
141 /* Allocate buffer for Buffer ptr list */
142 pbuflist = kmalloc(sizeof(struct lpfc_dmabuf), GFP_KERNEL);
143 if (pbuflist)
144 pbuflist->virt = lpfc_mbuf_alloc(phba, MEM_PRI,
145 &pbuflist->phys);
146 if (!pbuflist || !pbuflist->virt)
147 goto els_iocb_free_pbuf_exit;
149 INIT_LIST_HEAD(&pbuflist->list);
151 icmd->un.elsreq64.bdl.addrHigh = putPaddrHigh(pbuflist->phys);
152 icmd->un.elsreq64.bdl.addrLow = putPaddrLow(pbuflist->phys);
153 icmd->un.elsreq64.bdl.bdeFlags = BUFF_TYPE_BDL;
154 icmd->un.elsreq64.remoteID = did; /* DID */
155 if (expectRsp) {
156 icmd->un.elsreq64.bdl.bdeSize = (2 * sizeof(struct ulp_bde64));
157 icmd->ulpCommand = CMD_ELS_REQUEST64_CR;
158 icmd->ulpTimeout = phba->fc_ratov * 2;
159 } else {
160 icmd->un.elsreq64.bdl.bdeSize = sizeof(struct ulp_bde64);
161 icmd->ulpCommand = CMD_XMIT_ELS_RSP64_CX;
163 icmd->ulpBdeCount = 1;
164 icmd->ulpLe = 1;
165 icmd->ulpClass = CLASS3;
167 if (phba->sli3_options & LPFC_SLI3_NPIV_ENABLED) {
168 icmd->un.elsreq64.myID = vport->fc_myDID;
170 /* For ELS_REQUEST64_CR, use the VPI by default */
171 icmd->ulpContext = vport->vpi;
172 icmd->ulpCt_h = 0;
173 icmd->ulpCt_l = 1;
176 bpl = (struct ulp_bde64 *) pbuflist->virt;
177 bpl->addrLow = le32_to_cpu(putPaddrLow(pcmd->phys));
178 bpl->addrHigh = le32_to_cpu(putPaddrHigh(pcmd->phys));
179 bpl->tus.f.bdeSize = cmdSize;
180 bpl->tus.f.bdeFlags = 0;
181 bpl->tus.w = le32_to_cpu(bpl->tus.w);
183 if (expectRsp) {
184 bpl++;
185 bpl->addrLow = le32_to_cpu(putPaddrLow(prsp->phys));
186 bpl->addrHigh = le32_to_cpu(putPaddrHigh(prsp->phys));
187 bpl->tus.f.bdeSize = FCELSSIZE;
188 bpl->tus.f.bdeFlags = BUFF_USE_RCV;
189 bpl->tus.w = le32_to_cpu(bpl->tus.w);
192 /* prevent preparing iocb with NULL ndlp reference */
193 elsiocb->context1 = lpfc_nlp_get(ndlp);
194 if (!elsiocb->context1)
195 goto els_iocb_free_pbuf_exit;
196 elsiocb->context2 = pcmd;
197 elsiocb->context3 = pbuflist;
198 elsiocb->retry = retry;
199 elsiocb->vport = vport;
200 elsiocb->drvrTimeout = (phba->fc_ratov << 1) + LPFC_DRVR_TIMEOUT;
202 if (prsp) {
203 list_add(&prsp->list, &pcmd->list);
205 if (expectRsp) {
206 /* Xmit ELS command <elsCmd> to remote NPORT <did> */
207 lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,
208 "0116 Xmit ELS command x%x to remote "
209 "NPORT x%x I/O tag: x%x, port state: x%x\n",
210 elscmd, did, elsiocb->iotag,
211 vport->port_state);
212 } else {
213 /* Xmit ELS response <elsCmd> to remote NPORT <did> */
214 lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,
215 "0117 Xmit ELS response x%x to remote "
216 "NPORT x%x I/O tag: x%x, size: x%x\n",
217 elscmd, ndlp->nlp_DID, elsiocb->iotag,
218 cmdSize);
220 return elsiocb;
222 els_iocb_free_pbuf_exit:
223 lpfc_mbuf_free(phba, prsp->virt, prsp->phys);
224 kfree(pbuflist);
226 els_iocb_free_prsp_exit:
227 lpfc_mbuf_free(phba, pcmd->virt, pcmd->phys);
228 kfree(prsp);
230 els_iocb_free_pcmb_exit:
231 kfree(pcmd);
232 lpfc_sli_release_iocbq(phba, elsiocb);
233 return NULL;
236 static int
237 lpfc_issue_fabric_reglogin(struct lpfc_vport *vport)
239 struct lpfc_hba *phba = vport->phba;
240 LPFC_MBOXQ_t *mbox;
241 struct lpfc_dmabuf *mp;
242 struct lpfc_nodelist *ndlp;
243 struct serv_parm *sp;
244 int rc;
245 int err = 0;
247 sp = &phba->fc_fabparam;
248 ndlp = lpfc_findnode_did(vport, Fabric_DID);
249 if (!ndlp || !NLP_CHK_NODE_ACT(ndlp)) {
250 err = 1;
251 goto fail;
254 mbox = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
255 if (!mbox) {
256 err = 2;
257 goto fail;
260 vport->port_state = LPFC_FABRIC_CFG_LINK;
261 lpfc_config_link(phba, mbox);
262 mbox->mbox_cmpl = lpfc_sli_def_mbox_cmpl;
263 mbox->vport = vport;
265 rc = lpfc_sli_issue_mbox(phba, mbox, MBX_NOWAIT);
266 if (rc == MBX_NOT_FINISHED) {
267 err = 3;
268 goto fail_free_mbox;
271 mbox = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
272 if (!mbox) {
273 err = 4;
274 goto fail;
276 rc = lpfc_reg_login(phba, vport->vpi, Fabric_DID, (uint8_t *)sp, mbox,
278 if (rc) {
279 err = 5;
280 goto fail_free_mbox;
283 mbox->mbox_cmpl = lpfc_mbx_cmpl_fabric_reg_login;
284 mbox->vport = vport;
285 /* increment the reference count on ndlp to hold reference
286 * for the callback routine.
288 mbox->context2 = lpfc_nlp_get(ndlp);
290 rc = lpfc_sli_issue_mbox(phba, mbox, MBX_NOWAIT);
291 if (rc == MBX_NOT_FINISHED) {
292 err = 6;
293 goto fail_issue_reg_login;
296 return 0;
298 fail_issue_reg_login:
299 /* decrement the reference count on ndlp just incremented
300 * for the failed mbox command.
302 lpfc_nlp_put(ndlp);
303 mp = (struct lpfc_dmabuf *) mbox->context1;
304 lpfc_mbuf_free(phba, mp->virt, mp->phys);
305 kfree(mp);
306 fail_free_mbox:
307 mempool_free(mbox, phba->mbox_mem_pool);
309 fail:
310 lpfc_vport_set_state(vport, FC_VPORT_FAILED);
311 lpfc_printf_vlog(vport, KERN_ERR, LOG_ELS,
312 "0249 Cannot issue Register Fabric login: Err %d\n", err);
313 return -ENXIO;
316 static int
317 lpfc_cmpl_els_flogi_fabric(struct lpfc_vport *vport, struct lpfc_nodelist *ndlp,
318 struct serv_parm *sp, IOCB_t *irsp)
320 struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
321 struct lpfc_hba *phba = vport->phba;
322 struct lpfc_nodelist *np;
323 struct lpfc_nodelist *next_np;
325 spin_lock_irq(shost->host_lock);
326 vport->fc_flag |= FC_FABRIC;
327 spin_unlock_irq(shost->host_lock);
329 phba->fc_edtov = be32_to_cpu(sp->cmn.e_d_tov);
330 if (sp->cmn.edtovResolution) /* E_D_TOV ticks are in nanoseconds */
331 phba->fc_edtov = (phba->fc_edtov + 999999) / 1000000;
333 phba->fc_ratov = (be32_to_cpu(sp->cmn.w2.r_a_tov) + 999) / 1000;
335 if (phba->fc_topology == TOPOLOGY_LOOP) {
336 spin_lock_irq(shost->host_lock);
337 vport->fc_flag |= FC_PUBLIC_LOOP;
338 spin_unlock_irq(shost->host_lock);
339 } else {
341 * If we are a N-port connected to a Fabric, fixup sparam's so
342 * logins to devices on remote loops work.
344 vport->fc_sparam.cmn.altBbCredit = 1;
347 vport->fc_myDID = irsp->un.ulpWord[4] & Mask_DID;
348 memcpy(&ndlp->nlp_portname, &sp->portName, sizeof(struct lpfc_name));
349 memcpy(&ndlp->nlp_nodename, &sp->nodeName, sizeof(struct lpfc_name));
350 ndlp->nlp_class_sup = 0;
351 if (sp->cls1.classValid)
352 ndlp->nlp_class_sup |= FC_COS_CLASS1;
353 if (sp->cls2.classValid)
354 ndlp->nlp_class_sup |= FC_COS_CLASS2;
355 if (sp->cls3.classValid)
356 ndlp->nlp_class_sup |= FC_COS_CLASS3;
357 if (sp->cls4.classValid)
358 ndlp->nlp_class_sup |= FC_COS_CLASS4;
359 ndlp->nlp_maxframe = ((sp->cmn.bbRcvSizeMsb & 0x0F) << 8) |
360 sp->cmn.bbRcvSizeLsb;
361 memcpy(&phba->fc_fabparam, sp, sizeof(struct serv_parm));
363 if (phba->sli3_options & LPFC_SLI3_NPIV_ENABLED) {
364 if (sp->cmn.response_multiple_NPort) {
365 lpfc_printf_vlog(vport, KERN_WARNING,
366 LOG_ELS | LOG_VPORT,
367 "1816 FLOGI NPIV supported, "
368 "response data 0x%x\n",
369 sp->cmn.response_multiple_NPort);
370 phba->link_flag |= LS_NPIV_FAB_SUPPORTED;
371 } else {
372 /* Because we asked f/w for NPIV it still expects us
373 to call reg_vnpid atleast for the physcial host */
374 lpfc_printf_vlog(vport, KERN_WARNING,
375 LOG_ELS | LOG_VPORT,
376 "1817 Fabric does not support NPIV "
377 "- configuring single port mode.\n");
378 phba->link_flag &= ~LS_NPIV_FAB_SUPPORTED;
382 if ((vport->fc_prevDID != vport->fc_myDID) &&
383 !(vport->fc_flag & FC_VPORT_NEEDS_REG_VPI)) {
385 /* If our NportID changed, we need to ensure all
386 * remaining NPORTs get unreg_login'ed.
388 list_for_each_entry_safe(np, next_np,
389 &vport->fc_nodes, nlp_listp) {
390 if (!NLP_CHK_NODE_ACT(ndlp))
391 continue;
392 if ((np->nlp_state != NLP_STE_NPR_NODE) ||
393 !(np->nlp_flag & NLP_NPR_ADISC))
394 continue;
395 spin_lock_irq(shost->host_lock);
396 np->nlp_flag &= ~NLP_NPR_ADISC;
397 spin_unlock_irq(shost->host_lock);
398 lpfc_unreg_rpi(vport, np);
400 if (phba->sli3_options & LPFC_SLI3_NPIV_ENABLED) {
401 lpfc_mbx_unreg_vpi(vport);
402 spin_lock_irq(shost->host_lock);
403 vport->fc_flag |= FC_VPORT_NEEDS_REG_VPI;
404 spin_unlock_irq(shost->host_lock);
408 lpfc_nlp_set_state(vport, ndlp, NLP_STE_REG_LOGIN_ISSUE);
410 if (phba->sli3_options & LPFC_SLI3_NPIV_ENABLED &&
411 vport->fc_flag & FC_VPORT_NEEDS_REG_VPI) {
412 lpfc_register_new_vport(phba, vport, ndlp);
413 return 0;
415 lpfc_issue_fabric_reglogin(vport);
416 return 0;
420 * We FLOGIed into an NPort, initiate pt2pt protocol
422 static int
423 lpfc_cmpl_els_flogi_nport(struct lpfc_vport *vport, struct lpfc_nodelist *ndlp,
424 struct serv_parm *sp)
426 struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
427 struct lpfc_hba *phba = vport->phba;
428 LPFC_MBOXQ_t *mbox;
429 int rc;
431 spin_lock_irq(shost->host_lock);
432 vport->fc_flag &= ~(FC_FABRIC | FC_PUBLIC_LOOP);
433 spin_unlock_irq(shost->host_lock);
435 phba->fc_edtov = FF_DEF_EDTOV;
436 phba->fc_ratov = FF_DEF_RATOV;
437 rc = memcmp(&vport->fc_portname, &sp->portName,
438 sizeof(vport->fc_portname));
439 if (rc >= 0) {
440 /* This side will initiate the PLOGI */
441 spin_lock_irq(shost->host_lock);
442 vport->fc_flag |= FC_PT2PT_PLOGI;
443 spin_unlock_irq(shost->host_lock);
446 * N_Port ID cannot be 0, set our to LocalID the other
447 * side will be RemoteID.
450 /* not equal */
451 if (rc)
452 vport->fc_myDID = PT2PT_LocalID;
454 mbox = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
455 if (!mbox)
456 goto fail;
458 lpfc_config_link(phba, mbox);
460 mbox->mbox_cmpl = lpfc_sli_def_mbox_cmpl;
461 mbox->vport = vport;
462 rc = lpfc_sli_issue_mbox(phba, mbox, MBX_NOWAIT);
463 if (rc == MBX_NOT_FINISHED) {
464 mempool_free(mbox, phba->mbox_mem_pool);
465 goto fail;
467 /* Decrement ndlp reference count indicating that ndlp can be
468 * safely released when other references to it are done.
470 lpfc_nlp_put(ndlp);
472 ndlp = lpfc_findnode_did(vport, PT2PT_RemoteID);
473 if (!ndlp) {
475 * Cannot find existing Fabric ndlp, so allocate a
476 * new one
478 ndlp = mempool_alloc(phba->nlp_mem_pool, GFP_KERNEL);
479 if (!ndlp)
480 goto fail;
481 lpfc_nlp_init(vport, ndlp, PT2PT_RemoteID);
482 } else if (!NLP_CHK_NODE_ACT(ndlp)) {
483 ndlp = lpfc_enable_node(vport, ndlp,
484 NLP_STE_UNUSED_NODE);
485 if(!ndlp)
486 goto fail;
489 memcpy(&ndlp->nlp_portname, &sp->portName,
490 sizeof(struct lpfc_name));
491 memcpy(&ndlp->nlp_nodename, &sp->nodeName,
492 sizeof(struct lpfc_name));
493 /* Set state will put ndlp onto node list if not already done */
494 lpfc_nlp_set_state(vport, ndlp, NLP_STE_NPR_NODE);
495 spin_lock_irq(shost->host_lock);
496 ndlp->nlp_flag |= NLP_NPR_2B_DISC;
497 spin_unlock_irq(shost->host_lock);
498 } else
499 /* This side will wait for the PLOGI, decrement ndlp reference
500 * count indicating that ndlp can be released when other
501 * references to it are done.
503 lpfc_nlp_put(ndlp);
505 /* If we are pt2pt with another NPort, force NPIV off! */
506 phba->sli3_options &= ~LPFC_SLI3_NPIV_ENABLED;
508 spin_lock_irq(shost->host_lock);
509 vport->fc_flag |= FC_PT2PT;
510 spin_unlock_irq(shost->host_lock);
512 /* Start discovery - this should just do CLEAR_LA */
513 lpfc_disc_start(vport);
514 return 0;
515 fail:
516 return -ENXIO;
519 static void
520 lpfc_cmpl_els_flogi(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
521 struct lpfc_iocbq *rspiocb)
523 struct lpfc_vport *vport = cmdiocb->vport;
524 struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
525 IOCB_t *irsp = &rspiocb->iocb;
526 struct lpfc_nodelist *ndlp = cmdiocb->context1;
527 struct lpfc_dmabuf *pcmd = cmdiocb->context2, *prsp;
528 struct serv_parm *sp;
529 int rc;
531 /* Check to see if link went down during discovery */
532 if (lpfc_els_chk_latt(vport)) {
533 /* One additional decrement on node reference count to
534 * trigger the release of the node
536 lpfc_nlp_put(ndlp);
537 goto out;
540 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
541 "FLOGI cmpl: status:x%x/x%x state:x%x",
542 irsp->ulpStatus, irsp->un.ulpWord[4],
543 vport->port_state);
545 if (irsp->ulpStatus) {
546 /* Check for retry */
547 if (lpfc_els_retry(phba, cmdiocb, rspiocb))
548 goto out;
550 /* FLOGI failed, so there is no fabric */
551 spin_lock_irq(shost->host_lock);
552 vport->fc_flag &= ~(FC_FABRIC | FC_PUBLIC_LOOP);
553 spin_unlock_irq(shost->host_lock);
555 /* If private loop, then allow max outstanding els to be
556 * LPFC_MAX_DISC_THREADS (32). Scanning in the case of no
557 * alpa map would take too long otherwise.
559 if (phba->alpa_map[0] == 0) {
560 vport->cfg_discovery_threads = LPFC_MAX_DISC_THREADS;
563 /* FLOGI failure */
564 lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,
565 "0100 FLOGI failure Data: x%x x%x "
566 "x%x\n",
567 irsp->ulpStatus, irsp->un.ulpWord[4],
568 irsp->ulpTimeout);
569 goto flogifail;
573 * The FLogI succeeded. Sync the data for the CPU before
574 * accessing it.
576 prsp = list_get_first(&pcmd->list, struct lpfc_dmabuf, list);
578 sp = prsp->virt + sizeof(uint32_t);
580 /* FLOGI completes successfully */
581 lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,
582 "0101 FLOGI completes sucessfully "
583 "Data: x%x x%x x%x x%x\n",
584 irsp->un.ulpWord[4], sp->cmn.e_d_tov,
585 sp->cmn.w2.r_a_tov, sp->cmn.edtovResolution);
587 if (vport->port_state == LPFC_FLOGI) {
589 * If Common Service Parameters indicate Nport
590 * we are point to point, if Fport we are Fabric.
592 if (sp->cmn.fPort)
593 rc = lpfc_cmpl_els_flogi_fabric(vport, ndlp, sp, irsp);
594 else
595 rc = lpfc_cmpl_els_flogi_nport(vport, ndlp, sp);
597 if (!rc)
598 goto out;
601 flogifail:
602 lpfc_nlp_put(ndlp);
604 if (!lpfc_error_lost_link(irsp)) {
605 /* FLOGI failed, so just use loop map to make discovery list */
606 lpfc_disc_list_loopmap(vport);
608 /* Start discovery */
609 lpfc_disc_start(vport);
610 } else if (((irsp->ulpStatus != IOSTAT_LOCAL_REJECT) ||
611 ((irsp->un.ulpWord[4] != IOERR_SLI_ABORTED) &&
612 (irsp->un.ulpWord[4] != IOERR_SLI_DOWN))) &&
613 (phba->link_state != LPFC_CLEAR_LA)) {
614 /* If FLOGI failed enable link interrupt. */
615 lpfc_issue_clear_la(phba, vport);
617 out:
618 lpfc_els_free_iocb(phba, cmdiocb);
621 static int
622 lpfc_issue_els_flogi(struct lpfc_vport *vport, struct lpfc_nodelist *ndlp,
623 uint8_t retry)
625 struct lpfc_hba *phba = vport->phba;
626 struct serv_parm *sp;
627 IOCB_t *icmd;
628 struct lpfc_iocbq *elsiocb;
629 struct lpfc_sli_ring *pring;
630 uint8_t *pcmd;
631 uint16_t cmdsize;
632 uint32_t tmo;
633 int rc;
635 pring = &phba->sli.ring[LPFC_ELS_RING];
637 cmdsize = (sizeof(uint32_t) + sizeof(struct serv_parm));
638 elsiocb = lpfc_prep_els_iocb(vport, 1, cmdsize, retry, ndlp,
639 ndlp->nlp_DID, ELS_CMD_FLOGI);
641 if (!elsiocb)
642 return 1;
644 icmd = &elsiocb->iocb;
645 pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
647 /* For FLOGI request, remainder of payload is service parameters */
648 *((uint32_t *) (pcmd)) = ELS_CMD_FLOGI;
649 pcmd += sizeof(uint32_t);
650 memcpy(pcmd, &vport->fc_sparam, sizeof(struct serv_parm));
651 sp = (struct serv_parm *) pcmd;
653 /* Setup CSPs accordingly for Fabric */
654 sp->cmn.e_d_tov = 0;
655 sp->cmn.w2.r_a_tov = 0;
656 sp->cls1.classValid = 0;
657 sp->cls2.seqDelivery = 1;
658 sp->cls3.seqDelivery = 1;
659 if (sp->cmn.fcphLow < FC_PH3)
660 sp->cmn.fcphLow = FC_PH3;
661 if (sp->cmn.fcphHigh < FC_PH3)
662 sp->cmn.fcphHigh = FC_PH3;
664 if (phba->sli3_options & LPFC_SLI3_NPIV_ENABLED) {
665 sp->cmn.request_multiple_Nport = 1;
667 /* For FLOGI, Let FLOGI rsp set the NPortID for VPI 0 */
668 icmd->ulpCt_h = 1;
669 icmd->ulpCt_l = 0;
672 if (phba->fc_topology != TOPOLOGY_LOOP) {
673 icmd->un.elsreq64.myID = 0;
674 icmd->un.elsreq64.fl = 1;
677 tmo = phba->fc_ratov;
678 phba->fc_ratov = LPFC_DISC_FLOGI_TMO;
679 lpfc_set_disctmo(vport);
680 phba->fc_ratov = tmo;
682 phba->fc_stat.elsXmitFLOGI++;
683 elsiocb->iocb_cmpl = lpfc_cmpl_els_flogi;
685 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
686 "Issue FLOGI: opt:x%x",
687 phba->sli3_options, 0, 0);
689 rc = lpfc_issue_fabric_iocb(phba, elsiocb);
690 if (rc == IOCB_ERROR) {
691 lpfc_els_free_iocb(phba, elsiocb);
692 return 1;
694 return 0;
698 lpfc_els_abort_flogi(struct lpfc_hba *phba)
700 struct lpfc_sli_ring *pring;
701 struct lpfc_iocbq *iocb, *next_iocb;
702 struct lpfc_nodelist *ndlp;
703 IOCB_t *icmd;
705 /* Abort outstanding I/O on NPort <nlp_DID> */
706 lpfc_printf_log(phba, KERN_INFO, LOG_DISCOVERY,
707 "0201 Abort outstanding I/O on NPort x%x\n",
708 Fabric_DID);
710 pring = &phba->sli.ring[LPFC_ELS_RING];
713 * Check the txcmplq for an iocb that matches the nport the driver is
714 * searching for.
716 spin_lock_irq(&phba->hbalock);
717 list_for_each_entry_safe(iocb, next_iocb, &pring->txcmplq, list) {
718 icmd = &iocb->iocb;
719 if (icmd->ulpCommand == CMD_ELS_REQUEST64_CR &&
720 icmd->un.elsreq64.bdl.ulpIoTag32) {
721 ndlp = (struct lpfc_nodelist *)(iocb->context1);
722 if (ndlp && NLP_CHK_NODE_ACT(ndlp) &&
723 (ndlp->nlp_DID == Fabric_DID))
724 lpfc_sli_issue_abort_iotag(phba, pring, iocb);
727 spin_unlock_irq(&phba->hbalock);
729 return 0;
733 lpfc_initial_flogi(struct lpfc_vport *vport)
735 struct lpfc_hba *phba = vport->phba;
736 struct lpfc_nodelist *ndlp;
738 vport->port_state = LPFC_FLOGI;
739 lpfc_set_disctmo(vport);
741 /* First look for the Fabric ndlp */
742 ndlp = lpfc_findnode_did(vport, Fabric_DID);
743 if (!ndlp) {
744 /* Cannot find existing Fabric ndlp, so allocate a new one */
745 ndlp = mempool_alloc(phba->nlp_mem_pool, GFP_KERNEL);
746 if (!ndlp)
747 return 0;
748 lpfc_nlp_init(vport, ndlp, Fabric_DID);
749 /* Put ndlp onto node list */
750 lpfc_enqueue_node(vport, ndlp);
751 } else if (!NLP_CHK_NODE_ACT(ndlp)) {
752 /* re-setup ndlp without removing from node list */
753 ndlp = lpfc_enable_node(vport, ndlp, NLP_STE_UNUSED_NODE);
754 if (!ndlp)
755 return 0;
758 if (lpfc_issue_els_flogi(vport, ndlp, 0))
759 /* This decrement of reference count to node shall kick off
760 * the release of the node.
762 lpfc_nlp_put(ndlp);
764 return 1;
768 lpfc_initial_fdisc(struct lpfc_vport *vport)
770 struct lpfc_hba *phba = vport->phba;
771 struct lpfc_nodelist *ndlp;
773 /* First look for the Fabric ndlp */
774 ndlp = lpfc_findnode_did(vport, Fabric_DID);
775 if (!ndlp) {
776 /* Cannot find existing Fabric ndlp, so allocate a new one */
777 ndlp = mempool_alloc(phba->nlp_mem_pool, GFP_KERNEL);
778 if (!ndlp)
779 return 0;
780 lpfc_nlp_init(vport, ndlp, Fabric_DID);
781 /* Put ndlp onto node list */
782 lpfc_enqueue_node(vport, ndlp);
783 } else if (!NLP_CHK_NODE_ACT(ndlp)) {
784 /* re-setup ndlp without removing from node list */
785 ndlp = lpfc_enable_node(vport, ndlp, NLP_STE_UNUSED_NODE);
786 if (!ndlp)
787 return 0;
790 if (lpfc_issue_els_fdisc(vport, ndlp, 0)) {
791 /* decrement node reference count to trigger the release of
792 * the node.
794 lpfc_nlp_put(ndlp);
795 return 0;
797 return 1;
800 void
801 lpfc_more_plogi(struct lpfc_vport *vport)
803 int sentplogi;
805 if (vport->num_disc_nodes)
806 vport->num_disc_nodes--;
808 /* Continue discovery with <num_disc_nodes> PLOGIs to go */
809 lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
810 "0232 Continue discovery with %d PLOGIs to go "
811 "Data: x%x x%x x%x\n",
812 vport->num_disc_nodes, vport->fc_plogi_cnt,
813 vport->fc_flag, vport->port_state);
814 /* Check to see if there are more PLOGIs to be sent */
815 if (vport->fc_flag & FC_NLP_MORE)
816 /* go thru NPR nodes and issue any remaining ELS PLOGIs */
817 sentplogi = lpfc_els_disc_plogi(vport);
819 return;
822 static struct lpfc_nodelist *
823 lpfc_plogi_confirm_nport(struct lpfc_hba *phba, uint32_t *prsp,
824 struct lpfc_nodelist *ndlp)
826 struct lpfc_vport *vport = ndlp->vport;
827 struct lpfc_nodelist *new_ndlp;
828 struct lpfc_rport_data *rdata;
829 struct fc_rport *rport;
830 struct serv_parm *sp;
831 uint8_t name[sizeof(struct lpfc_name)];
832 uint32_t rc, keepDID = 0;
834 /* Fabric nodes can have the same WWPN so we don't bother searching
835 * by WWPN. Just return the ndlp that was given to us.
837 if (ndlp->nlp_type & NLP_FABRIC)
838 return ndlp;
840 sp = (struct serv_parm *) ((uint8_t *) prsp + sizeof(uint32_t));
841 memset(name, 0, sizeof(struct lpfc_name));
843 /* Now we find out if the NPort we are logging into, matches the WWPN
844 * we have for that ndlp. If not, we have some work to do.
846 new_ndlp = lpfc_findnode_wwpn(vport, &sp->portName);
848 if (new_ndlp == ndlp && NLP_CHK_NODE_ACT(new_ndlp))
849 return ndlp;
851 if (!new_ndlp) {
852 rc = memcmp(&ndlp->nlp_portname, name,
853 sizeof(struct lpfc_name));
854 if (!rc)
855 return ndlp;
856 new_ndlp = mempool_alloc(phba->nlp_mem_pool, GFP_ATOMIC);
857 if (!new_ndlp)
858 return ndlp;
859 lpfc_nlp_init(vport, new_ndlp, ndlp->nlp_DID);
860 } else if (!NLP_CHK_NODE_ACT(new_ndlp)) {
861 rc = memcmp(&ndlp->nlp_portname, name,
862 sizeof(struct lpfc_name));
863 if (!rc)
864 return ndlp;
865 new_ndlp = lpfc_enable_node(vport, new_ndlp,
866 NLP_STE_UNUSED_NODE);
867 if (!new_ndlp)
868 return ndlp;
869 keepDID = new_ndlp->nlp_DID;
870 } else
871 keepDID = new_ndlp->nlp_DID;
873 lpfc_unreg_rpi(vport, new_ndlp);
874 new_ndlp->nlp_DID = ndlp->nlp_DID;
875 new_ndlp->nlp_prev_state = ndlp->nlp_prev_state;
877 if (ndlp->nlp_flag & NLP_NPR_2B_DISC)
878 new_ndlp->nlp_flag |= NLP_NPR_2B_DISC;
879 ndlp->nlp_flag &= ~NLP_NPR_2B_DISC;
881 /* Set state will put new_ndlp on to node list if not already done */
882 lpfc_nlp_set_state(vport, new_ndlp, ndlp->nlp_state);
884 /* Move this back to NPR state */
885 if (memcmp(&ndlp->nlp_portname, name, sizeof(struct lpfc_name)) == 0) {
886 /* The new_ndlp is replacing ndlp totally, so we need
887 * to put ndlp on UNUSED list and try to free it.
890 /* Fix up the rport accordingly */
891 rport = ndlp->rport;
892 if (rport) {
893 rdata = rport->dd_data;
894 if (rdata->pnode == ndlp) {
895 lpfc_nlp_put(ndlp);
896 ndlp->rport = NULL;
897 rdata->pnode = lpfc_nlp_get(new_ndlp);
898 new_ndlp->rport = rport;
900 new_ndlp->nlp_type = ndlp->nlp_type;
902 /* We shall actually free the ndlp with both nlp_DID and
903 * nlp_portname fields equals 0 to avoid any ndlp on the
904 * nodelist never to be used.
906 if (ndlp->nlp_DID == 0) {
907 spin_lock_irq(&phba->ndlp_lock);
908 NLP_SET_FREE_REQ(ndlp);
909 spin_unlock_irq(&phba->ndlp_lock);
912 /* Two ndlps cannot have the same did on the nodelist */
913 ndlp->nlp_DID = keepDID;
914 lpfc_drop_node(vport, ndlp);
916 else {
917 lpfc_unreg_rpi(vport, ndlp);
918 /* Two ndlps cannot have the same did */
919 ndlp->nlp_DID = keepDID;
920 lpfc_nlp_set_state(vport, ndlp, NLP_STE_NPR_NODE);
922 return new_ndlp;
925 void
926 lpfc_end_rscn(struct lpfc_vport *vport)
928 struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
930 if (vport->fc_flag & FC_RSCN_MODE) {
932 * Check to see if more RSCNs came in while we were
933 * processing this one.
935 if (vport->fc_rscn_id_cnt ||
936 (vport->fc_flag & FC_RSCN_DISCOVERY) != 0)
937 lpfc_els_handle_rscn(vport);
938 else {
939 spin_lock_irq(shost->host_lock);
940 vport->fc_flag &= ~FC_RSCN_MODE;
941 spin_unlock_irq(shost->host_lock);
946 static void
947 lpfc_cmpl_els_plogi(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
948 struct lpfc_iocbq *rspiocb)
950 struct lpfc_vport *vport = cmdiocb->vport;
951 struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
952 IOCB_t *irsp;
953 struct lpfc_nodelist *ndlp;
954 struct lpfc_dmabuf *prsp;
955 int disc, rc, did, type;
957 /* we pass cmdiocb to state machine which needs rspiocb as well */
958 cmdiocb->context_un.rsp_iocb = rspiocb;
960 irsp = &rspiocb->iocb;
961 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
962 "PLOGI cmpl: status:x%x/x%x did:x%x",
963 irsp->ulpStatus, irsp->un.ulpWord[4],
964 irsp->un.elsreq64.remoteID);
966 ndlp = lpfc_findnode_did(vport, irsp->un.elsreq64.remoteID);
967 if (!ndlp || !NLP_CHK_NODE_ACT(ndlp)) {
968 lpfc_printf_vlog(vport, KERN_ERR, LOG_ELS,
969 "0136 PLOGI completes to NPort x%x "
970 "with no ndlp. Data: x%x x%x x%x\n",
971 irsp->un.elsreq64.remoteID,
972 irsp->ulpStatus, irsp->un.ulpWord[4],
973 irsp->ulpIoTag);
974 goto out;
977 /* Since ndlp can be freed in the disc state machine, note if this node
978 * is being used during discovery.
980 spin_lock_irq(shost->host_lock);
981 disc = (ndlp->nlp_flag & NLP_NPR_2B_DISC);
982 ndlp->nlp_flag &= ~NLP_NPR_2B_DISC;
983 spin_unlock_irq(shost->host_lock);
984 rc = 0;
986 /* PLOGI completes to NPort <nlp_DID> */
987 lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,
988 "0102 PLOGI completes to NPort x%x "
989 "Data: x%x x%x x%x x%x x%x\n",
990 ndlp->nlp_DID, irsp->ulpStatus, irsp->un.ulpWord[4],
991 irsp->ulpTimeout, disc, vport->num_disc_nodes);
992 /* Check to see if link went down during discovery */
993 if (lpfc_els_chk_latt(vport)) {
994 spin_lock_irq(shost->host_lock);
995 ndlp->nlp_flag |= NLP_NPR_2B_DISC;
996 spin_unlock_irq(shost->host_lock);
997 goto out;
1000 /* ndlp could be freed in DSM, save these values now */
1001 type = ndlp->nlp_type;
1002 did = ndlp->nlp_DID;
1004 if (irsp->ulpStatus) {
1005 /* Check for retry */
1006 if (lpfc_els_retry(phba, cmdiocb, rspiocb)) {
1007 /* ELS command is being retried */
1008 if (disc) {
1009 spin_lock_irq(shost->host_lock);
1010 ndlp->nlp_flag |= NLP_NPR_2B_DISC;
1011 spin_unlock_irq(shost->host_lock);
1013 goto out;
1015 /* PLOGI failed */
1016 /* Do not call DSM for lpfc_els_abort'ed ELS cmds */
1017 if (lpfc_error_lost_link(irsp))
1018 rc = NLP_STE_FREED_NODE;
1019 else
1020 rc = lpfc_disc_state_machine(vport, ndlp, cmdiocb,
1021 NLP_EVT_CMPL_PLOGI);
1022 } else {
1023 /* Good status, call state machine */
1024 prsp = list_entry(((struct lpfc_dmabuf *)
1025 cmdiocb->context2)->list.next,
1026 struct lpfc_dmabuf, list);
1027 ndlp = lpfc_plogi_confirm_nport(phba, prsp->virt, ndlp);
1028 rc = lpfc_disc_state_machine(vport, ndlp, cmdiocb,
1029 NLP_EVT_CMPL_PLOGI);
1032 if (disc && vport->num_disc_nodes) {
1033 /* Check to see if there are more PLOGIs to be sent */
1034 lpfc_more_plogi(vport);
1036 if (vport->num_disc_nodes == 0) {
1037 spin_lock_irq(shost->host_lock);
1038 vport->fc_flag &= ~FC_NDISC_ACTIVE;
1039 spin_unlock_irq(shost->host_lock);
1041 lpfc_can_disctmo(vport);
1042 lpfc_end_rscn(vport);
1046 out:
1047 lpfc_els_free_iocb(phba, cmdiocb);
1048 return;
1052 lpfc_issue_els_plogi(struct lpfc_vport *vport, uint32_t did, uint8_t retry)
1054 struct lpfc_hba *phba = vport->phba;
1055 struct serv_parm *sp;
1056 IOCB_t *icmd;
1057 struct lpfc_nodelist *ndlp;
1058 struct lpfc_iocbq *elsiocb;
1059 struct lpfc_sli_ring *pring;
1060 struct lpfc_sli *psli;
1061 uint8_t *pcmd;
1062 uint16_t cmdsize;
1063 int ret;
1065 psli = &phba->sli;
1066 pring = &psli->ring[LPFC_ELS_RING]; /* ELS ring */
1068 ndlp = lpfc_findnode_did(vport, did);
1069 if (ndlp && !NLP_CHK_NODE_ACT(ndlp))
1070 ndlp = NULL;
1072 /* If ndlp is not NULL, we will bump the reference count on it */
1073 cmdsize = (sizeof(uint32_t) + sizeof(struct serv_parm));
1074 elsiocb = lpfc_prep_els_iocb(vport, 1, cmdsize, retry, ndlp, did,
1075 ELS_CMD_PLOGI);
1076 if (!elsiocb)
1077 return 1;
1079 icmd = &elsiocb->iocb;
1080 pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
1082 /* For PLOGI request, remainder of payload is service parameters */
1083 *((uint32_t *) (pcmd)) = ELS_CMD_PLOGI;
1084 pcmd += sizeof(uint32_t);
1085 memcpy(pcmd, &vport->fc_sparam, sizeof(struct serv_parm));
1086 sp = (struct serv_parm *) pcmd;
1088 if (sp->cmn.fcphLow < FC_PH_4_3)
1089 sp->cmn.fcphLow = FC_PH_4_3;
1091 if (sp->cmn.fcphHigh < FC_PH3)
1092 sp->cmn.fcphHigh = FC_PH3;
1094 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
1095 "Issue PLOGI: did:x%x",
1096 did, 0, 0);
1098 phba->fc_stat.elsXmitPLOGI++;
1099 elsiocb->iocb_cmpl = lpfc_cmpl_els_plogi;
1100 ret = lpfc_sli_issue_iocb(phba, pring, elsiocb, 0);
1102 if (ret == IOCB_ERROR) {
1103 lpfc_els_free_iocb(phba, elsiocb);
1104 return 1;
1106 return 0;
1109 static void
1110 lpfc_cmpl_els_prli(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
1111 struct lpfc_iocbq *rspiocb)
1113 struct lpfc_vport *vport = cmdiocb->vport;
1114 struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
1115 IOCB_t *irsp;
1116 struct lpfc_sli *psli;
1117 struct lpfc_nodelist *ndlp;
1119 psli = &phba->sli;
1120 /* we pass cmdiocb to state machine which needs rspiocb as well */
1121 cmdiocb->context_un.rsp_iocb = rspiocb;
1123 irsp = &(rspiocb->iocb);
1124 ndlp = (struct lpfc_nodelist *) cmdiocb->context1;
1125 spin_lock_irq(shost->host_lock);
1126 ndlp->nlp_flag &= ~NLP_PRLI_SND;
1127 spin_unlock_irq(shost->host_lock);
1129 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
1130 "PRLI cmpl: status:x%x/x%x did:x%x",
1131 irsp->ulpStatus, irsp->un.ulpWord[4],
1132 ndlp->nlp_DID);
1133 /* PRLI completes to NPort <nlp_DID> */
1134 lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,
1135 "0103 PRLI completes to NPort x%x "
1136 "Data: x%x x%x x%x x%x\n",
1137 ndlp->nlp_DID, irsp->ulpStatus, irsp->un.ulpWord[4],
1138 irsp->ulpTimeout, vport->num_disc_nodes);
1140 vport->fc_prli_sent--;
1141 /* Check to see if link went down during discovery */
1142 if (lpfc_els_chk_latt(vport))
1143 goto out;
1145 if (irsp->ulpStatus) {
1146 /* Check for retry */
1147 if (lpfc_els_retry(phba, cmdiocb, rspiocb)) {
1148 /* ELS command is being retried */
1149 goto out;
1151 /* PRLI failed */
1152 /* Do not call DSM for lpfc_els_abort'ed ELS cmds */
1153 if (lpfc_error_lost_link(irsp))
1154 goto out;
1155 else
1156 lpfc_disc_state_machine(vport, ndlp, cmdiocb,
1157 NLP_EVT_CMPL_PRLI);
1158 } else
1159 /* Good status, call state machine */
1160 lpfc_disc_state_machine(vport, ndlp, cmdiocb,
1161 NLP_EVT_CMPL_PRLI);
1162 out:
1163 lpfc_els_free_iocb(phba, cmdiocb);
1164 return;
1168 lpfc_issue_els_prli(struct lpfc_vport *vport, struct lpfc_nodelist *ndlp,
1169 uint8_t retry)
1171 struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
1172 struct lpfc_hba *phba = vport->phba;
1173 PRLI *npr;
1174 IOCB_t *icmd;
1175 struct lpfc_iocbq *elsiocb;
1176 struct lpfc_sli_ring *pring;
1177 struct lpfc_sli *psli;
1178 uint8_t *pcmd;
1179 uint16_t cmdsize;
1181 psli = &phba->sli;
1182 pring = &psli->ring[LPFC_ELS_RING]; /* ELS ring */
1184 cmdsize = (sizeof(uint32_t) + sizeof(PRLI));
1185 elsiocb = lpfc_prep_els_iocb(vport, 1, cmdsize, retry, ndlp,
1186 ndlp->nlp_DID, ELS_CMD_PRLI);
1187 if (!elsiocb)
1188 return 1;
1190 icmd = &elsiocb->iocb;
1191 pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
1193 /* For PRLI request, remainder of payload is service parameters */
1194 memset(pcmd, 0, (sizeof(PRLI) + sizeof(uint32_t)));
1195 *((uint32_t *) (pcmd)) = ELS_CMD_PRLI;
1196 pcmd += sizeof(uint32_t);
1198 /* For PRLI, remainder of payload is PRLI parameter page */
1199 npr = (PRLI *) pcmd;
1201 * If our firmware version is 3.20 or later,
1202 * set the following bits for FC-TAPE support.
1204 if (phba->vpd.rev.feaLevelHigh >= 0x02) {
1205 npr->ConfmComplAllowed = 1;
1206 npr->Retry = 1;
1207 npr->TaskRetryIdReq = 1;
1209 npr->estabImagePair = 1;
1210 npr->readXferRdyDis = 1;
1212 /* For FCP support */
1213 npr->prliType = PRLI_FCP_TYPE;
1214 npr->initiatorFunc = 1;
1216 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
1217 "Issue PRLI: did:x%x",
1218 ndlp->nlp_DID, 0, 0);
1220 phba->fc_stat.elsXmitPRLI++;
1221 elsiocb->iocb_cmpl = lpfc_cmpl_els_prli;
1222 spin_lock_irq(shost->host_lock);
1223 ndlp->nlp_flag |= NLP_PRLI_SND;
1224 spin_unlock_irq(shost->host_lock);
1225 if (lpfc_sli_issue_iocb(phba, pring, elsiocb, 0) == IOCB_ERROR) {
1226 spin_lock_irq(shost->host_lock);
1227 ndlp->nlp_flag &= ~NLP_PRLI_SND;
1228 spin_unlock_irq(shost->host_lock);
1229 lpfc_els_free_iocb(phba, elsiocb);
1230 return 1;
1232 vport->fc_prli_sent++;
1233 return 0;
1236 void
1237 lpfc_more_adisc(struct lpfc_vport *vport)
1239 int sentadisc;
1241 if (vport->num_disc_nodes)
1242 vport->num_disc_nodes--;
1243 /* Continue discovery with <num_disc_nodes> ADISCs to go */
1244 lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
1245 "0210 Continue discovery with %d ADISCs to go "
1246 "Data: x%x x%x x%x\n",
1247 vport->num_disc_nodes, vport->fc_adisc_cnt,
1248 vport->fc_flag, vport->port_state);
1249 /* Check to see if there are more ADISCs to be sent */
1250 if (vport->fc_flag & FC_NLP_MORE) {
1251 lpfc_set_disctmo(vport);
1252 /* go thru NPR nodes and issue any remaining ELS ADISCs */
1253 sentadisc = lpfc_els_disc_adisc(vport);
1255 return;
1258 static void
1259 lpfc_rscn_disc(struct lpfc_vport *vport)
1261 lpfc_can_disctmo(vport);
1263 /* RSCN discovery */
1264 /* go thru NPR nodes and issue ELS PLOGIs */
1265 if (vport->fc_npr_cnt)
1266 if (lpfc_els_disc_plogi(vport))
1267 return;
1269 lpfc_end_rscn(vport);
1272 static void
1273 lpfc_cmpl_els_adisc(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
1274 struct lpfc_iocbq *rspiocb)
1276 struct lpfc_vport *vport = cmdiocb->vport;
1277 struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
1278 IOCB_t *irsp;
1279 struct lpfc_nodelist *ndlp;
1280 int disc;
1282 /* we pass cmdiocb to state machine which needs rspiocb as well */
1283 cmdiocb->context_un.rsp_iocb = rspiocb;
1285 irsp = &(rspiocb->iocb);
1286 ndlp = (struct lpfc_nodelist *) cmdiocb->context1;
1288 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
1289 "ADISC cmpl: status:x%x/x%x did:x%x",
1290 irsp->ulpStatus, irsp->un.ulpWord[4],
1291 ndlp->nlp_DID);
1293 /* Since ndlp can be freed in the disc state machine, note if this node
1294 * is being used during discovery.
1296 spin_lock_irq(shost->host_lock);
1297 disc = (ndlp->nlp_flag & NLP_NPR_2B_DISC);
1298 ndlp->nlp_flag &= ~(NLP_ADISC_SND | NLP_NPR_2B_DISC);
1299 spin_unlock_irq(shost->host_lock);
1300 /* ADISC completes to NPort <nlp_DID> */
1301 lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,
1302 "0104 ADISC completes to NPort x%x "
1303 "Data: x%x x%x x%x x%x x%x\n",
1304 ndlp->nlp_DID, irsp->ulpStatus, irsp->un.ulpWord[4],
1305 irsp->ulpTimeout, disc, vport->num_disc_nodes);
1306 /* Check to see if link went down during discovery */
1307 if (lpfc_els_chk_latt(vport)) {
1308 spin_lock_irq(shost->host_lock);
1309 ndlp->nlp_flag |= NLP_NPR_2B_DISC;
1310 spin_unlock_irq(shost->host_lock);
1311 goto out;
1314 if (irsp->ulpStatus) {
1315 /* Check for retry */
1316 if (lpfc_els_retry(phba, cmdiocb, rspiocb)) {
1317 /* ELS command is being retried */
1318 if (disc) {
1319 spin_lock_irq(shost->host_lock);
1320 ndlp->nlp_flag |= NLP_NPR_2B_DISC;
1321 spin_unlock_irq(shost->host_lock);
1322 lpfc_set_disctmo(vport);
1324 goto out;
1326 /* ADISC failed */
1327 /* Do not call DSM for lpfc_els_abort'ed ELS cmds */
1328 if (!lpfc_error_lost_link(irsp))
1329 lpfc_disc_state_machine(vport, ndlp, cmdiocb,
1330 NLP_EVT_CMPL_ADISC);
1331 } else
1332 /* Good status, call state machine */
1333 lpfc_disc_state_machine(vport, ndlp, cmdiocb,
1334 NLP_EVT_CMPL_ADISC);
1336 if (disc && vport->num_disc_nodes) {
1337 /* Check to see if there are more ADISCs to be sent */
1338 lpfc_more_adisc(vport);
1340 /* Check to see if we are done with ADISC authentication */
1341 if (vport->num_disc_nodes == 0) {
1342 /* If we get here, there is nothing left to ADISC */
1344 * For NPIV, cmpl_reg_vpi will set port_state to READY,
1345 * and continue discovery.
1347 if ((phba->sli3_options & LPFC_SLI3_NPIV_ENABLED) &&
1348 !(vport->fc_flag & FC_RSCN_MODE)) {
1349 lpfc_issue_reg_vpi(phba, vport);
1350 goto out;
1353 * For SLI2, we need to set port_state to READY
1354 * and continue discovery.
1356 if (vport->port_state < LPFC_VPORT_READY) {
1357 /* If we get here, there is nothing to ADISC */
1358 if (vport->port_type == LPFC_PHYSICAL_PORT)
1359 lpfc_issue_clear_la(phba, vport);
1361 if (!(vport->fc_flag & FC_ABORT_DISCOVERY)) {
1362 vport->num_disc_nodes = 0;
1363 /* go thru NPR list, issue ELS PLOGIs */
1364 if (vport->fc_npr_cnt)
1365 lpfc_els_disc_plogi(vport);
1367 if (!vport->num_disc_nodes) {
1368 spin_lock_irq(shost->host_lock);
1369 vport->fc_flag &=
1370 ~FC_NDISC_ACTIVE;
1371 spin_unlock_irq(
1372 shost->host_lock);
1373 lpfc_can_disctmo(vport);
1376 vport->port_state = LPFC_VPORT_READY;
1377 } else {
1378 lpfc_rscn_disc(vport);
1382 out:
1383 lpfc_els_free_iocb(phba, cmdiocb);
1384 return;
1388 lpfc_issue_els_adisc(struct lpfc_vport *vport, struct lpfc_nodelist *ndlp,
1389 uint8_t retry)
1391 struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
1392 struct lpfc_hba *phba = vport->phba;
1393 ADISC *ap;
1394 IOCB_t *icmd;
1395 struct lpfc_iocbq *elsiocb;
1396 struct lpfc_sli *psli = &phba->sli;
1397 struct lpfc_sli_ring *pring = &psli->ring[LPFC_ELS_RING];
1398 uint8_t *pcmd;
1399 uint16_t cmdsize;
1401 cmdsize = (sizeof(uint32_t) + sizeof(ADISC));
1402 elsiocb = lpfc_prep_els_iocb(vport, 1, cmdsize, retry, ndlp,
1403 ndlp->nlp_DID, ELS_CMD_ADISC);
1404 if (!elsiocb)
1405 return 1;
1407 icmd = &elsiocb->iocb;
1408 pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
1410 /* For ADISC request, remainder of payload is service parameters */
1411 *((uint32_t *) (pcmd)) = ELS_CMD_ADISC;
1412 pcmd += sizeof(uint32_t);
1414 /* Fill in ADISC payload */
1415 ap = (ADISC *) pcmd;
1416 ap->hardAL_PA = phba->fc_pref_ALPA;
1417 memcpy(&ap->portName, &vport->fc_portname, sizeof(struct lpfc_name));
1418 memcpy(&ap->nodeName, &vport->fc_nodename, sizeof(struct lpfc_name));
1419 ap->DID = be32_to_cpu(vport->fc_myDID);
1421 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
1422 "Issue ADISC: did:x%x",
1423 ndlp->nlp_DID, 0, 0);
1425 phba->fc_stat.elsXmitADISC++;
1426 elsiocb->iocb_cmpl = lpfc_cmpl_els_adisc;
1427 spin_lock_irq(shost->host_lock);
1428 ndlp->nlp_flag |= NLP_ADISC_SND;
1429 spin_unlock_irq(shost->host_lock);
1430 if (lpfc_sli_issue_iocb(phba, pring, elsiocb, 0) == IOCB_ERROR) {
1431 spin_lock_irq(shost->host_lock);
1432 ndlp->nlp_flag &= ~NLP_ADISC_SND;
1433 spin_unlock_irq(shost->host_lock);
1434 lpfc_els_free_iocb(phba, elsiocb);
1435 return 1;
1437 return 0;
1440 static void
1441 lpfc_cmpl_els_logo(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
1442 struct lpfc_iocbq *rspiocb)
1444 struct lpfc_nodelist *ndlp = (struct lpfc_nodelist *) cmdiocb->context1;
1445 struct lpfc_vport *vport = ndlp->vport;
1446 struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
1447 IOCB_t *irsp;
1448 struct lpfc_sli *psli;
1450 psli = &phba->sli;
1451 /* we pass cmdiocb to state machine which needs rspiocb as well */
1452 cmdiocb->context_un.rsp_iocb = rspiocb;
1454 irsp = &(rspiocb->iocb);
1455 spin_lock_irq(shost->host_lock);
1456 ndlp->nlp_flag &= ~NLP_LOGO_SND;
1457 spin_unlock_irq(shost->host_lock);
1459 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
1460 "LOGO cmpl: status:x%x/x%x did:x%x",
1461 irsp->ulpStatus, irsp->un.ulpWord[4],
1462 ndlp->nlp_DID);
1463 /* LOGO completes to NPort <nlp_DID> */
1464 lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,
1465 "0105 LOGO completes to NPort x%x "
1466 "Data: x%x x%x x%x x%x\n",
1467 ndlp->nlp_DID, irsp->ulpStatus, irsp->un.ulpWord[4],
1468 irsp->ulpTimeout, vport->num_disc_nodes);
1469 /* Check to see if link went down during discovery */
1470 if (lpfc_els_chk_latt(vport))
1471 goto out;
1473 if (ndlp->nlp_flag & NLP_TARGET_REMOVE) {
1474 /* NLP_EVT_DEVICE_RM should unregister the RPI
1475 * which should abort all outstanding IOs.
1477 lpfc_disc_state_machine(vport, ndlp, cmdiocb,
1478 NLP_EVT_DEVICE_RM);
1479 goto out;
1482 if (irsp->ulpStatus) {
1483 /* Check for retry */
1484 if (lpfc_els_retry(phba, cmdiocb, rspiocb))
1485 /* ELS command is being retried */
1486 goto out;
1487 /* LOGO failed */
1488 /* Do not call DSM for lpfc_els_abort'ed ELS cmds */
1489 if (lpfc_error_lost_link(irsp))
1490 goto out;
1491 else
1492 lpfc_disc_state_machine(vport, ndlp, cmdiocb,
1493 NLP_EVT_CMPL_LOGO);
1494 } else
1495 /* Good status, call state machine.
1496 * This will unregister the rpi if needed.
1498 lpfc_disc_state_machine(vport, ndlp, cmdiocb,
1499 NLP_EVT_CMPL_LOGO);
1500 out:
1501 lpfc_els_free_iocb(phba, cmdiocb);
1502 return;
1506 lpfc_issue_els_logo(struct lpfc_vport *vport, struct lpfc_nodelist *ndlp,
1507 uint8_t retry)
1509 struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
1510 struct lpfc_hba *phba = vport->phba;
1511 IOCB_t *icmd;
1512 struct lpfc_iocbq *elsiocb;
1513 struct lpfc_sli_ring *pring;
1514 struct lpfc_sli *psli;
1515 uint8_t *pcmd;
1516 uint16_t cmdsize;
1517 int rc;
1519 psli = &phba->sli;
1520 pring = &psli->ring[LPFC_ELS_RING];
1522 spin_lock_irq(shost->host_lock);
1523 if (ndlp->nlp_flag & NLP_LOGO_SND) {
1524 spin_unlock_irq(shost->host_lock);
1525 return 0;
1527 spin_unlock_irq(shost->host_lock);
1529 cmdsize = (2 * sizeof(uint32_t)) + sizeof(struct lpfc_name);
1530 elsiocb = lpfc_prep_els_iocb(vport, 1, cmdsize, retry, ndlp,
1531 ndlp->nlp_DID, ELS_CMD_LOGO);
1532 if (!elsiocb)
1533 return 1;
1535 icmd = &elsiocb->iocb;
1536 pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
1537 *((uint32_t *) (pcmd)) = ELS_CMD_LOGO;
1538 pcmd += sizeof(uint32_t);
1540 /* Fill in LOGO payload */
1541 *((uint32_t *) (pcmd)) = be32_to_cpu(vport->fc_myDID);
1542 pcmd += sizeof(uint32_t);
1543 memcpy(pcmd, &vport->fc_portname, sizeof(struct lpfc_name));
1545 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
1546 "Issue LOGO: did:x%x",
1547 ndlp->nlp_DID, 0, 0);
1549 phba->fc_stat.elsXmitLOGO++;
1550 elsiocb->iocb_cmpl = lpfc_cmpl_els_logo;
1551 spin_lock_irq(shost->host_lock);
1552 ndlp->nlp_flag |= NLP_LOGO_SND;
1553 spin_unlock_irq(shost->host_lock);
1554 rc = lpfc_sli_issue_iocb(phba, pring, elsiocb, 0);
1556 if (rc == IOCB_ERROR) {
1557 spin_lock_irq(shost->host_lock);
1558 ndlp->nlp_flag &= ~NLP_LOGO_SND;
1559 spin_unlock_irq(shost->host_lock);
1560 lpfc_els_free_iocb(phba, elsiocb);
1561 return 1;
1563 return 0;
1566 static void
1567 lpfc_cmpl_els_cmd(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
1568 struct lpfc_iocbq *rspiocb)
1570 struct lpfc_vport *vport = cmdiocb->vport;
1571 IOCB_t *irsp;
1573 irsp = &rspiocb->iocb;
1575 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
1576 "ELS cmd cmpl: status:x%x/x%x did:x%x",
1577 irsp->ulpStatus, irsp->un.ulpWord[4],
1578 irsp->un.elsreq64.remoteID);
1579 /* ELS cmd tag <ulpIoTag> completes */
1580 lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,
1581 "0106 ELS cmd tag x%x completes Data: x%x x%x x%x\n",
1582 irsp->ulpIoTag, irsp->ulpStatus,
1583 irsp->un.ulpWord[4], irsp->ulpTimeout);
1584 /* Check to see if link went down during discovery */
1585 lpfc_els_chk_latt(vport);
1586 lpfc_els_free_iocb(phba, cmdiocb);
1587 return;
1591 lpfc_issue_els_scr(struct lpfc_vport *vport, uint32_t nportid, uint8_t retry)
1593 struct lpfc_hba *phba = vport->phba;
1594 IOCB_t *icmd;
1595 struct lpfc_iocbq *elsiocb;
1596 struct lpfc_sli_ring *pring;
1597 struct lpfc_sli *psli;
1598 uint8_t *pcmd;
1599 uint16_t cmdsize;
1600 struct lpfc_nodelist *ndlp;
1602 psli = &phba->sli;
1603 pring = &psli->ring[LPFC_ELS_RING]; /* ELS ring */
1604 cmdsize = (sizeof(uint32_t) + sizeof(SCR));
1606 ndlp = lpfc_findnode_did(vport, nportid);
1607 if (!ndlp) {
1608 ndlp = mempool_alloc(phba->nlp_mem_pool, GFP_KERNEL);
1609 if (!ndlp)
1610 return 1;
1611 lpfc_nlp_init(vport, ndlp, nportid);
1612 lpfc_enqueue_node(vport, ndlp);
1613 } else if (!NLP_CHK_NODE_ACT(ndlp)) {
1614 ndlp = lpfc_enable_node(vport, ndlp, NLP_STE_UNUSED_NODE);
1615 if (!ndlp)
1616 return 1;
1619 elsiocb = lpfc_prep_els_iocb(vport, 1, cmdsize, retry, ndlp,
1620 ndlp->nlp_DID, ELS_CMD_SCR);
1622 if (!elsiocb) {
1623 /* This will trigger the release of the node just
1624 * allocated
1626 lpfc_nlp_put(ndlp);
1627 return 1;
1630 icmd = &elsiocb->iocb;
1631 pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
1633 *((uint32_t *) (pcmd)) = ELS_CMD_SCR;
1634 pcmd += sizeof(uint32_t);
1636 /* For SCR, remainder of payload is SCR parameter page */
1637 memset(pcmd, 0, sizeof(SCR));
1638 ((SCR *) pcmd)->Function = SCR_FUNC_FULL;
1640 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
1641 "Issue SCR: did:x%x",
1642 ndlp->nlp_DID, 0, 0);
1644 phba->fc_stat.elsXmitSCR++;
1645 elsiocb->iocb_cmpl = lpfc_cmpl_els_cmd;
1646 if (lpfc_sli_issue_iocb(phba, pring, elsiocb, 0) == IOCB_ERROR) {
1647 /* The additional lpfc_nlp_put will cause the following
1648 * lpfc_els_free_iocb routine to trigger the rlease of
1649 * the node.
1651 lpfc_nlp_put(ndlp);
1652 lpfc_els_free_iocb(phba, elsiocb);
1653 return 1;
1655 /* This will cause the callback-function lpfc_cmpl_els_cmd to
1656 * trigger the release of node.
1658 lpfc_nlp_put(ndlp);
1659 return 0;
1662 static int
1663 lpfc_issue_els_farpr(struct lpfc_vport *vport, uint32_t nportid, uint8_t retry)
1665 struct lpfc_hba *phba = vport->phba;
1666 IOCB_t *icmd;
1667 struct lpfc_iocbq *elsiocb;
1668 struct lpfc_sli_ring *pring;
1669 struct lpfc_sli *psli;
1670 FARP *fp;
1671 uint8_t *pcmd;
1672 uint32_t *lp;
1673 uint16_t cmdsize;
1674 struct lpfc_nodelist *ondlp;
1675 struct lpfc_nodelist *ndlp;
1677 psli = &phba->sli;
1678 pring = &psli->ring[LPFC_ELS_RING]; /* ELS ring */
1679 cmdsize = (sizeof(uint32_t) + sizeof(FARP));
1681 ndlp = lpfc_findnode_did(vport, nportid);
1682 if (!ndlp) {
1683 ndlp = mempool_alloc(phba->nlp_mem_pool, GFP_KERNEL);
1684 if (!ndlp)
1685 return 1;
1686 lpfc_nlp_init(vport, ndlp, nportid);
1687 lpfc_enqueue_node(vport, ndlp);
1688 } else if (!NLP_CHK_NODE_ACT(ndlp)) {
1689 ndlp = lpfc_enable_node(vport, ndlp, NLP_STE_UNUSED_NODE);
1690 if (!ndlp)
1691 return 1;
1694 elsiocb = lpfc_prep_els_iocb(vport, 1, cmdsize, retry, ndlp,
1695 ndlp->nlp_DID, ELS_CMD_RNID);
1696 if (!elsiocb) {
1697 /* This will trigger the release of the node just
1698 * allocated
1700 lpfc_nlp_put(ndlp);
1701 return 1;
1704 icmd = &elsiocb->iocb;
1705 pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
1707 *((uint32_t *) (pcmd)) = ELS_CMD_FARPR;
1708 pcmd += sizeof(uint32_t);
1710 /* Fill in FARPR payload */
1711 fp = (FARP *) (pcmd);
1712 memset(fp, 0, sizeof(FARP));
1713 lp = (uint32_t *) pcmd;
1714 *lp++ = be32_to_cpu(nportid);
1715 *lp++ = be32_to_cpu(vport->fc_myDID);
1716 fp->Rflags = 0;
1717 fp->Mflags = (FARP_MATCH_PORT | FARP_MATCH_NODE);
1719 memcpy(&fp->RportName, &vport->fc_portname, sizeof(struct lpfc_name));
1720 memcpy(&fp->RnodeName, &vport->fc_nodename, sizeof(struct lpfc_name));
1721 ondlp = lpfc_findnode_did(vport, nportid);
1722 if (ondlp && NLP_CHK_NODE_ACT(ondlp)) {
1723 memcpy(&fp->OportName, &ondlp->nlp_portname,
1724 sizeof(struct lpfc_name));
1725 memcpy(&fp->OnodeName, &ondlp->nlp_nodename,
1726 sizeof(struct lpfc_name));
1729 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
1730 "Issue FARPR: did:x%x",
1731 ndlp->nlp_DID, 0, 0);
1733 phba->fc_stat.elsXmitFARPR++;
1734 elsiocb->iocb_cmpl = lpfc_cmpl_els_cmd;
1735 if (lpfc_sli_issue_iocb(phba, pring, elsiocb, 0) == IOCB_ERROR) {
1736 /* The additional lpfc_nlp_put will cause the following
1737 * lpfc_els_free_iocb routine to trigger the release of
1738 * the node.
1740 lpfc_nlp_put(ndlp);
1741 lpfc_els_free_iocb(phba, elsiocb);
1742 return 1;
1744 /* This will cause the callback-function lpfc_cmpl_els_cmd to
1745 * trigger the release of the node.
1747 lpfc_nlp_put(ndlp);
1748 return 0;
1751 void
1752 lpfc_cancel_retry_delay_tmo(struct lpfc_vport *vport, struct lpfc_nodelist *nlp)
1754 struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
1755 struct lpfc_work_evt *evtp;
1757 if (!(nlp->nlp_flag & NLP_DELAY_TMO))
1758 return;
1759 spin_lock_irq(shost->host_lock);
1760 nlp->nlp_flag &= ~NLP_DELAY_TMO;
1761 spin_unlock_irq(shost->host_lock);
1762 del_timer_sync(&nlp->nlp_delayfunc);
1763 nlp->nlp_last_elscmd = 0;
1764 if (!list_empty(&nlp->els_retry_evt.evt_listp)) {
1765 list_del_init(&nlp->els_retry_evt.evt_listp);
1766 /* Decrement nlp reference count held for the delayed retry */
1767 evtp = &nlp->els_retry_evt;
1768 lpfc_nlp_put((struct lpfc_nodelist *)evtp->evt_arg1);
1770 if (nlp->nlp_flag & NLP_NPR_2B_DISC) {
1771 spin_lock_irq(shost->host_lock);
1772 nlp->nlp_flag &= ~NLP_NPR_2B_DISC;
1773 spin_unlock_irq(shost->host_lock);
1774 if (vport->num_disc_nodes) {
1775 if (vport->port_state < LPFC_VPORT_READY) {
1776 /* Check if there are more ADISCs to be sent */
1777 lpfc_more_adisc(vport);
1778 if ((vport->num_disc_nodes == 0) &&
1779 (vport->fc_npr_cnt))
1780 lpfc_els_disc_plogi(vport);
1781 } else {
1782 /* Check if there are more PLOGIs to be sent */
1783 lpfc_more_plogi(vport);
1785 if (vport->num_disc_nodes == 0) {
1786 spin_lock_irq(shost->host_lock);
1787 vport->fc_flag &= ~FC_NDISC_ACTIVE;
1788 spin_unlock_irq(shost->host_lock);
1789 lpfc_can_disctmo(vport);
1790 lpfc_end_rscn(vport);
1794 return;
1797 void
1798 lpfc_els_retry_delay(unsigned long ptr)
1800 struct lpfc_nodelist *ndlp = (struct lpfc_nodelist *) ptr;
1801 struct lpfc_vport *vport = ndlp->vport;
1802 struct lpfc_hba *phba = vport->phba;
1803 unsigned long flags;
1804 struct lpfc_work_evt *evtp = &ndlp->els_retry_evt;
1806 spin_lock_irqsave(&phba->hbalock, flags);
1807 if (!list_empty(&evtp->evt_listp)) {
1808 spin_unlock_irqrestore(&phba->hbalock, flags);
1809 return;
1812 /* We need to hold the node by incrementing the reference
1813 * count until the queued work is done
1815 evtp->evt_arg1 = lpfc_nlp_get(ndlp);
1816 if (evtp->evt_arg1) {
1817 evtp->evt = LPFC_EVT_ELS_RETRY;
1818 list_add_tail(&evtp->evt_listp, &phba->work_list);
1819 lpfc_worker_wake_up(phba);
1821 spin_unlock_irqrestore(&phba->hbalock, flags);
1822 return;
1825 void
1826 lpfc_els_retry_delay_handler(struct lpfc_nodelist *ndlp)
1828 struct lpfc_vport *vport = ndlp->vport;
1829 struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
1830 uint32_t cmd, did, retry;
1832 spin_lock_irq(shost->host_lock);
1833 did = ndlp->nlp_DID;
1834 cmd = ndlp->nlp_last_elscmd;
1835 ndlp->nlp_last_elscmd = 0;
1837 if (!(ndlp->nlp_flag & NLP_DELAY_TMO)) {
1838 spin_unlock_irq(shost->host_lock);
1839 return;
1842 ndlp->nlp_flag &= ~NLP_DELAY_TMO;
1843 spin_unlock_irq(shost->host_lock);
1845 * If a discovery event readded nlp_delayfunc after timer
1846 * firing and before processing the timer, cancel the
1847 * nlp_delayfunc.
1849 del_timer_sync(&ndlp->nlp_delayfunc);
1850 retry = ndlp->nlp_retry;
1852 switch (cmd) {
1853 case ELS_CMD_FLOGI:
1854 lpfc_issue_els_flogi(vport, ndlp, retry);
1855 break;
1856 case ELS_CMD_PLOGI:
1857 if (!lpfc_issue_els_plogi(vport, ndlp->nlp_DID, retry)) {
1858 ndlp->nlp_prev_state = ndlp->nlp_state;
1859 lpfc_nlp_set_state(vport, ndlp, NLP_STE_PLOGI_ISSUE);
1861 break;
1862 case ELS_CMD_ADISC:
1863 if (!lpfc_issue_els_adisc(vport, ndlp, retry)) {
1864 ndlp->nlp_prev_state = ndlp->nlp_state;
1865 lpfc_nlp_set_state(vport, ndlp, NLP_STE_ADISC_ISSUE);
1867 break;
1868 case ELS_CMD_PRLI:
1869 if (!lpfc_issue_els_prli(vport, ndlp, retry)) {
1870 ndlp->nlp_prev_state = ndlp->nlp_state;
1871 lpfc_nlp_set_state(vport, ndlp, NLP_STE_PRLI_ISSUE);
1873 break;
1874 case ELS_CMD_LOGO:
1875 if (!lpfc_issue_els_logo(vport, ndlp, retry)) {
1876 ndlp->nlp_prev_state = ndlp->nlp_state;
1877 lpfc_nlp_set_state(vport, ndlp, NLP_STE_NPR_NODE);
1879 break;
1880 case ELS_CMD_FDISC:
1881 lpfc_issue_els_fdisc(vport, ndlp, retry);
1882 break;
1884 return;
1887 static int
1888 lpfc_els_retry(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
1889 struct lpfc_iocbq *rspiocb)
1891 struct lpfc_vport *vport = cmdiocb->vport;
1892 struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
1893 IOCB_t *irsp = &rspiocb->iocb;
1894 struct lpfc_nodelist *ndlp = (struct lpfc_nodelist *) cmdiocb->context1;
1895 struct lpfc_dmabuf *pcmd = (struct lpfc_dmabuf *) cmdiocb->context2;
1896 uint32_t *elscmd;
1897 struct ls_rjt stat;
1898 int retry = 0, maxretry = lpfc_max_els_tries, delay = 0;
1899 int logerr = 0;
1900 uint32_t cmd = 0;
1901 uint32_t did;
1904 /* Note: context2 may be 0 for internal driver abort
1905 * of delays ELS command.
1908 if (pcmd && pcmd->virt) {
1909 elscmd = (uint32_t *) (pcmd->virt);
1910 cmd = *elscmd++;
1913 if (ndlp && NLP_CHK_NODE_ACT(ndlp))
1914 did = ndlp->nlp_DID;
1915 else {
1916 /* We should only hit this case for retrying PLOGI */
1917 did = irsp->un.elsreq64.remoteID;
1918 ndlp = lpfc_findnode_did(vport, did);
1919 if ((!ndlp || !NLP_CHK_NODE_ACT(ndlp))
1920 && (cmd != ELS_CMD_PLOGI))
1921 return 1;
1924 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
1925 "Retry ELS: wd7:x%x wd4:x%x did:x%x",
1926 *(((uint32_t *) irsp) + 7), irsp->un.ulpWord[4], ndlp->nlp_DID);
1928 switch (irsp->ulpStatus) {
1929 case IOSTAT_FCP_RSP_ERROR:
1930 case IOSTAT_REMOTE_STOP:
1931 break;
1933 case IOSTAT_LOCAL_REJECT:
1934 switch ((irsp->un.ulpWord[4] & 0xff)) {
1935 case IOERR_LOOP_OPEN_FAILURE:
1936 if (cmd == ELS_CMD_PLOGI && cmdiocb->retry == 0)
1937 delay = 1000;
1938 retry = 1;
1939 break;
1941 case IOERR_ILLEGAL_COMMAND:
1942 lpfc_printf_vlog(vport, KERN_ERR, LOG_ELS,
1943 "0124 Retry illegal cmd x%x "
1944 "retry:x%x delay:x%x\n",
1945 cmd, cmdiocb->retry, delay);
1946 retry = 1;
1947 /* All command's retry policy */
1948 maxretry = 8;
1949 if (cmdiocb->retry > 2)
1950 delay = 1000;
1951 break;
1953 case IOERR_NO_RESOURCES:
1954 logerr = 1; /* HBA out of resources */
1955 retry = 1;
1956 if (cmdiocb->retry > 100)
1957 delay = 100;
1958 maxretry = 250;
1959 break;
1961 case IOERR_ILLEGAL_FRAME:
1962 delay = 100;
1963 retry = 1;
1964 break;
1966 case IOERR_SEQUENCE_TIMEOUT:
1967 case IOERR_INVALID_RPI:
1968 retry = 1;
1969 break;
1971 break;
1973 case IOSTAT_NPORT_RJT:
1974 case IOSTAT_FABRIC_RJT:
1975 if (irsp->un.ulpWord[4] & RJT_UNAVAIL_TEMP) {
1976 retry = 1;
1977 break;
1979 break;
1981 case IOSTAT_NPORT_BSY:
1982 case IOSTAT_FABRIC_BSY:
1983 logerr = 1; /* Fabric / Remote NPort out of resources */
1984 retry = 1;
1985 break;
1987 case IOSTAT_LS_RJT:
1988 stat.un.lsRjtError = be32_to_cpu(irsp->un.ulpWord[4]);
1989 /* Added for Vendor specifc support
1990 * Just keep retrying for these Rsn / Exp codes
1992 switch (stat.un.b.lsRjtRsnCode) {
1993 case LSRJT_UNABLE_TPC:
1994 if (stat.un.b.lsRjtRsnCodeExp ==
1995 LSEXP_CMD_IN_PROGRESS) {
1996 if (cmd == ELS_CMD_PLOGI) {
1997 delay = 1000;
1998 maxretry = 48;
2000 retry = 1;
2001 break;
2003 if (cmd == ELS_CMD_PLOGI) {
2004 delay = 1000;
2005 maxretry = lpfc_max_els_tries + 1;
2006 retry = 1;
2007 break;
2009 if ((phba->sli3_options & LPFC_SLI3_NPIV_ENABLED) &&
2010 (cmd == ELS_CMD_FDISC) &&
2011 (stat.un.b.lsRjtRsnCodeExp == LSEXP_OUT_OF_RESOURCE)){
2012 lpfc_printf_vlog(vport, KERN_ERR, LOG_ELS,
2013 "0125 FDISC Failed (x%x). "
2014 "Fabric out of resources\n",
2015 stat.un.lsRjtError);
2016 lpfc_vport_set_state(vport,
2017 FC_VPORT_NO_FABRIC_RSCS);
2019 break;
2021 case LSRJT_LOGICAL_BSY:
2022 if ((cmd == ELS_CMD_PLOGI) ||
2023 (cmd == ELS_CMD_PRLI)) {
2024 delay = 1000;
2025 maxretry = 48;
2026 } else if (cmd == ELS_CMD_FDISC) {
2027 /* FDISC retry policy */
2028 maxretry = 48;
2029 if (cmdiocb->retry >= 32)
2030 delay = 1000;
2032 retry = 1;
2033 break;
2035 case LSRJT_LOGICAL_ERR:
2036 /* There are some cases where switches return this
2037 * error when they are not ready and should be returning
2038 * Logical Busy. We should delay every time.
2040 if (cmd == ELS_CMD_FDISC &&
2041 stat.un.b.lsRjtRsnCodeExp == LSEXP_PORT_LOGIN_REQ) {
2042 maxretry = 3;
2043 delay = 1000;
2044 retry = 1;
2045 break;
2047 case LSRJT_PROTOCOL_ERR:
2048 if ((phba->sli3_options & LPFC_SLI3_NPIV_ENABLED) &&
2049 (cmd == ELS_CMD_FDISC) &&
2050 ((stat.un.b.lsRjtRsnCodeExp == LSEXP_INVALID_PNAME) ||
2051 (stat.un.b.lsRjtRsnCodeExp == LSEXP_INVALID_NPORT_ID))
2053 lpfc_printf_vlog(vport, KERN_ERR, LOG_ELS,
2054 "0123 FDISC Failed (x%x). "
2055 "Fabric Detected Bad WWN\n",
2056 stat.un.lsRjtError);
2057 lpfc_vport_set_state(vport,
2058 FC_VPORT_FABRIC_REJ_WWN);
2060 break;
2062 break;
2064 case IOSTAT_INTERMED_RSP:
2065 case IOSTAT_BA_RJT:
2066 break;
2068 default:
2069 break;
2072 if (did == FDMI_DID)
2073 retry = 1;
2075 if ((cmd == ELS_CMD_FLOGI) &&
2076 (phba->fc_topology != TOPOLOGY_LOOP) &&
2077 !lpfc_error_lost_link(irsp)) {
2078 /* FLOGI retry policy */
2079 retry = 1;
2080 maxretry = 48;
2081 if (cmdiocb->retry >= 32)
2082 delay = 1000;
2085 if ((++cmdiocb->retry) >= maxretry) {
2086 phba->fc_stat.elsRetryExceeded++;
2087 retry = 0;
2090 if ((vport->load_flag & FC_UNLOADING) != 0)
2091 retry = 0;
2093 if (retry) {
2095 /* Retry ELS command <elsCmd> to remote NPORT <did> */
2096 lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,
2097 "0107 Retry ELS command x%x to remote "
2098 "NPORT x%x Data: x%x x%x\n",
2099 cmd, did, cmdiocb->retry, delay);
2101 if (((cmd == ELS_CMD_PLOGI) || (cmd == ELS_CMD_ADISC)) &&
2102 ((irsp->ulpStatus != IOSTAT_LOCAL_REJECT) ||
2103 ((irsp->un.ulpWord[4] & 0xff) != IOERR_NO_RESOURCES))) {
2104 /* Don't reset timer for no resources */
2106 /* If discovery / RSCN timer is running, reset it */
2107 if (timer_pending(&vport->fc_disctmo) ||
2108 (vport->fc_flag & FC_RSCN_MODE))
2109 lpfc_set_disctmo(vport);
2112 phba->fc_stat.elsXmitRetry++;
2113 if (ndlp && NLP_CHK_NODE_ACT(ndlp) && delay) {
2114 phba->fc_stat.elsDelayRetry++;
2115 ndlp->nlp_retry = cmdiocb->retry;
2117 /* delay is specified in milliseconds */
2118 mod_timer(&ndlp->nlp_delayfunc,
2119 jiffies + msecs_to_jiffies(delay));
2120 spin_lock_irq(shost->host_lock);
2121 ndlp->nlp_flag |= NLP_DELAY_TMO;
2122 spin_unlock_irq(shost->host_lock);
2124 ndlp->nlp_prev_state = ndlp->nlp_state;
2125 if (cmd == ELS_CMD_PRLI)
2126 lpfc_nlp_set_state(vport, ndlp,
2127 NLP_STE_REG_LOGIN_ISSUE);
2128 else
2129 lpfc_nlp_set_state(vport, ndlp,
2130 NLP_STE_NPR_NODE);
2131 ndlp->nlp_last_elscmd = cmd;
2133 return 1;
2135 switch (cmd) {
2136 case ELS_CMD_FLOGI:
2137 lpfc_issue_els_flogi(vport, ndlp, cmdiocb->retry);
2138 return 1;
2139 case ELS_CMD_FDISC:
2140 lpfc_issue_els_fdisc(vport, ndlp, cmdiocb->retry);
2141 return 1;
2142 case ELS_CMD_PLOGI:
2143 if (ndlp && NLP_CHK_NODE_ACT(ndlp)) {
2144 ndlp->nlp_prev_state = ndlp->nlp_state;
2145 lpfc_nlp_set_state(vport, ndlp,
2146 NLP_STE_PLOGI_ISSUE);
2148 lpfc_issue_els_plogi(vport, did, cmdiocb->retry);
2149 return 1;
2150 case ELS_CMD_ADISC:
2151 ndlp->nlp_prev_state = ndlp->nlp_state;
2152 lpfc_nlp_set_state(vport, ndlp, NLP_STE_ADISC_ISSUE);
2153 lpfc_issue_els_adisc(vport, ndlp, cmdiocb->retry);
2154 return 1;
2155 case ELS_CMD_PRLI:
2156 ndlp->nlp_prev_state = ndlp->nlp_state;
2157 lpfc_nlp_set_state(vport, ndlp, NLP_STE_PRLI_ISSUE);
2158 lpfc_issue_els_prli(vport, ndlp, cmdiocb->retry);
2159 return 1;
2160 case ELS_CMD_LOGO:
2161 ndlp->nlp_prev_state = ndlp->nlp_state;
2162 lpfc_nlp_set_state(vport, ndlp, NLP_STE_NPR_NODE);
2163 lpfc_issue_els_logo(vport, ndlp, cmdiocb->retry);
2164 return 1;
2167 /* No retry ELS command <elsCmd> to remote NPORT <did> */
2168 if (logerr) {
2169 lpfc_printf_vlog(vport, KERN_ERR, LOG_ELS,
2170 "0137 No retry ELS command x%x to remote "
2171 "NPORT x%x: Out of Resources: Error:x%x/%x\n",
2172 cmd, did, irsp->ulpStatus,
2173 irsp->un.ulpWord[4]);
2175 else {
2176 lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,
2177 "0108 No retry ELS command x%x to remote "
2178 "NPORT x%x Retried:%d Error:x%x/%x\n",
2179 cmd, did, cmdiocb->retry, irsp->ulpStatus,
2180 irsp->un.ulpWord[4]);
2182 return 0;
2185 static int
2186 lpfc_els_free_data(struct lpfc_hba *phba, struct lpfc_dmabuf *buf_ptr1)
2188 struct lpfc_dmabuf *buf_ptr;
2190 /* Free the response before processing the command. */
2191 if (!list_empty(&buf_ptr1->list)) {
2192 list_remove_head(&buf_ptr1->list, buf_ptr,
2193 struct lpfc_dmabuf,
2194 list);
2195 lpfc_mbuf_free(phba, buf_ptr->virt, buf_ptr->phys);
2196 kfree(buf_ptr);
2198 lpfc_mbuf_free(phba, buf_ptr1->virt, buf_ptr1->phys);
2199 kfree(buf_ptr1);
2200 return 0;
2203 static int
2204 lpfc_els_free_bpl(struct lpfc_hba *phba, struct lpfc_dmabuf *buf_ptr)
2206 lpfc_mbuf_free(phba, buf_ptr->virt, buf_ptr->phys);
2207 kfree(buf_ptr);
2208 return 0;
2212 lpfc_els_free_iocb(struct lpfc_hba *phba, struct lpfc_iocbq *elsiocb)
2214 struct lpfc_dmabuf *buf_ptr, *buf_ptr1;
2215 struct lpfc_nodelist *ndlp;
2217 ndlp = (struct lpfc_nodelist *)elsiocb->context1;
2218 if (ndlp) {
2219 if (ndlp->nlp_flag & NLP_DEFER_RM) {
2220 lpfc_nlp_put(ndlp);
2222 /* If the ndlp is not being used by another discovery
2223 * thread, free it.
2225 if (!lpfc_nlp_not_used(ndlp)) {
2226 /* If ndlp is being used by another discovery
2227 * thread, just clear NLP_DEFER_RM
2229 ndlp->nlp_flag &= ~NLP_DEFER_RM;
2232 else
2233 lpfc_nlp_put(ndlp);
2234 elsiocb->context1 = NULL;
2236 /* context2 = cmd, context2->next = rsp, context3 = bpl */
2237 if (elsiocb->context2) {
2238 if (elsiocb->iocb_flag & LPFC_DELAY_MEM_FREE) {
2239 /* Firmware could still be in progress of DMAing
2240 * payload, so don't free data buffer till after
2241 * a hbeat.
2243 elsiocb->iocb_flag &= ~LPFC_DELAY_MEM_FREE;
2244 buf_ptr = elsiocb->context2;
2245 elsiocb->context2 = NULL;
2246 if (buf_ptr) {
2247 buf_ptr1 = NULL;
2248 spin_lock_irq(&phba->hbalock);
2249 if (!list_empty(&buf_ptr->list)) {
2250 list_remove_head(&buf_ptr->list,
2251 buf_ptr1, struct lpfc_dmabuf,
2252 list);
2253 INIT_LIST_HEAD(&buf_ptr1->list);
2254 list_add_tail(&buf_ptr1->list,
2255 &phba->elsbuf);
2256 phba->elsbuf_cnt++;
2258 INIT_LIST_HEAD(&buf_ptr->list);
2259 list_add_tail(&buf_ptr->list, &phba->elsbuf);
2260 phba->elsbuf_cnt++;
2261 spin_unlock_irq(&phba->hbalock);
2263 } else {
2264 buf_ptr1 = (struct lpfc_dmabuf *) elsiocb->context2;
2265 lpfc_els_free_data(phba, buf_ptr1);
2269 if (elsiocb->context3) {
2270 buf_ptr = (struct lpfc_dmabuf *) elsiocb->context3;
2271 lpfc_els_free_bpl(phba, buf_ptr);
2273 lpfc_sli_release_iocbq(phba, elsiocb);
2274 return 0;
2277 static void
2278 lpfc_cmpl_els_logo_acc(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
2279 struct lpfc_iocbq *rspiocb)
2281 struct lpfc_nodelist *ndlp = (struct lpfc_nodelist *) cmdiocb->context1;
2282 struct lpfc_vport *vport = cmdiocb->vport;
2283 IOCB_t *irsp;
2285 irsp = &rspiocb->iocb;
2286 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_RSP,
2287 "ACC LOGO cmpl: status:x%x/x%x did:x%x",
2288 irsp->ulpStatus, irsp->un.ulpWord[4], ndlp->nlp_DID);
2289 /* ACC to LOGO completes to NPort <nlp_DID> */
2290 lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,
2291 "0109 ACC to LOGO completes to NPort x%x "
2292 "Data: x%x x%x x%x\n",
2293 ndlp->nlp_DID, ndlp->nlp_flag, ndlp->nlp_state,
2294 ndlp->nlp_rpi);
2296 if (ndlp->nlp_state == NLP_STE_NPR_NODE) {
2297 /* NPort Recovery mode or node is just allocated */
2298 if (!lpfc_nlp_not_used(ndlp)) {
2299 /* If the ndlp is being used by another discovery
2300 * thread, just unregister the RPI.
2302 lpfc_unreg_rpi(vport, ndlp);
2303 } else {
2304 /* Indicate the node has already released, should
2305 * not reference to it from within lpfc_els_free_iocb.
2307 cmdiocb->context1 = NULL;
2310 lpfc_els_free_iocb(phba, cmdiocb);
2311 return;
2314 void
2315 lpfc_mbx_cmpl_dflt_rpi(struct lpfc_hba *phba, LPFC_MBOXQ_t *pmb)
2317 struct lpfc_dmabuf *mp = (struct lpfc_dmabuf *) (pmb->context1);
2318 struct lpfc_nodelist *ndlp = (struct lpfc_nodelist *) pmb->context2;
2320 pmb->context1 = NULL;
2321 lpfc_mbuf_free(phba, mp->virt, mp->phys);
2322 kfree(mp);
2323 mempool_free(pmb, phba->mbox_mem_pool);
2324 if (ndlp && NLP_CHK_NODE_ACT(ndlp)) {
2325 lpfc_nlp_put(ndlp);
2326 /* This is the end of the default RPI cleanup logic for this
2327 * ndlp. If no other discovery threads are using this ndlp.
2328 * we should free all resources associated with it.
2330 lpfc_nlp_not_used(ndlp);
2332 return;
2335 static void
2336 lpfc_cmpl_els_rsp(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
2337 struct lpfc_iocbq *rspiocb)
2339 struct lpfc_nodelist *ndlp = (struct lpfc_nodelist *) cmdiocb->context1;
2340 struct lpfc_vport *vport = ndlp ? ndlp->vport : NULL;
2341 struct Scsi_Host *shost = vport ? lpfc_shost_from_vport(vport) : NULL;
2342 IOCB_t *irsp;
2343 uint8_t *pcmd;
2344 LPFC_MBOXQ_t *mbox = NULL;
2345 struct lpfc_dmabuf *mp = NULL;
2346 uint32_t ls_rjt = 0;
2348 irsp = &rspiocb->iocb;
2350 if (cmdiocb->context_un.mbox)
2351 mbox = cmdiocb->context_un.mbox;
2353 /* First determine if this is a LS_RJT cmpl. Note, this callback
2354 * function can have cmdiocb->contest1 (ndlp) field set to NULL.
2356 pcmd = (uint8_t *) (((struct lpfc_dmabuf *) cmdiocb->context2)->virt);
2357 if (ndlp && NLP_CHK_NODE_ACT(ndlp) &&
2358 (*((uint32_t *) (pcmd)) == ELS_CMD_LS_RJT)) {
2359 /* A LS_RJT associated with Default RPI cleanup has its own
2360 * seperate code path.
2362 if (!(ndlp->nlp_flag & NLP_RM_DFLT_RPI))
2363 ls_rjt = 1;
2366 /* Check to see if link went down during discovery */
2367 if (!ndlp || !NLP_CHK_NODE_ACT(ndlp) || lpfc_els_chk_latt(vport)) {
2368 if (mbox) {
2369 mp = (struct lpfc_dmabuf *) mbox->context1;
2370 if (mp) {
2371 lpfc_mbuf_free(phba, mp->virt, mp->phys);
2372 kfree(mp);
2374 mempool_free(mbox, phba->mbox_mem_pool);
2376 if (ndlp && NLP_CHK_NODE_ACT(ndlp) &&
2377 (ndlp->nlp_flag & NLP_RM_DFLT_RPI))
2378 if (lpfc_nlp_not_used(ndlp)) {
2379 ndlp = NULL;
2380 /* Indicate the node has already released,
2381 * should not reference to it from within
2382 * the routine lpfc_els_free_iocb.
2384 cmdiocb->context1 = NULL;
2386 goto out;
2389 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_RSP,
2390 "ELS rsp cmpl: status:x%x/x%x did:x%x",
2391 irsp->ulpStatus, irsp->un.ulpWord[4],
2392 cmdiocb->iocb.un.elsreq64.remoteID);
2393 /* ELS response tag <ulpIoTag> completes */
2394 lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,
2395 "0110 ELS response tag x%x completes "
2396 "Data: x%x x%x x%x x%x x%x x%x x%x\n",
2397 cmdiocb->iocb.ulpIoTag, rspiocb->iocb.ulpStatus,
2398 rspiocb->iocb.un.ulpWord[4], rspiocb->iocb.ulpTimeout,
2399 ndlp->nlp_DID, ndlp->nlp_flag, ndlp->nlp_state,
2400 ndlp->nlp_rpi);
2401 if (mbox) {
2402 if ((rspiocb->iocb.ulpStatus == 0)
2403 && (ndlp->nlp_flag & NLP_ACC_REGLOGIN)) {
2404 lpfc_unreg_rpi(vport, ndlp);
2405 /* Increment reference count to ndlp to hold the
2406 * reference to ndlp for the callback function.
2408 mbox->context2 = lpfc_nlp_get(ndlp);
2409 mbox->vport = vport;
2410 if (ndlp->nlp_flag & NLP_RM_DFLT_RPI) {
2411 mbox->mbox_flag |= LPFC_MBX_IMED_UNREG;
2412 mbox->mbox_cmpl = lpfc_mbx_cmpl_dflt_rpi;
2414 else {
2415 mbox->mbox_cmpl = lpfc_mbx_cmpl_reg_login;
2416 ndlp->nlp_prev_state = ndlp->nlp_state;
2417 lpfc_nlp_set_state(vport, ndlp,
2418 NLP_STE_REG_LOGIN_ISSUE);
2420 if (lpfc_sli_issue_mbox(phba, mbox, MBX_NOWAIT)
2421 != MBX_NOT_FINISHED)
2422 goto out;
2423 else
2424 /* Decrement the ndlp reference count we
2425 * set for this failed mailbox command.
2427 lpfc_nlp_put(ndlp);
2429 /* ELS rsp: Cannot issue reg_login for <NPortid> */
2430 lpfc_printf_vlog(vport, KERN_ERR, LOG_ELS,
2431 "0138 ELS rsp: Cannot issue reg_login for x%x "
2432 "Data: x%x x%x x%x\n",
2433 ndlp->nlp_DID, ndlp->nlp_flag, ndlp->nlp_state,
2434 ndlp->nlp_rpi);
2436 if (lpfc_nlp_not_used(ndlp)) {
2437 ndlp = NULL;
2438 /* Indicate node has already been released,
2439 * should not reference to it from within
2440 * the routine lpfc_els_free_iocb.
2442 cmdiocb->context1 = NULL;
2444 } else {
2445 /* Do not drop node for lpfc_els_abort'ed ELS cmds */
2446 if (!lpfc_error_lost_link(irsp) &&
2447 ndlp->nlp_flag & NLP_ACC_REGLOGIN) {
2448 if (lpfc_nlp_not_used(ndlp)) {
2449 ndlp = NULL;
2450 /* Indicate node has already been
2451 * released, should not reference
2452 * to it from within the routine
2453 * lpfc_els_free_iocb.
2455 cmdiocb->context1 = NULL;
2459 mp = (struct lpfc_dmabuf *) mbox->context1;
2460 if (mp) {
2461 lpfc_mbuf_free(phba, mp->virt, mp->phys);
2462 kfree(mp);
2464 mempool_free(mbox, phba->mbox_mem_pool);
2466 out:
2467 if (ndlp && NLP_CHK_NODE_ACT(ndlp)) {
2468 spin_lock_irq(shost->host_lock);
2469 ndlp->nlp_flag &= ~(NLP_ACC_REGLOGIN | NLP_RM_DFLT_RPI);
2470 spin_unlock_irq(shost->host_lock);
2472 /* If the node is not being used by another discovery thread,
2473 * and we are sending a reject, we are done with it.
2474 * Release driver reference count here and free associated
2475 * resources.
2477 if (ls_rjt)
2478 if (lpfc_nlp_not_used(ndlp))
2479 /* Indicate node has already been released,
2480 * should not reference to it from within
2481 * the routine lpfc_els_free_iocb.
2483 cmdiocb->context1 = NULL;
2486 lpfc_els_free_iocb(phba, cmdiocb);
2487 return;
2491 lpfc_els_rsp_acc(struct lpfc_vport *vport, uint32_t flag,
2492 struct lpfc_iocbq *oldiocb, struct lpfc_nodelist *ndlp,
2493 LPFC_MBOXQ_t *mbox)
2495 struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
2496 struct lpfc_hba *phba = vport->phba;
2497 IOCB_t *icmd;
2498 IOCB_t *oldcmd;
2499 struct lpfc_iocbq *elsiocb;
2500 struct lpfc_sli_ring *pring;
2501 struct lpfc_sli *psli;
2502 uint8_t *pcmd;
2503 uint16_t cmdsize;
2504 int rc;
2505 ELS_PKT *els_pkt_ptr;
2507 psli = &phba->sli;
2508 pring = &psli->ring[LPFC_ELS_RING]; /* ELS ring */
2509 oldcmd = &oldiocb->iocb;
2511 switch (flag) {
2512 case ELS_CMD_ACC:
2513 cmdsize = sizeof(uint32_t);
2514 elsiocb = lpfc_prep_els_iocb(vport, 0, cmdsize, oldiocb->retry,
2515 ndlp, ndlp->nlp_DID, ELS_CMD_ACC);
2516 if (!elsiocb) {
2517 spin_lock_irq(shost->host_lock);
2518 ndlp->nlp_flag &= ~NLP_LOGO_ACC;
2519 spin_unlock_irq(shost->host_lock);
2520 return 1;
2523 icmd = &elsiocb->iocb;
2524 icmd->ulpContext = oldcmd->ulpContext; /* Xri */
2525 pcmd = (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
2526 *((uint32_t *) (pcmd)) = ELS_CMD_ACC;
2527 pcmd += sizeof(uint32_t);
2529 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_RSP,
2530 "Issue ACC: did:x%x flg:x%x",
2531 ndlp->nlp_DID, ndlp->nlp_flag, 0);
2532 break;
2533 case ELS_CMD_PLOGI:
2534 cmdsize = (sizeof(struct serv_parm) + sizeof(uint32_t));
2535 elsiocb = lpfc_prep_els_iocb(vport, 0, cmdsize, oldiocb->retry,
2536 ndlp, ndlp->nlp_DID, ELS_CMD_ACC);
2537 if (!elsiocb)
2538 return 1;
2540 icmd = &elsiocb->iocb;
2541 icmd->ulpContext = oldcmd->ulpContext; /* Xri */
2542 pcmd = (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
2544 if (mbox)
2545 elsiocb->context_un.mbox = mbox;
2547 *((uint32_t *) (pcmd)) = ELS_CMD_ACC;
2548 pcmd += sizeof(uint32_t);
2549 memcpy(pcmd, &vport->fc_sparam, sizeof(struct serv_parm));
2551 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_RSP,
2552 "Issue ACC PLOGI: did:x%x flg:x%x",
2553 ndlp->nlp_DID, ndlp->nlp_flag, 0);
2554 break;
2555 case ELS_CMD_PRLO:
2556 cmdsize = sizeof(uint32_t) + sizeof(PRLO);
2557 elsiocb = lpfc_prep_els_iocb(vport, 0, cmdsize, oldiocb->retry,
2558 ndlp, ndlp->nlp_DID, ELS_CMD_PRLO);
2559 if (!elsiocb)
2560 return 1;
2562 icmd = &elsiocb->iocb;
2563 icmd->ulpContext = oldcmd->ulpContext; /* Xri */
2564 pcmd = (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
2566 memcpy(pcmd, ((struct lpfc_dmabuf *) oldiocb->context2)->virt,
2567 sizeof(uint32_t) + sizeof(PRLO));
2568 *((uint32_t *) (pcmd)) = ELS_CMD_PRLO_ACC;
2569 els_pkt_ptr = (ELS_PKT *) pcmd;
2570 els_pkt_ptr->un.prlo.acceptRspCode = PRLO_REQ_EXECUTED;
2572 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_RSP,
2573 "Issue ACC PRLO: did:x%x flg:x%x",
2574 ndlp->nlp_DID, ndlp->nlp_flag, 0);
2575 break;
2576 default:
2577 return 1;
2579 /* Xmit ELS ACC response tag <ulpIoTag> */
2580 lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,
2581 "0128 Xmit ELS ACC response tag x%x, XRI: x%x, "
2582 "DID: x%x, nlp_flag: x%x nlp_state: x%x RPI: x%x\n",
2583 elsiocb->iotag, elsiocb->iocb.ulpContext,
2584 ndlp->nlp_DID, ndlp->nlp_flag, ndlp->nlp_state,
2585 ndlp->nlp_rpi);
2586 if (ndlp->nlp_flag & NLP_LOGO_ACC) {
2587 spin_lock_irq(shost->host_lock);
2588 ndlp->nlp_flag &= ~NLP_LOGO_ACC;
2589 spin_unlock_irq(shost->host_lock);
2590 elsiocb->iocb_cmpl = lpfc_cmpl_els_logo_acc;
2591 } else {
2592 elsiocb->iocb_cmpl = lpfc_cmpl_els_rsp;
2595 phba->fc_stat.elsXmitACC++;
2596 rc = lpfc_sli_issue_iocb(phba, pring, elsiocb, 0);
2597 if (rc == IOCB_ERROR) {
2598 lpfc_els_free_iocb(phba, elsiocb);
2599 return 1;
2601 return 0;
2605 lpfc_els_rsp_reject(struct lpfc_vport *vport, uint32_t rejectError,
2606 struct lpfc_iocbq *oldiocb, struct lpfc_nodelist *ndlp,
2607 LPFC_MBOXQ_t *mbox)
2609 struct lpfc_hba *phba = vport->phba;
2610 IOCB_t *icmd;
2611 IOCB_t *oldcmd;
2612 struct lpfc_iocbq *elsiocb;
2613 struct lpfc_sli_ring *pring;
2614 struct lpfc_sli *psli;
2615 uint8_t *pcmd;
2616 uint16_t cmdsize;
2617 int rc;
2619 psli = &phba->sli;
2620 pring = &psli->ring[LPFC_ELS_RING]; /* ELS ring */
2622 cmdsize = 2 * sizeof(uint32_t);
2623 elsiocb = lpfc_prep_els_iocb(vport, 0, cmdsize, oldiocb->retry, ndlp,
2624 ndlp->nlp_DID, ELS_CMD_LS_RJT);
2625 if (!elsiocb)
2626 return 1;
2628 icmd = &elsiocb->iocb;
2629 oldcmd = &oldiocb->iocb;
2630 icmd->ulpContext = oldcmd->ulpContext; /* Xri */
2631 pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
2633 *((uint32_t *) (pcmd)) = ELS_CMD_LS_RJT;
2634 pcmd += sizeof(uint32_t);
2635 *((uint32_t *) (pcmd)) = rejectError;
2637 if (mbox)
2638 elsiocb->context_un.mbox = mbox;
2640 /* Xmit ELS RJT <err> response tag <ulpIoTag> */
2641 lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,
2642 "0129 Xmit ELS RJT x%x response tag x%x "
2643 "xri x%x, did x%x, nlp_flag x%x, nlp_state x%x, "
2644 "rpi x%x\n",
2645 rejectError, elsiocb->iotag,
2646 elsiocb->iocb.ulpContext, ndlp->nlp_DID,
2647 ndlp->nlp_flag, ndlp->nlp_state, ndlp->nlp_rpi);
2648 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_RSP,
2649 "Issue LS_RJT: did:x%x flg:x%x err:x%x",
2650 ndlp->nlp_DID, ndlp->nlp_flag, rejectError);
2652 phba->fc_stat.elsXmitLSRJT++;
2653 elsiocb->iocb_cmpl = lpfc_cmpl_els_rsp;
2654 rc = lpfc_sli_issue_iocb(phba, pring, elsiocb, 0);
2656 if (rc == IOCB_ERROR) {
2657 lpfc_els_free_iocb(phba, elsiocb);
2658 return 1;
2660 return 0;
2664 lpfc_els_rsp_adisc_acc(struct lpfc_vport *vport, struct lpfc_iocbq *oldiocb,
2665 struct lpfc_nodelist *ndlp)
2667 struct lpfc_hba *phba = vport->phba;
2668 struct lpfc_sli *psli = &phba->sli;
2669 struct lpfc_sli_ring *pring = &psli->ring[LPFC_ELS_RING];
2670 ADISC *ap;
2671 IOCB_t *icmd, *oldcmd;
2672 struct lpfc_iocbq *elsiocb;
2673 uint8_t *pcmd;
2674 uint16_t cmdsize;
2675 int rc;
2677 cmdsize = sizeof(uint32_t) + sizeof(ADISC);
2678 elsiocb = lpfc_prep_els_iocb(vport, 0, cmdsize, oldiocb->retry, ndlp,
2679 ndlp->nlp_DID, ELS_CMD_ACC);
2680 if (!elsiocb)
2681 return 1;
2683 icmd = &elsiocb->iocb;
2684 oldcmd = &oldiocb->iocb;
2685 icmd->ulpContext = oldcmd->ulpContext; /* Xri */
2687 /* Xmit ADISC ACC response tag <ulpIoTag> */
2688 lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,
2689 "0130 Xmit ADISC ACC response iotag x%x xri: "
2690 "x%x, did x%x, nlp_flag x%x, nlp_state x%x rpi x%x\n",
2691 elsiocb->iotag, elsiocb->iocb.ulpContext,
2692 ndlp->nlp_DID, ndlp->nlp_flag, ndlp->nlp_state,
2693 ndlp->nlp_rpi);
2694 pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
2696 *((uint32_t *) (pcmd)) = ELS_CMD_ACC;
2697 pcmd += sizeof(uint32_t);
2699 ap = (ADISC *) (pcmd);
2700 ap->hardAL_PA = phba->fc_pref_ALPA;
2701 memcpy(&ap->portName, &vport->fc_portname, sizeof(struct lpfc_name));
2702 memcpy(&ap->nodeName, &vport->fc_nodename, sizeof(struct lpfc_name));
2703 ap->DID = be32_to_cpu(vport->fc_myDID);
2705 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_RSP,
2706 "Issue ACC ADISC: did:x%x flg:x%x",
2707 ndlp->nlp_DID, ndlp->nlp_flag, 0);
2709 phba->fc_stat.elsXmitACC++;
2710 elsiocb->iocb_cmpl = lpfc_cmpl_els_rsp;
2711 rc = lpfc_sli_issue_iocb(phba, pring, elsiocb, 0);
2712 if (rc == IOCB_ERROR) {
2713 lpfc_els_free_iocb(phba, elsiocb);
2714 return 1;
2716 return 0;
2720 lpfc_els_rsp_prli_acc(struct lpfc_vport *vport, struct lpfc_iocbq *oldiocb,
2721 struct lpfc_nodelist *ndlp)
2723 struct lpfc_hba *phba = vport->phba;
2724 PRLI *npr;
2725 lpfc_vpd_t *vpd;
2726 IOCB_t *icmd;
2727 IOCB_t *oldcmd;
2728 struct lpfc_iocbq *elsiocb;
2729 struct lpfc_sli_ring *pring;
2730 struct lpfc_sli *psli;
2731 uint8_t *pcmd;
2732 uint16_t cmdsize;
2733 int rc;
2735 psli = &phba->sli;
2736 pring = &psli->ring[LPFC_ELS_RING]; /* ELS ring */
2738 cmdsize = sizeof(uint32_t) + sizeof(PRLI);
2739 elsiocb = lpfc_prep_els_iocb(vport, 0, cmdsize, oldiocb->retry, ndlp,
2740 ndlp->nlp_DID, (ELS_CMD_ACC | (ELS_CMD_PRLI & ~ELS_RSP_MASK)));
2741 if (!elsiocb)
2742 return 1;
2744 icmd = &elsiocb->iocb;
2745 oldcmd = &oldiocb->iocb;
2746 icmd->ulpContext = oldcmd->ulpContext; /* Xri */
2747 /* Xmit PRLI ACC response tag <ulpIoTag> */
2748 lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,
2749 "0131 Xmit PRLI ACC response tag x%x xri x%x, "
2750 "did x%x, nlp_flag x%x, nlp_state x%x, rpi x%x\n",
2751 elsiocb->iotag, elsiocb->iocb.ulpContext,
2752 ndlp->nlp_DID, ndlp->nlp_flag, ndlp->nlp_state,
2753 ndlp->nlp_rpi);
2754 pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
2756 *((uint32_t *) (pcmd)) = (ELS_CMD_ACC | (ELS_CMD_PRLI & ~ELS_RSP_MASK));
2757 pcmd += sizeof(uint32_t);
2759 /* For PRLI, remainder of payload is PRLI parameter page */
2760 memset(pcmd, 0, sizeof(PRLI));
2762 npr = (PRLI *) pcmd;
2763 vpd = &phba->vpd;
2765 * If the remote port is a target and our firmware version is 3.20 or
2766 * later, set the following bits for FC-TAPE support.
2768 if ((ndlp->nlp_type & NLP_FCP_TARGET) &&
2769 (vpd->rev.feaLevelHigh >= 0x02)) {
2770 npr->ConfmComplAllowed = 1;
2771 npr->Retry = 1;
2772 npr->TaskRetryIdReq = 1;
2775 npr->acceptRspCode = PRLI_REQ_EXECUTED;
2776 npr->estabImagePair = 1;
2777 npr->readXferRdyDis = 1;
2778 npr->ConfmComplAllowed = 1;
2780 npr->prliType = PRLI_FCP_TYPE;
2781 npr->initiatorFunc = 1;
2783 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_RSP,
2784 "Issue ACC PRLI: did:x%x flg:x%x",
2785 ndlp->nlp_DID, ndlp->nlp_flag, 0);
2787 phba->fc_stat.elsXmitACC++;
2788 elsiocb->iocb_cmpl = lpfc_cmpl_els_rsp;
2790 rc = lpfc_sli_issue_iocb(phba, pring, elsiocb, 0);
2791 if (rc == IOCB_ERROR) {
2792 lpfc_els_free_iocb(phba, elsiocb);
2793 return 1;
2795 return 0;
2798 static int
2799 lpfc_els_rsp_rnid_acc(struct lpfc_vport *vport, uint8_t format,
2800 struct lpfc_iocbq *oldiocb, struct lpfc_nodelist *ndlp)
2802 struct lpfc_hba *phba = vport->phba;
2803 RNID *rn;
2804 IOCB_t *icmd, *oldcmd;
2805 struct lpfc_iocbq *elsiocb;
2806 struct lpfc_sli_ring *pring;
2807 struct lpfc_sli *psli;
2808 uint8_t *pcmd;
2809 uint16_t cmdsize;
2810 int rc;
2812 psli = &phba->sli;
2813 pring = &psli->ring[LPFC_ELS_RING];
2815 cmdsize = sizeof(uint32_t) + sizeof(uint32_t)
2816 + (2 * sizeof(struct lpfc_name));
2817 if (format)
2818 cmdsize += sizeof(RNID_TOP_DISC);
2820 elsiocb = lpfc_prep_els_iocb(vport, 0, cmdsize, oldiocb->retry, ndlp,
2821 ndlp->nlp_DID, ELS_CMD_ACC);
2822 if (!elsiocb)
2823 return 1;
2825 icmd = &elsiocb->iocb;
2826 oldcmd = &oldiocb->iocb;
2827 icmd->ulpContext = oldcmd->ulpContext; /* Xri */
2828 /* Xmit RNID ACC response tag <ulpIoTag> */
2829 lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,
2830 "0132 Xmit RNID ACC response tag x%x xri x%x\n",
2831 elsiocb->iotag, elsiocb->iocb.ulpContext);
2832 pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
2833 *((uint32_t *) (pcmd)) = ELS_CMD_ACC;
2834 pcmd += sizeof(uint32_t);
2836 memset(pcmd, 0, sizeof(RNID));
2837 rn = (RNID *) (pcmd);
2838 rn->Format = format;
2839 rn->CommonLen = (2 * sizeof(struct lpfc_name));
2840 memcpy(&rn->portName, &vport->fc_portname, sizeof(struct lpfc_name));
2841 memcpy(&rn->nodeName, &vport->fc_nodename, sizeof(struct lpfc_name));
2842 switch (format) {
2843 case 0:
2844 rn->SpecificLen = 0;
2845 break;
2846 case RNID_TOPOLOGY_DISC:
2847 rn->SpecificLen = sizeof(RNID_TOP_DISC);
2848 memcpy(&rn->un.topologyDisc.portName,
2849 &vport->fc_portname, sizeof(struct lpfc_name));
2850 rn->un.topologyDisc.unitType = RNID_HBA;
2851 rn->un.topologyDisc.physPort = 0;
2852 rn->un.topologyDisc.attachedNodes = 0;
2853 break;
2854 default:
2855 rn->CommonLen = 0;
2856 rn->SpecificLen = 0;
2857 break;
2860 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_RSP,
2861 "Issue ACC RNID: did:x%x flg:x%x",
2862 ndlp->nlp_DID, ndlp->nlp_flag, 0);
2864 phba->fc_stat.elsXmitACC++;
2865 elsiocb->iocb_cmpl = lpfc_cmpl_els_rsp;
2866 lpfc_nlp_put(ndlp);
2867 elsiocb->context1 = NULL; /* Don't need ndlp for cmpl,
2868 * it could be freed */
2870 rc = lpfc_sli_issue_iocb(phba, pring, elsiocb, 0);
2871 if (rc == IOCB_ERROR) {
2872 lpfc_els_free_iocb(phba, elsiocb);
2873 return 1;
2875 return 0;
2879 lpfc_els_disc_adisc(struct lpfc_vport *vport)
2881 struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
2882 struct lpfc_nodelist *ndlp, *next_ndlp;
2883 int sentadisc = 0;
2885 /* go thru NPR nodes and issue any remaining ELS ADISCs */
2886 list_for_each_entry_safe(ndlp, next_ndlp, &vport->fc_nodes, nlp_listp) {
2887 if (!NLP_CHK_NODE_ACT(ndlp))
2888 continue;
2889 if (ndlp->nlp_state == NLP_STE_NPR_NODE &&
2890 (ndlp->nlp_flag & NLP_NPR_2B_DISC) != 0 &&
2891 (ndlp->nlp_flag & NLP_NPR_ADISC) != 0) {
2892 spin_lock_irq(shost->host_lock);
2893 ndlp->nlp_flag &= ~NLP_NPR_ADISC;
2894 spin_unlock_irq(shost->host_lock);
2895 ndlp->nlp_prev_state = ndlp->nlp_state;
2896 lpfc_nlp_set_state(vport, ndlp, NLP_STE_ADISC_ISSUE);
2897 lpfc_issue_els_adisc(vport, ndlp, 0);
2898 sentadisc++;
2899 vport->num_disc_nodes++;
2900 if (vport->num_disc_nodes >=
2901 vport->cfg_discovery_threads) {
2902 spin_lock_irq(shost->host_lock);
2903 vport->fc_flag |= FC_NLP_MORE;
2904 spin_unlock_irq(shost->host_lock);
2905 break;
2909 if (sentadisc == 0) {
2910 spin_lock_irq(shost->host_lock);
2911 vport->fc_flag &= ~FC_NLP_MORE;
2912 spin_unlock_irq(shost->host_lock);
2914 return sentadisc;
2918 lpfc_els_disc_plogi(struct lpfc_vport *vport)
2920 struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
2921 struct lpfc_nodelist *ndlp, *next_ndlp;
2922 int sentplogi = 0;
2924 /* go thru NPR nodes and issue any remaining ELS PLOGIs */
2925 list_for_each_entry_safe(ndlp, next_ndlp, &vport->fc_nodes, nlp_listp) {
2926 if (!NLP_CHK_NODE_ACT(ndlp))
2927 continue;
2928 if (ndlp->nlp_state == NLP_STE_NPR_NODE &&
2929 (ndlp->nlp_flag & NLP_NPR_2B_DISC) != 0 &&
2930 (ndlp->nlp_flag & NLP_DELAY_TMO) == 0 &&
2931 (ndlp->nlp_flag & NLP_NPR_ADISC) == 0) {
2932 ndlp->nlp_prev_state = ndlp->nlp_state;
2933 lpfc_nlp_set_state(vport, ndlp, NLP_STE_PLOGI_ISSUE);
2934 lpfc_issue_els_plogi(vport, ndlp->nlp_DID, 0);
2935 sentplogi++;
2936 vport->num_disc_nodes++;
2937 if (vport->num_disc_nodes >=
2938 vport->cfg_discovery_threads) {
2939 spin_lock_irq(shost->host_lock);
2940 vport->fc_flag |= FC_NLP_MORE;
2941 spin_unlock_irq(shost->host_lock);
2942 break;
2946 if (sentplogi) {
2947 lpfc_set_disctmo(vport);
2949 else {
2950 spin_lock_irq(shost->host_lock);
2951 vport->fc_flag &= ~FC_NLP_MORE;
2952 spin_unlock_irq(shost->host_lock);
2954 return sentplogi;
2957 void
2958 lpfc_els_flush_rscn(struct lpfc_vport *vport)
2960 struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
2961 struct lpfc_hba *phba = vport->phba;
2962 int i;
2964 spin_lock_irq(shost->host_lock);
2965 if (vport->fc_rscn_flush) {
2966 /* Another thread is walking fc_rscn_id_list on this vport */
2967 spin_unlock_irq(shost->host_lock);
2968 return;
2970 /* Indicate we are walking lpfc_els_flush_rscn on this vport */
2971 vport->fc_rscn_flush = 1;
2972 spin_unlock_irq(shost->host_lock);
2974 for (i = 0; i < vport->fc_rscn_id_cnt; i++) {
2975 lpfc_in_buf_free(phba, vport->fc_rscn_id_list[i]);
2976 vport->fc_rscn_id_list[i] = NULL;
2978 spin_lock_irq(shost->host_lock);
2979 vport->fc_rscn_id_cnt = 0;
2980 vport->fc_flag &= ~(FC_RSCN_MODE | FC_RSCN_DISCOVERY);
2981 spin_unlock_irq(shost->host_lock);
2982 lpfc_can_disctmo(vport);
2983 /* Indicate we are done walking this fc_rscn_id_list */
2984 vport->fc_rscn_flush = 0;
2988 lpfc_rscn_payload_check(struct lpfc_vport *vport, uint32_t did)
2990 D_ID ns_did;
2991 D_ID rscn_did;
2992 uint32_t *lp;
2993 uint32_t payload_len, i;
2994 struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
2996 ns_did.un.word = did;
2998 /* Never match fabric nodes for RSCNs */
2999 if ((did & Fabric_DID_MASK) == Fabric_DID_MASK)
3000 return 0;
3002 /* If we are doing a FULL RSCN rediscovery, match everything */
3003 if (vport->fc_flag & FC_RSCN_DISCOVERY)
3004 return did;
3006 spin_lock_irq(shost->host_lock);
3007 if (vport->fc_rscn_flush) {
3008 /* Another thread is walking fc_rscn_id_list on this vport */
3009 spin_unlock_irq(shost->host_lock);
3010 return 0;
3012 /* Indicate we are walking fc_rscn_id_list on this vport */
3013 vport->fc_rscn_flush = 1;
3014 spin_unlock_irq(shost->host_lock);
3015 for (i = 0; i < vport->fc_rscn_id_cnt; i++) {
3016 lp = vport->fc_rscn_id_list[i]->virt;
3017 payload_len = be32_to_cpu(*lp++ & ~ELS_CMD_MASK);
3018 payload_len -= sizeof(uint32_t); /* take off word 0 */
3019 while (payload_len) {
3020 rscn_did.un.word = be32_to_cpu(*lp++);
3021 payload_len -= sizeof(uint32_t);
3022 switch (rscn_did.un.b.resv) {
3023 case 0: /* Single N_Port ID effected */
3024 if (ns_did.un.word == rscn_did.un.word)
3025 goto return_did_out;
3026 break;
3027 case 1: /* Whole N_Port Area effected */
3028 if ((ns_did.un.b.domain == rscn_did.un.b.domain)
3029 && (ns_did.un.b.area == rscn_did.un.b.area))
3030 goto return_did_out;
3031 break;
3032 case 2: /* Whole N_Port Domain effected */
3033 if (ns_did.un.b.domain == rscn_did.un.b.domain)
3034 goto return_did_out;
3035 break;
3036 default:
3037 /* Unknown Identifier in RSCN node */
3038 lpfc_printf_vlog(vport, KERN_ERR, LOG_DISCOVERY,
3039 "0217 Unknown Identifier in "
3040 "RSCN payload Data: x%x\n",
3041 rscn_did.un.word);
3042 case 3: /* Whole Fabric effected */
3043 goto return_did_out;
3047 /* Indicate we are done with walking fc_rscn_id_list on this vport */
3048 vport->fc_rscn_flush = 0;
3049 return 0;
3050 return_did_out:
3051 /* Indicate we are done with walking fc_rscn_id_list on this vport */
3052 vport->fc_rscn_flush = 0;
3053 return did;
3056 static int
3057 lpfc_rscn_recovery_check(struct lpfc_vport *vport)
3059 struct lpfc_nodelist *ndlp = NULL;
3061 /* Move all affected nodes by pending RSCNs to NPR state. */
3062 list_for_each_entry(ndlp, &vport->fc_nodes, nlp_listp) {
3063 if (!NLP_CHK_NODE_ACT(ndlp) ||
3064 (ndlp->nlp_state == NLP_STE_UNUSED_NODE) ||
3065 !lpfc_rscn_payload_check(vport, ndlp->nlp_DID))
3066 continue;
3067 lpfc_disc_state_machine(vport, ndlp, NULL,
3068 NLP_EVT_DEVICE_RECOVERY);
3069 lpfc_cancel_retry_delay_tmo(vport, ndlp);
3071 return 0;
3074 static int
3075 lpfc_els_rcv_rscn(struct lpfc_vport *vport, struct lpfc_iocbq *cmdiocb,
3076 struct lpfc_nodelist *ndlp)
3078 struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
3079 struct lpfc_hba *phba = vport->phba;
3080 struct lpfc_dmabuf *pcmd;
3081 uint32_t *lp, *datap;
3082 IOCB_t *icmd;
3083 uint32_t payload_len, length, nportid, *cmd;
3084 int rscn_cnt;
3085 int rscn_id = 0, hba_id = 0;
3086 int i;
3088 icmd = &cmdiocb->iocb;
3089 pcmd = (struct lpfc_dmabuf *) cmdiocb->context2;
3090 lp = (uint32_t *) pcmd->virt;
3092 payload_len = be32_to_cpu(*lp++ & ~ELS_CMD_MASK);
3093 payload_len -= sizeof(uint32_t); /* take off word 0 */
3094 /* RSCN received */
3095 lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
3096 "0214 RSCN received Data: x%x x%x x%x x%x\n",
3097 vport->fc_flag, payload_len, *lp,
3098 vport->fc_rscn_id_cnt);
3099 for (i = 0; i < payload_len/sizeof(uint32_t); i++)
3100 fc_host_post_event(shost, fc_get_event_number(),
3101 FCH_EVT_RSCN, lp[i]);
3103 /* If we are about to begin discovery, just ACC the RSCN.
3104 * Discovery processing will satisfy it.
3106 if (vport->port_state <= LPFC_NS_QRY) {
3107 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
3108 "RCV RSCN ignore: did:x%x/ste:x%x flg:x%x",
3109 ndlp->nlp_DID, vport->port_state, ndlp->nlp_flag);
3111 lpfc_els_rsp_acc(vport, ELS_CMD_ACC, cmdiocb, ndlp, NULL);
3112 return 0;
3115 /* If this RSCN just contains NPortIDs for other vports on this HBA,
3116 * just ACC and ignore it.
3118 if ((phba->sli3_options & LPFC_SLI3_NPIV_ENABLED) &&
3119 !(vport->cfg_peer_port_login)) {
3120 i = payload_len;
3121 datap = lp;
3122 while (i > 0) {
3123 nportid = *datap++;
3124 nportid = ((be32_to_cpu(nportid)) & Mask_DID);
3125 i -= sizeof(uint32_t);
3126 rscn_id++;
3127 if (lpfc_find_vport_by_did(phba, nportid))
3128 hba_id++;
3130 if (rscn_id == hba_id) {
3131 /* ALL NPortIDs in RSCN are on HBA */
3132 lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
3133 "0214 Ignore RSCN "
3134 "Data: x%x x%x x%x x%x\n",
3135 vport->fc_flag, payload_len,
3136 *lp, vport->fc_rscn_id_cnt);
3137 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
3138 "RCV RSCN vport: did:x%x/ste:x%x flg:x%x",
3139 ndlp->nlp_DID, vport->port_state,
3140 ndlp->nlp_flag);
3142 lpfc_els_rsp_acc(vport, ELS_CMD_ACC, cmdiocb,
3143 ndlp, NULL);
3144 return 0;
3148 spin_lock_irq(shost->host_lock);
3149 if (vport->fc_rscn_flush) {
3150 /* Another thread is walking fc_rscn_id_list on this vport */
3151 spin_unlock_irq(shost->host_lock);
3152 vport->fc_flag |= FC_RSCN_DISCOVERY;
3153 /* Send back ACC */
3154 lpfc_els_rsp_acc(vport, ELS_CMD_ACC, cmdiocb, ndlp, NULL);
3155 return 0;
3157 /* Indicate we are walking fc_rscn_id_list on this vport */
3158 vport->fc_rscn_flush = 1;
3159 spin_unlock_irq(shost->host_lock);
3160 /* Get the array count after sucessfully have the token */
3161 rscn_cnt = vport->fc_rscn_id_cnt;
3162 /* If we are already processing an RSCN, save the received
3163 * RSCN payload buffer, cmdiocb->context2 to process later.
3165 if (vport->fc_flag & (FC_RSCN_MODE | FC_NDISC_ACTIVE)) {
3166 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
3167 "RCV RSCN defer: did:x%x/ste:x%x flg:x%x",
3168 ndlp->nlp_DID, vport->port_state, ndlp->nlp_flag);
3170 spin_lock_irq(shost->host_lock);
3171 vport->fc_flag |= FC_RSCN_DEFERRED;
3172 if ((rscn_cnt < FC_MAX_HOLD_RSCN) &&
3173 !(vport->fc_flag & FC_RSCN_DISCOVERY)) {
3174 vport->fc_flag |= FC_RSCN_MODE;
3175 spin_unlock_irq(shost->host_lock);
3176 if (rscn_cnt) {
3177 cmd = vport->fc_rscn_id_list[rscn_cnt-1]->virt;
3178 length = be32_to_cpu(*cmd & ~ELS_CMD_MASK);
3180 if ((rscn_cnt) &&
3181 (payload_len + length <= LPFC_BPL_SIZE)) {
3182 *cmd &= ELS_CMD_MASK;
3183 *cmd |= cpu_to_be32(payload_len + length);
3184 memcpy(((uint8_t *)cmd) + length, lp,
3185 payload_len);
3186 } else {
3187 vport->fc_rscn_id_list[rscn_cnt] = pcmd;
3188 vport->fc_rscn_id_cnt++;
3189 /* If we zero, cmdiocb->context2, the calling
3190 * routine will not try to free it.
3192 cmdiocb->context2 = NULL;
3194 /* Deferred RSCN */
3195 lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
3196 "0235 Deferred RSCN "
3197 "Data: x%x x%x x%x\n",
3198 vport->fc_rscn_id_cnt, vport->fc_flag,
3199 vport->port_state);
3200 } else {
3201 vport->fc_flag |= FC_RSCN_DISCOVERY;
3202 spin_unlock_irq(shost->host_lock);
3203 /* ReDiscovery RSCN */
3204 lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
3205 "0234 ReDiscovery RSCN "
3206 "Data: x%x x%x x%x\n",
3207 vport->fc_rscn_id_cnt, vport->fc_flag,
3208 vport->port_state);
3210 /* Indicate we are done walking fc_rscn_id_list on this vport */
3211 vport->fc_rscn_flush = 0;
3212 /* Send back ACC */
3213 lpfc_els_rsp_acc(vport, ELS_CMD_ACC, cmdiocb, ndlp, NULL);
3214 /* send RECOVERY event for ALL nodes that match RSCN payload */
3215 lpfc_rscn_recovery_check(vport);
3216 spin_lock_irq(shost->host_lock);
3217 vport->fc_flag &= ~FC_RSCN_DEFERRED;
3218 spin_unlock_irq(shost->host_lock);
3219 return 0;
3221 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
3222 "RCV RSCN: did:x%x/ste:x%x flg:x%x",
3223 ndlp->nlp_DID, vport->port_state, ndlp->nlp_flag);
3225 spin_lock_irq(shost->host_lock);
3226 vport->fc_flag |= FC_RSCN_MODE;
3227 spin_unlock_irq(shost->host_lock);
3228 vport->fc_rscn_id_list[vport->fc_rscn_id_cnt++] = pcmd;
3229 /* Indicate we are done walking fc_rscn_id_list on this vport */
3230 vport->fc_rscn_flush = 0;
3232 * If we zero, cmdiocb->context2, the calling routine will
3233 * not try to free it.
3235 cmdiocb->context2 = NULL;
3236 lpfc_set_disctmo(vport);
3237 /* Send back ACC */
3238 lpfc_els_rsp_acc(vport, ELS_CMD_ACC, cmdiocb, ndlp, NULL);
3239 /* send RECOVERY event for ALL nodes that match RSCN payload */
3240 lpfc_rscn_recovery_check(vport);
3241 return lpfc_els_handle_rscn(vport);
3245 lpfc_els_handle_rscn(struct lpfc_vport *vport)
3247 struct lpfc_nodelist *ndlp;
3248 struct lpfc_hba *phba = vport->phba;
3250 /* Ignore RSCN if the port is being torn down. */
3251 if (vport->load_flag & FC_UNLOADING) {
3252 lpfc_els_flush_rscn(vport);
3253 return 0;
3256 /* Start timer for RSCN processing */
3257 lpfc_set_disctmo(vport);
3259 /* RSCN processed */
3260 lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
3261 "0215 RSCN processed Data: x%x x%x x%x x%x\n",
3262 vport->fc_flag, 0, vport->fc_rscn_id_cnt,
3263 vport->port_state);
3265 /* To process RSCN, first compare RSCN data with NameServer */
3266 vport->fc_ns_retry = 0;
3267 vport->num_disc_nodes = 0;
3269 ndlp = lpfc_findnode_did(vport, NameServer_DID);
3270 if (ndlp && NLP_CHK_NODE_ACT(ndlp)
3271 && ndlp->nlp_state == NLP_STE_UNMAPPED_NODE) {
3272 /* Good ndlp, issue CT Request to NameServer */
3273 if (lpfc_ns_cmd(vport, SLI_CTNS_GID_FT, 0, 0) == 0)
3274 /* Wait for NameServer query cmpl before we can
3275 continue */
3276 return 1;
3277 } else {
3278 /* If login to NameServer does not exist, issue one */
3279 /* Good status, issue PLOGI to NameServer */
3280 ndlp = lpfc_findnode_did(vport, NameServer_DID);
3281 if (ndlp && NLP_CHK_NODE_ACT(ndlp))
3282 /* Wait for NameServer login cmpl before we can
3283 continue */
3284 return 1;
3286 if (ndlp) {
3287 ndlp = lpfc_enable_node(vport, ndlp,
3288 NLP_STE_PLOGI_ISSUE);
3289 if (!ndlp) {
3290 lpfc_els_flush_rscn(vport);
3291 return 0;
3293 ndlp->nlp_prev_state = NLP_STE_UNUSED_NODE;
3294 } else {
3295 ndlp = mempool_alloc(phba->nlp_mem_pool, GFP_KERNEL);
3296 if (!ndlp) {
3297 lpfc_els_flush_rscn(vport);
3298 return 0;
3300 lpfc_nlp_init(vport, ndlp, NameServer_DID);
3301 ndlp->nlp_prev_state = ndlp->nlp_state;
3302 lpfc_nlp_set_state(vport, ndlp, NLP_STE_PLOGI_ISSUE);
3304 ndlp->nlp_type |= NLP_FABRIC;
3305 lpfc_issue_els_plogi(vport, NameServer_DID, 0);
3306 /* Wait for NameServer login cmpl before we can
3307 * continue
3309 return 1;
3312 lpfc_els_flush_rscn(vport);
3313 return 0;
3316 static int
3317 lpfc_els_rcv_flogi(struct lpfc_vport *vport, struct lpfc_iocbq *cmdiocb,
3318 struct lpfc_nodelist *ndlp)
3320 struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
3321 struct lpfc_hba *phba = vport->phba;
3322 struct lpfc_dmabuf *pcmd = (struct lpfc_dmabuf *) cmdiocb->context2;
3323 uint32_t *lp = (uint32_t *) pcmd->virt;
3324 IOCB_t *icmd = &cmdiocb->iocb;
3325 struct serv_parm *sp;
3326 LPFC_MBOXQ_t *mbox;
3327 struct ls_rjt stat;
3328 uint32_t cmd, did;
3329 int rc;
3331 cmd = *lp++;
3332 sp = (struct serv_parm *) lp;
3334 /* FLOGI received */
3336 lpfc_set_disctmo(vport);
3338 if (phba->fc_topology == TOPOLOGY_LOOP) {
3339 /* We should never receive a FLOGI in loop mode, ignore it */
3340 did = icmd->un.elsreq64.remoteID;
3342 /* An FLOGI ELS command <elsCmd> was received from DID <did> in
3343 Loop Mode */
3344 lpfc_printf_vlog(vport, KERN_ERR, LOG_ELS,
3345 "0113 An FLOGI ELS command x%x was "
3346 "received from DID x%x in Loop Mode\n",
3347 cmd, did);
3348 return 1;
3351 did = Fabric_DID;
3353 if ((lpfc_check_sparm(vport, ndlp, sp, CLASS3))) {
3354 /* For a FLOGI we accept, then if our portname is greater
3355 * then the remote portname we initiate Nport login.
3358 rc = memcmp(&vport->fc_portname, &sp->portName,
3359 sizeof(struct lpfc_name));
3361 if (!rc) {
3362 mbox = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
3363 if (!mbox)
3364 return 1;
3366 lpfc_linkdown(phba);
3367 lpfc_init_link(phba, mbox,
3368 phba->cfg_topology,
3369 phba->cfg_link_speed);
3370 mbox->mb.un.varInitLnk.lipsr_AL_PA = 0;
3371 mbox->mbox_cmpl = lpfc_sli_def_mbox_cmpl;
3372 mbox->vport = vport;
3373 rc = lpfc_sli_issue_mbox(phba, mbox, MBX_NOWAIT);
3374 lpfc_set_loopback_flag(phba);
3375 if (rc == MBX_NOT_FINISHED) {
3376 mempool_free(mbox, phba->mbox_mem_pool);
3378 return 1;
3379 } else if (rc > 0) { /* greater than */
3380 spin_lock_irq(shost->host_lock);
3381 vport->fc_flag |= FC_PT2PT_PLOGI;
3382 spin_unlock_irq(shost->host_lock);
3384 spin_lock_irq(shost->host_lock);
3385 vport->fc_flag |= FC_PT2PT;
3386 vport->fc_flag &= ~(FC_FABRIC | FC_PUBLIC_LOOP);
3387 spin_unlock_irq(shost->host_lock);
3388 } else {
3389 /* Reject this request because invalid parameters */
3390 stat.un.b.lsRjtRsvd0 = 0;
3391 stat.un.b.lsRjtRsnCode = LSRJT_UNABLE_TPC;
3392 stat.un.b.lsRjtRsnCodeExp = LSEXP_SPARM_OPTIONS;
3393 stat.un.b.vendorUnique = 0;
3394 lpfc_els_rsp_reject(vport, stat.un.lsRjtError, cmdiocb, ndlp,
3395 NULL);
3396 return 1;
3399 /* Send back ACC */
3400 lpfc_els_rsp_acc(vport, ELS_CMD_PLOGI, cmdiocb, ndlp, NULL);
3402 return 0;
3405 static int
3406 lpfc_els_rcv_rnid(struct lpfc_vport *vport, struct lpfc_iocbq *cmdiocb,
3407 struct lpfc_nodelist *ndlp)
3409 struct lpfc_dmabuf *pcmd;
3410 uint32_t *lp;
3411 IOCB_t *icmd;
3412 RNID *rn;
3413 struct ls_rjt stat;
3414 uint32_t cmd, did;
3416 icmd = &cmdiocb->iocb;
3417 did = icmd->un.elsreq64.remoteID;
3418 pcmd = (struct lpfc_dmabuf *) cmdiocb->context2;
3419 lp = (uint32_t *) pcmd->virt;
3421 cmd = *lp++;
3422 rn = (RNID *) lp;
3424 /* RNID received */
3426 switch (rn->Format) {
3427 case 0:
3428 case RNID_TOPOLOGY_DISC:
3429 /* Send back ACC */
3430 lpfc_els_rsp_rnid_acc(vport, rn->Format, cmdiocb, ndlp);
3431 break;
3432 default:
3433 /* Reject this request because format not supported */
3434 stat.un.b.lsRjtRsvd0 = 0;
3435 stat.un.b.lsRjtRsnCode = LSRJT_UNABLE_TPC;
3436 stat.un.b.lsRjtRsnCodeExp = LSEXP_CANT_GIVE_DATA;
3437 stat.un.b.vendorUnique = 0;
3438 lpfc_els_rsp_reject(vport, stat.un.lsRjtError, cmdiocb, ndlp,
3439 NULL);
3441 return 0;
3444 static int
3445 lpfc_els_rcv_lirr(struct lpfc_vport *vport, struct lpfc_iocbq *cmdiocb,
3446 struct lpfc_nodelist *ndlp)
3448 struct ls_rjt stat;
3450 /* For now, unconditionally reject this command */
3451 stat.un.b.lsRjtRsvd0 = 0;
3452 stat.un.b.lsRjtRsnCode = LSRJT_UNABLE_TPC;
3453 stat.un.b.lsRjtRsnCodeExp = LSEXP_CANT_GIVE_DATA;
3454 stat.un.b.vendorUnique = 0;
3455 lpfc_els_rsp_reject(vport, stat.un.lsRjtError, cmdiocb, ndlp, NULL);
3456 return 0;
3459 static void
3460 lpfc_els_rsp_rps_acc(struct lpfc_hba *phba, LPFC_MBOXQ_t *pmb)
3462 struct lpfc_sli *psli = &phba->sli;
3463 struct lpfc_sli_ring *pring = &psli->ring[LPFC_ELS_RING];
3464 MAILBOX_t *mb;
3465 IOCB_t *icmd;
3466 RPS_RSP *rps_rsp;
3467 uint8_t *pcmd;
3468 struct lpfc_iocbq *elsiocb;
3469 struct lpfc_nodelist *ndlp;
3470 uint16_t xri, status;
3471 uint32_t cmdsize;
3473 mb = &pmb->mb;
3475 ndlp = (struct lpfc_nodelist *) pmb->context2;
3476 xri = (uint16_t) ((unsigned long)(pmb->context1));
3477 pmb->context1 = NULL;
3478 pmb->context2 = NULL;
3480 if (mb->mbxStatus) {
3481 mempool_free(pmb, phba->mbox_mem_pool);
3482 return;
3485 cmdsize = sizeof(RPS_RSP) + sizeof(uint32_t);
3486 mempool_free(pmb, phba->mbox_mem_pool);
3487 elsiocb = lpfc_prep_els_iocb(phba->pport, 0, cmdsize,
3488 lpfc_max_els_tries, ndlp,
3489 ndlp->nlp_DID, ELS_CMD_ACC);
3491 /* Decrement the ndlp reference count from previous mbox command */
3492 lpfc_nlp_put(ndlp);
3494 if (!elsiocb)
3495 return;
3497 icmd = &elsiocb->iocb;
3498 icmd->ulpContext = xri;
3500 pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
3501 *((uint32_t *) (pcmd)) = ELS_CMD_ACC;
3502 pcmd += sizeof(uint32_t); /* Skip past command */
3503 rps_rsp = (RPS_RSP *)pcmd;
3505 if (phba->fc_topology != TOPOLOGY_LOOP)
3506 status = 0x10;
3507 else
3508 status = 0x8;
3509 if (phba->pport->fc_flag & FC_FABRIC)
3510 status |= 0x4;
3512 rps_rsp->rsvd1 = 0;
3513 rps_rsp->portStatus = cpu_to_be16(status);
3514 rps_rsp->linkFailureCnt = cpu_to_be32(mb->un.varRdLnk.linkFailureCnt);
3515 rps_rsp->lossSyncCnt = cpu_to_be32(mb->un.varRdLnk.lossSyncCnt);
3516 rps_rsp->lossSignalCnt = cpu_to_be32(mb->un.varRdLnk.lossSignalCnt);
3517 rps_rsp->primSeqErrCnt = cpu_to_be32(mb->un.varRdLnk.primSeqErrCnt);
3518 rps_rsp->invalidXmitWord = cpu_to_be32(mb->un.varRdLnk.invalidXmitWord);
3519 rps_rsp->crcCnt = cpu_to_be32(mb->un.varRdLnk.crcCnt);
3520 /* Xmit ELS RPS ACC response tag <ulpIoTag> */
3521 lpfc_printf_vlog(ndlp->vport, KERN_INFO, LOG_ELS,
3522 "0118 Xmit ELS RPS ACC response tag x%x xri x%x, "
3523 "did x%x, nlp_flag x%x, nlp_state x%x, rpi x%x\n",
3524 elsiocb->iotag, elsiocb->iocb.ulpContext,
3525 ndlp->nlp_DID, ndlp->nlp_flag, ndlp->nlp_state,
3526 ndlp->nlp_rpi);
3527 elsiocb->iocb_cmpl = lpfc_cmpl_els_rsp;
3528 phba->fc_stat.elsXmitACC++;
3529 if (lpfc_sli_issue_iocb(phba, pring, elsiocb, 0) == IOCB_ERROR)
3530 lpfc_els_free_iocb(phba, elsiocb);
3531 return;
3534 static int
3535 lpfc_els_rcv_rps(struct lpfc_vport *vport, struct lpfc_iocbq *cmdiocb,
3536 struct lpfc_nodelist *ndlp)
3538 struct lpfc_hba *phba = vport->phba;
3539 uint32_t *lp;
3540 uint8_t flag;
3541 LPFC_MBOXQ_t *mbox;
3542 struct lpfc_dmabuf *pcmd;
3543 RPS *rps;
3544 struct ls_rjt stat;
3546 if ((ndlp->nlp_state != NLP_STE_UNMAPPED_NODE) &&
3547 (ndlp->nlp_state != NLP_STE_MAPPED_NODE)) {
3548 stat.un.b.lsRjtRsvd0 = 0;
3549 stat.un.b.lsRjtRsnCode = LSRJT_UNABLE_TPC;
3550 stat.un.b.lsRjtRsnCodeExp = LSEXP_CANT_GIVE_DATA;
3551 stat.un.b.vendorUnique = 0;
3552 lpfc_els_rsp_reject(vport, stat.un.lsRjtError, cmdiocb, ndlp,
3553 NULL);
3556 pcmd = (struct lpfc_dmabuf *) cmdiocb->context2;
3557 lp = (uint32_t *) pcmd->virt;
3558 flag = (be32_to_cpu(*lp++) & 0xf);
3559 rps = (RPS *) lp;
3561 if ((flag == 0) ||
3562 ((flag == 1) && (be32_to_cpu(rps->un.portNum) == 0)) ||
3563 ((flag == 2) && (memcmp(&rps->un.portName, &vport->fc_portname,
3564 sizeof(struct lpfc_name)) == 0))) {
3566 printk("Fix me....\n");
3567 dump_stack();
3568 mbox = mempool_alloc(phba->mbox_mem_pool, GFP_ATOMIC);
3569 if (mbox) {
3570 lpfc_read_lnk_stat(phba, mbox);
3571 mbox->context1 =
3572 (void *)((unsigned long) cmdiocb->iocb.ulpContext);
3573 mbox->context2 = lpfc_nlp_get(ndlp);
3574 mbox->vport = vport;
3575 mbox->mbox_cmpl = lpfc_els_rsp_rps_acc;
3576 if (lpfc_sli_issue_mbox(phba, mbox, MBX_NOWAIT)
3577 != MBX_NOT_FINISHED)
3578 /* Mbox completion will send ELS Response */
3579 return 0;
3580 /* Decrement reference count used for the failed mbox
3581 * command.
3583 lpfc_nlp_put(ndlp);
3584 mempool_free(mbox, phba->mbox_mem_pool);
3587 stat.un.b.lsRjtRsvd0 = 0;
3588 stat.un.b.lsRjtRsnCode = LSRJT_UNABLE_TPC;
3589 stat.un.b.lsRjtRsnCodeExp = LSEXP_CANT_GIVE_DATA;
3590 stat.un.b.vendorUnique = 0;
3591 lpfc_els_rsp_reject(vport, stat.un.lsRjtError, cmdiocb, ndlp, NULL);
3592 return 0;
3595 static int
3596 lpfc_els_rsp_rpl_acc(struct lpfc_vport *vport, uint16_t cmdsize,
3597 struct lpfc_iocbq *oldiocb, struct lpfc_nodelist *ndlp)
3599 struct lpfc_hba *phba = vport->phba;
3600 IOCB_t *icmd, *oldcmd;
3601 RPL_RSP rpl_rsp;
3602 struct lpfc_iocbq *elsiocb;
3603 struct lpfc_sli *psli = &phba->sli;
3604 struct lpfc_sli_ring *pring = &psli->ring[LPFC_ELS_RING];
3605 uint8_t *pcmd;
3607 elsiocb = lpfc_prep_els_iocb(vport, 0, cmdsize, oldiocb->retry, ndlp,
3608 ndlp->nlp_DID, ELS_CMD_ACC);
3610 if (!elsiocb)
3611 return 1;
3613 icmd = &elsiocb->iocb;
3614 oldcmd = &oldiocb->iocb;
3615 icmd->ulpContext = oldcmd->ulpContext; /* Xri */
3617 pcmd = (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
3618 *((uint32_t *) (pcmd)) = ELS_CMD_ACC;
3619 pcmd += sizeof(uint16_t);
3620 *((uint16_t *)(pcmd)) = be16_to_cpu(cmdsize);
3621 pcmd += sizeof(uint16_t);
3623 /* Setup the RPL ACC payload */
3624 rpl_rsp.listLen = be32_to_cpu(1);
3625 rpl_rsp.index = 0;
3626 rpl_rsp.port_num_blk.portNum = 0;
3627 rpl_rsp.port_num_blk.portID = be32_to_cpu(vport->fc_myDID);
3628 memcpy(&rpl_rsp.port_num_blk.portName, &vport->fc_portname,
3629 sizeof(struct lpfc_name));
3630 memcpy(pcmd, &rpl_rsp, cmdsize - sizeof(uint32_t));
3631 /* Xmit ELS RPL ACC response tag <ulpIoTag> */
3632 lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,
3633 "0120 Xmit ELS RPL ACC response tag x%x "
3634 "xri x%x, did x%x, nlp_flag x%x, nlp_state x%x, "
3635 "rpi x%x\n",
3636 elsiocb->iotag, elsiocb->iocb.ulpContext,
3637 ndlp->nlp_DID, ndlp->nlp_flag, ndlp->nlp_state,
3638 ndlp->nlp_rpi);
3639 elsiocb->iocb_cmpl = lpfc_cmpl_els_rsp;
3640 phba->fc_stat.elsXmitACC++;
3641 if (lpfc_sli_issue_iocb(phba, pring, elsiocb, 0) == IOCB_ERROR) {
3642 lpfc_els_free_iocb(phba, elsiocb);
3643 return 1;
3645 return 0;
3648 static int
3649 lpfc_els_rcv_rpl(struct lpfc_vport *vport, struct lpfc_iocbq *cmdiocb,
3650 struct lpfc_nodelist *ndlp)
3652 struct lpfc_dmabuf *pcmd;
3653 uint32_t *lp;
3654 uint32_t maxsize;
3655 uint16_t cmdsize;
3656 RPL *rpl;
3657 struct ls_rjt stat;
3659 if ((ndlp->nlp_state != NLP_STE_UNMAPPED_NODE) &&
3660 (ndlp->nlp_state != NLP_STE_MAPPED_NODE)) {
3661 stat.un.b.lsRjtRsvd0 = 0;
3662 stat.un.b.lsRjtRsnCode = LSRJT_UNABLE_TPC;
3663 stat.un.b.lsRjtRsnCodeExp = LSEXP_CANT_GIVE_DATA;
3664 stat.un.b.vendorUnique = 0;
3665 lpfc_els_rsp_reject(vport, stat.un.lsRjtError, cmdiocb, ndlp,
3666 NULL);
3669 pcmd = (struct lpfc_dmabuf *) cmdiocb->context2;
3670 lp = (uint32_t *) pcmd->virt;
3671 rpl = (RPL *) (lp + 1);
3673 maxsize = be32_to_cpu(rpl->maxsize);
3675 /* We support only one port */
3676 if ((rpl->index == 0) &&
3677 ((maxsize == 0) ||
3678 ((maxsize * sizeof(uint32_t)) >= sizeof(RPL_RSP)))) {
3679 cmdsize = sizeof(uint32_t) + sizeof(RPL_RSP);
3680 } else {
3681 cmdsize = sizeof(uint32_t) + maxsize * sizeof(uint32_t);
3683 lpfc_els_rsp_rpl_acc(vport, cmdsize, cmdiocb, ndlp);
3685 return 0;
3688 static int
3689 lpfc_els_rcv_farp(struct lpfc_vport *vport, struct lpfc_iocbq *cmdiocb,
3690 struct lpfc_nodelist *ndlp)
3692 struct lpfc_dmabuf *pcmd;
3693 uint32_t *lp;
3694 IOCB_t *icmd;
3695 FARP *fp;
3696 uint32_t cmd, cnt, did;
3698 icmd = &cmdiocb->iocb;
3699 did = icmd->un.elsreq64.remoteID;
3700 pcmd = (struct lpfc_dmabuf *) cmdiocb->context2;
3701 lp = (uint32_t *) pcmd->virt;
3703 cmd = *lp++;
3704 fp = (FARP *) lp;
3705 /* FARP-REQ received from DID <did> */
3706 lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,
3707 "0601 FARP-REQ received from DID x%x\n", did);
3708 /* We will only support match on WWPN or WWNN */
3709 if (fp->Mflags & ~(FARP_MATCH_NODE | FARP_MATCH_PORT)) {
3710 return 0;
3713 cnt = 0;
3714 /* If this FARP command is searching for my portname */
3715 if (fp->Mflags & FARP_MATCH_PORT) {
3716 if (memcmp(&fp->RportName, &vport->fc_portname,
3717 sizeof(struct lpfc_name)) == 0)
3718 cnt = 1;
3721 /* If this FARP command is searching for my nodename */
3722 if (fp->Mflags & FARP_MATCH_NODE) {
3723 if (memcmp(&fp->RnodeName, &vport->fc_nodename,
3724 sizeof(struct lpfc_name)) == 0)
3725 cnt = 1;
3728 if (cnt) {
3729 if ((ndlp->nlp_state == NLP_STE_UNMAPPED_NODE) ||
3730 (ndlp->nlp_state == NLP_STE_MAPPED_NODE)) {
3731 /* Log back into the node before sending the FARP. */
3732 if (fp->Rflags & FARP_REQUEST_PLOGI) {
3733 ndlp->nlp_prev_state = ndlp->nlp_state;
3734 lpfc_nlp_set_state(vport, ndlp,
3735 NLP_STE_PLOGI_ISSUE);
3736 lpfc_issue_els_plogi(vport, ndlp->nlp_DID, 0);
3739 /* Send a FARP response to that node */
3740 if (fp->Rflags & FARP_REQUEST_FARPR)
3741 lpfc_issue_els_farpr(vport, did, 0);
3744 return 0;
3747 static int
3748 lpfc_els_rcv_farpr(struct lpfc_vport *vport, struct lpfc_iocbq *cmdiocb,
3749 struct lpfc_nodelist *ndlp)
3751 struct lpfc_dmabuf *pcmd;
3752 uint32_t *lp;
3753 IOCB_t *icmd;
3754 uint32_t cmd, did;
3756 icmd = &cmdiocb->iocb;
3757 did = icmd->un.elsreq64.remoteID;
3758 pcmd = (struct lpfc_dmabuf *) cmdiocb->context2;
3759 lp = (uint32_t *) pcmd->virt;
3761 cmd = *lp++;
3762 /* FARP-RSP received from DID <did> */
3763 lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,
3764 "0600 FARP-RSP received from DID x%x\n", did);
3765 /* ACCEPT the Farp resp request */
3766 lpfc_els_rsp_acc(vport, ELS_CMD_ACC, cmdiocb, ndlp, NULL);
3768 return 0;
3771 static int
3772 lpfc_els_rcv_fan(struct lpfc_vport *vport, struct lpfc_iocbq *cmdiocb,
3773 struct lpfc_nodelist *fan_ndlp)
3775 struct lpfc_hba *phba = vport->phba;
3776 uint32_t *lp;
3777 FAN *fp;
3779 lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS, "0265 FAN received\n");
3780 lp = (uint32_t *)((struct lpfc_dmabuf *)cmdiocb->context2)->virt;
3781 fp = (FAN *) ++lp;
3782 /* FAN received; Fan does not have a reply sequence */
3783 if ((vport == phba->pport) &&
3784 (vport->port_state == LPFC_LOCAL_CFG_LINK)) {
3785 if ((memcmp(&phba->fc_fabparam.nodeName, &fp->FnodeName,
3786 sizeof(struct lpfc_name))) ||
3787 (memcmp(&phba->fc_fabparam.portName, &fp->FportName,
3788 sizeof(struct lpfc_name)))) {
3789 /* This port has switched fabrics. FLOGI is required */
3790 lpfc_initial_flogi(vport);
3791 } else {
3792 /* FAN verified - skip FLOGI */
3793 vport->fc_myDID = vport->fc_prevDID;
3794 lpfc_issue_fabric_reglogin(vport);
3797 return 0;
3800 void
3801 lpfc_els_timeout(unsigned long ptr)
3803 struct lpfc_vport *vport = (struct lpfc_vport *) ptr;
3804 struct lpfc_hba *phba = vport->phba;
3805 uint32_t tmo_posted;
3806 unsigned long iflag;
3808 spin_lock_irqsave(&vport->work_port_lock, iflag);
3809 tmo_posted = vport->work_port_events & WORKER_ELS_TMO;
3810 if (!tmo_posted)
3811 vport->work_port_events |= WORKER_ELS_TMO;
3812 spin_unlock_irqrestore(&vport->work_port_lock, iflag);
3814 if (!tmo_posted)
3815 lpfc_worker_wake_up(phba);
3816 return;
3819 void
3820 lpfc_els_timeout_handler(struct lpfc_vport *vport)
3822 struct lpfc_hba *phba = vport->phba;
3823 struct lpfc_sli_ring *pring;
3824 struct lpfc_iocbq *tmp_iocb, *piocb;
3825 IOCB_t *cmd = NULL;
3826 struct lpfc_dmabuf *pcmd;
3827 uint32_t els_command = 0;
3828 uint32_t timeout;
3829 uint32_t remote_ID = 0xffffffff;
3831 /* If the timer is already canceled do nothing */
3832 if ((vport->work_port_events & WORKER_ELS_TMO) == 0) {
3833 return;
3835 spin_lock_irq(&phba->hbalock);
3836 timeout = (uint32_t)(phba->fc_ratov << 1);
3838 pring = &phba->sli.ring[LPFC_ELS_RING];
3840 list_for_each_entry_safe(piocb, tmp_iocb, &pring->txcmplq, list) {
3841 cmd = &piocb->iocb;
3843 if ((piocb->iocb_flag & LPFC_IO_LIBDFC) != 0 ||
3844 piocb->iocb.ulpCommand == CMD_ABORT_XRI_CN ||
3845 piocb->iocb.ulpCommand == CMD_CLOSE_XRI_CN)
3846 continue;
3848 if (piocb->vport != vport)
3849 continue;
3851 pcmd = (struct lpfc_dmabuf *) piocb->context2;
3852 if (pcmd)
3853 els_command = *(uint32_t *) (pcmd->virt);
3855 if (els_command == ELS_CMD_FARP ||
3856 els_command == ELS_CMD_FARPR ||
3857 els_command == ELS_CMD_FDISC)
3858 continue;
3860 if (piocb->drvrTimeout > 0) {
3861 if (piocb->drvrTimeout >= timeout)
3862 piocb->drvrTimeout -= timeout;
3863 else
3864 piocb->drvrTimeout = 0;
3865 continue;
3868 remote_ID = 0xffffffff;
3869 if (cmd->ulpCommand != CMD_GEN_REQUEST64_CR)
3870 remote_ID = cmd->un.elsreq64.remoteID;
3871 else {
3872 struct lpfc_nodelist *ndlp;
3873 ndlp = __lpfc_findnode_rpi(vport, cmd->ulpContext);
3874 if (ndlp && NLP_CHK_NODE_ACT(ndlp))
3875 remote_ID = ndlp->nlp_DID;
3877 lpfc_printf_vlog(vport, KERN_ERR, LOG_ELS,
3878 "0127 ELS timeout Data: x%x x%x x%x "
3879 "x%x\n", els_command,
3880 remote_ID, cmd->ulpCommand, cmd->ulpIoTag);
3881 lpfc_sli_issue_abort_iotag(phba, pring, piocb);
3883 spin_unlock_irq(&phba->hbalock);
3885 if (phba->sli.ring[LPFC_ELS_RING].txcmplq_cnt)
3886 mod_timer(&vport->els_tmofunc, jiffies + HZ * timeout);
3889 void
3890 lpfc_els_flush_cmd(struct lpfc_vport *vport)
3892 LIST_HEAD(completions);
3893 struct lpfc_hba *phba = vport->phba;
3894 struct lpfc_sli_ring *pring = &phba->sli.ring[LPFC_ELS_RING];
3895 struct lpfc_iocbq *tmp_iocb, *piocb;
3896 IOCB_t *cmd = NULL;
3898 lpfc_fabric_abort_vport(vport);
3900 spin_lock_irq(&phba->hbalock);
3901 list_for_each_entry_safe(piocb, tmp_iocb, &pring->txq, list) {
3902 cmd = &piocb->iocb;
3904 if (piocb->iocb_flag & LPFC_IO_LIBDFC) {
3905 continue;
3908 /* Do not flush out the QUE_RING and ABORT/CLOSE iocbs */
3909 if (cmd->ulpCommand == CMD_QUE_RING_BUF_CN ||
3910 cmd->ulpCommand == CMD_QUE_RING_BUF64_CN ||
3911 cmd->ulpCommand == CMD_CLOSE_XRI_CN ||
3912 cmd->ulpCommand == CMD_ABORT_XRI_CN)
3913 continue;
3915 if (piocb->vport != vport)
3916 continue;
3918 list_move_tail(&piocb->list, &completions);
3919 pring->txq_cnt--;
3922 list_for_each_entry_safe(piocb, tmp_iocb, &pring->txcmplq, list) {
3923 if (piocb->iocb_flag & LPFC_IO_LIBDFC) {
3924 continue;
3927 if (piocb->vport != vport)
3928 continue;
3930 lpfc_sli_issue_abort_iotag(phba, pring, piocb);
3932 spin_unlock_irq(&phba->hbalock);
3934 while (!list_empty(&completions)) {
3935 piocb = list_get_first(&completions, struct lpfc_iocbq, list);
3936 cmd = &piocb->iocb;
3937 list_del_init(&piocb->list);
3939 if (!piocb->iocb_cmpl)
3940 lpfc_sli_release_iocbq(phba, piocb);
3941 else {
3942 cmd->ulpStatus = IOSTAT_LOCAL_REJECT;
3943 cmd->un.ulpWord[4] = IOERR_SLI_ABORTED;
3944 (piocb->iocb_cmpl) (phba, piocb, piocb);
3948 return;
3951 void
3952 lpfc_els_flush_all_cmd(struct lpfc_hba *phba)
3954 LIST_HEAD(completions);
3955 struct lpfc_sli_ring *pring = &phba->sli.ring[LPFC_ELS_RING];
3956 struct lpfc_iocbq *tmp_iocb, *piocb;
3957 IOCB_t *cmd = NULL;
3959 lpfc_fabric_abort_hba(phba);
3960 spin_lock_irq(&phba->hbalock);
3961 list_for_each_entry_safe(piocb, tmp_iocb, &pring->txq, list) {
3962 cmd = &piocb->iocb;
3963 if (piocb->iocb_flag & LPFC_IO_LIBDFC)
3964 continue;
3965 /* Do not flush out the QUE_RING and ABORT/CLOSE iocbs */
3966 if (cmd->ulpCommand == CMD_QUE_RING_BUF_CN ||
3967 cmd->ulpCommand == CMD_QUE_RING_BUF64_CN ||
3968 cmd->ulpCommand == CMD_CLOSE_XRI_CN ||
3969 cmd->ulpCommand == CMD_ABORT_XRI_CN)
3970 continue;
3971 list_move_tail(&piocb->list, &completions);
3972 pring->txq_cnt--;
3974 list_for_each_entry_safe(piocb, tmp_iocb, &pring->txcmplq, list) {
3975 if (piocb->iocb_flag & LPFC_IO_LIBDFC)
3976 continue;
3977 lpfc_sli_issue_abort_iotag(phba, pring, piocb);
3979 spin_unlock_irq(&phba->hbalock);
3980 while (!list_empty(&completions)) {
3981 piocb = list_get_first(&completions, struct lpfc_iocbq, list);
3982 cmd = &piocb->iocb;
3983 list_del_init(&piocb->list);
3984 if (!piocb->iocb_cmpl)
3985 lpfc_sli_release_iocbq(phba, piocb);
3986 else {
3987 cmd->ulpStatus = IOSTAT_LOCAL_REJECT;
3988 cmd->un.ulpWord[4] = IOERR_SLI_ABORTED;
3989 (piocb->iocb_cmpl) (phba, piocb, piocb);
3992 return;
3995 static void
3996 lpfc_els_unsol_buffer(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
3997 struct lpfc_vport *vport, struct lpfc_iocbq *elsiocb)
3999 struct Scsi_Host *shost;
4000 struct lpfc_nodelist *ndlp;
4001 struct ls_rjt stat;
4002 uint32_t *payload;
4003 uint32_t cmd, did, newnode, rjt_err = 0;
4004 IOCB_t *icmd = &elsiocb->iocb;
4006 if (!vport || !(elsiocb->context2))
4007 goto dropit;
4009 newnode = 0;
4010 payload = ((struct lpfc_dmabuf *)elsiocb->context2)->virt;
4011 cmd = *payload;
4012 if ((phba->sli3_options & LPFC_SLI3_HBQ_ENABLED) == 0)
4013 lpfc_post_buffer(phba, pring, 1);
4015 did = icmd->un.rcvels.remoteID;
4016 if (icmd->ulpStatus) {
4017 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
4018 "RCV Unsol ELS: status:x%x/x%x did:x%x",
4019 icmd->ulpStatus, icmd->un.ulpWord[4], did);
4020 goto dropit;
4023 /* Check to see if link went down during discovery */
4024 if (lpfc_els_chk_latt(vport))
4025 goto dropit;
4027 /* Ignore traffic recevied during vport shutdown. */
4028 if (vport->load_flag & FC_UNLOADING)
4029 goto dropit;
4031 ndlp = lpfc_findnode_did(vport, did);
4032 if (!ndlp) {
4033 /* Cannot find existing Fabric ndlp, so allocate a new one */
4034 ndlp = mempool_alloc(phba->nlp_mem_pool, GFP_KERNEL);
4035 if (!ndlp)
4036 goto dropit;
4038 lpfc_nlp_init(vport, ndlp, did);
4039 lpfc_nlp_set_state(vport, ndlp, NLP_STE_NPR_NODE);
4040 newnode = 1;
4041 if ((did & Fabric_DID_MASK) == Fabric_DID_MASK)
4042 ndlp->nlp_type |= NLP_FABRIC;
4043 } else if (!NLP_CHK_NODE_ACT(ndlp)) {
4044 ndlp = lpfc_enable_node(vport, ndlp,
4045 NLP_STE_UNUSED_NODE);
4046 if (!ndlp)
4047 goto dropit;
4048 lpfc_nlp_set_state(vport, ndlp, NLP_STE_NPR_NODE);
4049 newnode = 1;
4050 if ((did & Fabric_DID_MASK) == Fabric_DID_MASK)
4051 ndlp->nlp_type |= NLP_FABRIC;
4052 } else if (ndlp->nlp_state == NLP_STE_UNUSED_NODE) {
4053 /* This is similar to the new node path */
4054 ndlp = lpfc_nlp_get(ndlp);
4055 if (!ndlp)
4056 goto dropit;
4057 lpfc_nlp_set_state(vport, ndlp, NLP_STE_NPR_NODE);
4058 newnode = 1;
4061 phba->fc_stat.elsRcvFrame++;
4062 if (elsiocb->context1)
4063 lpfc_nlp_put(elsiocb->context1);
4065 elsiocb->context1 = lpfc_nlp_get(ndlp);
4066 elsiocb->vport = vport;
4068 if ((cmd & ELS_CMD_MASK) == ELS_CMD_RSCN) {
4069 cmd &= ELS_CMD_MASK;
4071 /* ELS command <elsCmd> received from NPORT <did> */
4072 lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,
4073 "0112 ELS command x%x received from NPORT x%x "
4074 "Data: x%x\n", cmd, did, vport->port_state);
4075 switch (cmd) {
4076 case ELS_CMD_PLOGI:
4077 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
4078 "RCV PLOGI: did:x%x/ste:x%x flg:x%x",
4079 did, vport->port_state, ndlp->nlp_flag);
4081 phba->fc_stat.elsRcvPLOGI++;
4082 ndlp = lpfc_plogi_confirm_nport(phba, payload, ndlp);
4084 if (vport->port_state < LPFC_DISC_AUTH) {
4085 if (!(phba->pport->fc_flag & FC_PT2PT) ||
4086 (phba->pport->fc_flag & FC_PT2PT_PLOGI)) {
4087 rjt_err = LSRJT_UNABLE_TPC;
4088 break;
4090 /* We get here, and drop thru, if we are PT2PT with
4091 * another NPort and the other side has initiated
4092 * the PLOGI before responding to our FLOGI.
4096 shost = lpfc_shost_from_vport(vport);
4097 spin_lock_irq(shost->host_lock);
4098 ndlp->nlp_flag &= ~NLP_TARGET_REMOVE;
4099 spin_unlock_irq(shost->host_lock);
4101 lpfc_disc_state_machine(vport, ndlp, elsiocb,
4102 NLP_EVT_RCV_PLOGI);
4104 break;
4105 case ELS_CMD_FLOGI:
4106 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
4107 "RCV FLOGI: did:x%x/ste:x%x flg:x%x",
4108 did, vport->port_state, ndlp->nlp_flag);
4110 phba->fc_stat.elsRcvFLOGI++;
4111 lpfc_els_rcv_flogi(vport, elsiocb, ndlp);
4112 if (newnode)
4113 lpfc_nlp_put(ndlp);
4114 break;
4115 case ELS_CMD_LOGO:
4116 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
4117 "RCV LOGO: did:x%x/ste:x%x flg:x%x",
4118 did, vport->port_state, ndlp->nlp_flag);
4120 phba->fc_stat.elsRcvLOGO++;
4121 if (vport->port_state < LPFC_DISC_AUTH) {
4122 rjt_err = LSRJT_UNABLE_TPC;
4123 break;
4125 lpfc_disc_state_machine(vport, ndlp, elsiocb, NLP_EVT_RCV_LOGO);
4126 break;
4127 case ELS_CMD_PRLO:
4128 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
4129 "RCV PRLO: did:x%x/ste:x%x flg:x%x",
4130 did, vport->port_state, ndlp->nlp_flag);
4132 phba->fc_stat.elsRcvPRLO++;
4133 if (vport->port_state < LPFC_DISC_AUTH) {
4134 rjt_err = LSRJT_UNABLE_TPC;
4135 break;
4137 lpfc_disc_state_machine(vport, ndlp, elsiocb, NLP_EVT_RCV_PRLO);
4138 break;
4139 case ELS_CMD_RSCN:
4140 phba->fc_stat.elsRcvRSCN++;
4141 lpfc_els_rcv_rscn(vport, elsiocb, ndlp);
4142 if (newnode)
4143 lpfc_nlp_put(ndlp);
4144 break;
4145 case ELS_CMD_ADISC:
4146 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
4147 "RCV ADISC: did:x%x/ste:x%x flg:x%x",
4148 did, vport->port_state, ndlp->nlp_flag);
4150 phba->fc_stat.elsRcvADISC++;
4151 if (vport->port_state < LPFC_DISC_AUTH) {
4152 rjt_err = LSRJT_UNABLE_TPC;
4153 break;
4155 lpfc_disc_state_machine(vport, ndlp, elsiocb,
4156 NLP_EVT_RCV_ADISC);
4157 break;
4158 case ELS_CMD_PDISC:
4159 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
4160 "RCV PDISC: did:x%x/ste:x%x flg:x%x",
4161 did, vport->port_state, ndlp->nlp_flag);
4163 phba->fc_stat.elsRcvPDISC++;
4164 if (vport->port_state < LPFC_DISC_AUTH) {
4165 rjt_err = LSRJT_UNABLE_TPC;
4166 break;
4168 lpfc_disc_state_machine(vport, ndlp, elsiocb,
4169 NLP_EVT_RCV_PDISC);
4170 break;
4171 case ELS_CMD_FARPR:
4172 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
4173 "RCV FARPR: did:x%x/ste:x%x flg:x%x",
4174 did, vport->port_state, ndlp->nlp_flag);
4176 phba->fc_stat.elsRcvFARPR++;
4177 lpfc_els_rcv_farpr(vport, elsiocb, ndlp);
4178 break;
4179 case ELS_CMD_FARP:
4180 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
4181 "RCV FARP: did:x%x/ste:x%x flg:x%x",
4182 did, vport->port_state, ndlp->nlp_flag);
4184 phba->fc_stat.elsRcvFARP++;
4185 lpfc_els_rcv_farp(vport, elsiocb, ndlp);
4186 break;
4187 case ELS_CMD_FAN:
4188 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
4189 "RCV FAN: did:x%x/ste:x%x flg:x%x",
4190 did, vport->port_state, ndlp->nlp_flag);
4192 phba->fc_stat.elsRcvFAN++;
4193 lpfc_els_rcv_fan(vport, elsiocb, ndlp);
4194 break;
4195 case ELS_CMD_PRLI:
4196 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
4197 "RCV PRLI: did:x%x/ste:x%x flg:x%x",
4198 did, vport->port_state, ndlp->nlp_flag);
4200 phba->fc_stat.elsRcvPRLI++;
4201 if (vport->port_state < LPFC_DISC_AUTH) {
4202 rjt_err = LSRJT_UNABLE_TPC;
4203 break;
4205 lpfc_disc_state_machine(vport, ndlp, elsiocb, NLP_EVT_RCV_PRLI);
4206 break;
4207 case ELS_CMD_LIRR:
4208 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
4209 "RCV LIRR: did:x%x/ste:x%x flg:x%x",
4210 did, vport->port_state, ndlp->nlp_flag);
4212 phba->fc_stat.elsRcvLIRR++;
4213 lpfc_els_rcv_lirr(vport, elsiocb, ndlp);
4214 if (newnode)
4215 lpfc_nlp_put(ndlp);
4216 break;
4217 case ELS_CMD_RPS:
4218 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
4219 "RCV RPS: did:x%x/ste:x%x flg:x%x",
4220 did, vport->port_state, ndlp->nlp_flag);
4222 phba->fc_stat.elsRcvRPS++;
4223 lpfc_els_rcv_rps(vport, elsiocb, ndlp);
4224 if (newnode)
4225 lpfc_nlp_put(ndlp);
4226 break;
4227 case ELS_CMD_RPL:
4228 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
4229 "RCV RPL: did:x%x/ste:x%x flg:x%x",
4230 did, vport->port_state, ndlp->nlp_flag);
4232 phba->fc_stat.elsRcvRPL++;
4233 lpfc_els_rcv_rpl(vport, elsiocb, ndlp);
4234 if (newnode)
4235 lpfc_nlp_put(ndlp);
4236 break;
4237 case ELS_CMD_RNID:
4238 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
4239 "RCV RNID: did:x%x/ste:x%x flg:x%x",
4240 did, vport->port_state, ndlp->nlp_flag);
4242 phba->fc_stat.elsRcvRNID++;
4243 lpfc_els_rcv_rnid(vport, elsiocb, ndlp);
4244 if (newnode)
4245 lpfc_nlp_put(ndlp);
4246 break;
4247 default:
4248 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
4249 "RCV ELS cmd: cmd:x%x did:x%x/ste:x%x",
4250 cmd, did, vport->port_state);
4252 /* Unsupported ELS command, reject */
4253 rjt_err = LSRJT_INVALID_CMD;
4255 /* Unknown ELS command <elsCmd> received from NPORT <did> */
4256 lpfc_printf_vlog(vport, KERN_ERR, LOG_ELS,
4257 "0115 Unknown ELS command x%x "
4258 "received from NPORT x%x\n", cmd, did);
4259 if (newnode)
4260 lpfc_nlp_put(ndlp);
4261 break;
4264 /* check if need to LS_RJT received ELS cmd */
4265 if (rjt_err) {
4266 memset(&stat, 0, sizeof(stat));
4267 stat.un.b.lsRjtRsnCode = rjt_err;
4268 stat.un.b.lsRjtRsnCodeExp = LSEXP_NOTHING_MORE;
4269 lpfc_els_rsp_reject(vport, stat.un.lsRjtError, elsiocb, ndlp,
4270 NULL);
4273 return;
4275 dropit:
4276 if (vport && !(vport->load_flag & FC_UNLOADING))
4277 lpfc_printf_log(phba, KERN_ERR, LOG_ELS,
4278 "(%d):0111 Dropping received ELS cmd "
4279 "Data: x%x x%x x%x\n",
4280 vport->vpi, icmd->ulpStatus,
4281 icmd->un.ulpWord[4], icmd->ulpTimeout);
4282 phba->fc_stat.elsRcvDrop++;
4285 static struct lpfc_vport *
4286 lpfc_find_vport_by_vpid(struct lpfc_hba *phba, uint16_t vpi)
4288 struct lpfc_vport *vport;
4289 unsigned long flags;
4291 spin_lock_irqsave(&phba->hbalock, flags);
4292 list_for_each_entry(vport, &phba->port_list, listentry) {
4293 if (vport->vpi == vpi) {
4294 spin_unlock_irqrestore(&phba->hbalock, flags);
4295 return vport;
4298 spin_unlock_irqrestore(&phba->hbalock, flags);
4299 return NULL;
4302 void
4303 lpfc_els_unsol_event(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
4304 struct lpfc_iocbq *elsiocb)
4306 struct lpfc_vport *vport = phba->pport;
4307 IOCB_t *icmd = &elsiocb->iocb;
4308 dma_addr_t paddr;
4309 struct lpfc_dmabuf *bdeBuf1 = elsiocb->context2;
4310 struct lpfc_dmabuf *bdeBuf2 = elsiocb->context3;
4312 elsiocb->context2 = NULL;
4313 elsiocb->context3 = NULL;
4315 if (icmd->ulpStatus == IOSTAT_NEED_BUFFER) {
4316 lpfc_sli_hbqbuf_add_hbqs(phba, LPFC_ELS_HBQ);
4317 } else if (icmd->ulpStatus == IOSTAT_LOCAL_REJECT &&
4318 (icmd->un.ulpWord[4] & 0xff) == IOERR_RCV_BUFFER_WAITING) {
4319 phba->fc_stat.NoRcvBuf++;
4320 /* Not enough posted buffers; Try posting more buffers */
4321 if (!(phba->sli3_options & LPFC_SLI3_HBQ_ENABLED))
4322 lpfc_post_buffer(phba, pring, 0);
4323 return;
4326 if ((phba->sli3_options & LPFC_SLI3_NPIV_ENABLED) &&
4327 (icmd->ulpCommand == CMD_IOCB_RCV_ELS64_CX ||
4328 icmd->ulpCommand == CMD_IOCB_RCV_SEQ64_CX)) {
4329 if (icmd->unsli3.rcvsli3.vpi == 0xffff)
4330 vport = phba->pport;
4331 else {
4332 uint16_t vpi = icmd->unsli3.rcvsli3.vpi;
4333 vport = lpfc_find_vport_by_vpid(phba, vpi);
4336 /* If there are no BDEs associated
4337 * with this IOCB, there is nothing to do.
4339 if (icmd->ulpBdeCount == 0)
4340 return;
4342 /* type of ELS cmd is first 32bit word
4343 * in packet
4345 if (phba->sli3_options & LPFC_SLI3_HBQ_ENABLED) {
4346 elsiocb->context2 = bdeBuf1;
4347 } else {
4348 paddr = getPaddr(icmd->un.cont64[0].addrHigh,
4349 icmd->un.cont64[0].addrLow);
4350 elsiocb->context2 = lpfc_sli_ringpostbuf_get(phba, pring,
4351 paddr);
4354 lpfc_els_unsol_buffer(phba, pring, vport, elsiocb);
4356 * The different unsolicited event handlers would tell us
4357 * if they are done with "mp" by setting context2 to NULL.
4359 lpfc_nlp_put(elsiocb->context1);
4360 elsiocb->context1 = NULL;
4361 if (elsiocb->context2) {
4362 lpfc_in_buf_free(phba, (struct lpfc_dmabuf *)elsiocb->context2);
4363 elsiocb->context2 = NULL;
4366 /* RCV_ELS64_CX provide for 2 BDEs - process 2nd if included */
4367 if ((phba->sli3_options & LPFC_SLI3_HBQ_ENABLED) &&
4368 icmd->ulpBdeCount == 2) {
4369 elsiocb->context2 = bdeBuf2;
4370 lpfc_els_unsol_buffer(phba, pring, vport, elsiocb);
4371 /* free mp if we are done with it */
4372 if (elsiocb->context2) {
4373 lpfc_in_buf_free(phba, elsiocb->context2);
4374 elsiocb->context2 = NULL;
4379 void
4380 lpfc_do_scr_ns_plogi(struct lpfc_hba *phba, struct lpfc_vport *vport)
4382 struct lpfc_nodelist *ndlp, *ndlp_fdmi;
4384 ndlp = lpfc_findnode_did(vport, NameServer_DID);
4385 if (!ndlp) {
4386 ndlp = mempool_alloc(phba->nlp_mem_pool, GFP_KERNEL);
4387 if (!ndlp) {
4388 if (phba->fc_topology == TOPOLOGY_LOOP) {
4389 lpfc_disc_start(vport);
4390 return;
4392 lpfc_vport_set_state(vport, FC_VPORT_FAILED);
4393 lpfc_printf_vlog(vport, KERN_ERR, LOG_ELS,
4394 "0251 NameServer login: no memory\n");
4395 return;
4397 lpfc_nlp_init(vport, ndlp, NameServer_DID);
4398 } else if (!NLP_CHK_NODE_ACT(ndlp)) {
4399 ndlp = lpfc_enable_node(vport, ndlp, NLP_STE_UNUSED_NODE);
4400 if (!ndlp) {
4401 if (phba->fc_topology == TOPOLOGY_LOOP) {
4402 lpfc_disc_start(vport);
4403 return;
4405 lpfc_vport_set_state(vport, FC_VPORT_FAILED);
4406 lpfc_printf_vlog(vport, KERN_ERR, LOG_ELS,
4407 "0348 NameServer login: node freed\n");
4408 return;
4411 ndlp->nlp_type |= NLP_FABRIC;
4413 lpfc_nlp_set_state(vport, ndlp, NLP_STE_PLOGI_ISSUE);
4415 if (lpfc_issue_els_plogi(vport, ndlp->nlp_DID, 0)) {
4416 lpfc_vport_set_state(vport, FC_VPORT_FAILED);
4417 lpfc_printf_vlog(vport, KERN_ERR, LOG_ELS,
4418 "0252 Cannot issue NameServer login\n");
4419 return;
4422 if (vport->cfg_fdmi_on) {
4423 ndlp_fdmi = mempool_alloc(phba->nlp_mem_pool,
4424 GFP_KERNEL);
4425 if (ndlp_fdmi) {
4426 lpfc_nlp_init(vport, ndlp_fdmi, FDMI_DID);
4427 ndlp_fdmi->nlp_type |= NLP_FABRIC;
4428 lpfc_nlp_set_state(vport, ndlp_fdmi,
4429 NLP_STE_PLOGI_ISSUE);
4430 lpfc_issue_els_plogi(vport, ndlp_fdmi->nlp_DID,
4434 return;
4437 static void
4438 lpfc_cmpl_reg_new_vport(struct lpfc_hba *phba, LPFC_MBOXQ_t *pmb)
4440 struct lpfc_vport *vport = pmb->vport;
4441 struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
4442 struct lpfc_nodelist *ndlp = (struct lpfc_nodelist *) pmb->context2;
4443 MAILBOX_t *mb = &pmb->mb;
4445 spin_lock_irq(shost->host_lock);
4446 vport->fc_flag &= ~FC_VPORT_NEEDS_REG_VPI;
4447 spin_unlock_irq(shost->host_lock);
4449 if (mb->mbxStatus) {
4450 lpfc_printf_vlog(vport, KERN_ERR, LOG_MBOX,
4451 "0915 Register VPI failed: 0x%x\n",
4452 mb->mbxStatus);
4454 switch (mb->mbxStatus) {
4455 case 0x11: /* unsupported feature */
4456 case 0x9603: /* max_vpi exceeded */
4457 case 0x9602: /* Link event since CLEAR_LA */
4458 /* giving up on vport registration */
4459 lpfc_vport_set_state(vport, FC_VPORT_FAILED);
4460 spin_lock_irq(shost->host_lock);
4461 vport->fc_flag &= ~(FC_FABRIC | FC_PUBLIC_LOOP);
4462 spin_unlock_irq(shost->host_lock);
4463 lpfc_can_disctmo(vport);
4464 break;
4465 default:
4466 /* Try to recover from this error */
4467 lpfc_mbx_unreg_vpi(vport);
4468 spin_lock_irq(shost->host_lock);
4469 vport->fc_flag |= FC_VPORT_NEEDS_REG_VPI;
4470 spin_unlock_irq(shost->host_lock);
4471 if (vport->port_type == LPFC_PHYSICAL_PORT)
4472 lpfc_initial_flogi(vport);
4473 else
4474 lpfc_initial_fdisc(vport);
4475 break;
4478 } else {
4479 if (vport == phba->pport)
4480 lpfc_issue_fabric_reglogin(vport);
4481 else
4482 lpfc_do_scr_ns_plogi(phba, vport);
4485 /* Now, we decrement the ndlp reference count held for this
4486 * callback function
4488 lpfc_nlp_put(ndlp);
4490 mempool_free(pmb, phba->mbox_mem_pool);
4491 return;
4494 static void
4495 lpfc_register_new_vport(struct lpfc_hba *phba, struct lpfc_vport *vport,
4496 struct lpfc_nodelist *ndlp)
4498 struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
4499 LPFC_MBOXQ_t *mbox;
4501 mbox = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
4502 if (mbox) {
4503 lpfc_reg_vpi(phba, vport->vpi, vport->fc_myDID, mbox);
4504 mbox->vport = vport;
4505 mbox->context2 = lpfc_nlp_get(ndlp);
4506 mbox->mbox_cmpl = lpfc_cmpl_reg_new_vport;
4507 if (lpfc_sli_issue_mbox(phba, mbox, MBX_NOWAIT)
4508 == MBX_NOT_FINISHED) {
4509 /* mailbox command not success, decrement ndlp
4510 * reference count for this command
4512 lpfc_nlp_put(ndlp);
4513 mempool_free(mbox, phba->mbox_mem_pool);
4515 lpfc_printf_vlog(vport, KERN_ERR, LOG_MBOX,
4516 "0253 Register VPI: Can't send mbox\n");
4517 goto mbox_err_exit;
4519 } else {
4520 lpfc_printf_vlog(vport, KERN_ERR, LOG_MBOX,
4521 "0254 Register VPI: no memory\n");
4522 goto mbox_err_exit;
4524 return;
4526 mbox_err_exit:
4527 lpfc_vport_set_state(vport, FC_VPORT_FAILED);
4528 spin_lock_irq(shost->host_lock);
4529 vport->fc_flag &= ~FC_VPORT_NEEDS_REG_VPI;
4530 spin_unlock_irq(shost->host_lock);
4531 return;
4534 static void
4535 lpfc_cmpl_els_fdisc(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
4536 struct lpfc_iocbq *rspiocb)
4538 struct lpfc_vport *vport = cmdiocb->vport;
4539 struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
4540 struct lpfc_nodelist *ndlp = (struct lpfc_nodelist *) cmdiocb->context1;
4541 struct lpfc_nodelist *np;
4542 struct lpfc_nodelist *next_np;
4543 IOCB_t *irsp = &rspiocb->iocb;
4544 struct lpfc_iocbq *piocb;
4546 lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,
4547 "0123 FDISC completes. x%x/x%x prevDID: x%x\n",
4548 irsp->ulpStatus, irsp->un.ulpWord[4],
4549 vport->fc_prevDID);
4550 /* Since all FDISCs are being single threaded, we
4551 * must reset the discovery timer for ALL vports
4552 * waiting to send FDISC when one completes.
4554 list_for_each_entry(piocb, &phba->fabric_iocb_list, list) {
4555 lpfc_set_disctmo(piocb->vport);
4558 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
4559 "FDISC cmpl: status:x%x/x%x prevdid:x%x",
4560 irsp->ulpStatus, irsp->un.ulpWord[4], vport->fc_prevDID);
4562 if (irsp->ulpStatus) {
4563 /* Check for retry */
4564 if (lpfc_els_retry(phba, cmdiocb, rspiocb))
4565 goto out;
4566 /* FDISC failed */
4567 lpfc_printf_vlog(vport, KERN_ERR, LOG_ELS,
4568 "0124 FDISC failed. (%d/%d)\n",
4569 irsp->ulpStatus, irsp->un.ulpWord[4]);
4570 if (vport->fc_vport->vport_state == FC_VPORT_INITIALIZING)
4571 lpfc_vport_set_state(vport, FC_VPORT_FAILED);
4572 lpfc_nlp_put(ndlp);
4573 /* giving up on FDISC. Cancel discovery timer */
4574 lpfc_can_disctmo(vport);
4575 } else {
4576 spin_lock_irq(shost->host_lock);
4577 vport->fc_flag |= FC_FABRIC;
4578 if (vport->phba->fc_topology == TOPOLOGY_LOOP)
4579 vport->fc_flag |= FC_PUBLIC_LOOP;
4580 spin_unlock_irq(shost->host_lock);
4582 vport->fc_myDID = irsp->un.ulpWord[4] & Mask_DID;
4583 lpfc_vport_set_state(vport, FC_VPORT_ACTIVE);
4584 if ((vport->fc_prevDID != vport->fc_myDID) &&
4585 !(vport->fc_flag & FC_VPORT_NEEDS_REG_VPI)) {
4586 /* If our NportID changed, we need to ensure all
4587 * remaining NPORTs get unreg_login'ed so we can
4588 * issue unreg_vpi.
4590 list_for_each_entry_safe(np, next_np,
4591 &vport->fc_nodes, nlp_listp) {
4592 if (!NLP_CHK_NODE_ACT(ndlp) ||
4593 (np->nlp_state != NLP_STE_NPR_NODE) ||
4594 !(np->nlp_flag & NLP_NPR_ADISC))
4595 continue;
4596 spin_lock_irq(shost->host_lock);
4597 np->nlp_flag &= ~NLP_NPR_ADISC;
4598 spin_unlock_irq(shost->host_lock);
4599 lpfc_unreg_rpi(vport, np);
4601 lpfc_mbx_unreg_vpi(vport);
4602 spin_lock_irq(shost->host_lock);
4603 vport->fc_flag |= FC_VPORT_NEEDS_REG_VPI;
4604 spin_unlock_irq(shost->host_lock);
4607 if (vport->fc_flag & FC_VPORT_NEEDS_REG_VPI)
4608 lpfc_register_new_vport(phba, vport, ndlp);
4609 else
4610 lpfc_do_scr_ns_plogi(phba, vport);
4612 /* Unconditionaly kick off releasing fabric node for vports */
4613 lpfc_nlp_put(ndlp);
4616 out:
4617 lpfc_els_free_iocb(phba, cmdiocb);
4620 static int
4621 lpfc_issue_els_fdisc(struct lpfc_vport *vport, struct lpfc_nodelist *ndlp,
4622 uint8_t retry)
4624 struct lpfc_hba *phba = vport->phba;
4625 IOCB_t *icmd;
4626 struct lpfc_iocbq *elsiocb;
4627 struct serv_parm *sp;
4628 uint8_t *pcmd;
4629 uint16_t cmdsize;
4630 int did = ndlp->nlp_DID;
4631 int rc;
4633 cmdsize = (sizeof(uint32_t) + sizeof(struct serv_parm));
4634 elsiocb = lpfc_prep_els_iocb(vport, 1, cmdsize, retry, ndlp, did,
4635 ELS_CMD_FDISC);
4636 if (!elsiocb) {
4637 lpfc_vport_set_state(vport, FC_VPORT_FAILED);
4638 lpfc_printf_vlog(vport, KERN_ERR, LOG_ELS,
4639 "0255 Issue FDISC: no IOCB\n");
4640 return 1;
4643 icmd = &elsiocb->iocb;
4644 icmd->un.elsreq64.myID = 0;
4645 icmd->un.elsreq64.fl = 1;
4647 /* For FDISC, Let FDISC rsp set the NPortID for this VPI */
4648 icmd->ulpCt_h = 1;
4649 icmd->ulpCt_l = 0;
4651 pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
4652 *((uint32_t *) (pcmd)) = ELS_CMD_FDISC;
4653 pcmd += sizeof(uint32_t); /* CSP Word 1 */
4654 memcpy(pcmd, &vport->phba->pport->fc_sparam, sizeof(struct serv_parm));
4655 sp = (struct serv_parm *) pcmd;
4656 /* Setup CSPs accordingly for Fabric */
4657 sp->cmn.e_d_tov = 0;
4658 sp->cmn.w2.r_a_tov = 0;
4659 sp->cls1.classValid = 0;
4660 sp->cls2.seqDelivery = 1;
4661 sp->cls3.seqDelivery = 1;
4663 pcmd += sizeof(uint32_t); /* CSP Word 2 */
4664 pcmd += sizeof(uint32_t); /* CSP Word 3 */
4665 pcmd += sizeof(uint32_t); /* CSP Word 4 */
4666 pcmd += sizeof(uint32_t); /* Port Name */
4667 memcpy(pcmd, &vport->fc_portname, 8);
4668 pcmd += sizeof(uint32_t); /* Node Name */
4669 pcmd += sizeof(uint32_t); /* Node Name */
4670 memcpy(pcmd, &vport->fc_nodename, 8);
4672 lpfc_set_disctmo(vport);
4674 phba->fc_stat.elsXmitFDISC++;
4675 elsiocb->iocb_cmpl = lpfc_cmpl_els_fdisc;
4677 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
4678 "Issue FDISC: did:x%x",
4679 did, 0, 0);
4681 rc = lpfc_issue_fabric_iocb(phba, elsiocb);
4682 if (rc == IOCB_ERROR) {
4683 lpfc_els_free_iocb(phba, elsiocb);
4684 lpfc_vport_set_state(vport, FC_VPORT_FAILED);
4685 lpfc_printf_vlog(vport, KERN_ERR, LOG_ELS,
4686 "0256 Issue FDISC: Cannot send IOCB\n");
4687 return 1;
4689 lpfc_vport_set_state(vport, FC_VPORT_INITIALIZING);
4690 vport->port_state = LPFC_FDISC;
4691 return 0;
4694 static void
4695 lpfc_cmpl_els_npiv_logo(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
4696 struct lpfc_iocbq *rspiocb)
4698 struct lpfc_vport *vport = cmdiocb->vport;
4699 IOCB_t *irsp;
4700 struct lpfc_nodelist *ndlp;
4701 ndlp = (struct lpfc_nodelist *)cmdiocb->context1;
4703 irsp = &rspiocb->iocb;
4704 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
4705 "LOGO npiv cmpl: status:x%x/x%x did:x%x",
4706 irsp->ulpStatus, irsp->un.ulpWord[4], irsp->un.rcvels.remoteID);
4708 lpfc_els_free_iocb(phba, cmdiocb);
4709 vport->unreg_vpi_cmpl = VPORT_ERROR;
4711 /* Trigger the release of the ndlp after logo */
4712 lpfc_nlp_put(ndlp);
4716 lpfc_issue_els_npiv_logo(struct lpfc_vport *vport, struct lpfc_nodelist *ndlp)
4718 struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
4719 struct lpfc_hba *phba = vport->phba;
4720 struct lpfc_sli_ring *pring = &phba->sli.ring[LPFC_ELS_RING];
4721 IOCB_t *icmd;
4722 struct lpfc_iocbq *elsiocb;
4723 uint8_t *pcmd;
4724 uint16_t cmdsize;
4726 cmdsize = 2 * sizeof(uint32_t) + sizeof(struct lpfc_name);
4727 elsiocb = lpfc_prep_els_iocb(vport, 1, cmdsize, 0, ndlp, ndlp->nlp_DID,
4728 ELS_CMD_LOGO);
4729 if (!elsiocb)
4730 return 1;
4732 icmd = &elsiocb->iocb;
4733 pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
4734 *((uint32_t *) (pcmd)) = ELS_CMD_LOGO;
4735 pcmd += sizeof(uint32_t);
4737 /* Fill in LOGO payload */
4738 *((uint32_t *) (pcmd)) = be32_to_cpu(vport->fc_myDID);
4739 pcmd += sizeof(uint32_t);
4740 memcpy(pcmd, &vport->fc_portname, sizeof(struct lpfc_name));
4742 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
4743 "Issue LOGO npiv did:x%x flg:x%x",
4744 ndlp->nlp_DID, ndlp->nlp_flag, 0);
4746 elsiocb->iocb_cmpl = lpfc_cmpl_els_npiv_logo;
4747 spin_lock_irq(shost->host_lock);
4748 ndlp->nlp_flag |= NLP_LOGO_SND;
4749 spin_unlock_irq(shost->host_lock);
4750 if (lpfc_sli_issue_iocb(phba, pring, elsiocb, 0) == IOCB_ERROR) {
4751 spin_lock_irq(shost->host_lock);
4752 ndlp->nlp_flag &= ~NLP_LOGO_SND;
4753 spin_unlock_irq(shost->host_lock);
4754 lpfc_els_free_iocb(phba, elsiocb);
4755 return 1;
4757 return 0;
4760 void
4761 lpfc_fabric_block_timeout(unsigned long ptr)
4763 struct lpfc_hba *phba = (struct lpfc_hba *) ptr;
4764 unsigned long iflags;
4765 uint32_t tmo_posted;
4767 spin_lock_irqsave(&phba->pport->work_port_lock, iflags);
4768 tmo_posted = phba->pport->work_port_events & WORKER_FABRIC_BLOCK_TMO;
4769 if (!tmo_posted)
4770 phba->pport->work_port_events |= WORKER_FABRIC_BLOCK_TMO;
4771 spin_unlock_irqrestore(&phba->pport->work_port_lock, iflags);
4773 if (!tmo_posted)
4774 lpfc_worker_wake_up(phba);
4775 return;
4778 static void
4779 lpfc_resume_fabric_iocbs(struct lpfc_hba *phba)
4781 struct lpfc_iocbq *iocb;
4782 unsigned long iflags;
4783 int ret;
4784 struct lpfc_sli_ring *pring = &phba->sli.ring[LPFC_ELS_RING];
4785 IOCB_t *cmd;
4787 repeat:
4788 iocb = NULL;
4789 spin_lock_irqsave(&phba->hbalock, iflags);
4790 /* Post any pending iocb to the SLI layer */
4791 if (atomic_read(&phba->fabric_iocb_count) == 0) {
4792 list_remove_head(&phba->fabric_iocb_list, iocb, typeof(*iocb),
4793 list);
4794 if (iocb)
4795 /* Increment fabric iocb count to hold the position */
4796 atomic_inc(&phba->fabric_iocb_count);
4798 spin_unlock_irqrestore(&phba->hbalock, iflags);
4799 if (iocb) {
4800 iocb->fabric_iocb_cmpl = iocb->iocb_cmpl;
4801 iocb->iocb_cmpl = lpfc_cmpl_fabric_iocb;
4802 iocb->iocb_flag |= LPFC_IO_FABRIC;
4804 lpfc_debugfs_disc_trc(iocb->vport, LPFC_DISC_TRC_ELS_CMD,
4805 "Fabric sched1: ste:x%x",
4806 iocb->vport->port_state, 0, 0);
4808 ret = lpfc_sli_issue_iocb(phba, pring, iocb, 0);
4810 if (ret == IOCB_ERROR) {
4811 iocb->iocb_cmpl = iocb->fabric_iocb_cmpl;
4812 iocb->fabric_iocb_cmpl = NULL;
4813 iocb->iocb_flag &= ~LPFC_IO_FABRIC;
4814 cmd = &iocb->iocb;
4815 cmd->ulpStatus = IOSTAT_LOCAL_REJECT;
4816 cmd->un.ulpWord[4] = IOERR_SLI_ABORTED;
4817 iocb->iocb_cmpl(phba, iocb, iocb);
4819 atomic_dec(&phba->fabric_iocb_count);
4820 goto repeat;
4824 return;
4827 void
4828 lpfc_unblock_fabric_iocbs(struct lpfc_hba *phba)
4830 clear_bit(FABRIC_COMANDS_BLOCKED, &phba->bit_flags);
4832 lpfc_resume_fabric_iocbs(phba);
4833 return;
4836 static void
4837 lpfc_block_fabric_iocbs(struct lpfc_hba *phba)
4839 int blocked;
4841 blocked = test_and_set_bit(FABRIC_COMANDS_BLOCKED, &phba->bit_flags);
4842 /* Start a timer to unblock fabric iocbs after 100ms */
4843 if (!blocked)
4844 mod_timer(&phba->fabric_block_timer, jiffies + HZ/10 );
4846 return;
4849 static void
4850 lpfc_cmpl_fabric_iocb(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
4851 struct lpfc_iocbq *rspiocb)
4853 struct ls_rjt stat;
4855 if ((cmdiocb->iocb_flag & LPFC_IO_FABRIC) != LPFC_IO_FABRIC)
4856 BUG();
4858 switch (rspiocb->iocb.ulpStatus) {
4859 case IOSTAT_NPORT_RJT:
4860 case IOSTAT_FABRIC_RJT:
4861 if (rspiocb->iocb.un.ulpWord[4] & RJT_UNAVAIL_TEMP) {
4862 lpfc_block_fabric_iocbs(phba);
4864 break;
4866 case IOSTAT_NPORT_BSY:
4867 case IOSTAT_FABRIC_BSY:
4868 lpfc_block_fabric_iocbs(phba);
4869 break;
4871 case IOSTAT_LS_RJT:
4872 stat.un.lsRjtError =
4873 be32_to_cpu(rspiocb->iocb.un.ulpWord[4]);
4874 if ((stat.un.b.lsRjtRsnCode == LSRJT_UNABLE_TPC) ||
4875 (stat.un.b.lsRjtRsnCode == LSRJT_LOGICAL_BSY))
4876 lpfc_block_fabric_iocbs(phba);
4877 break;
4880 if (atomic_read(&phba->fabric_iocb_count) == 0)
4881 BUG();
4883 cmdiocb->iocb_cmpl = cmdiocb->fabric_iocb_cmpl;
4884 cmdiocb->fabric_iocb_cmpl = NULL;
4885 cmdiocb->iocb_flag &= ~LPFC_IO_FABRIC;
4886 cmdiocb->iocb_cmpl(phba, cmdiocb, rspiocb);
4888 atomic_dec(&phba->fabric_iocb_count);
4889 if (!test_bit(FABRIC_COMANDS_BLOCKED, &phba->bit_flags)) {
4890 /* Post any pending iocbs to HBA */
4891 lpfc_resume_fabric_iocbs(phba);
4895 static int
4896 lpfc_issue_fabric_iocb(struct lpfc_hba *phba, struct lpfc_iocbq *iocb)
4898 unsigned long iflags;
4899 struct lpfc_sli_ring *pring = &phba->sli.ring[LPFC_ELS_RING];
4900 int ready;
4901 int ret;
4903 if (atomic_read(&phba->fabric_iocb_count) > 1)
4904 BUG();
4906 spin_lock_irqsave(&phba->hbalock, iflags);
4907 ready = atomic_read(&phba->fabric_iocb_count) == 0 &&
4908 !test_bit(FABRIC_COMANDS_BLOCKED, &phba->bit_flags);
4910 if (ready)
4911 /* Increment fabric iocb count to hold the position */
4912 atomic_inc(&phba->fabric_iocb_count);
4913 spin_unlock_irqrestore(&phba->hbalock, iflags);
4914 if (ready) {
4915 iocb->fabric_iocb_cmpl = iocb->iocb_cmpl;
4916 iocb->iocb_cmpl = lpfc_cmpl_fabric_iocb;
4917 iocb->iocb_flag |= LPFC_IO_FABRIC;
4919 lpfc_debugfs_disc_trc(iocb->vport, LPFC_DISC_TRC_ELS_CMD,
4920 "Fabric sched2: ste:x%x",
4921 iocb->vport->port_state, 0, 0);
4923 ret = lpfc_sli_issue_iocb(phba, pring, iocb, 0);
4925 if (ret == IOCB_ERROR) {
4926 iocb->iocb_cmpl = iocb->fabric_iocb_cmpl;
4927 iocb->fabric_iocb_cmpl = NULL;
4928 iocb->iocb_flag &= ~LPFC_IO_FABRIC;
4929 atomic_dec(&phba->fabric_iocb_count);
4931 } else {
4932 spin_lock_irqsave(&phba->hbalock, iflags);
4933 list_add_tail(&iocb->list, &phba->fabric_iocb_list);
4934 spin_unlock_irqrestore(&phba->hbalock, iflags);
4935 ret = IOCB_SUCCESS;
4937 return ret;
4941 static void lpfc_fabric_abort_vport(struct lpfc_vport *vport)
4943 LIST_HEAD(completions);
4944 struct lpfc_hba *phba = vport->phba;
4945 struct lpfc_iocbq *tmp_iocb, *piocb;
4946 IOCB_t *cmd;
4948 spin_lock_irq(&phba->hbalock);
4949 list_for_each_entry_safe(piocb, tmp_iocb, &phba->fabric_iocb_list,
4950 list) {
4952 if (piocb->vport != vport)
4953 continue;
4955 list_move_tail(&piocb->list, &completions);
4957 spin_unlock_irq(&phba->hbalock);
4959 while (!list_empty(&completions)) {
4960 piocb = list_get_first(&completions, struct lpfc_iocbq, list);
4961 list_del_init(&piocb->list);
4963 cmd = &piocb->iocb;
4964 cmd->ulpStatus = IOSTAT_LOCAL_REJECT;
4965 cmd->un.ulpWord[4] = IOERR_SLI_ABORTED;
4966 (piocb->iocb_cmpl) (phba, piocb, piocb);
4970 void lpfc_fabric_abort_nport(struct lpfc_nodelist *ndlp)
4972 LIST_HEAD(completions);
4973 struct lpfc_hba *phba = ndlp->vport->phba;
4974 struct lpfc_iocbq *tmp_iocb, *piocb;
4975 struct lpfc_sli_ring *pring = &phba->sli.ring[LPFC_ELS_RING];
4976 IOCB_t *cmd;
4978 spin_lock_irq(&phba->hbalock);
4979 list_for_each_entry_safe(piocb, tmp_iocb, &phba->fabric_iocb_list,
4980 list) {
4981 if ((lpfc_check_sli_ndlp(phba, pring, piocb, ndlp))) {
4983 list_move_tail(&piocb->list, &completions);
4986 spin_unlock_irq(&phba->hbalock);
4988 while (!list_empty(&completions)) {
4989 piocb = list_get_first(&completions, struct lpfc_iocbq, list);
4990 list_del_init(&piocb->list);
4992 cmd = &piocb->iocb;
4993 cmd->ulpStatus = IOSTAT_LOCAL_REJECT;
4994 cmd->un.ulpWord[4] = IOERR_SLI_ABORTED;
4995 (piocb->iocb_cmpl) (phba, piocb, piocb);
4999 void lpfc_fabric_abort_hba(struct lpfc_hba *phba)
5001 LIST_HEAD(completions);
5002 struct lpfc_iocbq *piocb;
5003 IOCB_t *cmd;
5005 spin_lock_irq(&phba->hbalock);
5006 list_splice_init(&phba->fabric_iocb_list, &completions);
5007 spin_unlock_irq(&phba->hbalock);
5009 while (!list_empty(&completions)) {
5010 piocb = list_get_first(&completions, struct lpfc_iocbq, list);
5011 list_del_init(&piocb->list);
5013 cmd = &piocb->iocb;
5014 cmd->ulpStatus = IOSTAT_LOCAL_REJECT;
5015 cmd->un.ulpWord[4] = IOERR_SLI_ABORTED;
5016 (piocb->iocb_cmpl) (phba, piocb, piocb);