xref: /openbmc/linux/drivers/scsi/lpfc/lpfc_els.c (revision c21b37f6)
1 /*******************************************************************
2  * This file is part of the Emulex Linux Device Driver for         *
3  * Fibre Channel Host Bus Adapters.                                *
4  * Copyright (C) 2004-2007 Emulex.  All rights reserved.           *
5  * EMULEX and SLI are trademarks of Emulex.                        *
6  * www.emulex.com                                                  *
7  * 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 
22 #include <linux/blkdev.h>
23 #include <linux/pci.h>
24 #include <linux/interrupt.h>
25 
26 #include <scsi/scsi.h>
27 #include <scsi/scsi_device.h>
28 #include <scsi/scsi_host.h>
29 #include <scsi/scsi_transport_fc.h>
30 
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"
40 
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 
46 static int lpfc_max_els_tries = 3;
47 
48 int
49 lpfc_els_chk_latt(struct lpfc_vport *vport)
50 {
51 	struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
52 	struct lpfc_hba  *phba = vport->phba;
53 	uint32_t ha_copy;
54 
55 	if (vport->port_state >= LPFC_VPORT_READY ||
56 	    phba->link_state == LPFC_LINK_DOWN)
57 		return 0;
58 
59 	/* Read the HBA Host Attention Register */
60 	ha_copy = readl(phba->HAregaddr);
61 
62 	if (!(ha_copy & HA_LATT))
63 		return 0;
64 
65 	/* Pending Link Event during Discovery */
66 	lpfc_printf_log(phba, KERN_ERR, LOG_DISCOVERY,
67 			"%d (%d):0237 Pending Link Event during "
68 			"Discovery: State x%x\n",
69 			phba->brd_no, vport->vpi,  phba->pport->port_state);
70 
71 	/* CLEAR_LA should re-enable link attention events and
72 	 * we should then imediately take a LATT event. The
73 	 * LATT processing should call lpfc_linkdown() which
74 	 * will cleanup any left over in-progress discovery
75 	 * events.
76 	 */
77 	spin_lock_irq(shost->host_lock);
78 	vport->fc_flag |= FC_ABORT_DISCOVERY;
79 	spin_unlock_irq(shost->host_lock);
80 
81 	if (phba->link_state != LPFC_CLEAR_LA)
82 		lpfc_issue_clear_la(phba, vport);
83 
84 	return 1;
85 }
86 
87 static struct lpfc_iocbq *
88 lpfc_prep_els_iocb(struct lpfc_vport *vport, uint8_t expectRsp,
89 		   uint16_t cmdSize, uint8_t retry,
90 		   struct lpfc_nodelist *ndlp, uint32_t did,
91 		   uint32_t elscmd)
92 {
93 	struct lpfc_hba  *phba = vport->phba;
94 	struct lpfc_iocbq *elsiocb;
95 	struct lpfc_dmabuf *pcmd, *prsp, *pbuflist;
96 	struct ulp_bde64 *bpl;
97 	IOCB_t *icmd;
98 
99 
100 	if (!lpfc_is_link_up(phba))
101 		return NULL;
102 
103 	/* Allocate buffer for  command iocb */
104 	elsiocb = lpfc_sli_get_iocbq(phba);
105 
106 	if (elsiocb == NULL)
107 		return NULL;
108 	icmd = &elsiocb->iocb;
109 
110 	/* fill in BDEs for command */
111 	/* Allocate buffer for command payload */
112 	if (((pcmd = kmalloc(sizeof(struct lpfc_dmabuf), GFP_KERNEL)) == 0) ||
113 	    ((pcmd->virt = lpfc_mbuf_alloc(phba,
114 					   MEM_PRI, &(pcmd->phys))) == 0)) {
115 		kfree(pcmd);
116 
117 		lpfc_sli_release_iocbq(phba, elsiocb);
118 		return NULL;
119 	}
120 
121 	INIT_LIST_HEAD(&pcmd->list);
122 
123 	/* Allocate buffer for response payload */
124 	if (expectRsp) {
125 		prsp = kmalloc(sizeof(struct lpfc_dmabuf), GFP_KERNEL);
126 		if (prsp)
127 			prsp->virt = lpfc_mbuf_alloc(phba, MEM_PRI,
128 						     &prsp->phys);
129 		if (prsp == 0 || prsp->virt == 0) {
130 			kfree(prsp);
131 			lpfc_mbuf_free(phba, pcmd->virt, pcmd->phys);
132 			kfree(pcmd);
133 			lpfc_sli_release_iocbq(phba, elsiocb);
134 			return NULL;
135 		}
136 		INIT_LIST_HEAD(&prsp->list);
137 	} else {
138 		prsp = NULL;
139 	}
140 
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 == 0 || pbuflist->virt == 0) {
147 		lpfc_sli_release_iocbq(phba, elsiocb);
148 		lpfc_mbuf_free(phba, pcmd->virt, pcmd->phys);
149 		lpfc_mbuf_free(phba, prsp->virt, prsp->phys);
150 		kfree(pcmd);
151 		kfree(prsp);
152 		kfree(pbuflist);
153 		return NULL;
154 	}
155 
156 	INIT_LIST_HEAD(&pbuflist->list);
157 
158 	icmd->un.elsreq64.bdl.addrHigh = putPaddrHigh(pbuflist->phys);
159 	icmd->un.elsreq64.bdl.addrLow = putPaddrLow(pbuflist->phys);
160 	icmd->un.elsreq64.bdl.bdeFlags = BUFF_TYPE_BDL;
161 	icmd->un.elsreq64.remoteID = did;	/* DID */
162 	if (expectRsp) {
163 		icmd->un.elsreq64.bdl.bdeSize = (2 * sizeof(struct ulp_bde64));
164 		icmd->ulpCommand = CMD_ELS_REQUEST64_CR;
165 		icmd->ulpTimeout = phba->fc_ratov * 2;
166 	} else {
167 		icmd->un.elsreq64.bdl.bdeSize = sizeof(struct ulp_bde64);
168 		icmd->ulpCommand = CMD_XMIT_ELS_RSP64_CX;
169 	}
170 	icmd->ulpBdeCount = 1;
171 	icmd->ulpLe = 1;
172 	icmd->ulpClass = CLASS3;
173 
174 	if (phba->sli3_options & LPFC_SLI3_NPIV_ENABLED) {
175 		icmd->un.elsreq64.myID = vport->fc_myDID;
176 
177 		/* For ELS_REQUEST64_CR, use the VPI by default */
178 		icmd->ulpContext = vport->vpi;
179 		icmd->ulpCt_h = 0;
180 		icmd->ulpCt_l = 1;
181 	}
182 
183 	bpl = (struct ulp_bde64 *) pbuflist->virt;
184 	bpl->addrLow = le32_to_cpu(putPaddrLow(pcmd->phys));
185 	bpl->addrHigh = le32_to_cpu(putPaddrHigh(pcmd->phys));
186 	bpl->tus.f.bdeSize = cmdSize;
187 	bpl->tus.f.bdeFlags = 0;
188 	bpl->tus.w = le32_to_cpu(bpl->tus.w);
189 
190 	if (expectRsp) {
191 		bpl++;
192 		bpl->addrLow = le32_to_cpu(putPaddrLow(prsp->phys));
193 		bpl->addrHigh = le32_to_cpu(putPaddrHigh(prsp->phys));
194 		bpl->tus.f.bdeSize = FCELSSIZE;
195 		bpl->tus.f.bdeFlags = BUFF_USE_RCV;
196 		bpl->tus.w = le32_to_cpu(bpl->tus.w);
197 	}
198 
199 	/* Save for completion so we can release these resources */
200 	if (elscmd != ELS_CMD_LS_RJT)
201 		elsiocb->context1 = lpfc_nlp_get(ndlp);
202 	elsiocb->context2 = pcmd;
203 	elsiocb->context3 = pbuflist;
204 	elsiocb->retry = retry;
205 	elsiocb->vport = vport;
206 	elsiocb->drvrTimeout = (phba->fc_ratov << 1) + LPFC_DRVR_TIMEOUT;
207 
208 	if (prsp) {
209 		list_add(&prsp->list, &pcmd->list);
210 	}
211 
212 	if (expectRsp) {
213 		/* Xmit ELS command <elsCmd> to remote NPORT <did> */
214 		lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
215 				"%d (%d):0116 Xmit ELS command x%x to remote "
216 				"NPORT x%x I/O tag: x%x, port state: x%x\n",
217 				phba->brd_no, vport->vpi,  elscmd, did,
218 				elsiocb->iotag, vport->port_state);
219 	} else {
220 		/* Xmit ELS response <elsCmd> to remote NPORT <did> */
221 		lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
222 				"%d (%d):0117 Xmit ELS response x%x to remote "
223 				"NPORT x%x I/O tag: x%x, size: x%x\n",
224 				phba->brd_no, vport->vpi, elscmd,
225 				ndlp->nlp_DID, elsiocb->iotag, cmdSize);
226 	}
227 
228 	return elsiocb;
229 }
230 
231 
232 static int
233 lpfc_issue_fabric_reglogin(struct lpfc_vport *vport)
234 {
235 	struct lpfc_hba  *phba = vport->phba;
236 	LPFC_MBOXQ_t *mbox;
237 	struct lpfc_dmabuf *mp;
238 	struct lpfc_nodelist *ndlp;
239 	struct serv_parm *sp;
240 	int rc;
241 
242 	sp = &phba->fc_fabparam;
243 	ndlp = lpfc_findnode_did(vport, Fabric_DID);
244 	if (!ndlp)
245 		goto fail;
246 
247 	mbox = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
248 	if (!mbox)
249 		goto fail;
250 
251 	vport->port_state = LPFC_FABRIC_CFG_LINK;
252 	lpfc_config_link(phba, mbox);
253 	mbox->mbox_cmpl = lpfc_sli_def_mbox_cmpl;
254 	mbox->vport = vport;
255 
256 	rc = lpfc_sli_issue_mbox(phba, mbox, MBX_NOWAIT | MBX_STOP_IOCB);
257 	if (rc == MBX_NOT_FINISHED)
258 		goto fail_free_mbox;
259 
260 	mbox = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
261 	if (!mbox)
262 		goto fail;
263 	rc = lpfc_reg_login(phba, vport->vpi, Fabric_DID, (uint8_t *)sp, mbox,
264 			    0);
265 	if (rc)
266 		goto fail_free_mbox;
267 
268 	mbox->mbox_cmpl = lpfc_mbx_cmpl_fabric_reg_login;
269 	mbox->vport = vport;
270 	mbox->context2 = lpfc_nlp_get(ndlp);
271 
272 	rc = lpfc_sli_issue_mbox(phba, mbox, MBX_NOWAIT | MBX_STOP_IOCB);
273 	if (rc == MBX_NOT_FINISHED)
274 		goto fail_issue_reg_login;
275 
276 	return 0;
277 
278 fail_issue_reg_login:
279 	lpfc_nlp_put(ndlp);
280 	mp = (struct lpfc_dmabuf *) mbox->context1;
281 	lpfc_mbuf_free(phba, mp->virt, mp->phys);
282 	kfree(mp);
283 fail_free_mbox:
284 	mempool_free(mbox, phba->mbox_mem_pool);
285 
286 fail:
287 	lpfc_vport_set_state(vport, FC_VPORT_FAILED);
288 	lpfc_printf_log(phba, KERN_ERR, LOG_ELS,
289 		"%d (%d):0249 Cannot issue Register Fabric login\n",
290 		phba->brd_no, vport->vpi);
291 	return -ENXIO;
292 }
293 
294 static int
295 lpfc_cmpl_els_flogi_fabric(struct lpfc_vport *vport, struct lpfc_nodelist *ndlp,
296 			   struct serv_parm *sp, IOCB_t *irsp)
297 {
298 	struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
299 	struct lpfc_hba  *phba = vport->phba;
300 	struct lpfc_nodelist *np;
301 	struct lpfc_nodelist *next_np;
302 
303 	spin_lock_irq(shost->host_lock);
304 	vport->fc_flag |= FC_FABRIC;
305 	spin_unlock_irq(shost->host_lock);
306 
307 	phba->fc_edtov = be32_to_cpu(sp->cmn.e_d_tov);
308 	if (sp->cmn.edtovResolution)	/* E_D_TOV ticks are in nanoseconds */
309 		phba->fc_edtov = (phba->fc_edtov + 999999) / 1000000;
310 
311 	phba->fc_ratov = (be32_to_cpu(sp->cmn.w2.r_a_tov) + 999) / 1000;
312 
313 	if (phba->fc_topology == TOPOLOGY_LOOP) {
314 		spin_lock_irq(shost->host_lock);
315 		vport->fc_flag |= FC_PUBLIC_LOOP;
316 		spin_unlock_irq(shost->host_lock);
317 	} else {
318 		/*
319 		 * If we are a N-port connected to a Fabric, fixup sparam's so
320 		 * logins to devices on remote loops work.
321 		 */
322 		vport->fc_sparam.cmn.altBbCredit = 1;
323 	}
324 
325 	vport->fc_myDID = irsp->un.ulpWord[4] & Mask_DID;
326 	memcpy(&ndlp->nlp_portname, &sp->portName, sizeof(struct lpfc_name));
327 	memcpy(&ndlp->nlp_nodename, &sp->nodeName, sizeof(struct lpfc_name));
328 	ndlp->nlp_class_sup = 0;
329 	if (sp->cls1.classValid)
330 		ndlp->nlp_class_sup |= FC_COS_CLASS1;
331 	if (sp->cls2.classValid)
332 		ndlp->nlp_class_sup |= FC_COS_CLASS2;
333 	if (sp->cls3.classValid)
334 		ndlp->nlp_class_sup |= FC_COS_CLASS3;
335 	if (sp->cls4.classValid)
336 		ndlp->nlp_class_sup |= FC_COS_CLASS4;
337 	ndlp->nlp_maxframe = ((sp->cmn.bbRcvSizeMsb & 0x0F) << 8) |
338 				sp->cmn.bbRcvSizeLsb;
339 	memcpy(&phba->fc_fabparam, sp, sizeof(struct serv_parm));
340 
341 	if (phba->sli3_options & LPFC_SLI3_NPIV_ENABLED) {
342 		if (sp->cmn.response_multiple_NPort) {
343 			lpfc_printf_log(phba, KERN_WARNING, LOG_ELS | LOG_VPORT,
344 					"%d:1816 FLOGI NPIV supported, "
345 					"response data 0x%x\n",
346 					phba->brd_no,
347 					sp->cmn.response_multiple_NPort);
348 			phba->link_flag |= LS_NPIV_FAB_SUPPORTED;
349 
350 		} else {
351 			/* Because we asked f/w for NPIV it still expects us
352 			   to call reg_vnpid atleast for the physcial host */
353 			lpfc_printf_log(phba, KERN_WARNING, LOG_ELS | LOG_VPORT,
354 					"%d:1817 Fabric does not support NPIV "
355 					"- configuring single port mode.\n",
356 					phba->brd_no);
357 			phba->link_flag &= ~LS_NPIV_FAB_SUPPORTED;
358 		}
359 	}
360 
361 	if ((vport->fc_prevDID != vport->fc_myDID) &&
362 		!(vport->fc_flag & FC_VPORT_NEEDS_REG_VPI)) {
363 
364 		/* If our NportID changed, we need to ensure all
365 		 * remaining NPORTs get unreg_login'ed.
366 		 */
367 		list_for_each_entry_safe(np, next_np,
368 					&vport->fc_nodes, nlp_listp) {
369 			if ((np->nlp_state != NLP_STE_NPR_NODE) ||
370 				   !(np->nlp_flag & NLP_NPR_ADISC))
371 				continue;
372 			spin_lock_irq(shost->host_lock);
373 			np->nlp_flag &= ~NLP_NPR_ADISC;
374 			spin_unlock_irq(shost->host_lock);
375 			lpfc_unreg_rpi(vport, np);
376 		}
377 		if (phba->sli3_options & LPFC_SLI3_NPIV_ENABLED) {
378 			lpfc_mbx_unreg_vpi(vport);
379 			vport->fc_flag |= FC_VPORT_NEEDS_REG_VPI;
380 		}
381 	}
382 
383 	ndlp->nlp_sid = irsp->un.ulpWord[4] & Mask_DID;
384 	lpfc_nlp_set_state(vport, ndlp, NLP_STE_REG_LOGIN_ISSUE);
385 
386 	if (phba->sli3_options & LPFC_SLI3_NPIV_ENABLED &&
387 	    vport->fc_flag & FC_VPORT_NEEDS_REG_VPI) {
388 		lpfc_register_new_vport(phba, vport, ndlp);
389 		return 0;
390 	}
391 	lpfc_issue_fabric_reglogin(vport);
392 	return 0;
393 }
394 
395 /*
396  * We FLOGIed into an NPort, initiate pt2pt protocol
397  */
398 static int
399 lpfc_cmpl_els_flogi_nport(struct lpfc_vport *vport, struct lpfc_nodelist *ndlp,
400 			  struct serv_parm *sp)
401 {
402 	struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
403 	struct lpfc_hba  *phba = vport->phba;
404 	LPFC_MBOXQ_t *mbox;
405 	int rc;
406 
407 	spin_lock_irq(shost->host_lock);
408 	vport->fc_flag &= ~(FC_FABRIC | FC_PUBLIC_LOOP);
409 	spin_unlock_irq(shost->host_lock);
410 
411 	phba->fc_edtov = FF_DEF_EDTOV;
412 	phba->fc_ratov = FF_DEF_RATOV;
413 	rc = memcmp(&vport->fc_portname, &sp->portName,
414 		    sizeof(vport->fc_portname));
415 	if (rc >= 0) {
416 		/* This side will initiate the PLOGI */
417 		spin_lock_irq(shost->host_lock);
418 		vport->fc_flag |= FC_PT2PT_PLOGI;
419 		spin_unlock_irq(shost->host_lock);
420 
421 		/*
422 		 * N_Port ID cannot be 0, set our to LocalID the other
423 		 * side will be RemoteID.
424 		 */
425 
426 		/* not equal */
427 		if (rc)
428 			vport->fc_myDID = PT2PT_LocalID;
429 
430 		mbox = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
431 		if (!mbox)
432 			goto fail;
433 
434 		lpfc_config_link(phba, mbox);
435 
436 		mbox->mbox_cmpl = lpfc_sli_def_mbox_cmpl;
437 		mbox->vport = vport;
438 		rc = lpfc_sli_issue_mbox(phba, mbox,
439 					 MBX_NOWAIT | MBX_STOP_IOCB);
440 		if (rc == MBX_NOT_FINISHED) {
441 			mempool_free(mbox, phba->mbox_mem_pool);
442 			goto fail;
443 		}
444 		lpfc_nlp_put(ndlp);
445 
446 		ndlp = lpfc_findnode_did(vport, PT2PT_RemoteID);
447 		if (!ndlp) {
448 			/*
449 			 * Cannot find existing Fabric ndlp, so allocate a
450 			 * new one
451 			 */
452 			ndlp = mempool_alloc(phba->nlp_mem_pool, GFP_KERNEL);
453 			if (!ndlp)
454 				goto fail;
455 
456 			lpfc_nlp_init(vport, ndlp, PT2PT_RemoteID);
457 		}
458 
459 		memcpy(&ndlp->nlp_portname, &sp->portName,
460 		       sizeof(struct lpfc_name));
461 		memcpy(&ndlp->nlp_nodename, &sp->nodeName,
462 		       sizeof(struct lpfc_name));
463 		lpfc_nlp_set_state(vport, ndlp, NLP_STE_NPR_NODE);
464 		spin_lock_irq(shost->host_lock);
465 		ndlp->nlp_flag |= NLP_NPR_2B_DISC;
466 		spin_unlock_irq(shost->host_lock);
467 	} else {
468 		/* This side will wait for the PLOGI */
469 		lpfc_nlp_put(ndlp);
470 	}
471 
472 	spin_lock_irq(shost->host_lock);
473 	vport->fc_flag |= FC_PT2PT;
474 	spin_unlock_irq(shost->host_lock);
475 
476 	/* Start discovery - this should just do CLEAR_LA */
477 	lpfc_disc_start(vport);
478 	return 0;
479 fail:
480 	return -ENXIO;
481 }
482 
483 static void
484 lpfc_cmpl_els_flogi(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
485 		    struct lpfc_iocbq *rspiocb)
486 {
487 	struct lpfc_vport *vport = cmdiocb->vport;
488 	struct Scsi_Host  *shost = lpfc_shost_from_vport(vport);
489 	IOCB_t *irsp = &rspiocb->iocb;
490 	struct lpfc_nodelist *ndlp = cmdiocb->context1;
491 	struct lpfc_dmabuf *pcmd = cmdiocb->context2, *prsp;
492 	struct serv_parm *sp;
493 	int rc;
494 
495 	/* Check to see if link went down during discovery */
496 	if (lpfc_els_chk_latt(vport)) {
497 		lpfc_nlp_put(ndlp);
498 		goto out;
499 	}
500 
501 	lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
502 		"FLOGI cmpl:      status:x%x/x%x state:x%x",
503 		irsp->ulpStatus, irsp->un.ulpWord[4],
504 		vport->port_state);
505 
506 	if (irsp->ulpStatus) {
507 		/* Check for retry */
508 		if (lpfc_els_retry(phba, cmdiocb, rspiocb))
509 			goto out;
510 
511 		/* FLOGI failed, so there is no fabric */
512 		spin_lock_irq(shost->host_lock);
513 		vport->fc_flag &= ~(FC_FABRIC | FC_PUBLIC_LOOP);
514 		spin_unlock_irq(shost->host_lock);
515 
516 		/* If private loop, then allow max outstanding els to be
517 		 * LPFC_MAX_DISC_THREADS (32). Scanning in the case of no
518 		 * alpa map would take too long otherwise.
519 		 */
520 		if (phba->alpa_map[0] == 0) {
521 			phba->cfg_discovery_threads = LPFC_MAX_DISC_THREADS;
522 		}
523 
524 		/* FLOGI failure */
525 		lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
526 				"%d (%d):0100 FLOGI failure Data: x%x x%x "
527 				"x%x\n",
528 				phba->brd_no, vport->vpi,
529 				irsp->ulpStatus, irsp->un.ulpWord[4],
530 				irsp->ulpTimeout);
531 		goto flogifail;
532 	}
533 
534 	/*
535 	 * The FLogI succeeded.  Sync the data for the CPU before
536 	 * accessing it.
537 	 */
538 	prsp = list_get_first(&pcmd->list, struct lpfc_dmabuf, list);
539 
540 	sp = prsp->virt + sizeof(uint32_t);
541 
542 	/* FLOGI completes successfully */
543 	lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
544 			"%d (%d):0101 FLOGI completes sucessfully "
545 			"Data: x%x x%x x%x x%x\n",
546 			phba->brd_no, vport->vpi,
547 			irsp->un.ulpWord[4], sp->cmn.e_d_tov,
548 			sp->cmn.w2.r_a_tov, sp->cmn.edtovResolution);
549 
550 	if (vport->port_state == LPFC_FLOGI) {
551 		/*
552 		 * If Common Service Parameters indicate Nport
553 		 * we are point to point, if Fport we are Fabric.
554 		 */
555 		if (sp->cmn.fPort)
556 			rc = lpfc_cmpl_els_flogi_fabric(vport, ndlp, sp, irsp);
557 		else
558 			rc = lpfc_cmpl_els_flogi_nport(vport, ndlp, sp);
559 
560 		if (!rc)
561 			goto out;
562 	}
563 
564 flogifail:
565 	lpfc_nlp_put(ndlp);
566 
567 	if (!lpfc_error_lost_link(irsp)) {
568 		/* FLOGI failed, so just use loop map to make discovery list */
569 		lpfc_disc_list_loopmap(vport);
570 
571 		/* Start discovery */
572 		lpfc_disc_start(vport);
573 	}
574 
575 out:
576 	lpfc_els_free_iocb(phba, cmdiocb);
577 }
578 
579 static int
580 lpfc_issue_els_flogi(struct lpfc_vport *vport, struct lpfc_nodelist *ndlp,
581 		     uint8_t retry)
582 {
583 	struct lpfc_hba  *phba = vport->phba;
584 	struct serv_parm *sp;
585 	IOCB_t *icmd;
586 	struct lpfc_iocbq *elsiocb;
587 	struct lpfc_sli_ring *pring;
588 	uint8_t *pcmd;
589 	uint16_t cmdsize;
590 	uint32_t tmo;
591 	int rc;
592 
593 	pring = &phba->sli.ring[LPFC_ELS_RING];
594 
595 	cmdsize = (sizeof(uint32_t) + sizeof(struct serv_parm));
596 	elsiocb = lpfc_prep_els_iocb(vport, 1, cmdsize, retry, ndlp,
597 				     ndlp->nlp_DID, ELS_CMD_FLOGI);
598 
599 	if (!elsiocb)
600 		return 1;
601 
602 	icmd = &elsiocb->iocb;
603 	pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
604 
605 	/* For FLOGI request, remainder of payload is service parameters */
606 	*((uint32_t *) (pcmd)) = ELS_CMD_FLOGI;
607 	pcmd += sizeof(uint32_t);
608 	memcpy(pcmd, &vport->fc_sparam, sizeof(struct serv_parm));
609 	sp = (struct serv_parm *) pcmd;
610 
611 	/* Setup CSPs accordingly for Fabric */
612 	sp->cmn.e_d_tov = 0;
613 	sp->cmn.w2.r_a_tov = 0;
614 	sp->cls1.classValid = 0;
615 	sp->cls2.seqDelivery = 1;
616 	sp->cls3.seqDelivery = 1;
617 	if (sp->cmn.fcphLow < FC_PH3)
618 		sp->cmn.fcphLow = FC_PH3;
619 	if (sp->cmn.fcphHigh < FC_PH3)
620 		sp->cmn.fcphHigh = FC_PH3;
621 
622 	if (phba->sli3_options & LPFC_SLI3_NPIV_ENABLED) {
623 		sp->cmn.request_multiple_Nport = 1;
624 
625 		/* For FLOGI, Let FLOGI rsp set the NPortID for VPI 0 */
626 		icmd->ulpCt_h = 1;
627 		icmd->ulpCt_l = 0;
628 	}
629 
630 	if (phba->fc_topology != TOPOLOGY_LOOP) {
631 		icmd->un.elsreq64.myID = 0;
632 		icmd->un.elsreq64.fl = 1;
633 	}
634 
635 	tmo = phba->fc_ratov;
636 	phba->fc_ratov = LPFC_DISC_FLOGI_TMO;
637 	lpfc_set_disctmo(vport);
638 	phba->fc_ratov = tmo;
639 
640 	phba->fc_stat.elsXmitFLOGI++;
641 	elsiocb->iocb_cmpl = lpfc_cmpl_els_flogi;
642 
643 	lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
644 		"Issue FLOGI:     opt:x%x",
645 		phba->sli3_options, 0, 0);
646 
647 	rc = lpfc_issue_fabric_iocb(phba, elsiocb);
648 	if (rc == IOCB_ERROR) {
649 		lpfc_els_free_iocb(phba, elsiocb);
650 		return 1;
651 	}
652 	return 0;
653 }
654 
655 int
656 lpfc_els_abort_flogi(struct lpfc_hba *phba)
657 {
658 	struct lpfc_sli_ring *pring;
659 	struct lpfc_iocbq *iocb, *next_iocb;
660 	struct lpfc_nodelist *ndlp;
661 	IOCB_t *icmd;
662 
663 	/* Abort outstanding I/O on NPort <nlp_DID> */
664 	lpfc_printf_log(phba, KERN_INFO, LOG_DISCOVERY,
665 			"%d:0201 Abort outstanding I/O on NPort x%x\n",
666 			phba->brd_no, Fabric_DID);
667 
668 	pring = &phba->sli.ring[LPFC_ELS_RING];
669 
670 	/*
671 	 * Check the txcmplq for an iocb that matches the nport the driver is
672 	 * searching for.
673 	 */
674 	spin_lock_irq(&phba->hbalock);
675 	list_for_each_entry_safe(iocb, next_iocb, &pring->txcmplq, list) {
676 		icmd = &iocb->iocb;
677 		if (icmd->ulpCommand == CMD_ELS_REQUEST64_CR &&
678 		    icmd->un.elsreq64.bdl.ulpIoTag32) {
679 			ndlp = (struct lpfc_nodelist *)(iocb->context1);
680 			if (ndlp && (ndlp->nlp_DID == Fabric_DID)) {
681 				lpfc_sli_issue_abort_iotag(phba, pring, iocb);
682 			}
683 		}
684 	}
685 	spin_unlock_irq(&phba->hbalock);
686 
687 	return 0;
688 }
689 
690 int
691 lpfc_initial_flogi(struct lpfc_vport *vport)
692 {
693 	struct lpfc_hba *phba = vport->phba;
694 	struct lpfc_nodelist *ndlp;
695 
696 	/* First look for the Fabric ndlp */
697 	ndlp = lpfc_findnode_did(vport, Fabric_DID);
698 	if (!ndlp) {
699 		/* Cannot find existing Fabric ndlp, so allocate a new one */
700 		ndlp = mempool_alloc(phba->nlp_mem_pool, GFP_KERNEL);
701 		if (!ndlp)
702 			return 0;
703 		lpfc_nlp_init(vport, ndlp, Fabric_DID);
704 	} else {
705 		lpfc_dequeue_node(vport, ndlp);
706 	}
707 	if (lpfc_issue_els_flogi(vport, ndlp, 0)) {
708 		lpfc_nlp_put(ndlp);
709 	}
710 	return 1;
711 }
712 
713 int
714 lpfc_initial_fdisc(struct lpfc_vport *vport)
715 {
716 	struct lpfc_hba *phba = vport->phba;
717 	struct lpfc_nodelist *ndlp;
718 
719 	/* First look for the Fabric ndlp */
720 	ndlp = lpfc_findnode_did(vport, Fabric_DID);
721 	if (!ndlp) {
722 		/* Cannot find existing Fabric ndlp, so allocate a new one */
723 		ndlp = mempool_alloc(phba->nlp_mem_pool, GFP_KERNEL);
724 		if (!ndlp)
725 			return 0;
726 		lpfc_nlp_init(vport, ndlp, Fabric_DID);
727 	} else {
728 		lpfc_dequeue_node(vport, ndlp);
729 	}
730 	if (lpfc_issue_els_fdisc(vport, ndlp, 0)) {
731 		lpfc_nlp_put(ndlp);
732 	}
733 	return 1;
734 }
735 static void
736 lpfc_more_plogi(struct lpfc_vport *vport)
737 {
738 	int sentplogi;
739 	struct lpfc_hba *phba = vport->phba;
740 
741 	if (vport->num_disc_nodes)
742 		vport->num_disc_nodes--;
743 
744 	/* Continue discovery with <num_disc_nodes> PLOGIs to go */
745 	lpfc_printf_log(phba, KERN_INFO, LOG_DISCOVERY,
746 			"%d (%d):0232 Continue discovery with %d PLOGIs to go "
747 			"Data: x%x x%x x%x\n",
748 			phba->brd_no, vport->vpi, vport->num_disc_nodes,
749 			vport->fc_plogi_cnt, vport->fc_flag, vport->port_state);
750 
751 	/* Check to see if there are more PLOGIs to be sent */
752 	if (vport->fc_flag & FC_NLP_MORE)
753 		/* go thru NPR nodes and issue any remaining ELS PLOGIs */
754 		sentplogi = lpfc_els_disc_plogi(vport);
755 
756 	return;
757 }
758 
759 static struct lpfc_nodelist *
760 lpfc_plogi_confirm_nport(struct lpfc_hba *phba, uint32_t *prsp,
761 			 struct lpfc_nodelist *ndlp)
762 {
763 	struct lpfc_vport    *vport = ndlp->vport;
764 	struct lpfc_nodelist *new_ndlp;
765 	struct serv_parm *sp;
766 	uint8_t  name[sizeof(struct lpfc_name)];
767 	uint32_t rc;
768 
769 	/* Fabric nodes can have the same WWPN so we don't bother searching
770 	 * by WWPN.  Just return the ndlp that was given to us.
771 	 */
772 	if (ndlp->nlp_type & NLP_FABRIC)
773 		return ndlp;
774 
775 	sp = (struct serv_parm *) ((uint8_t *) prsp + sizeof(uint32_t));
776 	memset(name, 0, sizeof(struct lpfc_name));
777 
778 	/* Now we find out if the NPort we are logging into, matches the WWPN
779 	 * we have for that ndlp. If not, we have some work to do.
780 	 */
781 	new_ndlp = lpfc_findnode_wwpn(vport, &sp->portName);
782 
783 	if (new_ndlp == ndlp)
784 		return ndlp;
785 
786 	if (!new_ndlp) {
787 		rc = memcmp(&ndlp->nlp_portname, name,
788 			    sizeof(struct lpfc_name));
789 		if (!rc)
790 			return ndlp;
791 		new_ndlp = mempool_alloc(phba->nlp_mem_pool, GFP_ATOMIC);
792 		if (!new_ndlp)
793 			return ndlp;
794 
795 		lpfc_nlp_init(vport, new_ndlp, ndlp->nlp_DID);
796 	}
797 
798 	lpfc_unreg_rpi(vport, new_ndlp);
799 	new_ndlp->nlp_DID = ndlp->nlp_DID;
800 	new_ndlp->nlp_prev_state = ndlp->nlp_prev_state;
801 	lpfc_nlp_set_state(vport, new_ndlp, ndlp->nlp_state);
802 
803 	/* Move this back to NPR state */
804 	if (memcmp(&ndlp->nlp_portname, name, sizeof(struct lpfc_name)) == 0)
805 		lpfc_drop_node(vport, ndlp);
806 	else {
807 		lpfc_unreg_rpi(vport, ndlp);
808 		ndlp->nlp_DID = 0; /* Two ndlps cannot have the same did */
809 		lpfc_nlp_set_state(vport, ndlp, NLP_STE_NPR_NODE);
810 	}
811 	return new_ndlp;
812 }
813 
814 static void
815 lpfc_cmpl_els_plogi(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
816 		    struct lpfc_iocbq *rspiocb)
817 {
818 	struct lpfc_vport *vport = cmdiocb->vport;
819 	struct Scsi_Host  *shost = lpfc_shost_from_vport(vport);
820 	IOCB_t *irsp;
821 	struct lpfc_nodelist *ndlp;
822 	struct lpfc_dmabuf *prsp;
823 	int disc, rc, did, type;
824 
825 	/* we pass cmdiocb to state machine which needs rspiocb as well */
826 	cmdiocb->context_un.rsp_iocb = rspiocb;
827 
828 	irsp = &rspiocb->iocb;
829 	lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
830 		"PLOGI cmpl:      status:x%x/x%x did:x%x",
831 		irsp->ulpStatus, irsp->un.ulpWord[4],
832 		irsp->un.elsreq64.remoteID);
833 
834 	ndlp = lpfc_findnode_did(vport, irsp->un.elsreq64.remoteID);
835 	if (!ndlp) {
836 		lpfc_printf_log(phba, KERN_ERR, LOG_ELS,
837 			"%d (%d):0136 PLOGI completes to NPort x%x "
838 			"with no ndlp. Data: x%x x%x x%x\n",
839 			phba->brd_no, vport->vpi, irsp->un.elsreq64.remoteID,
840 			irsp->ulpStatus, irsp->un.ulpWord[4], irsp->ulpIoTag);
841 		goto out;
842 	}
843 
844 	/* Since ndlp can be freed in the disc state machine, note if this node
845 	 * is being used during discovery.
846 	 */
847 	spin_lock_irq(shost->host_lock);
848 	disc = (ndlp->nlp_flag & NLP_NPR_2B_DISC);
849 	ndlp->nlp_flag &= ~NLP_NPR_2B_DISC;
850 	spin_unlock_irq(shost->host_lock);
851 	rc   = 0;
852 
853 	/* PLOGI completes to NPort <nlp_DID> */
854 	lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
855 			"%d (%d):0102 PLOGI completes to NPort x%x "
856 			"Data: x%x x%x x%x x%x x%x\n",
857 			phba->brd_no, vport->vpi, ndlp->nlp_DID,
858 			irsp->ulpStatus, irsp->un.ulpWord[4],
859 			irsp->ulpTimeout, disc, vport->num_disc_nodes);
860 
861 	/* Check to see if link went down during discovery */
862 	if (lpfc_els_chk_latt(vport)) {
863 		spin_lock_irq(shost->host_lock);
864 		ndlp->nlp_flag |= NLP_NPR_2B_DISC;
865 		spin_unlock_irq(shost->host_lock);
866 		goto out;
867 	}
868 
869 	/* ndlp could be freed in DSM, save these values now */
870 	type = ndlp->nlp_type;
871 	did = ndlp->nlp_DID;
872 
873 	if (irsp->ulpStatus) {
874 		/* Check for retry */
875 		if (lpfc_els_retry(phba, cmdiocb, rspiocb)) {
876 			/* ELS command is being retried */
877 			if (disc) {
878 				spin_lock_irq(shost->host_lock);
879 				ndlp->nlp_flag |= NLP_NPR_2B_DISC;
880 				spin_unlock_irq(shost->host_lock);
881 			}
882 			goto out;
883 		}
884 
885 		/* PLOGI failed */
886 		if (ndlp->nlp_DID == NameServer_DID) {
887 			lpfc_vport_set_state(vport, FC_VPORT_FAILED);
888 			lpfc_printf_log(phba, KERN_ERR, LOG_ELS,
889 				"%d (%d):0250 Nameserver login error: "
890 				"0x%x / 0x%x\n",
891 				phba->brd_no, vport->vpi,
892 				irsp->ulpStatus, irsp->un.ulpWord[4]);
893 		}
894 
895 		/* Do not call DSM for lpfc_els_abort'ed ELS cmds */
896 		if (lpfc_error_lost_link(irsp)) {
897 			rc = NLP_STE_FREED_NODE;
898 		} else {
899 			rc = lpfc_disc_state_machine(vport, ndlp, cmdiocb,
900 						     NLP_EVT_CMPL_PLOGI);
901 		}
902 	} else {
903 		/* Good status, call state machine */
904 		prsp = list_entry(((struct lpfc_dmabuf *)
905 				   cmdiocb->context2)->list.next,
906 				  struct lpfc_dmabuf, list);
907 		ndlp = lpfc_plogi_confirm_nport(phba, prsp->virt, ndlp);
908 		rc = lpfc_disc_state_machine(vport, ndlp, cmdiocb,
909 					     NLP_EVT_CMPL_PLOGI);
910 	}
911 
912 	if (disc && vport->num_disc_nodes) {
913 		/* Check to see if there are more PLOGIs to be sent */
914 		lpfc_more_plogi(vport);
915 
916 		if (vport->num_disc_nodes == 0) {
917 			spin_lock_irq(shost->host_lock);
918 			vport->fc_flag &= ~FC_NDISC_ACTIVE;
919 			spin_unlock_irq(shost->host_lock);
920 
921 			lpfc_can_disctmo(vport);
922 			if (vport->fc_flag & FC_RSCN_MODE) {
923 				/*
924 				 * Check to see if more RSCNs came in while
925 				 * we were processing this one.
926 				 */
927 				if ((vport->fc_rscn_id_cnt == 0) &&
928 				    (!(vport->fc_flag & FC_RSCN_DISCOVERY))) {
929 					spin_lock_irq(shost->host_lock);
930 					vport->fc_flag &= ~FC_RSCN_MODE;
931 					spin_unlock_irq(shost->host_lock);
932 				} else {
933 					lpfc_els_handle_rscn(vport);
934 				}
935 			}
936 		}
937 	}
938 
939 out:
940 	lpfc_els_free_iocb(phba, cmdiocb);
941 	return;
942 }
943 
944 int
945 lpfc_issue_els_plogi(struct lpfc_vport *vport, uint32_t did, uint8_t retry)
946 {
947 	struct lpfc_hba  *phba = vport->phba;
948 	struct serv_parm *sp;
949 	IOCB_t *icmd;
950 	struct lpfc_iocbq *elsiocb;
951 	struct lpfc_sli_ring *pring;
952 	struct lpfc_sli *psli;
953 	uint8_t *pcmd;
954 	uint16_t cmdsize;
955 	int ret;
956 
957 	psli = &phba->sli;
958 	pring = &psli->ring[LPFC_ELS_RING];	/* ELS ring */
959 
960 	cmdsize = (sizeof(uint32_t) + sizeof(struct serv_parm));
961 	elsiocb = lpfc_prep_els_iocb(vport, 1, cmdsize, retry, NULL, did,
962 				     ELS_CMD_PLOGI);
963 	if (!elsiocb)
964 		return 1;
965 
966 	icmd = &elsiocb->iocb;
967 	pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
968 
969 	/* For PLOGI request, remainder of payload is service parameters */
970 	*((uint32_t *) (pcmd)) = ELS_CMD_PLOGI;
971 	pcmd += sizeof(uint32_t);
972 	memcpy(pcmd, &vport->fc_sparam, sizeof(struct serv_parm));
973 	sp = (struct serv_parm *) pcmd;
974 
975 	if (sp->cmn.fcphLow < FC_PH_4_3)
976 		sp->cmn.fcphLow = FC_PH_4_3;
977 
978 	if (sp->cmn.fcphHigh < FC_PH3)
979 		sp->cmn.fcphHigh = FC_PH3;
980 
981 	lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
982 		"Issue PLOGI:     did:x%x",
983 		did, 0, 0);
984 
985 	phba->fc_stat.elsXmitPLOGI++;
986 	elsiocb->iocb_cmpl = lpfc_cmpl_els_plogi;
987 	ret = lpfc_sli_issue_iocb(phba, pring, elsiocb, 0);
988 
989 	if (ret == IOCB_ERROR) {
990 		lpfc_els_free_iocb(phba, elsiocb);
991 		return 1;
992 	}
993 	return 0;
994 }
995 
996 static void
997 lpfc_cmpl_els_prli(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
998 		   struct lpfc_iocbq *rspiocb)
999 {
1000 	struct lpfc_vport *vport = cmdiocb->vport;
1001 	struct Scsi_Host  *shost = lpfc_shost_from_vport(vport);
1002 	IOCB_t *irsp;
1003 	struct lpfc_sli *psli;
1004 	struct lpfc_nodelist *ndlp;
1005 
1006 	psli = &phba->sli;
1007 	/* we pass cmdiocb to state machine which needs rspiocb as well */
1008 	cmdiocb->context_un.rsp_iocb = rspiocb;
1009 
1010 	irsp = &(rspiocb->iocb);
1011 	ndlp = (struct lpfc_nodelist *) cmdiocb->context1;
1012 	spin_lock_irq(shost->host_lock);
1013 	ndlp->nlp_flag &= ~NLP_PRLI_SND;
1014 	spin_unlock_irq(shost->host_lock);
1015 
1016 	lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
1017 		"PRLI cmpl:       status:x%x/x%x did:x%x",
1018 		irsp->ulpStatus, irsp->un.ulpWord[4],
1019 		ndlp->nlp_DID);
1020 
1021 	/* PRLI completes to NPort <nlp_DID> */
1022 	lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
1023 			"%d (%d):0103 PRLI completes to NPort x%x "
1024 			"Data: x%x x%x x%x x%x\n",
1025 			phba->brd_no, vport->vpi, ndlp->nlp_DID,
1026 			irsp->ulpStatus, irsp->un.ulpWord[4], irsp->ulpTimeout,
1027 			vport->num_disc_nodes);
1028 
1029 	vport->fc_prli_sent--;
1030 	/* Check to see if link went down during discovery */
1031 	if (lpfc_els_chk_latt(vport))
1032 		goto out;
1033 
1034 	if (irsp->ulpStatus) {
1035 		/* Check for retry */
1036 		if (lpfc_els_retry(phba, cmdiocb, rspiocb)) {
1037 			/* ELS command is being retried */
1038 			goto out;
1039 		}
1040 		/* PRLI failed */
1041 		/* Do not call DSM for lpfc_els_abort'ed ELS cmds */
1042 		if (lpfc_error_lost_link(irsp)) {
1043 			goto out;
1044 		} else {
1045 			lpfc_disc_state_machine(vport, ndlp, cmdiocb,
1046 						NLP_EVT_CMPL_PRLI);
1047 		}
1048 	} else {
1049 		/* Good status, call state machine */
1050 		lpfc_disc_state_machine(vport, ndlp, cmdiocb,
1051 					NLP_EVT_CMPL_PRLI);
1052 	}
1053 
1054 out:
1055 	lpfc_els_free_iocb(phba, cmdiocb);
1056 	return;
1057 }
1058 
1059 int
1060 lpfc_issue_els_prli(struct lpfc_vport *vport, struct lpfc_nodelist *ndlp,
1061 		    uint8_t retry)
1062 {
1063 	struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
1064 	struct lpfc_hba *phba = vport->phba;
1065 	PRLI *npr;
1066 	IOCB_t *icmd;
1067 	struct lpfc_iocbq *elsiocb;
1068 	struct lpfc_sli_ring *pring;
1069 	struct lpfc_sli *psli;
1070 	uint8_t *pcmd;
1071 	uint16_t cmdsize;
1072 
1073 	psli = &phba->sli;
1074 	pring = &psli->ring[LPFC_ELS_RING];	/* ELS ring */
1075 
1076 	cmdsize = (sizeof(uint32_t) + sizeof(PRLI));
1077 	elsiocb = lpfc_prep_els_iocb(vport, 1, cmdsize, retry, ndlp,
1078 				     ndlp->nlp_DID, ELS_CMD_PRLI);
1079 	if (!elsiocb)
1080 		return 1;
1081 
1082 	icmd = &elsiocb->iocb;
1083 	pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
1084 
1085 	/* For PRLI request, remainder of payload is service parameters */
1086 	memset(pcmd, 0, (sizeof(PRLI) + sizeof(uint32_t)));
1087 	*((uint32_t *) (pcmd)) = ELS_CMD_PRLI;
1088 	pcmd += sizeof(uint32_t);
1089 
1090 	/* For PRLI, remainder of payload is PRLI parameter page */
1091 	npr = (PRLI *) pcmd;
1092 	/*
1093 	 * If our firmware version is 3.20 or later,
1094 	 * set the following bits for FC-TAPE support.
1095 	 */
1096 	if (phba->vpd.rev.feaLevelHigh >= 0x02) {
1097 		npr->ConfmComplAllowed = 1;
1098 		npr->Retry = 1;
1099 		npr->TaskRetryIdReq = 1;
1100 	}
1101 	npr->estabImagePair = 1;
1102 	npr->readXferRdyDis = 1;
1103 
1104 	/* For FCP support */
1105 	npr->prliType = PRLI_FCP_TYPE;
1106 	npr->initiatorFunc = 1;
1107 
1108 	lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
1109 		"Issue PRLI:      did:x%x",
1110 		ndlp->nlp_DID, 0, 0);
1111 
1112 	phba->fc_stat.elsXmitPRLI++;
1113 	elsiocb->iocb_cmpl = lpfc_cmpl_els_prli;
1114 	spin_lock_irq(shost->host_lock);
1115 	ndlp->nlp_flag |= NLP_PRLI_SND;
1116 	spin_unlock_irq(shost->host_lock);
1117 	if (lpfc_sli_issue_iocb(phba, pring, elsiocb, 0) == IOCB_ERROR) {
1118 		spin_lock_irq(shost->host_lock);
1119 		ndlp->nlp_flag &= ~NLP_PRLI_SND;
1120 		spin_unlock_irq(shost->host_lock);
1121 		lpfc_els_free_iocb(phba, elsiocb);
1122 		return 1;
1123 	}
1124 	vport->fc_prli_sent++;
1125 	return 0;
1126 }
1127 
1128 static void
1129 lpfc_more_adisc(struct lpfc_vport *vport)
1130 {
1131 	int sentadisc;
1132 	struct lpfc_hba *phba = vport->phba;
1133 
1134 	if (vport->num_disc_nodes)
1135 		vport->num_disc_nodes--;
1136 
1137 	/* Continue discovery with <num_disc_nodes> ADISCs to go */
1138 	lpfc_printf_log(phba, KERN_INFO, LOG_DISCOVERY,
1139 			"%d (%d):0210 Continue discovery with %d ADISCs to go "
1140 			"Data: x%x x%x x%x\n",
1141 			phba->brd_no, vport->vpi, vport->num_disc_nodes,
1142 			vport->fc_adisc_cnt, vport->fc_flag, vport->port_state);
1143 
1144 	/* Check to see if there are more ADISCs to be sent */
1145 	if (vport->fc_flag & FC_NLP_MORE) {
1146 		lpfc_set_disctmo(vport);
1147 		/* go thru NPR nodes and issue any remaining ELS ADISCs */
1148 		sentadisc = lpfc_els_disc_adisc(vport);
1149 	}
1150 	return;
1151 }
1152 
1153 static void
1154 lpfc_rscn_disc(struct lpfc_vport *vport)
1155 {
1156 	struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
1157 
1158 	lpfc_can_disctmo(vport);
1159 
1160 	/* RSCN discovery */
1161 	/* go thru NPR nodes and issue ELS PLOGIs */
1162 	if (vport->fc_npr_cnt)
1163 		if (lpfc_els_disc_plogi(vport))
1164 			return;
1165 
1166 	if (vport->fc_flag & FC_RSCN_MODE) {
1167 		/* Check to see if more RSCNs came in while we were
1168 		 * processing this one.
1169 		 */
1170 		if ((vport->fc_rscn_id_cnt == 0) &&
1171 		    (!(vport->fc_flag & FC_RSCN_DISCOVERY))) {
1172 			spin_lock_irq(shost->host_lock);
1173 			vport->fc_flag &= ~FC_RSCN_MODE;
1174 			spin_unlock_irq(shost->host_lock);
1175 		} else {
1176 			lpfc_els_handle_rscn(vport);
1177 		}
1178 	}
1179 }
1180 
1181 static void
1182 lpfc_cmpl_els_adisc(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
1183 		    struct lpfc_iocbq *rspiocb)
1184 {
1185 	struct lpfc_vport *vport = cmdiocb->vport;
1186 	struct Scsi_Host  *shost = lpfc_shost_from_vport(vport);
1187 	IOCB_t *irsp;
1188 	struct lpfc_nodelist *ndlp;
1189 	int  disc;
1190 
1191 	/* we pass cmdiocb to state machine which needs rspiocb as well */
1192 	cmdiocb->context_un.rsp_iocb = rspiocb;
1193 
1194 	irsp = &(rspiocb->iocb);
1195 	ndlp = (struct lpfc_nodelist *) cmdiocb->context1;
1196 
1197 	lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
1198 		"ADISC cmpl:      status:x%x/x%x did:x%x",
1199 		irsp->ulpStatus, irsp->un.ulpWord[4],
1200 		ndlp->nlp_DID);
1201 
1202 	/* Since ndlp can be freed in the disc state machine, note if this node
1203 	 * is being used during discovery.
1204 	 */
1205 	spin_lock_irq(shost->host_lock);
1206 	disc = (ndlp->nlp_flag & NLP_NPR_2B_DISC);
1207 	ndlp->nlp_flag &= ~(NLP_ADISC_SND | NLP_NPR_2B_DISC);
1208 	spin_unlock_irq(shost->host_lock);
1209 
1210 	/* ADISC completes to NPort <nlp_DID> */
1211 	lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
1212 			"%d (%d):0104 ADISC completes to NPort x%x "
1213 			"Data: x%x x%x x%x x%x x%x\n",
1214 			phba->brd_no, vport->vpi, ndlp->nlp_DID,
1215 			irsp->ulpStatus, irsp->un.ulpWord[4], irsp->ulpTimeout,
1216 			disc, vport->num_disc_nodes);
1217 
1218 	/* Check to see if link went down during discovery */
1219 	if (lpfc_els_chk_latt(vport)) {
1220 		spin_lock_irq(shost->host_lock);
1221 		ndlp->nlp_flag |= NLP_NPR_2B_DISC;
1222 		spin_unlock_irq(shost->host_lock);
1223 		goto out;
1224 	}
1225 
1226 	if (irsp->ulpStatus) {
1227 		/* Check for retry */
1228 		if (lpfc_els_retry(phba, cmdiocb, rspiocb)) {
1229 			/* ELS command is being retried */
1230 			if (disc) {
1231 				spin_lock_irq(shost->host_lock);
1232 				ndlp->nlp_flag |= NLP_NPR_2B_DISC;
1233 				spin_unlock_irq(shost->host_lock);
1234 				lpfc_set_disctmo(vport);
1235 			}
1236 			goto out;
1237 		}
1238 		/* ADISC failed */
1239 		/* Do not call DSM for lpfc_els_abort'ed ELS cmds */
1240 		if (!lpfc_error_lost_link(irsp)) {
1241 			lpfc_disc_state_machine(vport, ndlp, cmdiocb,
1242 						NLP_EVT_CMPL_ADISC);
1243 		}
1244 	} else {
1245 		/* Good status, call state machine */
1246 		lpfc_disc_state_machine(vport, ndlp, cmdiocb,
1247 					NLP_EVT_CMPL_ADISC);
1248 	}
1249 
1250 	if (disc && vport->num_disc_nodes) {
1251 		/* Check to see if there are more ADISCs to be sent */
1252 		lpfc_more_adisc(vport);
1253 
1254 		/* Check to see if we are done with ADISC authentication */
1255 		if (vport->num_disc_nodes == 0) {
1256 			/* If we get here, there is nothing left to ADISC */
1257 			/*
1258 			 * For NPIV, cmpl_reg_vpi will set port_state to READY,
1259 			 * and continue discovery.
1260 			 */
1261 			if ((phba->sli3_options & LPFC_SLI3_NPIV_ENABLED) &&
1262 			   !(vport->fc_flag & FC_RSCN_MODE)) {
1263 				lpfc_issue_reg_vpi(phba, vport);
1264 				goto out;
1265 			}
1266 			/*
1267 			 * For SLI2, we need to set port_state to READY
1268 			 * and continue discovery.
1269 			 */
1270 			if (vport->port_state < LPFC_VPORT_READY) {
1271 				/* If we get here, there is nothing to ADISC */
1272 				if (vport->port_type == LPFC_PHYSICAL_PORT)
1273 					lpfc_issue_clear_la(phba, vport);
1274 
1275 				if (!(vport->fc_flag & FC_ABORT_DISCOVERY)) {
1276 					vport->num_disc_nodes = 0;
1277 					/* go thru NPR list, issue ELS PLOGIs */
1278 					if (vport->fc_npr_cnt)
1279 						lpfc_els_disc_plogi(vport);
1280 
1281 					if (!vport->num_disc_nodes) {
1282 						spin_lock_irq(shost->host_lock);
1283 						vport->fc_flag &=
1284 							~FC_NDISC_ACTIVE;
1285 						spin_unlock_irq(
1286 							shost->host_lock);
1287 						lpfc_can_disctmo(vport);
1288 					}
1289 				}
1290 				vport->port_state = LPFC_VPORT_READY;
1291 			} else {
1292 				lpfc_rscn_disc(vport);
1293 			}
1294 		}
1295 	}
1296 out:
1297 	lpfc_els_free_iocb(phba, cmdiocb);
1298 	return;
1299 }
1300 
1301 int
1302 lpfc_issue_els_adisc(struct lpfc_vport *vport, struct lpfc_nodelist *ndlp,
1303 		     uint8_t retry)
1304 {
1305 	struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
1306 	struct lpfc_hba  *phba = vport->phba;
1307 	ADISC *ap;
1308 	IOCB_t *icmd;
1309 	struct lpfc_iocbq *elsiocb;
1310 	struct lpfc_sli *psli = &phba->sli;
1311 	struct lpfc_sli_ring *pring = &psli->ring[LPFC_ELS_RING];
1312 	uint8_t *pcmd;
1313 	uint16_t cmdsize;
1314 
1315 	cmdsize = (sizeof(uint32_t) + sizeof(ADISC));
1316 	elsiocb = lpfc_prep_els_iocb(vport, 1, cmdsize, retry, ndlp,
1317 				     ndlp->nlp_DID, ELS_CMD_ADISC);
1318 	if (!elsiocb)
1319 		return 1;
1320 
1321 	icmd = &elsiocb->iocb;
1322 	pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
1323 
1324 	/* For ADISC request, remainder of payload is service parameters */
1325 	*((uint32_t *) (pcmd)) = ELS_CMD_ADISC;
1326 	pcmd += sizeof(uint32_t);
1327 
1328 	/* Fill in ADISC payload */
1329 	ap = (ADISC *) pcmd;
1330 	ap->hardAL_PA = phba->fc_pref_ALPA;
1331 	memcpy(&ap->portName, &vport->fc_portname, sizeof(struct lpfc_name));
1332 	memcpy(&ap->nodeName, &vport->fc_nodename, sizeof(struct lpfc_name));
1333 	ap->DID = be32_to_cpu(vport->fc_myDID);
1334 
1335 	lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
1336 		"Issue ADISC:     did:x%x",
1337 		ndlp->nlp_DID, 0, 0);
1338 
1339 	phba->fc_stat.elsXmitADISC++;
1340 	elsiocb->iocb_cmpl = lpfc_cmpl_els_adisc;
1341 	spin_lock_irq(shost->host_lock);
1342 	ndlp->nlp_flag |= NLP_ADISC_SND;
1343 	spin_unlock_irq(shost->host_lock);
1344 	if (lpfc_sli_issue_iocb(phba, pring, elsiocb, 0) == IOCB_ERROR) {
1345 		spin_lock_irq(shost->host_lock);
1346 		ndlp->nlp_flag &= ~NLP_ADISC_SND;
1347 		spin_unlock_irq(shost->host_lock);
1348 		lpfc_els_free_iocb(phba, elsiocb);
1349 		return 1;
1350 	}
1351 	return 0;
1352 }
1353 
1354 static void
1355 lpfc_cmpl_els_logo(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
1356 		   struct lpfc_iocbq *rspiocb)
1357 {
1358 	struct lpfc_nodelist *ndlp = (struct lpfc_nodelist *) cmdiocb->context1;
1359 	struct lpfc_vport *vport = ndlp->vport;
1360 	struct Scsi_Host  *shost = lpfc_shost_from_vport(vport);
1361 	IOCB_t *irsp;
1362 	struct lpfc_sli *psli;
1363 
1364 	psli = &phba->sli;
1365 	/* we pass cmdiocb to state machine which needs rspiocb as well */
1366 	cmdiocb->context_un.rsp_iocb = rspiocb;
1367 
1368 	irsp = &(rspiocb->iocb);
1369 	spin_lock_irq(shost->host_lock);
1370 	ndlp->nlp_flag &= ~NLP_LOGO_SND;
1371 	spin_unlock_irq(shost->host_lock);
1372 
1373 	lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
1374 		"LOGO cmpl:       status:x%x/x%x did:x%x",
1375 		irsp->ulpStatus, irsp->un.ulpWord[4],
1376 		ndlp->nlp_DID);
1377 
1378 	/* LOGO completes to NPort <nlp_DID> */
1379 	lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
1380 			"%d (%d):0105 LOGO completes to NPort x%x "
1381 			"Data: x%x x%x x%x x%x\n",
1382 			phba->brd_no, vport->vpi, ndlp->nlp_DID,
1383 			irsp->ulpStatus, irsp->un.ulpWord[4], irsp->ulpTimeout,
1384 			vport->num_disc_nodes);
1385 
1386 	/* Check to see if link went down during discovery */
1387 	if (lpfc_els_chk_latt(vport))
1388 		goto out;
1389 
1390 	if (ndlp->nlp_flag & NLP_TARGET_REMOVE) {
1391 	        /* NLP_EVT_DEVICE_RM should unregister the RPI
1392 		 * which should abort all outstanding IOs.
1393 		 */
1394 		lpfc_disc_state_machine(vport, ndlp, cmdiocb,
1395 					NLP_EVT_DEVICE_RM);
1396 		goto out;
1397 	}
1398 
1399 	if (irsp->ulpStatus) {
1400 		/* Check for retry */
1401 		if (lpfc_els_retry(phba, cmdiocb, rspiocb))
1402 			/* ELS command is being retried */
1403 			goto out;
1404 		/* LOGO failed */
1405 		/* Do not call DSM for lpfc_els_abort'ed ELS cmds */
1406 		if (lpfc_error_lost_link(irsp))
1407 			goto out;
1408 		else
1409 			lpfc_disc_state_machine(vport, ndlp, cmdiocb,
1410 						NLP_EVT_CMPL_LOGO);
1411 	} else {
1412 		/* Good status, call state machine.
1413 		 * This will unregister the rpi if needed.
1414 		 */
1415 		lpfc_disc_state_machine(vport, ndlp, cmdiocb,
1416 					NLP_EVT_CMPL_LOGO);
1417 	}
1418 
1419 out:
1420 	lpfc_els_free_iocb(phba, cmdiocb);
1421 	return;
1422 }
1423 
1424 int
1425 lpfc_issue_els_logo(struct lpfc_vport *vport, struct lpfc_nodelist *ndlp,
1426 		    uint8_t retry)
1427 {
1428 	struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
1429 	struct lpfc_hba  *phba = vport->phba;
1430 	IOCB_t *icmd;
1431 	struct lpfc_iocbq *elsiocb;
1432 	struct lpfc_sli_ring *pring;
1433 	struct lpfc_sli *psli;
1434 	uint8_t *pcmd;
1435 	uint16_t cmdsize;
1436 	int rc;
1437 
1438 	psli = &phba->sli;
1439 	pring = &psli->ring[LPFC_ELS_RING];
1440 
1441 	cmdsize = (2 * sizeof(uint32_t)) + sizeof(struct lpfc_name);
1442 	elsiocb = lpfc_prep_els_iocb(vport, 1, cmdsize, retry, ndlp,
1443 				     ndlp->nlp_DID, ELS_CMD_LOGO);
1444 	if (!elsiocb)
1445 		return 1;
1446 
1447 	icmd = &elsiocb->iocb;
1448 	pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
1449 	*((uint32_t *) (pcmd)) = ELS_CMD_LOGO;
1450 	pcmd += sizeof(uint32_t);
1451 
1452 	/* Fill in LOGO payload */
1453 	*((uint32_t *) (pcmd)) = be32_to_cpu(vport->fc_myDID);
1454 	pcmd += sizeof(uint32_t);
1455 	memcpy(pcmd, &vport->fc_portname, sizeof(struct lpfc_name));
1456 
1457 	lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
1458 		"Issue LOGO:      did:x%x",
1459 		ndlp->nlp_DID, 0, 0);
1460 
1461 	phba->fc_stat.elsXmitLOGO++;
1462 	elsiocb->iocb_cmpl = lpfc_cmpl_els_logo;
1463 	spin_lock_irq(shost->host_lock);
1464 	ndlp->nlp_flag |= NLP_LOGO_SND;
1465 	spin_unlock_irq(shost->host_lock);
1466 	rc = lpfc_sli_issue_iocb(phba, pring, elsiocb, 0);
1467 
1468 	if (rc == IOCB_ERROR) {
1469 		spin_lock_irq(shost->host_lock);
1470 		ndlp->nlp_flag &= ~NLP_LOGO_SND;
1471 		spin_unlock_irq(shost->host_lock);
1472 		lpfc_els_free_iocb(phba, elsiocb);
1473 		return 1;
1474 	}
1475 	return 0;
1476 }
1477 
1478 static void
1479 lpfc_cmpl_els_cmd(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
1480 		  struct lpfc_iocbq *rspiocb)
1481 {
1482 	struct lpfc_vport *vport = cmdiocb->vport;
1483 	IOCB_t *irsp;
1484 
1485 	irsp = &rspiocb->iocb;
1486 
1487 	lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
1488 		"ELS cmd cmpl:    status:x%x/x%x did:x%x",
1489 		irsp->ulpStatus, irsp->un.ulpWord[4],
1490 		irsp->un.elsreq64.remoteID);
1491 
1492 	/* ELS cmd tag <ulpIoTag> completes */
1493 	lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
1494 			"%d (%d):0106 ELS cmd tag x%x completes Data: x%x x%x "
1495 			"x%x\n",
1496 			phba->brd_no, vport->vpi,
1497 			irsp->ulpIoTag, irsp->ulpStatus,
1498 			irsp->un.ulpWord[4], irsp->ulpTimeout);
1499 
1500 	/* Check to see if link went down during discovery */
1501 	lpfc_els_chk_latt(vport);
1502 	lpfc_els_free_iocb(phba, cmdiocb);
1503 	return;
1504 }
1505 
1506 int
1507 lpfc_issue_els_scr(struct lpfc_vport *vport, uint32_t nportid, uint8_t retry)
1508 {
1509 	struct lpfc_hba  *phba = vport->phba;
1510 	IOCB_t *icmd;
1511 	struct lpfc_iocbq *elsiocb;
1512 	struct lpfc_sli_ring *pring;
1513 	struct lpfc_sli *psli;
1514 	uint8_t *pcmd;
1515 	uint16_t cmdsize;
1516 	struct lpfc_nodelist *ndlp;
1517 
1518 	psli = &phba->sli;
1519 	pring = &psli->ring[LPFC_ELS_RING];	/* ELS ring */
1520 	cmdsize = (sizeof(uint32_t) + sizeof(SCR));
1521 	ndlp = mempool_alloc(phba->nlp_mem_pool, GFP_KERNEL);
1522 	if (!ndlp)
1523 		return 1;
1524 
1525 	lpfc_nlp_init(vport, ndlp, nportid);
1526 
1527 	elsiocb = lpfc_prep_els_iocb(vport, 1, cmdsize, retry, ndlp,
1528 				     ndlp->nlp_DID, ELS_CMD_SCR);
1529 
1530 	if (!elsiocb) {
1531 		lpfc_nlp_put(ndlp);
1532 		return 1;
1533 	}
1534 
1535 	icmd = &elsiocb->iocb;
1536 	pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
1537 
1538 	*((uint32_t *) (pcmd)) = ELS_CMD_SCR;
1539 	pcmd += sizeof(uint32_t);
1540 
1541 	/* For SCR, remainder of payload is SCR parameter page */
1542 	memset(pcmd, 0, sizeof(SCR));
1543 	((SCR *) pcmd)->Function = SCR_FUNC_FULL;
1544 
1545 	lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
1546 		"Issue SCR:       did:x%x",
1547 		ndlp->nlp_DID, 0, 0);
1548 
1549 	phba->fc_stat.elsXmitSCR++;
1550 	elsiocb->iocb_cmpl = lpfc_cmpl_els_cmd;
1551 	if (lpfc_sli_issue_iocb(phba, pring, elsiocb, 0) == IOCB_ERROR) {
1552 		lpfc_nlp_put(ndlp);
1553 		lpfc_els_free_iocb(phba, elsiocb);
1554 		return 1;
1555 	}
1556 	lpfc_nlp_put(ndlp);
1557 	return 0;
1558 }
1559 
1560 static int
1561 lpfc_issue_els_farpr(struct lpfc_vport *vport, uint32_t nportid, uint8_t retry)
1562 {
1563 	struct lpfc_hba  *phba = vport->phba;
1564 	IOCB_t *icmd;
1565 	struct lpfc_iocbq *elsiocb;
1566 	struct lpfc_sli_ring *pring;
1567 	struct lpfc_sli *psli;
1568 	FARP *fp;
1569 	uint8_t *pcmd;
1570 	uint32_t *lp;
1571 	uint16_t cmdsize;
1572 	struct lpfc_nodelist *ondlp;
1573 	struct lpfc_nodelist *ndlp;
1574 
1575 	psli = &phba->sli;
1576 	pring = &psli->ring[LPFC_ELS_RING];	/* ELS ring */
1577 	cmdsize = (sizeof(uint32_t) + sizeof(FARP));
1578 	ndlp = mempool_alloc(phba->nlp_mem_pool, GFP_KERNEL);
1579 	if (!ndlp)
1580 		return 1;
1581 
1582 	lpfc_nlp_init(vport, ndlp, nportid);
1583 
1584 	elsiocb = lpfc_prep_els_iocb(vport, 1, cmdsize, retry, ndlp,
1585 				     ndlp->nlp_DID, ELS_CMD_RNID);
1586 	if (!elsiocb) {
1587 		lpfc_nlp_put(ndlp);
1588 		return 1;
1589 	}
1590 
1591 	icmd = &elsiocb->iocb;
1592 	pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
1593 
1594 	*((uint32_t *) (pcmd)) = ELS_CMD_FARPR;
1595 	pcmd += sizeof(uint32_t);
1596 
1597 	/* Fill in FARPR payload */
1598 	fp = (FARP *) (pcmd);
1599 	memset(fp, 0, sizeof(FARP));
1600 	lp = (uint32_t *) pcmd;
1601 	*lp++ = be32_to_cpu(nportid);
1602 	*lp++ = be32_to_cpu(vport->fc_myDID);
1603 	fp->Rflags = 0;
1604 	fp->Mflags = (FARP_MATCH_PORT | FARP_MATCH_NODE);
1605 
1606 	memcpy(&fp->RportName, &vport->fc_portname, sizeof(struct lpfc_name));
1607 	memcpy(&fp->RnodeName, &vport->fc_nodename, sizeof(struct lpfc_name));
1608 	ondlp = lpfc_findnode_did(vport, nportid);
1609 	if (ondlp) {
1610 		memcpy(&fp->OportName, &ondlp->nlp_portname,
1611 		       sizeof(struct lpfc_name));
1612 		memcpy(&fp->OnodeName, &ondlp->nlp_nodename,
1613 		       sizeof(struct lpfc_name));
1614 	}
1615 
1616 	lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
1617 		"Issue FARPR:     did:x%x",
1618 		ndlp->nlp_DID, 0, 0);
1619 
1620 	phba->fc_stat.elsXmitFARPR++;
1621 	elsiocb->iocb_cmpl = lpfc_cmpl_els_cmd;
1622 	if (lpfc_sli_issue_iocb(phba, pring, elsiocb, 0) == IOCB_ERROR) {
1623 		lpfc_nlp_put(ndlp);
1624 		lpfc_els_free_iocb(phba, elsiocb);
1625 		return 1;
1626 	}
1627 	lpfc_nlp_put(ndlp);
1628 	return 0;
1629 }
1630 
1631 static void
1632 lpfc_end_rscn(struct lpfc_vport *vport)
1633 {
1634 	struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
1635 
1636 	if (vport->fc_flag & FC_RSCN_MODE) {
1637 		/*
1638 		 * Check to see if more RSCNs came in while we were
1639 		 * processing this one.
1640 		 */
1641 		if (vport->fc_rscn_id_cnt ||
1642 		    (vport->fc_flag & FC_RSCN_DISCOVERY) != 0)
1643 			lpfc_els_handle_rscn(vport);
1644 		else {
1645 			spin_lock_irq(shost->host_lock);
1646 			vport->fc_flag &= ~FC_RSCN_MODE;
1647 			spin_unlock_irq(shost->host_lock);
1648 		}
1649 	}
1650 }
1651 
1652 void
1653 lpfc_cancel_retry_delay_tmo(struct lpfc_vport *vport, struct lpfc_nodelist *nlp)
1654 {
1655 	struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
1656 
1657 	spin_lock_irq(shost->host_lock);
1658 	nlp->nlp_flag &= ~NLP_DELAY_TMO;
1659 	spin_unlock_irq(shost->host_lock);
1660 	del_timer_sync(&nlp->nlp_delayfunc);
1661 	nlp->nlp_last_elscmd = 0;
1662 
1663 	if (!list_empty(&nlp->els_retry_evt.evt_listp))
1664 		list_del_init(&nlp->els_retry_evt.evt_listp);
1665 
1666 	if (nlp->nlp_flag & NLP_NPR_2B_DISC) {
1667 		spin_lock_irq(shost->host_lock);
1668 		nlp->nlp_flag &= ~NLP_NPR_2B_DISC;
1669 		spin_unlock_irq(shost->host_lock);
1670 		if (vport->num_disc_nodes) {
1671 			/* Check to see if there are more
1672 			 * PLOGIs to be sent
1673 			 */
1674 			lpfc_more_plogi(vport);
1675 
1676 			if (vport->num_disc_nodes == 0) {
1677 				spin_lock_irq(shost->host_lock);
1678 				vport->fc_flag &= ~FC_NDISC_ACTIVE;
1679 				spin_unlock_irq(shost->host_lock);
1680 				lpfc_can_disctmo(vport);
1681 				lpfc_end_rscn(vport);
1682 			}
1683 		}
1684 	}
1685 	return;
1686 }
1687 
1688 void
1689 lpfc_els_retry_delay(unsigned long ptr)
1690 {
1691 	struct lpfc_nodelist *ndlp = (struct lpfc_nodelist *) ptr;
1692 	struct lpfc_vport *vport = ndlp->vport;
1693 	struct lpfc_hba   *phba = vport->phba;
1694 	unsigned long flags;
1695 	struct lpfc_work_evt  *evtp = &ndlp->els_retry_evt;
1696 
1697 	ndlp = (struct lpfc_nodelist *) ptr;
1698 	phba = ndlp->vport->phba;
1699 	evtp = &ndlp->els_retry_evt;
1700 
1701 	spin_lock_irqsave(&phba->hbalock, flags);
1702 	if (!list_empty(&evtp->evt_listp)) {
1703 		spin_unlock_irqrestore(&phba->hbalock, flags);
1704 		return;
1705 	}
1706 
1707 	evtp->evt_arg1  = ndlp;
1708 	evtp->evt       = LPFC_EVT_ELS_RETRY;
1709 	list_add_tail(&evtp->evt_listp, &phba->work_list);
1710 	if (phba->work_wait)
1711 		lpfc_worker_wake_up(phba);
1712 
1713 	spin_unlock_irqrestore(&phba->hbalock, flags);
1714 	return;
1715 }
1716 
1717 void
1718 lpfc_els_retry_delay_handler(struct lpfc_nodelist *ndlp)
1719 {
1720 	struct lpfc_vport *vport = ndlp->vport;
1721 	struct Scsi_Host  *shost = lpfc_shost_from_vport(vport);
1722 	uint32_t cmd, did, retry;
1723 
1724 	spin_lock_irq(shost->host_lock);
1725 	did = ndlp->nlp_DID;
1726 	cmd = ndlp->nlp_last_elscmd;
1727 	ndlp->nlp_last_elscmd = 0;
1728 
1729 	if (!(ndlp->nlp_flag & NLP_DELAY_TMO)) {
1730 		spin_unlock_irq(shost->host_lock);
1731 		return;
1732 	}
1733 
1734 	ndlp->nlp_flag &= ~NLP_DELAY_TMO;
1735 	spin_unlock_irq(shost->host_lock);
1736 	/*
1737 	 * If a discovery event readded nlp_delayfunc after timer
1738 	 * firing and before processing the timer, cancel the
1739 	 * nlp_delayfunc.
1740 	 */
1741 	del_timer_sync(&ndlp->nlp_delayfunc);
1742 	retry = ndlp->nlp_retry;
1743 
1744 	switch (cmd) {
1745 	case ELS_CMD_FLOGI:
1746 		lpfc_issue_els_flogi(vport, ndlp, retry);
1747 		break;
1748 	case ELS_CMD_PLOGI:
1749 		if (!lpfc_issue_els_plogi(vport, ndlp->nlp_DID, retry)) {
1750 			ndlp->nlp_prev_state = ndlp->nlp_state;
1751 			lpfc_nlp_set_state(vport, ndlp, NLP_STE_PLOGI_ISSUE);
1752 		}
1753 		break;
1754 	case ELS_CMD_ADISC:
1755 		if (!lpfc_issue_els_adisc(vport, ndlp, retry)) {
1756 			ndlp->nlp_prev_state = ndlp->nlp_state;
1757 			lpfc_nlp_set_state(vport, ndlp, NLP_STE_ADISC_ISSUE);
1758 		}
1759 		break;
1760 	case ELS_CMD_PRLI:
1761 		if (!lpfc_issue_els_prli(vport, ndlp, retry)) {
1762 			ndlp->nlp_prev_state = ndlp->nlp_state;
1763 			lpfc_nlp_set_state(vport, ndlp, NLP_STE_PRLI_ISSUE);
1764 		}
1765 		break;
1766 	case ELS_CMD_LOGO:
1767 		if (!lpfc_issue_els_logo(vport, ndlp, retry)) {
1768 			ndlp->nlp_prev_state = ndlp->nlp_state;
1769 			lpfc_nlp_set_state(vport, ndlp, NLP_STE_NPR_NODE);
1770 		}
1771 		break;
1772 	case ELS_CMD_FDISC:
1773 		lpfc_issue_els_fdisc(vport, ndlp, retry);
1774 		break;
1775 	}
1776 	return;
1777 }
1778 
1779 static int
1780 lpfc_els_retry(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
1781 	       struct lpfc_iocbq *rspiocb)
1782 {
1783 	struct lpfc_vport *vport = cmdiocb->vport;
1784 	struct Scsi_Host  *shost = lpfc_shost_from_vport(vport);
1785 	IOCB_t *irsp = &rspiocb->iocb;
1786 	struct lpfc_nodelist *ndlp = (struct lpfc_nodelist *) cmdiocb->context1;
1787 	struct lpfc_dmabuf *pcmd = (struct lpfc_dmabuf *) cmdiocb->context2;
1788 	uint32_t *elscmd;
1789 	struct ls_rjt stat;
1790 	int retry = 0, maxretry = lpfc_max_els_tries, delay = 0;
1791 	uint32_t cmd = 0;
1792 	uint32_t did;
1793 
1794 
1795 	/* Note: context2 may be 0 for internal driver abort
1796 	 * of delays ELS command.
1797 	 */
1798 
1799 	if (pcmd && pcmd->virt) {
1800 		elscmd = (uint32_t *) (pcmd->virt);
1801 		cmd = *elscmd++;
1802 	}
1803 
1804 	if (ndlp)
1805 		did = ndlp->nlp_DID;
1806 	else {
1807 		/* We should only hit this case for retrying PLOGI */
1808 		did = irsp->un.elsreq64.remoteID;
1809 		ndlp = lpfc_findnode_did(vport, did);
1810 		if (!ndlp && (cmd != ELS_CMD_PLOGI))
1811 			return 1;
1812 	}
1813 
1814 	lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
1815 		"Retry ELS:       wd7:x%x wd4:x%x did:x%x",
1816 		*(((uint32_t *) irsp) + 7), irsp->un.ulpWord[4], ndlp->nlp_DID);
1817 
1818 	switch (irsp->ulpStatus) {
1819 	case IOSTAT_FCP_RSP_ERROR:
1820 	case IOSTAT_REMOTE_STOP:
1821 		break;
1822 
1823 	case IOSTAT_LOCAL_REJECT:
1824 		switch ((irsp->un.ulpWord[4] & 0xff)) {
1825 		case IOERR_LOOP_OPEN_FAILURE:
1826 			if (cmd == ELS_CMD_PLOGI && cmdiocb->retry == 0)
1827 				delay = 1000;
1828 			retry = 1;
1829 			break;
1830 
1831 		case IOERR_ILLEGAL_COMMAND:
1832 			if ((phba->sli3_options & LPFC_SLI3_VPORT_TEARDOWN) &&
1833 			    (cmd == ELS_CMD_FDISC)) {
1834 				lpfc_printf_log(phba, KERN_ERR, LOG_ELS,
1835 				"%d (%d):0124 FDISC failed (3/6) retrying...\n",
1836 					phba->brd_no, vport->vpi);
1837 				lpfc_mbx_unreg_vpi(vport);
1838 				retry = 1;
1839 				/* Always retry for this case */
1840 				cmdiocb->retry = 0;
1841 			}
1842 			break;
1843 
1844 		case IOERR_NO_RESOURCES:
1845 			retry = 1;
1846 			if (cmdiocb->retry > 100)
1847 				delay = 100;
1848 			maxretry = 250;
1849 			break;
1850 
1851 		case IOERR_ILLEGAL_FRAME:
1852 			delay = 100;
1853 			retry = 1;
1854 			break;
1855 
1856 		case IOERR_SEQUENCE_TIMEOUT:
1857 		case IOERR_INVALID_RPI:
1858 			retry = 1;
1859 			break;
1860 		}
1861 		break;
1862 
1863 	case IOSTAT_NPORT_RJT:
1864 	case IOSTAT_FABRIC_RJT:
1865 		if (irsp->un.ulpWord[4] & RJT_UNAVAIL_TEMP) {
1866 			retry = 1;
1867 			break;
1868 		}
1869 		break;
1870 
1871 	case IOSTAT_NPORT_BSY:
1872 	case IOSTAT_FABRIC_BSY:
1873 		retry = 1;
1874 		break;
1875 
1876 	case IOSTAT_LS_RJT:
1877 		stat.un.lsRjtError = be32_to_cpu(irsp->un.ulpWord[4]);
1878 		/* Added for Vendor specifc support
1879 		 * Just keep retrying for these Rsn / Exp codes
1880 		 */
1881 		switch (stat.un.b.lsRjtRsnCode) {
1882 		case LSRJT_UNABLE_TPC:
1883 			if (stat.un.b.lsRjtRsnCodeExp ==
1884 			    LSEXP_CMD_IN_PROGRESS) {
1885 				if (cmd == ELS_CMD_PLOGI) {
1886 					delay = 1000;
1887 					maxretry = 48;
1888 				}
1889 				retry = 1;
1890 				break;
1891 			}
1892 			if (cmd == ELS_CMD_PLOGI) {
1893 				delay = 1000;
1894 				maxretry = lpfc_max_els_tries + 1;
1895 				retry = 1;
1896 				break;
1897 			}
1898 			if ((phba->sli3_options & LPFC_SLI3_NPIV_ENABLED) &&
1899 			  (cmd == ELS_CMD_FDISC) &&
1900 			  (stat.un.b.lsRjtRsnCodeExp == LSEXP_OUT_OF_RESOURCE)){
1901 				lpfc_printf_log(phba, KERN_ERR, LOG_ELS,
1902 				"%d (%d):0125 FDISC Failed (x%x)."
1903 				" Fabric out of resources\n",
1904 				phba->brd_no, vport->vpi, stat.un.lsRjtError);
1905 				lpfc_vport_set_state(vport,
1906 						     FC_VPORT_NO_FABRIC_RSCS);
1907 			}
1908 			break;
1909 
1910 		case LSRJT_LOGICAL_BSY:
1911 			if ((cmd == ELS_CMD_PLOGI) ||
1912 			    (cmd == ELS_CMD_PRLI)) {
1913 				delay = 1000;
1914 				maxretry = 48;
1915 			} else if (cmd == ELS_CMD_FDISC) {
1916 				/* Always retry for this case */
1917 				cmdiocb->retry = 0;
1918 			}
1919 			retry = 1;
1920 			break;
1921 
1922 		case LSRJT_LOGICAL_ERR:
1923 		case LSRJT_PROTOCOL_ERR:
1924 			if ((phba->sli3_options & LPFC_SLI3_NPIV_ENABLED) &&
1925 			  (cmd == ELS_CMD_FDISC) &&
1926 			  ((stat.un.b.lsRjtRsnCodeExp == LSEXP_INVALID_PNAME) ||
1927 			  (stat.un.b.lsRjtRsnCodeExp == LSEXP_INVALID_NPORT_ID))
1928 			  ) {
1929 				lpfc_printf_log(phba, KERN_ERR, LOG_ELS,
1930 				"%d (%d):0123 FDISC Failed (x%x)."
1931 				" Fabric Detected Bad WWN\n",
1932 				phba->brd_no, vport->vpi, stat.un.lsRjtError);
1933 				lpfc_vport_set_state(vport,
1934 						     FC_VPORT_FABRIC_REJ_WWN);
1935 			}
1936 			break;
1937 		}
1938 		break;
1939 
1940 	case IOSTAT_INTERMED_RSP:
1941 	case IOSTAT_BA_RJT:
1942 		break;
1943 
1944 	default:
1945 		break;
1946 	}
1947 
1948 	if (did == FDMI_DID)
1949 		retry = 1;
1950 
1951 	if ((++cmdiocb->retry) >= maxretry) {
1952 		phba->fc_stat.elsRetryExceeded++;
1953 		retry = 0;
1954 	}
1955 
1956 	if ((vport->load_flag & FC_UNLOADING) != 0)
1957 		retry = 0;
1958 
1959 	if (retry) {
1960 
1961 		/* Retry ELS command <elsCmd> to remote NPORT <did> */
1962 		lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
1963 				"%d (%d):0107 Retry ELS command x%x to remote "
1964 				"NPORT x%x Data: x%x x%x\n",
1965 				phba->brd_no, vport->vpi,
1966 				cmd, did, cmdiocb->retry, delay);
1967 
1968 		if (((cmd == ELS_CMD_PLOGI) || (cmd == ELS_CMD_ADISC)) &&
1969 			((irsp->ulpStatus != IOSTAT_LOCAL_REJECT) ||
1970 			((irsp->un.ulpWord[4] & 0xff) != IOERR_NO_RESOURCES))) {
1971 			/* Don't reset timer for no resources */
1972 
1973 			/* If discovery / RSCN timer is running, reset it */
1974 			if (timer_pending(&vport->fc_disctmo) ||
1975 			    (vport->fc_flag & FC_RSCN_MODE))
1976 				lpfc_set_disctmo(vport);
1977 		}
1978 
1979 		phba->fc_stat.elsXmitRetry++;
1980 		if (ndlp && delay) {
1981 			phba->fc_stat.elsDelayRetry++;
1982 			ndlp->nlp_retry = cmdiocb->retry;
1983 
1984 			/* delay is specified in milliseconds */
1985 			mod_timer(&ndlp->nlp_delayfunc,
1986 				jiffies + msecs_to_jiffies(delay));
1987 			spin_lock_irq(shost->host_lock);
1988 			ndlp->nlp_flag |= NLP_DELAY_TMO;
1989 			spin_unlock_irq(shost->host_lock);
1990 
1991 			ndlp->nlp_prev_state = ndlp->nlp_state;
1992 			if (cmd == ELS_CMD_PRLI)
1993 				lpfc_nlp_set_state(vport, ndlp,
1994 					NLP_STE_REG_LOGIN_ISSUE);
1995 			else
1996 				lpfc_nlp_set_state(vport, ndlp,
1997 					NLP_STE_NPR_NODE);
1998 			ndlp->nlp_last_elscmd = cmd;
1999 
2000 			return 1;
2001 		}
2002 		switch (cmd) {
2003 		case ELS_CMD_FLOGI:
2004 			lpfc_issue_els_flogi(vport, ndlp, cmdiocb->retry);
2005 			return 1;
2006 		case ELS_CMD_FDISC:
2007 			lpfc_issue_els_fdisc(vport, ndlp, cmdiocb->retry);
2008 			return 1;
2009 		case ELS_CMD_PLOGI:
2010 			if (ndlp) {
2011 				ndlp->nlp_prev_state = ndlp->nlp_state;
2012 				lpfc_nlp_set_state(vport, ndlp,
2013 						   NLP_STE_PLOGI_ISSUE);
2014 			}
2015 			lpfc_issue_els_plogi(vport, did, cmdiocb->retry);
2016 			return 1;
2017 		case ELS_CMD_ADISC:
2018 			ndlp->nlp_prev_state = ndlp->nlp_state;
2019 			lpfc_nlp_set_state(vport, ndlp, NLP_STE_ADISC_ISSUE);
2020 			lpfc_issue_els_adisc(vport, ndlp, cmdiocb->retry);
2021 			return 1;
2022 		case ELS_CMD_PRLI:
2023 			ndlp->nlp_prev_state = ndlp->nlp_state;
2024 			lpfc_nlp_set_state(vport, ndlp, NLP_STE_PRLI_ISSUE);
2025 			lpfc_issue_els_prli(vport, ndlp, cmdiocb->retry);
2026 			return 1;
2027 		case ELS_CMD_LOGO:
2028 			ndlp->nlp_prev_state = ndlp->nlp_state;
2029 			lpfc_nlp_set_state(vport, ndlp, NLP_STE_NPR_NODE);
2030 			lpfc_issue_els_logo(vport, ndlp, cmdiocb->retry);
2031 			return 1;
2032 		}
2033 	}
2034 
2035 	/* No retry ELS command <elsCmd> to remote NPORT <did> */
2036 	lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
2037 			"%d (%d):0108 No retry ELS command x%x to remote "
2038 			"NPORT x%x Data: x%x\n",
2039 			phba->brd_no, vport->vpi,
2040 			cmd, did, cmdiocb->retry);
2041 
2042 	return 0;
2043 }
2044 
2045 int
2046 lpfc_els_free_iocb(struct lpfc_hba *phba, struct lpfc_iocbq *elsiocb)
2047 {
2048 	struct lpfc_dmabuf *buf_ptr, *buf_ptr1;
2049 
2050 	if (elsiocb->context1) {
2051 		lpfc_nlp_put(elsiocb->context1);
2052 		elsiocb->context1 = NULL;
2053 	}
2054 	/* context2  = cmd,  context2->next = rsp, context3 = bpl */
2055 	if (elsiocb->context2) {
2056 		buf_ptr1 = (struct lpfc_dmabuf *) elsiocb->context2;
2057 		/* Free the response before processing the command.  */
2058 		if (!list_empty(&buf_ptr1->list)) {
2059 			list_remove_head(&buf_ptr1->list, buf_ptr,
2060 					 struct lpfc_dmabuf,
2061 					 list);
2062 			lpfc_mbuf_free(phba, buf_ptr->virt, buf_ptr->phys);
2063 			kfree(buf_ptr);
2064 		}
2065 		lpfc_mbuf_free(phba, buf_ptr1->virt, buf_ptr1->phys);
2066 		kfree(buf_ptr1);
2067 	}
2068 
2069 	if (elsiocb->context3) {
2070 		buf_ptr = (struct lpfc_dmabuf *) elsiocb->context3;
2071 		lpfc_mbuf_free(phba, buf_ptr->virt, buf_ptr->phys);
2072 		kfree(buf_ptr);
2073 	}
2074 	lpfc_sli_release_iocbq(phba, elsiocb);
2075 	return 0;
2076 }
2077 
2078 static void
2079 lpfc_cmpl_els_logo_acc(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
2080 		       struct lpfc_iocbq *rspiocb)
2081 {
2082 	struct lpfc_nodelist *ndlp = (struct lpfc_nodelist *) cmdiocb->context1;
2083 	struct lpfc_vport *vport = cmdiocb->vport;
2084 	IOCB_t *irsp;
2085 
2086 	irsp = &rspiocb->iocb;
2087 	lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_RSP,
2088 		"ACC LOGO cmpl:   status:x%x/x%x did:x%x",
2089 		irsp->ulpStatus, irsp->un.ulpWord[4], ndlp->nlp_DID);
2090 
2091 	/* ACC to LOGO completes to NPort <nlp_DID> */
2092 	lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
2093 			"%d (%d):0109 ACC to LOGO completes to NPort x%x "
2094 			"Data: x%x x%x x%x\n",
2095 			phba->brd_no, vport->vpi, ndlp->nlp_DID,
2096 			ndlp->nlp_flag, ndlp->nlp_state, ndlp->nlp_rpi);
2097 
2098 	switch (ndlp->nlp_state) {
2099 	case NLP_STE_UNUSED_NODE:	/* node is just allocated */
2100 		lpfc_drop_node(vport, ndlp);
2101 		break;
2102 	case NLP_STE_NPR_NODE:		/* NPort Recovery mode */
2103 		lpfc_unreg_rpi(vport, ndlp);
2104 		break;
2105 	default:
2106 		break;
2107 	}
2108 	lpfc_els_free_iocb(phba, cmdiocb);
2109 	return;
2110 }
2111 
2112 void
2113 lpfc_mbx_cmpl_dflt_rpi(struct lpfc_hba *phba, LPFC_MBOXQ_t *pmb)
2114 {
2115 	struct lpfc_dmabuf *mp = (struct lpfc_dmabuf *) (pmb->context1);
2116 	struct lpfc_nodelist *ndlp = (struct lpfc_nodelist *) pmb->context2;
2117 
2118 	pmb->context1 = NULL;
2119 	lpfc_mbuf_free(phba, mp->virt, mp->phys);
2120 	kfree(mp);
2121 	mempool_free(pmb, phba->mbox_mem_pool);
2122 	lpfc_nlp_put(ndlp);
2123 	return;
2124 }
2125 
2126 static void
2127 lpfc_cmpl_els_rsp(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
2128 		  struct lpfc_iocbq *rspiocb)
2129 {
2130 	struct lpfc_nodelist *ndlp = (struct lpfc_nodelist *) cmdiocb->context1;
2131 	struct lpfc_vport *vport = ndlp ? ndlp->vport : NULL;
2132 	struct Scsi_Host  *shost = vport ? lpfc_shost_from_vport(vport) : NULL;
2133 	IOCB_t *irsp;
2134 	LPFC_MBOXQ_t *mbox = NULL;
2135 	struct lpfc_dmabuf *mp = NULL;
2136 
2137 	irsp = &rspiocb->iocb;
2138 
2139 	if (cmdiocb->context_un.mbox)
2140 		mbox = cmdiocb->context_un.mbox;
2141 
2142 	/* Check to see if link went down during discovery */
2143 	if (!ndlp || lpfc_els_chk_latt(vport)) {
2144 		if (mbox) {
2145 			mp = (struct lpfc_dmabuf *) mbox->context1;
2146 			if (mp) {
2147 				lpfc_mbuf_free(phba, mp->virt, mp->phys);
2148 				kfree(mp);
2149 			}
2150 			mempool_free(mbox, phba->mbox_mem_pool);
2151 		}
2152 		goto out;
2153 	}
2154 
2155 	lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_RSP,
2156 		"ACC cmpl:        status:x%x/x%x did:x%x",
2157 		irsp->ulpStatus, irsp->un.ulpWord[4],
2158 		irsp->un.rcvels.remoteID);
2159 
2160 	/* ELS response tag <ulpIoTag> completes */
2161 	lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
2162 			"%d (%d):0110 ELS response tag x%x completes "
2163 			"Data: x%x x%x x%x x%x x%x x%x x%x\n",
2164 			phba->brd_no, vport->vpi,
2165 			cmdiocb->iocb.ulpIoTag, rspiocb->iocb.ulpStatus,
2166 			rspiocb->iocb.un.ulpWord[4], rspiocb->iocb.ulpTimeout,
2167 			ndlp->nlp_DID, ndlp->nlp_flag, ndlp->nlp_state,
2168 			ndlp->nlp_rpi);
2169 
2170 	if (mbox) {
2171 		if ((rspiocb->iocb.ulpStatus == 0)
2172 		    && (ndlp->nlp_flag & NLP_ACC_REGLOGIN)) {
2173 			lpfc_unreg_rpi(vport, ndlp);
2174 			mbox->context2 = lpfc_nlp_get(ndlp);
2175 			mbox->vport = vport;
2176 			if (ndlp->nlp_flag & NLP_RM_DFLT_RPI) {
2177 				mbox->mbox_flag |= LPFC_MBX_IMED_UNREG;
2178 				mbox->mbox_cmpl = lpfc_mbx_cmpl_dflt_rpi;
2179 			}
2180 			else {
2181 				mbox->mbox_cmpl = lpfc_mbx_cmpl_reg_login;
2182 				ndlp->nlp_prev_state = ndlp->nlp_state;
2183 				lpfc_nlp_set_state(vport, ndlp,
2184 					   NLP_STE_REG_LOGIN_ISSUE);
2185 			}
2186 			if (lpfc_sli_issue_mbox(phba, mbox,
2187 						(MBX_NOWAIT | MBX_STOP_IOCB))
2188 			    != MBX_NOT_FINISHED) {
2189 				goto out;
2190 			}
2191 			lpfc_nlp_put(ndlp);
2192 			/* NOTE: we should have messages for unsuccessful
2193 			   reglogin */
2194 		} else {
2195 			/* Do not drop node for lpfc_els_abort'ed ELS cmds */
2196 			if (!lpfc_error_lost_link(irsp) &&
2197 			    ndlp->nlp_flag & NLP_ACC_REGLOGIN) {
2198 				lpfc_drop_node(vport, ndlp);
2199 				ndlp = NULL;
2200 			}
2201 		}
2202 		mp = (struct lpfc_dmabuf *) mbox->context1;
2203 		if (mp) {
2204 			lpfc_mbuf_free(phba, mp->virt, mp->phys);
2205 			kfree(mp);
2206 		}
2207 		mempool_free(mbox, phba->mbox_mem_pool);
2208 	}
2209 out:
2210 	if (ndlp) {
2211 		spin_lock_irq(shost->host_lock);
2212 		ndlp->nlp_flag &= ~(NLP_ACC_REGLOGIN | NLP_RM_DFLT_RPI);
2213 		spin_unlock_irq(shost->host_lock);
2214 	}
2215 	lpfc_els_free_iocb(phba, cmdiocb);
2216 	return;
2217 }
2218 
2219 int
2220 lpfc_els_rsp_acc(struct lpfc_vport *vport, uint32_t flag,
2221 		 struct lpfc_iocbq *oldiocb, struct lpfc_nodelist *ndlp,
2222 		 LPFC_MBOXQ_t *mbox, uint8_t newnode)
2223 {
2224 	struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
2225 	struct lpfc_hba  *phba = vport->phba;
2226 	IOCB_t *icmd;
2227 	IOCB_t *oldcmd;
2228 	struct lpfc_iocbq *elsiocb;
2229 	struct lpfc_sli_ring *pring;
2230 	struct lpfc_sli *psli;
2231 	uint8_t *pcmd;
2232 	uint16_t cmdsize;
2233 	int rc;
2234 	ELS_PKT *els_pkt_ptr;
2235 
2236 	psli = &phba->sli;
2237 	pring = &psli->ring[LPFC_ELS_RING];	/* ELS ring */
2238 	oldcmd = &oldiocb->iocb;
2239 
2240 	switch (flag) {
2241 	case ELS_CMD_ACC:
2242 		cmdsize = sizeof(uint32_t);
2243 		elsiocb = lpfc_prep_els_iocb(vport, 0, cmdsize, oldiocb->retry,
2244 					     ndlp, ndlp->nlp_DID, ELS_CMD_ACC);
2245 		if (!elsiocb) {
2246 			spin_lock_irq(shost->host_lock);
2247 			ndlp->nlp_flag &= ~NLP_LOGO_ACC;
2248 			spin_unlock_irq(shost->host_lock);
2249 			return 1;
2250 		}
2251 
2252 		icmd = &elsiocb->iocb;
2253 		icmd->ulpContext = oldcmd->ulpContext;	/* Xri */
2254 		pcmd = (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
2255 		*((uint32_t *) (pcmd)) = ELS_CMD_ACC;
2256 		pcmd += sizeof(uint32_t);
2257 
2258 		lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_RSP,
2259 			"Issue ACC:       did:x%x flg:x%x",
2260 			ndlp->nlp_DID, ndlp->nlp_flag, 0);
2261 		break;
2262 	case ELS_CMD_PLOGI:
2263 		cmdsize = (sizeof(struct serv_parm) + sizeof(uint32_t));
2264 		elsiocb = lpfc_prep_els_iocb(vport, 0, cmdsize, oldiocb->retry,
2265 					     ndlp, ndlp->nlp_DID, ELS_CMD_ACC);
2266 		if (!elsiocb)
2267 			return 1;
2268 
2269 		icmd = &elsiocb->iocb;
2270 		icmd->ulpContext = oldcmd->ulpContext;	/* Xri */
2271 		pcmd = (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
2272 
2273 		if (mbox)
2274 			elsiocb->context_un.mbox = mbox;
2275 
2276 		*((uint32_t *) (pcmd)) = ELS_CMD_ACC;
2277 		pcmd += sizeof(uint32_t);
2278 		memcpy(pcmd, &vport->fc_sparam, sizeof(struct serv_parm));
2279 
2280 		lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_RSP,
2281 			"Issue ACC PLOGI: did:x%x flg:x%x",
2282 			ndlp->nlp_DID, ndlp->nlp_flag, 0);
2283 		break;
2284 	case ELS_CMD_PRLO:
2285 		cmdsize = sizeof(uint32_t) + sizeof(PRLO);
2286 		elsiocb = lpfc_prep_els_iocb(vport, 0, cmdsize, oldiocb->retry,
2287 					     ndlp, ndlp->nlp_DID, ELS_CMD_PRLO);
2288 		if (!elsiocb)
2289 			return 1;
2290 
2291 		icmd = &elsiocb->iocb;
2292 		icmd->ulpContext = oldcmd->ulpContext; /* Xri */
2293 		pcmd = (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
2294 
2295 		memcpy(pcmd, ((struct lpfc_dmabuf *) oldiocb->context2)->virt,
2296 		       sizeof(uint32_t) + sizeof(PRLO));
2297 		*((uint32_t *) (pcmd)) = ELS_CMD_PRLO_ACC;
2298 		els_pkt_ptr = (ELS_PKT *) pcmd;
2299 		els_pkt_ptr->un.prlo.acceptRspCode = PRLO_REQ_EXECUTED;
2300 
2301 		lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_RSP,
2302 			"Issue ACC PRLO:  did:x%x flg:x%x",
2303 			ndlp->nlp_DID, ndlp->nlp_flag, 0);
2304 		break;
2305 	default:
2306 		return 1;
2307 	}
2308 
2309 	if (newnode) {
2310 		lpfc_nlp_put(ndlp);
2311 		elsiocb->context1 = NULL;
2312 	}
2313 
2314 	/* Xmit ELS ACC response tag <ulpIoTag> */
2315 	lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
2316 			"%d (%d):0128 Xmit ELS ACC response tag x%x, XRI: x%x, "
2317 			"DID: x%x, nlp_flag: x%x nlp_state: x%x RPI: x%x\n",
2318 			phba->brd_no, vport->vpi, elsiocb->iotag,
2319 			elsiocb->iocb.ulpContext, ndlp->nlp_DID,
2320 			ndlp->nlp_flag, ndlp->nlp_state, ndlp->nlp_rpi);
2321 
2322 	if (ndlp->nlp_flag & NLP_LOGO_ACC) {
2323 		spin_lock_irq(shost->host_lock);
2324 		ndlp->nlp_flag &= ~NLP_LOGO_ACC;
2325 		spin_unlock_irq(shost->host_lock);
2326 		elsiocb->iocb_cmpl = lpfc_cmpl_els_logo_acc;
2327 	} else {
2328 		elsiocb->iocb_cmpl = lpfc_cmpl_els_rsp;
2329 	}
2330 
2331 	phba->fc_stat.elsXmitACC++;
2332 	rc = lpfc_sli_issue_iocb(phba, pring, elsiocb, 0);
2333 	if (rc == IOCB_ERROR) {
2334 		lpfc_els_free_iocb(phba, elsiocb);
2335 		return 1;
2336 	}
2337 	return 0;
2338 }
2339 
2340 int
2341 lpfc_els_rsp_reject(struct lpfc_vport *vport, uint32_t rejectError,
2342 		    struct lpfc_iocbq *oldiocb, struct lpfc_nodelist *ndlp,
2343 		    LPFC_MBOXQ_t *mbox)
2344 {
2345 	struct lpfc_hba  *phba = vport->phba;
2346 	IOCB_t *icmd;
2347 	IOCB_t *oldcmd;
2348 	struct lpfc_iocbq *elsiocb;
2349 	struct lpfc_sli_ring *pring;
2350 	struct lpfc_sli *psli;
2351 	uint8_t *pcmd;
2352 	uint16_t cmdsize;
2353 	int rc;
2354 
2355 	psli = &phba->sli;
2356 	pring = &psli->ring[LPFC_ELS_RING];	/* ELS ring */
2357 
2358 	cmdsize = 2 * sizeof(uint32_t);
2359 	elsiocb = lpfc_prep_els_iocb(vport, 0, cmdsize, oldiocb->retry, ndlp,
2360 				     ndlp->nlp_DID, ELS_CMD_LS_RJT);
2361 	if (!elsiocb)
2362 		return 1;
2363 
2364 	icmd = &elsiocb->iocb;
2365 	oldcmd = &oldiocb->iocb;
2366 	icmd->ulpContext = oldcmd->ulpContext;	/* Xri */
2367 	pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
2368 
2369 	*((uint32_t *) (pcmd)) = ELS_CMD_LS_RJT;
2370 	pcmd += sizeof(uint32_t);
2371 	*((uint32_t *) (pcmd)) = rejectError;
2372 
2373 	if (mbox) {
2374 		elsiocb->context_un.mbox = mbox;
2375 		elsiocb->context1 = lpfc_nlp_get(ndlp);
2376 	}
2377 
2378 	/* Xmit ELS RJT <err> response tag <ulpIoTag> */
2379 	lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
2380 			"%d (%d):0129 Xmit ELS RJT x%x response tag x%x "
2381 			"xri x%x, did x%x, nlp_flag x%x, nlp_state x%x, "
2382 			"rpi x%x\n",
2383 			phba->brd_no, vport->vpi, rejectError, elsiocb->iotag,
2384 			elsiocb->iocb.ulpContext, ndlp->nlp_DID,
2385 			ndlp->nlp_flag, ndlp->nlp_state, ndlp->nlp_rpi);
2386 
2387 	lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_RSP,
2388 		"Issue LS_RJT:    did:x%x flg:x%x err:x%x",
2389 		ndlp->nlp_DID, ndlp->nlp_flag, rejectError);
2390 
2391 	phba->fc_stat.elsXmitLSRJT++;
2392 	elsiocb->iocb_cmpl = lpfc_cmpl_els_rsp;
2393 	rc = lpfc_sli_issue_iocb(phba, pring, elsiocb, 0);
2394 	if (rc == IOCB_ERROR) {
2395 		lpfc_els_free_iocb(phba, elsiocb);
2396 		return 1;
2397 	}
2398 	return 0;
2399 }
2400 
2401 int
2402 lpfc_els_rsp_adisc_acc(struct lpfc_vport *vport, struct lpfc_iocbq *oldiocb,
2403 		       struct lpfc_nodelist *ndlp)
2404 {
2405 	struct lpfc_hba  *phba = vport->phba;
2406 	struct lpfc_sli  *psli = &phba->sli;
2407 	struct lpfc_sli_ring *pring = &psli->ring[LPFC_ELS_RING];
2408 	ADISC *ap;
2409 	IOCB_t *icmd, *oldcmd;
2410 	struct lpfc_iocbq *elsiocb;
2411 	uint8_t *pcmd;
2412 	uint16_t cmdsize;
2413 	int rc;
2414 
2415 	cmdsize = sizeof(uint32_t) + sizeof(ADISC);
2416 	elsiocb = lpfc_prep_els_iocb(vport, 0, cmdsize, oldiocb->retry, ndlp,
2417 				     ndlp->nlp_DID, ELS_CMD_ACC);
2418 	if (!elsiocb)
2419 		return 1;
2420 
2421 	icmd = &elsiocb->iocb;
2422 	oldcmd = &oldiocb->iocb;
2423 	icmd->ulpContext = oldcmd->ulpContext;	/* Xri */
2424 
2425 	/* Xmit ADISC ACC response tag <ulpIoTag> */
2426 	lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
2427 			"%d (%d):0130 Xmit ADISC ACC response iotag x%x xri: "
2428 			"x%x, did x%x, nlp_flag x%x, nlp_state x%x rpi x%x\n",
2429 			phba->brd_no, vport->vpi, elsiocb->iotag,
2430 			elsiocb->iocb.ulpContext, ndlp->nlp_DID,
2431 			ndlp->nlp_flag, ndlp->nlp_state, ndlp->nlp_rpi);
2432 
2433 	pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
2434 
2435 	*((uint32_t *) (pcmd)) = ELS_CMD_ACC;
2436 	pcmd += sizeof(uint32_t);
2437 
2438 	ap = (ADISC *) (pcmd);
2439 	ap->hardAL_PA = phba->fc_pref_ALPA;
2440 	memcpy(&ap->portName, &vport->fc_portname, sizeof(struct lpfc_name));
2441 	memcpy(&ap->nodeName, &vport->fc_nodename, sizeof(struct lpfc_name));
2442 	ap->DID = be32_to_cpu(vport->fc_myDID);
2443 
2444 	lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_RSP,
2445 		"Issue ACC ADISC: did:x%x flg:x%x",
2446 		ndlp->nlp_DID, ndlp->nlp_flag, 0);
2447 
2448 	phba->fc_stat.elsXmitACC++;
2449 	elsiocb->iocb_cmpl = lpfc_cmpl_els_rsp;
2450 	rc = lpfc_sli_issue_iocb(phba, pring, elsiocb, 0);
2451 	if (rc == IOCB_ERROR) {
2452 		lpfc_els_free_iocb(phba, elsiocb);
2453 		return 1;
2454 	}
2455 	return 0;
2456 }
2457 
2458 int
2459 lpfc_els_rsp_prli_acc(struct lpfc_vport *vport, struct lpfc_iocbq *oldiocb,
2460 		      struct lpfc_nodelist *ndlp)
2461 {
2462 	struct lpfc_hba  *phba = vport->phba;
2463 	PRLI *npr;
2464 	lpfc_vpd_t *vpd;
2465 	IOCB_t *icmd;
2466 	IOCB_t *oldcmd;
2467 	struct lpfc_iocbq *elsiocb;
2468 	struct lpfc_sli_ring *pring;
2469 	struct lpfc_sli *psli;
2470 	uint8_t *pcmd;
2471 	uint16_t cmdsize;
2472 	int rc;
2473 
2474 	psli = &phba->sli;
2475 	pring = &psli->ring[LPFC_ELS_RING];	/* ELS ring */
2476 
2477 	cmdsize = sizeof(uint32_t) + sizeof(PRLI);
2478 	elsiocb = lpfc_prep_els_iocb(vport, 0, cmdsize, oldiocb->retry, ndlp,
2479 		ndlp->nlp_DID, (ELS_CMD_ACC | (ELS_CMD_PRLI & ~ELS_RSP_MASK)));
2480 	if (!elsiocb)
2481 		return 1;
2482 
2483 	icmd = &elsiocb->iocb;
2484 	oldcmd = &oldiocb->iocb;
2485 	icmd->ulpContext = oldcmd->ulpContext;	/* Xri */
2486 
2487 	/* Xmit PRLI ACC response tag <ulpIoTag> */
2488 	lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
2489 			"%d (%d):0131 Xmit PRLI ACC response tag x%x xri x%x, "
2490 			"did x%x, nlp_flag x%x, nlp_state x%x, rpi x%x\n",
2491 			phba->brd_no, vport->vpi, elsiocb->iotag,
2492 			elsiocb->iocb.ulpContext, ndlp->nlp_DID,
2493 			ndlp->nlp_flag, ndlp->nlp_state, ndlp->nlp_rpi);
2494 
2495 	pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
2496 
2497 	*((uint32_t *) (pcmd)) = (ELS_CMD_ACC | (ELS_CMD_PRLI & ~ELS_RSP_MASK));
2498 	pcmd += sizeof(uint32_t);
2499 
2500 	/* For PRLI, remainder of payload is PRLI parameter page */
2501 	memset(pcmd, 0, sizeof(PRLI));
2502 
2503 	npr = (PRLI *) pcmd;
2504 	vpd = &phba->vpd;
2505 	/*
2506 	 * If our firmware version is 3.20 or later,
2507 	 * set the following bits for FC-TAPE support.
2508 	 */
2509 	if (vpd->rev.feaLevelHigh >= 0x02) {
2510 		npr->ConfmComplAllowed = 1;
2511 		npr->Retry = 1;
2512 		npr->TaskRetryIdReq = 1;
2513 	}
2514 
2515 	npr->acceptRspCode = PRLI_REQ_EXECUTED;
2516 	npr->estabImagePair = 1;
2517 	npr->readXferRdyDis = 1;
2518 	npr->ConfmComplAllowed = 1;
2519 
2520 	npr->prliType = PRLI_FCP_TYPE;
2521 	npr->initiatorFunc = 1;
2522 
2523 	lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_RSP,
2524 		"Issue ACC PRLI:  did:x%x flg:x%x",
2525 		ndlp->nlp_DID, ndlp->nlp_flag, 0);
2526 
2527 	phba->fc_stat.elsXmitACC++;
2528 	elsiocb->iocb_cmpl = lpfc_cmpl_els_rsp;
2529 
2530 	rc = lpfc_sli_issue_iocb(phba, pring, elsiocb, 0);
2531 	if (rc == IOCB_ERROR) {
2532 		lpfc_els_free_iocb(phba, elsiocb);
2533 		return 1;
2534 	}
2535 	return 0;
2536 }
2537 
2538 static int
2539 lpfc_els_rsp_rnid_acc(struct lpfc_vport *vport, uint8_t format,
2540 		      struct lpfc_iocbq *oldiocb, struct lpfc_nodelist *ndlp)
2541 {
2542 	struct lpfc_hba  *phba = vport->phba;
2543 	RNID *rn;
2544 	IOCB_t *icmd, *oldcmd;
2545 	struct lpfc_iocbq *elsiocb;
2546 	struct lpfc_sli_ring *pring;
2547 	struct lpfc_sli *psli;
2548 	uint8_t *pcmd;
2549 	uint16_t cmdsize;
2550 	int rc;
2551 
2552 	psli = &phba->sli;
2553 	pring = &psli->ring[LPFC_ELS_RING];
2554 
2555 	cmdsize = sizeof(uint32_t) + sizeof(uint32_t)
2556 					+ (2 * sizeof(struct lpfc_name));
2557 	if (format)
2558 		cmdsize += sizeof(RNID_TOP_DISC);
2559 
2560 	elsiocb = lpfc_prep_els_iocb(vport, 0, cmdsize, oldiocb->retry, ndlp,
2561 				     ndlp->nlp_DID, ELS_CMD_ACC);
2562 	if (!elsiocb)
2563 		return 1;
2564 
2565 	icmd = &elsiocb->iocb;
2566 	oldcmd = &oldiocb->iocb;
2567 	icmd->ulpContext = oldcmd->ulpContext;	/* Xri */
2568 
2569 	/* Xmit RNID ACC response tag <ulpIoTag> */
2570 	lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
2571 			"%d (%d):0132 Xmit RNID ACC response tag x%x "
2572 			"xri x%x\n",
2573 			phba->brd_no, vport->vpi, elsiocb->iotag,
2574 			elsiocb->iocb.ulpContext);
2575 
2576 	pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
2577 
2578 	*((uint32_t *) (pcmd)) = ELS_CMD_ACC;
2579 	pcmd += sizeof(uint32_t);
2580 
2581 	memset(pcmd, 0, sizeof(RNID));
2582 	rn = (RNID *) (pcmd);
2583 	rn->Format = format;
2584 	rn->CommonLen = (2 * sizeof(struct lpfc_name));
2585 	memcpy(&rn->portName, &vport->fc_portname, sizeof(struct lpfc_name));
2586 	memcpy(&rn->nodeName, &vport->fc_nodename, sizeof(struct lpfc_name));
2587 	switch (format) {
2588 	case 0:
2589 		rn->SpecificLen = 0;
2590 		break;
2591 	case RNID_TOPOLOGY_DISC:
2592 		rn->SpecificLen = sizeof(RNID_TOP_DISC);
2593 		memcpy(&rn->un.topologyDisc.portName,
2594 		       &vport->fc_portname, sizeof(struct lpfc_name));
2595 		rn->un.topologyDisc.unitType = RNID_HBA;
2596 		rn->un.topologyDisc.physPort = 0;
2597 		rn->un.topologyDisc.attachedNodes = 0;
2598 		break;
2599 	default:
2600 		rn->CommonLen = 0;
2601 		rn->SpecificLen = 0;
2602 		break;
2603 	}
2604 
2605 	lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_RSP,
2606 		"Issue ACC RNID:  did:x%x flg:x%x",
2607 		ndlp->nlp_DID, ndlp->nlp_flag, 0);
2608 
2609 	phba->fc_stat.elsXmitACC++;
2610 	elsiocb->iocb_cmpl = lpfc_cmpl_els_rsp;
2611 	lpfc_nlp_put(ndlp);
2612 	elsiocb->context1 = NULL;  /* Don't need ndlp for cmpl,
2613 				    * it could be freed */
2614 
2615 	rc = lpfc_sli_issue_iocb(phba, pring, elsiocb, 0);
2616 	if (rc == IOCB_ERROR) {
2617 		lpfc_els_free_iocb(phba, elsiocb);
2618 		return 1;
2619 	}
2620 	return 0;
2621 }
2622 
2623 int
2624 lpfc_els_disc_adisc(struct lpfc_vport *vport)
2625 {
2626 	struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
2627 	struct lpfc_nodelist *ndlp, *next_ndlp;
2628 	int sentadisc = 0;
2629 
2630 	/* go thru NPR nodes and issue any remaining ELS ADISCs */
2631 	list_for_each_entry_safe(ndlp, next_ndlp, &vport->fc_nodes, nlp_listp) {
2632 		if (ndlp->nlp_state == NLP_STE_NPR_NODE &&
2633 		    (ndlp->nlp_flag & NLP_NPR_2B_DISC) != 0 &&
2634 		    (ndlp->nlp_flag & NLP_NPR_ADISC) != 0) {
2635 			spin_lock_irq(shost->host_lock);
2636 			ndlp->nlp_flag &= ~NLP_NPR_ADISC;
2637 			spin_unlock_irq(shost->host_lock);
2638 			ndlp->nlp_prev_state = ndlp->nlp_state;
2639 			lpfc_nlp_set_state(vport, ndlp, NLP_STE_ADISC_ISSUE);
2640 			lpfc_issue_els_adisc(vport, ndlp, 0);
2641 			sentadisc++;
2642 			vport->num_disc_nodes++;
2643 			if (vport->num_disc_nodes >=
2644 			    vport->phba->cfg_discovery_threads) {
2645 				spin_lock_irq(shost->host_lock);
2646 				vport->fc_flag |= FC_NLP_MORE;
2647 				spin_unlock_irq(shost->host_lock);
2648 				break;
2649 			}
2650 		}
2651 	}
2652 	if (sentadisc == 0) {
2653 		spin_lock_irq(shost->host_lock);
2654 		vport->fc_flag &= ~FC_NLP_MORE;
2655 		spin_unlock_irq(shost->host_lock);
2656 	}
2657 	return sentadisc;
2658 }
2659 
2660 int
2661 lpfc_els_disc_plogi(struct lpfc_vport *vport)
2662 {
2663 	struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
2664 	struct lpfc_nodelist *ndlp, *next_ndlp;
2665 	int sentplogi = 0;
2666 
2667 	/* go thru NPR nodes and issue any remaining ELS PLOGIs */
2668 	list_for_each_entry_safe(ndlp, next_ndlp, &vport->fc_nodes, nlp_listp) {
2669 		if (ndlp->nlp_state == NLP_STE_NPR_NODE &&
2670 		    (ndlp->nlp_flag & NLP_NPR_2B_DISC) != 0 &&
2671 		    (ndlp->nlp_flag & NLP_DELAY_TMO) == 0 &&
2672 		    (ndlp->nlp_flag & NLP_NPR_ADISC) == 0) {
2673 			ndlp->nlp_prev_state = ndlp->nlp_state;
2674 			lpfc_nlp_set_state(vport, ndlp, NLP_STE_PLOGI_ISSUE);
2675 			lpfc_issue_els_plogi(vport, ndlp->nlp_DID, 0);
2676 			sentplogi++;
2677 			vport->num_disc_nodes++;
2678 			if (vport->num_disc_nodes >=
2679 			    vport->phba->cfg_discovery_threads) {
2680 				spin_lock_irq(shost->host_lock);
2681 				vport->fc_flag |= FC_NLP_MORE;
2682 				spin_unlock_irq(shost->host_lock);
2683 				break;
2684 			}
2685 		}
2686 	}
2687 	if (sentplogi == 0) {
2688 		spin_lock_irq(shost->host_lock);
2689 		vport->fc_flag &= ~FC_NLP_MORE;
2690 		spin_unlock_irq(shost->host_lock);
2691 	}
2692 	return sentplogi;
2693 }
2694 
2695 void
2696 lpfc_els_flush_rscn(struct lpfc_vport *vport)
2697 {
2698 	struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
2699 	struct lpfc_hba  *phba = vport->phba;
2700 	int i;
2701 
2702 	for (i = 0; i < vport->fc_rscn_id_cnt; i++) {
2703 		lpfc_in_buf_free(phba, vport->fc_rscn_id_list[i]);
2704 		vport->fc_rscn_id_list[i] = NULL;
2705 	}
2706 	spin_lock_irq(shost->host_lock);
2707 	vport->fc_rscn_id_cnt = 0;
2708 	vport->fc_flag &= ~(FC_RSCN_MODE | FC_RSCN_DISCOVERY);
2709 	spin_unlock_irq(shost->host_lock);
2710 	lpfc_can_disctmo(vport);
2711 }
2712 
2713 int
2714 lpfc_rscn_payload_check(struct lpfc_vport *vport, uint32_t did)
2715 {
2716 	D_ID ns_did;
2717 	D_ID rscn_did;
2718 	uint32_t *lp;
2719 	uint32_t payload_len, i;
2720 	struct lpfc_hba *phba = vport->phba;
2721 
2722 	ns_did.un.word = did;
2723 
2724 	/* Never match fabric nodes for RSCNs */
2725 	if ((did & Fabric_DID_MASK) == Fabric_DID_MASK)
2726 		return 0;
2727 
2728 	/* If we are doing a FULL RSCN rediscovery, match everything */
2729 	if (vport->fc_flag & FC_RSCN_DISCOVERY)
2730 		return did;
2731 
2732 	for (i = 0; i < vport->fc_rscn_id_cnt; i++) {
2733 		lp = vport->fc_rscn_id_list[i]->virt;
2734 		payload_len = be32_to_cpu(*lp++ & ~ELS_CMD_MASK);
2735 		payload_len -= sizeof(uint32_t);	/* take off word 0 */
2736 		while (payload_len) {
2737 			rscn_did.un.word = be32_to_cpu(*lp++);
2738 			payload_len -= sizeof(uint32_t);
2739 			switch (rscn_did.un.b.resv) {
2740 			case 0:	/* Single N_Port ID effected */
2741 				if (ns_did.un.word == rscn_did.un.word)
2742 					return did;
2743 				break;
2744 			case 1:	/* Whole N_Port Area effected */
2745 				if ((ns_did.un.b.domain == rscn_did.un.b.domain)
2746 				    && (ns_did.un.b.area == rscn_did.un.b.area))
2747 					return did;
2748 				break;
2749 			case 2:	/* Whole N_Port Domain effected */
2750 				if (ns_did.un.b.domain == rscn_did.un.b.domain)
2751 					return did;
2752 				break;
2753 			default:
2754 				/* Unknown Identifier in RSCN node */
2755 				lpfc_printf_log(phba, KERN_ERR, LOG_DISCOVERY,
2756 						"%d (%d):0217 Unknown "
2757 						"Identifier in RSCN payload "
2758 						"Data: x%x\n",
2759 						phba->brd_no, vport->vpi,
2760 						rscn_did.un.word);
2761 			case 3:	/* Whole Fabric effected */
2762 				return did;
2763 			}
2764 		}
2765 	}
2766 	return 0;
2767 }
2768 
2769 static int
2770 lpfc_rscn_recovery_check(struct lpfc_vport *vport)
2771 {
2772 	struct lpfc_nodelist *ndlp = NULL;
2773 
2774 	/* Look at all nodes effected by pending RSCNs and move
2775 	 * them to NPR state.
2776 	 */
2777 
2778 	list_for_each_entry(ndlp, &vport->fc_nodes, nlp_listp) {
2779 		if (ndlp->nlp_state == NLP_STE_UNUSED_NODE ||
2780 		    lpfc_rscn_payload_check(vport, ndlp->nlp_DID) == 0)
2781 			continue;
2782 
2783 		lpfc_disc_state_machine(vport, ndlp, NULL,
2784 						NLP_EVT_DEVICE_RECOVERY);
2785 
2786 		/*
2787 		 * Make sure NLP_DELAY_TMO is NOT running after a device
2788 		 * recovery event.
2789 		 */
2790 		if (ndlp->nlp_flag & NLP_DELAY_TMO)
2791 			lpfc_cancel_retry_delay_tmo(vport, ndlp);
2792 	}
2793 
2794 	return 0;
2795 }
2796 
2797 static int
2798 lpfc_els_rcv_rscn(struct lpfc_vport *vport, struct lpfc_iocbq *cmdiocb,
2799 		  struct lpfc_nodelist *ndlp, uint8_t newnode)
2800 {
2801 	struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
2802 	struct lpfc_hba  *phba = vport->phba;
2803 	struct lpfc_dmabuf *pcmd;
2804 	struct lpfc_vport *next_vport;
2805 	uint32_t *lp, *datap;
2806 	IOCB_t *icmd;
2807 	uint32_t payload_len, length, nportid, *cmd;
2808 	int rscn_cnt = vport->fc_rscn_id_cnt;
2809 	int rscn_id = 0, hba_id = 0;
2810 	int i;
2811 
2812 	icmd = &cmdiocb->iocb;
2813 	pcmd = (struct lpfc_dmabuf *) cmdiocb->context2;
2814 	lp = (uint32_t *) pcmd->virt;
2815 
2816 	payload_len = be32_to_cpu(*lp++ & ~ELS_CMD_MASK);
2817 	payload_len -= sizeof(uint32_t);	/* take off word 0 */
2818 
2819 	/* RSCN received */
2820 	lpfc_printf_log(phba, KERN_INFO, LOG_DISCOVERY,
2821 			"%d (%d):0214 RSCN received Data: x%x x%x x%x x%x\n",
2822 			phba->brd_no, vport->vpi, vport->fc_flag, payload_len,
2823 			*lp, rscn_cnt);
2824 
2825 	for (i = 0; i < payload_len/sizeof(uint32_t); i++)
2826 		fc_host_post_event(shost, fc_get_event_number(),
2827 			FCH_EVT_RSCN, lp[i]);
2828 
2829 	/* If we are about to begin discovery, just ACC the RSCN.
2830 	 * Discovery processing will satisfy it.
2831 	 */
2832 	if (vport->port_state <= LPFC_NS_QRY) {
2833 		lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
2834 			"RCV RSCN ignore: did:x%x/ste:x%x flg:x%x",
2835 			ndlp->nlp_DID, vport->port_state, ndlp->nlp_flag);
2836 
2837 		lpfc_els_rsp_acc(vport, ELS_CMD_ACC, cmdiocb, ndlp, NULL,
2838 				 newnode);
2839 		return 0;
2840 	}
2841 
2842 	/* If this RSCN just contains NPortIDs for other vports on this HBA,
2843 	 * just ACC and ignore it.
2844 	 */
2845 	if ((phba->sli3_options & LPFC_SLI3_NPIV_ENABLED) &&
2846 		!(phba->cfg_peer_port_login)) {
2847 		i = payload_len;
2848 		datap = lp;
2849 		while (i > 0) {
2850 			nportid = *datap++;
2851 			nportid = ((be32_to_cpu(nportid)) & Mask_DID);
2852 			i -= sizeof(uint32_t);
2853 			rscn_id++;
2854 			list_for_each_entry(next_vport, &phba->port_list,
2855 				listentry) {
2856 				if (nportid == next_vport->fc_myDID) {
2857 					hba_id++;
2858 					break;
2859 				}
2860 			}
2861 		}
2862 		if (rscn_id == hba_id) {
2863 			/* ALL NPortIDs in RSCN are on HBA */
2864 			lpfc_printf_log(phba, KERN_INFO, LOG_DISCOVERY,
2865 			  "%d (%d):0214 Ignore RSCN Data: x%x x%x x%x x%x\n",
2866 			  phba->brd_no, vport->vpi, vport->fc_flag, payload_len,
2867 			  *lp, rscn_cnt);
2868 
2869 			lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
2870 				"RCV RSCN vport:  did:x%x/ste:x%x flg:x%x",
2871 				ndlp->nlp_DID, vport->port_state,
2872 				ndlp->nlp_flag);
2873 
2874 			lpfc_els_rsp_acc(vport, ELS_CMD_ACC, cmdiocb,
2875 				ndlp, NULL, newnode);
2876 			return 0;
2877 		}
2878 	}
2879 
2880 	/* If we are already processing an RSCN, save the received
2881 	 * RSCN payload buffer, cmdiocb->context2 to process later.
2882 	 */
2883 	if (vport->fc_flag & (FC_RSCN_MODE | FC_NDISC_ACTIVE)) {
2884 		lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
2885 			"RCV RSCN defer:  did:x%x/ste:x%x flg:x%x",
2886 			ndlp->nlp_DID, vport->port_state, ndlp->nlp_flag);
2887 
2888 		vport->fc_flag |= FC_RSCN_DEFERRED;
2889 		if ((rscn_cnt < FC_MAX_HOLD_RSCN) &&
2890 		    !(vport->fc_flag & FC_RSCN_DISCOVERY)) {
2891 			spin_lock_irq(shost->host_lock);
2892 			vport->fc_flag |= FC_RSCN_MODE;
2893 			spin_unlock_irq(shost->host_lock);
2894 			if (rscn_cnt) {
2895 				cmd = vport->fc_rscn_id_list[rscn_cnt-1]->virt;
2896 				length = be32_to_cpu(*cmd & ~ELS_CMD_MASK);
2897 			}
2898 			if ((rscn_cnt) &&
2899 			    (payload_len + length <= LPFC_BPL_SIZE)) {
2900 				*cmd &= ELS_CMD_MASK;
2901 				*cmd |= be32_to_cpu(payload_len + length);
2902 				memcpy(((uint8_t *)cmd) + length, lp,
2903 				       payload_len);
2904 			} else {
2905 				vport->fc_rscn_id_list[rscn_cnt] = pcmd;
2906 				vport->fc_rscn_id_cnt++;
2907 				/* If we zero, cmdiocb->context2, the calling
2908 				 * routine will not try to free it.
2909 				 */
2910 				cmdiocb->context2 = NULL;
2911 			}
2912 
2913 			/* Deferred RSCN */
2914 			lpfc_printf_log(phba, KERN_INFO, LOG_DISCOVERY,
2915 					"%d (%d):0235 Deferred RSCN "
2916 					"Data: x%x x%x x%x\n",
2917 					phba->brd_no, vport->vpi,
2918 					vport->fc_rscn_id_cnt, vport->fc_flag,
2919 					vport->port_state);
2920 		} else {
2921 			spin_lock_irq(shost->host_lock);
2922 			vport->fc_flag |= FC_RSCN_DISCOVERY;
2923 			spin_unlock_irq(shost->host_lock);
2924 			/* ReDiscovery RSCN */
2925 			lpfc_printf_log(phba, KERN_INFO, LOG_DISCOVERY,
2926 					"%d (%d):0234 ReDiscovery RSCN "
2927 					"Data: x%x x%x x%x\n",
2928 					phba->brd_no, vport->vpi,
2929 					vport->fc_rscn_id_cnt, vport->fc_flag,
2930 					vport->port_state);
2931 		}
2932 		/* Send back ACC */
2933 		lpfc_els_rsp_acc(vport, ELS_CMD_ACC, cmdiocb, ndlp, NULL,
2934 								newnode);
2935 
2936 		/* send RECOVERY event for ALL nodes that match RSCN payload */
2937 		lpfc_rscn_recovery_check(vport);
2938 		vport->fc_flag &= ~FC_RSCN_DEFERRED;
2939 		return 0;
2940 	}
2941 
2942 	lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
2943 		"RCV RSCN:        did:x%x/ste:x%x flg:x%x",
2944 		ndlp->nlp_DID, vport->port_state, ndlp->nlp_flag);
2945 
2946 	spin_lock_irq(shost->host_lock);
2947 	vport->fc_flag |= FC_RSCN_MODE;
2948 	spin_unlock_irq(shost->host_lock);
2949 	vport->fc_rscn_id_list[vport->fc_rscn_id_cnt++] = pcmd;
2950 	/*
2951 	 * If we zero, cmdiocb->context2, the calling routine will
2952 	 * not try to free it.
2953 	 */
2954 	cmdiocb->context2 = NULL;
2955 
2956 	lpfc_set_disctmo(vport);
2957 
2958 	/* Send back ACC */
2959 	lpfc_els_rsp_acc(vport, ELS_CMD_ACC, cmdiocb, ndlp, NULL, newnode);
2960 
2961 	/* send RECOVERY event for ALL nodes that match RSCN payload */
2962 	lpfc_rscn_recovery_check(vport);
2963 
2964 	return lpfc_els_handle_rscn(vport);
2965 }
2966 
2967 int
2968 lpfc_els_handle_rscn(struct lpfc_vport *vport)
2969 {
2970 	struct lpfc_nodelist *ndlp;
2971 	struct lpfc_hba *phba = vport->phba;
2972 
2973 	/* Ignore RSCN if the port is being torn down. */
2974 	if (vport->load_flag & FC_UNLOADING) {
2975 		lpfc_els_flush_rscn(vport);
2976 		return 0;
2977 	}
2978 
2979 	/* Start timer for RSCN processing */
2980 	lpfc_set_disctmo(vport);
2981 
2982 	/* RSCN processed */
2983 	lpfc_printf_log(phba, KERN_INFO, LOG_DISCOVERY,
2984 			"%d (%d):0215 RSCN processed Data: x%x x%x x%x x%x\n",
2985 			phba->brd_no, vport->vpi,
2986 			vport->fc_flag, 0, vport->fc_rscn_id_cnt,
2987 			vport->port_state);
2988 
2989 	/* To process RSCN, first compare RSCN data with NameServer */
2990 	vport->fc_ns_retry = 0;
2991 	ndlp = lpfc_findnode_did(vport, NameServer_DID);
2992 	if (ndlp && ndlp->nlp_state == NLP_STE_UNMAPPED_NODE) {
2993 		/* Good ndlp, issue CT Request to NameServer */
2994 		if (lpfc_ns_cmd(vport, SLI_CTNS_GID_FT, 0, 0) == 0)
2995 			/* Wait for NameServer query cmpl before we can
2996 			   continue */
2997 			return 1;
2998 	} else {
2999 		/* If login to NameServer does not exist, issue one */
3000 		/* Good status, issue PLOGI to NameServer */
3001 		ndlp = lpfc_findnode_did(vport, NameServer_DID);
3002 		if (ndlp)
3003 			/* Wait for NameServer login cmpl before we can
3004 			   continue */
3005 			return 1;
3006 
3007 		ndlp = mempool_alloc(phba->nlp_mem_pool, GFP_KERNEL);
3008 		if (!ndlp) {
3009 			lpfc_els_flush_rscn(vport);
3010 			return 0;
3011 		} else {
3012 			lpfc_nlp_init(vport, ndlp, NameServer_DID);
3013 			ndlp->nlp_type |= NLP_FABRIC;
3014 			ndlp->nlp_prev_state = ndlp->nlp_state;
3015 			lpfc_nlp_set_state(vport, ndlp, NLP_STE_PLOGI_ISSUE);
3016 			lpfc_issue_els_plogi(vport, NameServer_DID, 0);
3017 			/* Wait for NameServer login cmpl before we can
3018 			   continue */
3019 			return 1;
3020 		}
3021 	}
3022 
3023 	lpfc_els_flush_rscn(vport);
3024 	return 0;
3025 }
3026 
3027 static int
3028 lpfc_els_rcv_flogi(struct lpfc_vport *vport, struct lpfc_iocbq *cmdiocb,
3029 		   struct lpfc_nodelist *ndlp, uint8_t newnode)
3030 {
3031 	struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
3032 	struct lpfc_hba  *phba = vport->phba;
3033 	struct lpfc_dmabuf *pcmd = (struct lpfc_dmabuf *) cmdiocb->context2;
3034 	uint32_t *lp = (uint32_t *) pcmd->virt;
3035 	IOCB_t *icmd = &cmdiocb->iocb;
3036 	struct serv_parm *sp;
3037 	LPFC_MBOXQ_t *mbox;
3038 	struct ls_rjt stat;
3039 	uint32_t cmd, did;
3040 	int rc;
3041 
3042 	cmd = *lp++;
3043 	sp = (struct serv_parm *) lp;
3044 
3045 	/* FLOGI received */
3046 
3047 	lpfc_set_disctmo(vport);
3048 
3049 	if (phba->fc_topology == TOPOLOGY_LOOP) {
3050 		/* We should never receive a FLOGI in loop mode, ignore it */
3051 		did = icmd->un.elsreq64.remoteID;
3052 
3053 		/* An FLOGI ELS command <elsCmd> was received from DID <did> in
3054 		   Loop Mode */
3055 		lpfc_printf_log(phba, KERN_ERR, LOG_ELS,
3056 				"%d (%d):0113 An FLOGI ELS command x%x was "
3057 				"received from DID x%x in Loop Mode\n",
3058 				phba->brd_no, vport->vpi, cmd, did);
3059 		return 1;
3060 	}
3061 
3062 	did = Fabric_DID;
3063 
3064 	if ((lpfc_check_sparm(vport, ndlp, sp, CLASS3))) {
3065 		/* For a FLOGI we accept, then if our portname is greater
3066 		 * then the remote portname we initiate Nport login.
3067 		 */
3068 
3069 		rc = memcmp(&vport->fc_portname, &sp->portName,
3070 			    sizeof(struct lpfc_name));
3071 
3072 		if (!rc) {
3073 			mbox = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
3074 			if (!mbox)
3075 				return 1;
3076 
3077 			lpfc_linkdown(phba);
3078 			lpfc_init_link(phba, mbox,
3079 				       phba->cfg_topology,
3080 				       phba->cfg_link_speed);
3081 			mbox->mb.un.varInitLnk.lipsr_AL_PA = 0;
3082 			mbox->mbox_cmpl = lpfc_sli_def_mbox_cmpl;
3083 			mbox->vport = vport;
3084 			rc = lpfc_sli_issue_mbox
3085 				(phba, mbox, (MBX_NOWAIT | MBX_STOP_IOCB));
3086 			lpfc_set_loopback_flag(phba);
3087 			if (rc == MBX_NOT_FINISHED) {
3088 				mempool_free(mbox, phba->mbox_mem_pool);
3089 			}
3090 			return 1;
3091 		} else if (rc > 0) {	/* greater than */
3092 			spin_lock_irq(shost->host_lock);
3093 			vport->fc_flag |= FC_PT2PT_PLOGI;
3094 			spin_unlock_irq(shost->host_lock);
3095 		}
3096 		spin_lock_irq(shost->host_lock);
3097 		vport->fc_flag |= FC_PT2PT;
3098 		vport->fc_flag &= ~(FC_FABRIC | FC_PUBLIC_LOOP);
3099 		spin_unlock_irq(shost->host_lock);
3100 	} else {
3101 		/* Reject this request because invalid parameters */
3102 		stat.un.b.lsRjtRsvd0 = 0;
3103 		stat.un.b.lsRjtRsnCode = LSRJT_UNABLE_TPC;
3104 		stat.un.b.lsRjtRsnCodeExp = LSEXP_SPARM_OPTIONS;
3105 		stat.un.b.vendorUnique = 0;
3106 		lpfc_els_rsp_reject(vport, stat.un.lsRjtError, cmdiocb, ndlp,
3107 			NULL);
3108 		return 1;
3109 	}
3110 
3111 	/* Send back ACC */
3112 	lpfc_els_rsp_acc(vport, ELS_CMD_PLOGI, cmdiocb, ndlp, NULL, newnode);
3113 
3114 	return 0;
3115 }
3116 
3117 static int
3118 lpfc_els_rcv_rnid(struct lpfc_vport *vport, struct lpfc_iocbq *cmdiocb,
3119 		  struct lpfc_nodelist *ndlp)
3120 {
3121 	struct lpfc_dmabuf *pcmd;
3122 	uint32_t *lp;
3123 	IOCB_t *icmd;
3124 	RNID *rn;
3125 	struct ls_rjt stat;
3126 	uint32_t cmd, did;
3127 
3128 	icmd = &cmdiocb->iocb;
3129 	did = icmd->un.elsreq64.remoteID;
3130 	pcmd = (struct lpfc_dmabuf *) cmdiocb->context2;
3131 	lp = (uint32_t *) pcmd->virt;
3132 
3133 	cmd = *lp++;
3134 	rn = (RNID *) lp;
3135 
3136 	/* RNID received */
3137 
3138 	switch (rn->Format) {
3139 	case 0:
3140 	case RNID_TOPOLOGY_DISC:
3141 		/* Send back ACC */
3142 		lpfc_els_rsp_rnid_acc(vport, rn->Format, cmdiocb, ndlp);
3143 		break;
3144 	default:
3145 		/* Reject this request because format not supported */
3146 		stat.un.b.lsRjtRsvd0 = 0;
3147 		stat.un.b.lsRjtRsnCode = LSRJT_UNABLE_TPC;
3148 		stat.un.b.lsRjtRsnCodeExp = LSEXP_CANT_GIVE_DATA;
3149 		stat.un.b.vendorUnique = 0;
3150 		lpfc_els_rsp_reject(vport, stat.un.lsRjtError, cmdiocb, ndlp,
3151 			NULL);
3152 	}
3153 	return 0;
3154 }
3155 
3156 static int
3157 lpfc_els_rcv_lirr(struct lpfc_vport *vport, struct lpfc_iocbq *cmdiocb,
3158 		  struct lpfc_nodelist *ndlp)
3159 {
3160 	struct ls_rjt stat;
3161 
3162 	/* For now, unconditionally reject this command */
3163 	stat.un.b.lsRjtRsvd0 = 0;
3164 	stat.un.b.lsRjtRsnCode = LSRJT_UNABLE_TPC;
3165 	stat.un.b.lsRjtRsnCodeExp = LSEXP_CANT_GIVE_DATA;
3166 	stat.un.b.vendorUnique = 0;
3167 	lpfc_els_rsp_reject(vport, stat.un.lsRjtError, cmdiocb, ndlp, NULL);
3168 	return 0;
3169 }
3170 
3171 static void
3172 lpfc_els_rsp_rps_acc(struct lpfc_hba *phba, LPFC_MBOXQ_t *pmb)
3173 {
3174 	struct lpfc_sli *psli = &phba->sli;
3175 	struct lpfc_sli_ring *pring = &psli->ring[LPFC_ELS_RING];
3176 	MAILBOX_t *mb;
3177 	IOCB_t *icmd;
3178 	RPS_RSP *rps_rsp;
3179 	uint8_t *pcmd;
3180 	struct lpfc_iocbq *elsiocb;
3181 	struct lpfc_nodelist *ndlp;
3182 	uint16_t xri, status;
3183 	uint32_t cmdsize;
3184 
3185 	mb = &pmb->mb;
3186 
3187 	ndlp = (struct lpfc_nodelist *) pmb->context2;
3188 	xri = (uint16_t) ((unsigned long)(pmb->context1));
3189 	pmb->context1 = NULL;
3190 	pmb->context2 = NULL;
3191 
3192 	if (mb->mbxStatus) {
3193 		mempool_free(pmb, phba->mbox_mem_pool);
3194 		return;
3195 	}
3196 
3197 	cmdsize = sizeof(RPS_RSP) + sizeof(uint32_t);
3198 	mempool_free(pmb, phba->mbox_mem_pool);
3199 	elsiocb = lpfc_prep_els_iocb(phba->pport, 0, cmdsize,
3200 				     lpfc_max_els_tries, ndlp,
3201 				     ndlp->nlp_DID, ELS_CMD_ACC);
3202 	lpfc_nlp_put(ndlp);
3203 	if (!elsiocb)
3204 		return;
3205 
3206 	icmd = &elsiocb->iocb;
3207 	icmd->ulpContext = xri;
3208 
3209 	pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
3210 	*((uint32_t *) (pcmd)) = ELS_CMD_ACC;
3211 	pcmd += sizeof(uint32_t); /* Skip past command */
3212 	rps_rsp = (RPS_RSP *)pcmd;
3213 
3214 	if (phba->fc_topology != TOPOLOGY_LOOP)
3215 		status = 0x10;
3216 	else
3217 		status = 0x8;
3218 	if (phba->pport->fc_flag & FC_FABRIC)
3219 		status |= 0x4;
3220 
3221 	rps_rsp->rsvd1 = 0;
3222 	rps_rsp->portStatus = be16_to_cpu(status);
3223 	rps_rsp->linkFailureCnt = be32_to_cpu(mb->un.varRdLnk.linkFailureCnt);
3224 	rps_rsp->lossSyncCnt = be32_to_cpu(mb->un.varRdLnk.lossSyncCnt);
3225 	rps_rsp->lossSignalCnt = be32_to_cpu(mb->un.varRdLnk.lossSignalCnt);
3226 	rps_rsp->primSeqErrCnt = be32_to_cpu(mb->un.varRdLnk.primSeqErrCnt);
3227 	rps_rsp->invalidXmitWord = be32_to_cpu(mb->un.varRdLnk.invalidXmitWord);
3228 	rps_rsp->crcCnt = be32_to_cpu(mb->un.varRdLnk.crcCnt);
3229 
3230 	/* Xmit ELS RPS ACC response tag <ulpIoTag> */
3231 	lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
3232 			"%d (%d):0118 Xmit ELS RPS ACC response tag x%x "
3233 			"xri x%x, did x%x, nlp_flag x%x, nlp_state x%x, "
3234 			"rpi x%x\n",
3235 			phba->brd_no, ndlp->vport->vpi, elsiocb->iotag,
3236 			elsiocb->iocb.ulpContext, ndlp->nlp_DID,
3237 			ndlp->nlp_flag, ndlp->nlp_state, ndlp->nlp_rpi);
3238 
3239 	elsiocb->iocb_cmpl = lpfc_cmpl_els_rsp;
3240 	phba->fc_stat.elsXmitACC++;
3241 	if (lpfc_sli_issue_iocb(phba, pring, elsiocb, 0) == IOCB_ERROR)
3242 		lpfc_els_free_iocb(phba, elsiocb);
3243 	return;
3244 }
3245 
3246 static int
3247 lpfc_els_rcv_rps(struct lpfc_vport *vport, struct lpfc_iocbq *cmdiocb,
3248 		 struct lpfc_nodelist *ndlp)
3249 {
3250 	struct lpfc_hba *phba = vport->phba;
3251 	uint32_t *lp;
3252 	uint8_t flag;
3253 	LPFC_MBOXQ_t *mbox;
3254 	struct lpfc_dmabuf *pcmd;
3255 	RPS *rps;
3256 	struct ls_rjt stat;
3257 
3258 	if ((ndlp->nlp_state != NLP_STE_UNMAPPED_NODE) &&
3259 	    (ndlp->nlp_state != NLP_STE_MAPPED_NODE)) {
3260 		stat.un.b.lsRjtRsvd0 = 0;
3261 		stat.un.b.lsRjtRsnCode = LSRJT_UNABLE_TPC;
3262 		stat.un.b.lsRjtRsnCodeExp = LSEXP_CANT_GIVE_DATA;
3263 		stat.un.b.vendorUnique = 0;
3264 		lpfc_els_rsp_reject(vport, stat.un.lsRjtError, cmdiocb, ndlp,
3265 			NULL);
3266 	}
3267 
3268 	pcmd = (struct lpfc_dmabuf *) cmdiocb->context2;
3269 	lp = (uint32_t *) pcmd->virt;
3270 	flag = (be32_to_cpu(*lp++) & 0xf);
3271 	rps = (RPS *) lp;
3272 
3273 	if ((flag == 0) ||
3274 	    ((flag == 1) && (be32_to_cpu(rps->un.portNum) == 0)) ||
3275 	    ((flag == 2) && (memcmp(&rps->un.portName, &vport->fc_portname,
3276 				    sizeof(struct lpfc_name)) == 0))) {
3277 
3278 		printk("Fix me....\n");
3279 		dump_stack();
3280 		mbox = mempool_alloc(phba->mbox_mem_pool, GFP_ATOMIC);
3281 		if (mbox) {
3282 			lpfc_read_lnk_stat(phba, mbox);
3283 			mbox->context1 =
3284 			    (void *)((unsigned long) cmdiocb->iocb.ulpContext);
3285 			mbox->context2 = lpfc_nlp_get(ndlp);
3286 			mbox->vport = vport;
3287 			mbox->mbox_cmpl = lpfc_els_rsp_rps_acc;
3288 			if (lpfc_sli_issue_mbox (phba, mbox,
3289 			    (MBX_NOWAIT | MBX_STOP_IOCB)) != MBX_NOT_FINISHED)
3290 				/* Mbox completion will send ELS Response */
3291 				return 0;
3292 
3293 			lpfc_nlp_put(ndlp);
3294 			mempool_free(mbox, phba->mbox_mem_pool);
3295 		}
3296 	}
3297 	stat.un.b.lsRjtRsvd0 = 0;
3298 	stat.un.b.lsRjtRsnCode = LSRJT_UNABLE_TPC;
3299 	stat.un.b.lsRjtRsnCodeExp = LSEXP_CANT_GIVE_DATA;
3300 	stat.un.b.vendorUnique = 0;
3301 	lpfc_els_rsp_reject(vport, stat.un.lsRjtError, cmdiocb, ndlp, NULL);
3302 	return 0;
3303 }
3304 
3305 static int
3306 lpfc_els_rsp_rpl_acc(struct lpfc_vport *vport, uint16_t cmdsize,
3307 		     struct lpfc_iocbq *oldiocb, struct lpfc_nodelist *ndlp)
3308 {
3309 	struct lpfc_hba *phba = vport->phba;
3310 	IOCB_t *icmd, *oldcmd;
3311 	RPL_RSP rpl_rsp;
3312 	struct lpfc_iocbq *elsiocb;
3313 	struct lpfc_sli *psli = &phba->sli;
3314 	struct lpfc_sli_ring *pring = &psli->ring[LPFC_ELS_RING];
3315 	uint8_t *pcmd;
3316 
3317 	elsiocb = lpfc_prep_els_iocb(vport, 0, cmdsize, oldiocb->retry, ndlp,
3318 				     ndlp->nlp_DID, ELS_CMD_ACC);
3319 
3320 	if (!elsiocb)
3321 		return 1;
3322 
3323 	icmd = &elsiocb->iocb;
3324 	oldcmd = &oldiocb->iocb;
3325 	icmd->ulpContext = oldcmd->ulpContext;	/* Xri */
3326 
3327 	pcmd = (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
3328 	*((uint32_t *) (pcmd)) = ELS_CMD_ACC;
3329 	pcmd += sizeof(uint16_t);
3330 	*((uint16_t *)(pcmd)) = be16_to_cpu(cmdsize);
3331 	pcmd += sizeof(uint16_t);
3332 
3333 	/* Setup the RPL ACC payload */
3334 	rpl_rsp.listLen = be32_to_cpu(1);
3335 	rpl_rsp.index = 0;
3336 	rpl_rsp.port_num_blk.portNum = 0;
3337 	rpl_rsp.port_num_blk.portID = be32_to_cpu(vport->fc_myDID);
3338 	memcpy(&rpl_rsp.port_num_blk.portName, &vport->fc_portname,
3339 	    sizeof(struct lpfc_name));
3340 
3341 	memcpy(pcmd, &rpl_rsp, cmdsize - sizeof(uint32_t));
3342 
3343 
3344 	/* Xmit ELS RPL ACC response tag <ulpIoTag> */
3345 	lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
3346 			"%d (%d):0120 Xmit ELS RPL ACC response tag x%x "
3347 			"xri x%x, did x%x, nlp_flag x%x, nlp_state x%x, "
3348 			"rpi x%x\n",
3349 			phba->brd_no, vport->vpi, elsiocb->iotag,
3350 			elsiocb->iocb.ulpContext, ndlp->nlp_DID,
3351 			ndlp->nlp_flag, ndlp->nlp_state, ndlp->nlp_rpi);
3352 
3353 	elsiocb->iocb_cmpl = lpfc_cmpl_els_rsp;
3354 
3355 	phba->fc_stat.elsXmitACC++;
3356 	if (lpfc_sli_issue_iocb(phba, pring, elsiocb, 0) == IOCB_ERROR) {
3357 		lpfc_els_free_iocb(phba, elsiocb);
3358 		return 1;
3359 	}
3360 	return 0;
3361 }
3362 
3363 static int
3364 lpfc_els_rcv_rpl(struct lpfc_vport *vport, struct lpfc_iocbq *cmdiocb,
3365 		 struct lpfc_nodelist *ndlp)
3366 {
3367 	struct lpfc_dmabuf *pcmd;
3368 	uint32_t *lp;
3369 	uint32_t maxsize;
3370 	uint16_t cmdsize;
3371 	RPL *rpl;
3372 	struct ls_rjt stat;
3373 
3374 	if ((ndlp->nlp_state != NLP_STE_UNMAPPED_NODE) &&
3375 	    (ndlp->nlp_state != NLP_STE_MAPPED_NODE)) {
3376 		stat.un.b.lsRjtRsvd0 = 0;
3377 		stat.un.b.lsRjtRsnCode = LSRJT_UNABLE_TPC;
3378 		stat.un.b.lsRjtRsnCodeExp = LSEXP_CANT_GIVE_DATA;
3379 		stat.un.b.vendorUnique = 0;
3380 		lpfc_els_rsp_reject(vport, stat.un.lsRjtError, cmdiocb, ndlp,
3381 			NULL);
3382 	}
3383 
3384 	pcmd = (struct lpfc_dmabuf *) cmdiocb->context2;
3385 	lp = (uint32_t *) pcmd->virt;
3386 	rpl = (RPL *) (lp + 1);
3387 
3388 	maxsize = be32_to_cpu(rpl->maxsize);
3389 
3390 	/* We support only one port */
3391 	if ((rpl->index == 0) &&
3392 	    ((maxsize == 0) ||
3393 	     ((maxsize * sizeof(uint32_t)) >= sizeof(RPL_RSP)))) {
3394 		cmdsize = sizeof(uint32_t) + sizeof(RPL_RSP);
3395 	} else {
3396 		cmdsize = sizeof(uint32_t) + maxsize * sizeof(uint32_t);
3397 	}
3398 	lpfc_els_rsp_rpl_acc(vport, cmdsize, cmdiocb, ndlp);
3399 
3400 	return 0;
3401 }
3402 
3403 static int
3404 lpfc_els_rcv_farp(struct lpfc_vport *vport, struct lpfc_iocbq *cmdiocb,
3405 		  struct lpfc_nodelist *ndlp)
3406 {
3407 	struct lpfc_hba *phba = vport->phba;
3408 	struct lpfc_dmabuf *pcmd;
3409 	uint32_t *lp;
3410 	IOCB_t *icmd;
3411 	FARP *fp;
3412 	uint32_t cmd, cnt, did;
3413 
3414 	icmd = &cmdiocb->iocb;
3415 	did = icmd->un.elsreq64.remoteID;
3416 	pcmd = (struct lpfc_dmabuf *) cmdiocb->context2;
3417 	lp = (uint32_t *) pcmd->virt;
3418 
3419 	cmd = *lp++;
3420 	fp = (FARP *) lp;
3421 
3422 	/* FARP-REQ received from DID <did> */
3423 	lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
3424 			"%d (%d):0601 FARP-REQ received from DID x%x\n",
3425 			phba->brd_no, vport->vpi, did);
3426 
3427 	/* We will only support match on WWPN or WWNN */
3428 	if (fp->Mflags & ~(FARP_MATCH_NODE | FARP_MATCH_PORT)) {
3429 		return 0;
3430 	}
3431 
3432 	cnt = 0;
3433 	/* If this FARP command is searching for my portname */
3434 	if (fp->Mflags & FARP_MATCH_PORT) {
3435 		if (memcmp(&fp->RportName, &vport->fc_portname,
3436 			   sizeof(struct lpfc_name)) == 0)
3437 			cnt = 1;
3438 	}
3439 
3440 	/* If this FARP command is searching for my nodename */
3441 	if (fp->Mflags & FARP_MATCH_NODE) {
3442 		if (memcmp(&fp->RnodeName, &vport->fc_nodename,
3443 			   sizeof(struct lpfc_name)) == 0)
3444 			cnt = 1;
3445 	}
3446 
3447 	if (cnt) {
3448 		if ((ndlp->nlp_state == NLP_STE_UNMAPPED_NODE) ||
3449 		   (ndlp->nlp_state == NLP_STE_MAPPED_NODE)) {
3450 			/* Log back into the node before sending the FARP. */
3451 			if (fp->Rflags & FARP_REQUEST_PLOGI) {
3452 				ndlp->nlp_prev_state = ndlp->nlp_state;
3453 				lpfc_nlp_set_state(vport, ndlp,
3454 						   NLP_STE_PLOGI_ISSUE);
3455 				lpfc_issue_els_plogi(vport, ndlp->nlp_DID, 0);
3456 			}
3457 
3458 			/* Send a FARP response to that node */
3459 			if (fp->Rflags & FARP_REQUEST_FARPR)
3460 				lpfc_issue_els_farpr(vport, did, 0);
3461 		}
3462 	}
3463 	return 0;
3464 }
3465 
3466 static int
3467 lpfc_els_rcv_farpr(struct lpfc_vport *vport, struct lpfc_iocbq *cmdiocb,
3468 		   struct lpfc_nodelist  *ndlp)
3469 {
3470 	struct lpfc_dmabuf *pcmd;
3471 	uint32_t *lp;
3472 	IOCB_t *icmd;
3473 	uint32_t cmd, did;
3474 	struct lpfc_hba *phba = vport->phba;
3475 
3476 	icmd = &cmdiocb->iocb;
3477 	did = icmd->un.elsreq64.remoteID;
3478 	pcmd = (struct lpfc_dmabuf *) cmdiocb->context2;
3479 	lp = (uint32_t *) pcmd->virt;
3480 
3481 	cmd = *lp++;
3482 	/* FARP-RSP received from DID <did> */
3483 	lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
3484 			"%d (%d):0600 FARP-RSP received from DID x%x\n",
3485 			phba->brd_no, vport->vpi, did);
3486 	/* ACCEPT the Farp resp request */
3487 	lpfc_els_rsp_acc(vport, ELS_CMD_ACC, cmdiocb, ndlp, NULL, 0);
3488 
3489 	return 0;
3490 }
3491 
3492 static int
3493 lpfc_els_rcv_fan(struct lpfc_vport *vport, struct lpfc_iocbq *cmdiocb,
3494 		 struct lpfc_nodelist *fan_ndlp)
3495 {
3496 	struct lpfc_dmabuf *pcmd;
3497 	uint32_t *lp;
3498 	IOCB_t *icmd;
3499 	uint32_t cmd, did;
3500 	FAN *fp;
3501 	struct lpfc_nodelist *ndlp, *next_ndlp;
3502 	struct lpfc_hba *phba = vport->phba;
3503 
3504 	/* FAN received */
3505 	lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
3506 			"%d (%d):0265 FAN received\n",
3507 			phba->brd_no, vport->vpi);
3508 
3509 	icmd = &cmdiocb->iocb;
3510 	did = icmd->un.elsreq64.remoteID;
3511 	pcmd = (struct lpfc_dmabuf *)cmdiocb->context2;
3512 	lp = (uint32_t *)pcmd->virt;
3513 
3514 	cmd = *lp++;
3515 	fp = (FAN *) lp;
3516 
3517 	/* FAN received; Fan does not have a reply sequence */
3518 
3519 	if (phba->pport->port_state == LPFC_LOCAL_CFG_LINK) {
3520 		if ((memcmp(&phba->fc_fabparam.nodeName, &fp->FnodeName,
3521 			sizeof(struct lpfc_name)) != 0) ||
3522 		    (memcmp(&phba->fc_fabparam.portName, &fp->FportName,
3523 			sizeof(struct lpfc_name)) != 0)) {
3524 			/*
3525 			 * This node has switched fabrics.  FLOGI is required
3526 			 * Clean up the old rpi's
3527 			 */
3528 
3529 			list_for_each_entry_safe(ndlp, next_ndlp,
3530 						 &vport->fc_nodes, nlp_listp) {
3531 				if (ndlp->nlp_state != NLP_STE_NPR_NODE)
3532 					continue;
3533 				if (ndlp->nlp_type & NLP_FABRIC) {
3534 					/*
3535 					 * Clean up old Fabric, Nameserver and
3536 					 * other NLP_FABRIC logins
3537 					 */
3538 					lpfc_drop_node(vport, ndlp);
3539 				} else if (!(ndlp->nlp_flag & NLP_NPR_ADISC)) {
3540 					/* Fail outstanding I/O now since this
3541 					 * device is marked for PLOGI
3542 					 */
3543 					lpfc_unreg_rpi(vport, ndlp);
3544 				}
3545 			}
3546 
3547 			vport->port_state = LPFC_FLOGI;
3548 			lpfc_set_disctmo(vport);
3549 			lpfc_initial_flogi(vport);
3550 			return 0;
3551 		}
3552 		/* Discovery not needed,
3553 		 * move the nodes to their original state.
3554 		 */
3555 		list_for_each_entry_safe(ndlp, next_ndlp, &vport->fc_nodes,
3556 					 nlp_listp) {
3557 			if (ndlp->nlp_state != NLP_STE_NPR_NODE)
3558 				continue;
3559 
3560 			switch (ndlp->nlp_prev_state) {
3561 			case NLP_STE_UNMAPPED_NODE:
3562 				ndlp->nlp_prev_state = NLP_STE_NPR_NODE;
3563 				lpfc_nlp_set_state(vport, ndlp,
3564 						   NLP_STE_UNMAPPED_NODE);
3565 				break;
3566 
3567 			case NLP_STE_MAPPED_NODE:
3568 				ndlp->nlp_prev_state = NLP_STE_NPR_NODE;
3569 				lpfc_nlp_set_state(vport, ndlp,
3570 						   NLP_STE_MAPPED_NODE);
3571 				break;
3572 
3573 			default:
3574 				break;
3575 			}
3576 		}
3577 
3578 		/* Start discovery - this should just do CLEAR_LA */
3579 		lpfc_disc_start(vport);
3580 	}
3581 	return 0;
3582 }
3583 
3584 void
3585 lpfc_els_timeout(unsigned long ptr)
3586 {
3587 	struct lpfc_vport *vport = (struct lpfc_vport *) ptr;
3588 	struct lpfc_hba   *phba = vport->phba;
3589 	unsigned long iflag;
3590 
3591 	spin_lock_irqsave(&vport->work_port_lock, iflag);
3592 	if ((vport->work_port_events & WORKER_ELS_TMO) == 0) {
3593 		vport->work_port_events |= WORKER_ELS_TMO;
3594 		spin_unlock_irqrestore(&vport->work_port_lock, iflag);
3595 
3596 		spin_lock_irqsave(&phba->hbalock, iflag);
3597 		if (phba->work_wait)
3598 			lpfc_worker_wake_up(phba);
3599 		spin_unlock_irqrestore(&phba->hbalock, iflag);
3600 	}
3601 	else
3602 		spin_unlock_irqrestore(&vport->work_port_lock, iflag);
3603 	return;
3604 }
3605 
3606 void
3607 lpfc_els_timeout_handler(struct lpfc_vport *vport)
3608 {
3609 	struct lpfc_hba  *phba = vport->phba;
3610 	struct lpfc_sli_ring *pring;
3611 	struct lpfc_iocbq *tmp_iocb, *piocb;
3612 	IOCB_t *cmd = NULL;
3613 	struct lpfc_dmabuf *pcmd;
3614 	uint32_t els_command = 0;
3615 	uint32_t timeout;
3616 	uint32_t remote_ID = 0xffffffff;
3617 
3618 	/* If the timer is already canceled do nothing */
3619 	if ((vport->work_port_events & WORKER_ELS_TMO) == 0) {
3620 		return;
3621 	}
3622 	spin_lock_irq(&phba->hbalock);
3623 	timeout = (uint32_t)(phba->fc_ratov << 1);
3624 
3625 	pring = &phba->sli.ring[LPFC_ELS_RING];
3626 
3627 	list_for_each_entry_safe(piocb, tmp_iocb, &pring->txcmplq, list) {
3628 		cmd = &piocb->iocb;
3629 
3630 		if ((piocb->iocb_flag & LPFC_IO_LIBDFC) != 0 ||
3631 		    piocb->iocb.ulpCommand == CMD_ABORT_XRI_CN ||
3632 		    piocb->iocb.ulpCommand == CMD_CLOSE_XRI_CN)
3633 			continue;
3634 
3635 		if (piocb->vport != vport)
3636 			continue;
3637 
3638 		pcmd = (struct lpfc_dmabuf *) piocb->context2;
3639 		if (pcmd)
3640 			els_command = *(uint32_t *) (pcmd->virt);
3641 
3642 		if (els_command == ELS_CMD_FARP ||
3643 		    els_command == ELS_CMD_FARPR ||
3644 		    els_command == ELS_CMD_FDISC)
3645 			continue;
3646 
3647 		if (vport != piocb->vport)
3648 			continue;
3649 
3650 		if (piocb->drvrTimeout > 0) {
3651 			if (piocb->drvrTimeout >= timeout)
3652 				piocb->drvrTimeout -= timeout;
3653 			else
3654 				piocb->drvrTimeout = 0;
3655 			continue;
3656 		}
3657 
3658 		remote_ID = 0xffffffff;
3659 		if (cmd->ulpCommand != CMD_GEN_REQUEST64_CR)
3660 			remote_ID = cmd->un.elsreq64.remoteID;
3661 		else {
3662 			struct lpfc_nodelist *ndlp;
3663 			ndlp = __lpfc_findnode_rpi(vport, cmd->ulpContext);
3664 			if (ndlp)
3665 				remote_ID = ndlp->nlp_DID;
3666 		}
3667 
3668 		lpfc_printf_log(phba, KERN_ERR, LOG_ELS,
3669 				"%d (%d):0127 ELS timeout Data: x%x x%x x%x "
3670 				"x%x\n",
3671 				phba->brd_no, vport->vpi, els_command,
3672 				remote_ID, cmd->ulpCommand, cmd->ulpIoTag);
3673 
3674 		lpfc_sli_issue_abort_iotag(phba, pring, piocb);
3675 	}
3676 	spin_unlock_irq(&phba->hbalock);
3677 
3678 	if (phba->sli.ring[LPFC_ELS_RING].txcmplq_cnt)
3679 		mod_timer(&vport->els_tmofunc, jiffies + HZ * timeout);
3680 }
3681 
3682 void
3683 lpfc_els_flush_cmd(struct lpfc_vport *vport)
3684 {
3685 	LIST_HEAD(completions);
3686 	struct lpfc_hba  *phba = vport->phba;
3687 	struct lpfc_sli_ring *pring = &phba->sli.ring[LPFC_ELS_RING];
3688 	struct lpfc_iocbq *tmp_iocb, *piocb;
3689 	IOCB_t *cmd = NULL;
3690 
3691 	lpfc_fabric_abort_vport(vport);
3692 
3693 	spin_lock_irq(&phba->hbalock);
3694 	list_for_each_entry_safe(piocb, tmp_iocb, &pring->txq, list) {
3695 		cmd = &piocb->iocb;
3696 
3697 		if (piocb->iocb_flag & LPFC_IO_LIBDFC) {
3698 			continue;
3699 		}
3700 
3701 		/* Do not flush out the QUE_RING and ABORT/CLOSE iocbs */
3702 		if (cmd->ulpCommand == CMD_QUE_RING_BUF_CN ||
3703 		    cmd->ulpCommand == CMD_QUE_RING_BUF64_CN ||
3704 		    cmd->ulpCommand == CMD_CLOSE_XRI_CN ||
3705 		    cmd->ulpCommand == CMD_ABORT_XRI_CN)
3706 			continue;
3707 
3708 		if (piocb->vport != vport)
3709 			continue;
3710 
3711 		list_move_tail(&piocb->list, &completions);
3712 		pring->txq_cnt--;
3713 	}
3714 
3715 	list_for_each_entry_safe(piocb, tmp_iocb, &pring->txcmplq, list) {
3716 		if (piocb->iocb_flag & LPFC_IO_LIBDFC) {
3717 			continue;
3718 		}
3719 
3720 		if (piocb->vport != vport)
3721 			continue;
3722 
3723 		lpfc_sli_issue_abort_iotag(phba, pring, piocb);
3724 	}
3725 	spin_unlock_irq(&phba->hbalock);
3726 
3727 	while (!list_empty(&completions)) {
3728 		piocb = list_get_first(&completions, struct lpfc_iocbq, list);
3729 		cmd = &piocb->iocb;
3730 		list_del_init(&piocb->list);
3731 
3732 		if (!piocb->iocb_cmpl)
3733 			lpfc_sli_release_iocbq(phba, piocb);
3734 		else {
3735 			cmd->ulpStatus = IOSTAT_LOCAL_REJECT;
3736 			cmd->un.ulpWord[4] = IOERR_SLI_ABORTED;
3737 			(piocb->iocb_cmpl) (phba, piocb, piocb);
3738 		}
3739 	}
3740 
3741 	return;
3742 }
3743 
3744 static void
3745 lpfc_els_unsol_buffer(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
3746 		      struct lpfc_vport *vport, struct lpfc_iocbq *elsiocb)
3747 {
3748 	struct lpfc_nodelist *ndlp;
3749 	struct ls_rjt stat;
3750 	uint32_t *payload;
3751 	uint32_t cmd, did, newnode, rjt_err = 0;
3752 	IOCB_t *icmd = &elsiocb->iocb;
3753 
3754 	if (vport == NULL || elsiocb->context2 == NULL)
3755 		goto dropit;
3756 
3757 	newnode = 0;
3758 	payload = ((struct lpfc_dmabuf *)elsiocb->context2)->virt;
3759 	cmd = *payload;
3760 	if ((phba->sli3_options & LPFC_SLI3_HBQ_ENABLED) == 0)
3761 		lpfc_post_buffer(phba, pring, 1, 1);
3762 
3763 	did = icmd->un.rcvels.remoteID;
3764 	if (icmd->ulpStatus) {
3765 		lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
3766 			"RCV Unsol ELS:  status:x%x/x%x did:x%x",
3767 			icmd->ulpStatus, icmd->un.ulpWord[4], did);
3768 		goto dropit;
3769 	}
3770 
3771 	/* Check to see if link went down during discovery */
3772 	if (lpfc_els_chk_latt(vport))
3773 		goto dropit;
3774 
3775 	/* Ignore traffic recevied during vport shutdown. */
3776 	if (vport->load_flag & FC_UNLOADING)
3777 		goto dropit;
3778 
3779 	ndlp = lpfc_findnode_did(vport, did);
3780 	if (!ndlp) {
3781 		/* Cannot find existing Fabric ndlp, so allocate a new one */
3782 		ndlp = mempool_alloc(phba->nlp_mem_pool, GFP_KERNEL);
3783 		if (!ndlp)
3784 			goto dropit;
3785 
3786 		lpfc_nlp_init(vport, ndlp, did);
3787 		newnode = 1;
3788 		if ((did & Fabric_DID_MASK) == Fabric_DID_MASK) {
3789 			ndlp->nlp_type |= NLP_FABRIC;
3790 		}
3791 		lpfc_nlp_set_state(vport, ndlp, NLP_STE_UNUSED_NODE);
3792 	}
3793 
3794 	phba->fc_stat.elsRcvFrame++;
3795 	if (elsiocb->context1)
3796 		lpfc_nlp_put(elsiocb->context1);
3797 	elsiocb->context1 = lpfc_nlp_get(ndlp);
3798 	elsiocb->vport = vport;
3799 
3800 	if ((cmd & ELS_CMD_MASK) == ELS_CMD_RSCN) {
3801 		cmd &= ELS_CMD_MASK;
3802 	}
3803 	/* ELS command <elsCmd> received from NPORT <did> */
3804 	lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
3805 			"%d (%d):0112 ELS command x%x received from NPORT x%x "
3806 			"Data: x%x\n", phba->brd_no, vport->vpi, cmd, did,
3807 			vport->port_state);
3808 
3809 	switch (cmd) {
3810 	case ELS_CMD_PLOGI:
3811 		lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
3812 			"RCV PLOGI:       did:x%x/ste:x%x flg:x%x",
3813 			did, vport->port_state, ndlp->nlp_flag);
3814 
3815 		phba->fc_stat.elsRcvPLOGI++;
3816 		ndlp = lpfc_plogi_confirm_nport(phba, payload, ndlp);
3817 
3818 		if (vport->port_state < LPFC_DISC_AUTH) {
3819 			rjt_err = LSRJT_UNABLE_TPC;
3820 			break;
3821 		}
3822 		lpfc_disc_state_machine(vport, ndlp, elsiocb,
3823 					NLP_EVT_RCV_PLOGI);
3824 
3825 		break;
3826 	case ELS_CMD_FLOGI:
3827 		lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
3828 			"RCV FLOGI:       did:x%x/ste:x%x flg:x%x",
3829 			did, vport->port_state, ndlp->nlp_flag);
3830 
3831 		phba->fc_stat.elsRcvFLOGI++;
3832 		lpfc_els_rcv_flogi(vport, elsiocb, ndlp, newnode);
3833 		if (newnode)
3834 			lpfc_drop_node(vport, ndlp);
3835 		break;
3836 	case ELS_CMD_LOGO:
3837 		lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
3838 			"RCV LOGO:        did:x%x/ste:x%x flg:x%x",
3839 			did, vport->port_state, ndlp->nlp_flag);
3840 
3841 		phba->fc_stat.elsRcvLOGO++;
3842 		if (vport->port_state < LPFC_DISC_AUTH) {
3843 			rjt_err = LSRJT_UNABLE_TPC;
3844 			break;
3845 		}
3846 		lpfc_disc_state_machine(vport, ndlp, elsiocb, NLP_EVT_RCV_LOGO);
3847 		break;
3848 	case ELS_CMD_PRLO:
3849 		lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
3850 			"RCV PRLO:        did:x%x/ste:x%x flg:x%x",
3851 			did, vport->port_state, ndlp->nlp_flag);
3852 
3853 		phba->fc_stat.elsRcvPRLO++;
3854 		if (vport->port_state < LPFC_DISC_AUTH) {
3855 			rjt_err = LSRJT_UNABLE_TPC;
3856 			break;
3857 		}
3858 		lpfc_disc_state_machine(vport, ndlp, elsiocb, NLP_EVT_RCV_PRLO);
3859 		break;
3860 	case ELS_CMD_RSCN:
3861 		phba->fc_stat.elsRcvRSCN++;
3862 		lpfc_els_rcv_rscn(vport, elsiocb, ndlp, newnode);
3863 		if (newnode)
3864 			lpfc_drop_node(vport, ndlp);
3865 		break;
3866 	case ELS_CMD_ADISC:
3867 		lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
3868 			"RCV ADISC:       did:x%x/ste:x%x flg:x%x",
3869 			did, vport->port_state, ndlp->nlp_flag);
3870 
3871 		phba->fc_stat.elsRcvADISC++;
3872 		if (vport->port_state < LPFC_DISC_AUTH) {
3873 			rjt_err = LSRJT_UNABLE_TPC;
3874 			break;
3875 		}
3876 		lpfc_disc_state_machine(vport, ndlp, elsiocb,
3877 					NLP_EVT_RCV_ADISC);
3878 		break;
3879 	case ELS_CMD_PDISC:
3880 		lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
3881 			"RCV PDISC:       did:x%x/ste:x%x flg:x%x",
3882 			did, vport->port_state, ndlp->nlp_flag);
3883 
3884 		phba->fc_stat.elsRcvPDISC++;
3885 		if (vport->port_state < LPFC_DISC_AUTH) {
3886 			rjt_err = LSRJT_UNABLE_TPC;
3887 			break;
3888 		}
3889 		lpfc_disc_state_machine(vport, ndlp, elsiocb,
3890 					NLP_EVT_RCV_PDISC);
3891 		break;
3892 	case ELS_CMD_FARPR:
3893 		lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
3894 			"RCV FARPR:       did:x%x/ste:x%x flg:x%x",
3895 			did, vport->port_state, ndlp->nlp_flag);
3896 
3897 		phba->fc_stat.elsRcvFARPR++;
3898 		lpfc_els_rcv_farpr(vport, elsiocb, ndlp);
3899 		break;
3900 	case ELS_CMD_FARP:
3901 		lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
3902 			"RCV FARP:        did:x%x/ste:x%x flg:x%x",
3903 			did, vport->port_state, ndlp->nlp_flag);
3904 
3905 		phba->fc_stat.elsRcvFARP++;
3906 		lpfc_els_rcv_farp(vport, elsiocb, ndlp);
3907 		break;
3908 	case ELS_CMD_FAN:
3909 		lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
3910 			"RCV FAN:         did:x%x/ste:x%x flg:x%x",
3911 			did, vport->port_state, ndlp->nlp_flag);
3912 
3913 		phba->fc_stat.elsRcvFAN++;
3914 		lpfc_els_rcv_fan(vport, elsiocb, ndlp);
3915 		break;
3916 	case ELS_CMD_PRLI:
3917 		lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
3918 			"RCV PRLI:        did:x%x/ste:x%x flg:x%x",
3919 			did, vport->port_state, ndlp->nlp_flag);
3920 
3921 		phba->fc_stat.elsRcvPRLI++;
3922 		if (vport->port_state < LPFC_DISC_AUTH) {
3923 			rjt_err = LSRJT_UNABLE_TPC;
3924 			break;
3925 		}
3926 		lpfc_disc_state_machine(vport, ndlp, elsiocb, NLP_EVT_RCV_PRLI);
3927 		break;
3928 	case ELS_CMD_LIRR:
3929 		lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
3930 			"RCV LIRR:        did:x%x/ste:x%x flg:x%x",
3931 			did, vport->port_state, ndlp->nlp_flag);
3932 
3933 		phba->fc_stat.elsRcvLIRR++;
3934 		lpfc_els_rcv_lirr(vport, elsiocb, ndlp);
3935 		if (newnode)
3936 			lpfc_drop_node(vport, ndlp);
3937 		break;
3938 	case ELS_CMD_RPS:
3939 		lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
3940 			"RCV RPS:         did:x%x/ste:x%x flg:x%x",
3941 			did, vport->port_state, ndlp->nlp_flag);
3942 
3943 		phba->fc_stat.elsRcvRPS++;
3944 		lpfc_els_rcv_rps(vport, elsiocb, ndlp);
3945 		if (newnode)
3946 			lpfc_drop_node(vport, ndlp);
3947 		break;
3948 	case ELS_CMD_RPL:
3949 		lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
3950 			"RCV RPL:         did:x%x/ste:x%x flg:x%x",
3951 			did, vport->port_state, ndlp->nlp_flag);
3952 
3953 		phba->fc_stat.elsRcvRPL++;
3954 		lpfc_els_rcv_rpl(vport, elsiocb, ndlp);
3955 		if (newnode)
3956 			lpfc_drop_node(vport, ndlp);
3957 		break;
3958 	case ELS_CMD_RNID:
3959 		lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
3960 			"RCV RNID:        did:x%x/ste:x%x flg:x%x",
3961 			did, vport->port_state, ndlp->nlp_flag);
3962 
3963 		phba->fc_stat.elsRcvRNID++;
3964 		lpfc_els_rcv_rnid(vport, elsiocb, ndlp);
3965 		if (newnode)
3966 			lpfc_drop_node(vport, ndlp);
3967 		break;
3968 	default:
3969 		lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_UNSOL,
3970 			"RCV ELS cmd:     cmd:x%x did:x%x/ste:x%x",
3971 			cmd, did, vport->port_state);
3972 
3973 		/* Unsupported ELS command, reject */
3974 		rjt_err = LSRJT_INVALID_CMD;
3975 
3976 		/* Unknown ELS command <elsCmd> received from NPORT <did> */
3977 		lpfc_printf_log(phba, KERN_ERR, LOG_ELS,
3978 				"%d (%d):0115 Unknown ELS command x%x "
3979 				"received from NPORT x%x\n",
3980 				phba->brd_no, vport->vpi, cmd, did);
3981 		if (newnode)
3982 			lpfc_drop_node(vport, ndlp);
3983 		break;
3984 	}
3985 
3986 	/* check if need to LS_RJT received ELS cmd */
3987 	if (rjt_err) {
3988 		memset(&stat, 0, sizeof(stat));
3989 		stat.un.b.lsRjtRsnCode = rjt_err;
3990 		stat.un.b.lsRjtRsnCodeExp = LSEXP_NOTHING_MORE;
3991 		lpfc_els_rsp_reject(vport, stat.un.lsRjtError, elsiocb, ndlp,
3992 			NULL);
3993 		if (newnode)
3994 			lpfc_drop_node(vport, ndlp);
3995 	}
3996 
3997 	return;
3998 
3999 dropit:
4000 	lpfc_printf_log(phba, KERN_ERR, LOG_ELS,
4001 			"%d (%d):0111 Dropping received ELS cmd "
4002 			"Data: x%x x%x x%x\n",
4003 			phba->brd_no, vport ? vport->vpi : 0xffff,
4004 			icmd->ulpStatus, icmd->un.ulpWord[4],
4005 			icmd->ulpTimeout);
4006 	phba->fc_stat.elsRcvDrop++;
4007 }
4008 
4009 static struct lpfc_vport *
4010 lpfc_find_vport_by_vpid(struct lpfc_hba *phba, uint16_t vpi)
4011 {
4012 	struct lpfc_vport *vport;
4013 
4014 	list_for_each_entry(vport, &phba->port_list, listentry) {
4015 		if (vport->vpi == vpi)
4016 			return vport;
4017 	}
4018 	return NULL;
4019 }
4020 
4021 void
4022 lpfc_els_unsol_event(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
4023 		     struct lpfc_iocbq *elsiocb)
4024 {
4025 	struct lpfc_vport *vport = phba->pport;
4026 	IOCB_t *icmd = &elsiocb->iocb;
4027 	dma_addr_t paddr;
4028 	struct lpfc_dmabuf *bdeBuf1 = elsiocb->context2;
4029 	struct lpfc_dmabuf *bdeBuf2 = elsiocb->context3;
4030 
4031 	elsiocb->context2 = NULL;
4032 	elsiocb->context3 = NULL;
4033 
4034 	if (icmd->ulpStatus == IOSTAT_NEED_BUFFER) {
4035 		lpfc_sli_hbqbuf_add_hbqs(phba, LPFC_ELS_HBQ);
4036 	} else if (icmd->ulpStatus == IOSTAT_LOCAL_REJECT &&
4037 	    (icmd->un.ulpWord[4] & 0xff) == IOERR_RCV_BUFFER_WAITING) {
4038 		phba->fc_stat.NoRcvBuf++;
4039 		/* Not enough posted buffers; Try posting more buffers */
4040 		if (!(phba->sli3_options & LPFC_SLI3_HBQ_ENABLED))
4041 			lpfc_post_buffer(phba, pring, 0, 1);
4042 		return;
4043 	}
4044 
4045 	if ((phba->sli3_options & LPFC_SLI3_NPIV_ENABLED) &&
4046 	    (icmd->ulpCommand == CMD_IOCB_RCV_ELS64_CX ||
4047 	     icmd->ulpCommand == CMD_IOCB_RCV_SEQ64_CX)) {
4048 		if (icmd->unsli3.rcvsli3.vpi == 0xffff)
4049 			vport = phba->pport;
4050 		else {
4051 			uint16_t vpi = icmd->unsli3.rcvsli3.vpi;
4052 			vport = lpfc_find_vport_by_vpid(phba, vpi);
4053 		}
4054 	}
4055 				/* If there are no BDEs associated
4056 				 * with this IOCB, there is nothing to do.
4057 				 */
4058 	if (icmd->ulpBdeCount == 0)
4059 		return;
4060 
4061 				/* type of ELS cmd is first 32bit word
4062 				 * in packet
4063 				 */
4064 	if (phba->sli3_options & LPFC_SLI3_HBQ_ENABLED) {
4065 		elsiocb->context2 = bdeBuf1;
4066 	} else {
4067 		paddr = getPaddr(icmd->un.cont64[0].addrHigh,
4068 				 icmd->un.cont64[0].addrLow);
4069 		elsiocb->context2 = lpfc_sli_ringpostbuf_get(phba, pring,
4070 							     paddr);
4071 	}
4072 
4073 	lpfc_els_unsol_buffer(phba, pring, vport, elsiocb);
4074 	/*
4075 	 * The different unsolicited event handlers would tell us
4076 	 * if they are done with "mp" by setting context2 to NULL.
4077 	 */
4078 	lpfc_nlp_put(elsiocb->context1);
4079 	elsiocb->context1 = NULL;
4080 	if (elsiocb->context2) {
4081 		lpfc_in_buf_free(phba, (struct lpfc_dmabuf *)elsiocb->context2);
4082 		elsiocb->context2 = NULL;
4083 	}
4084 
4085 	/* RCV_ELS64_CX provide for 2 BDEs - process 2nd if included */
4086 	if ((phba->sli3_options & LPFC_SLI3_HBQ_ENABLED) &&
4087 	    icmd->ulpBdeCount == 2) {
4088 		elsiocb->context2 = bdeBuf2;
4089 		lpfc_els_unsol_buffer(phba, pring, vport, elsiocb);
4090 		/* free mp if we are done with it */
4091 		if (elsiocb->context2) {
4092 			lpfc_in_buf_free(phba, elsiocb->context2);
4093 			elsiocb->context2 = NULL;
4094 		}
4095 	}
4096 }
4097 
4098 void
4099 lpfc_do_scr_ns_plogi(struct lpfc_hba *phba, struct lpfc_vport *vport)
4100 {
4101 	struct lpfc_nodelist *ndlp, *ndlp_fdmi;
4102 
4103 	ndlp = lpfc_findnode_did(vport, NameServer_DID);
4104 	if (!ndlp) {
4105 		ndlp = mempool_alloc(phba->nlp_mem_pool, GFP_KERNEL);
4106 		if (!ndlp) {
4107 			if (phba->fc_topology == TOPOLOGY_LOOP) {
4108 				lpfc_disc_start(vport);
4109 				return;
4110 			}
4111 			lpfc_vport_set_state(vport, FC_VPORT_FAILED);
4112 			lpfc_printf_log(phba, KERN_ERR, LOG_ELS,
4113 				"%d (%d):0251 NameServer login: no memory\n",
4114 				phba->brd_no, vport->vpi);
4115 			return;
4116 		}
4117 		lpfc_nlp_init(vport, ndlp, NameServer_DID);
4118 		ndlp->nlp_type |= NLP_FABRIC;
4119 	}
4120 
4121 	lpfc_nlp_set_state(vport, ndlp, NLP_STE_PLOGI_ISSUE);
4122 
4123 	if (lpfc_issue_els_plogi(vport, ndlp->nlp_DID, 0)) {
4124 		lpfc_vport_set_state(vport, FC_VPORT_FAILED);
4125 		lpfc_printf_log(phba, KERN_ERR, LOG_ELS,
4126 			"%d (%d):0252 Cannot issue NameServer login\n",
4127 			phba->brd_no, vport->vpi);
4128 		return;
4129 	}
4130 
4131 	if (phba->cfg_fdmi_on) {
4132 		ndlp_fdmi = mempool_alloc(phba->nlp_mem_pool,
4133 					  GFP_KERNEL);
4134 		if (ndlp_fdmi) {
4135 			lpfc_nlp_init(vport, ndlp_fdmi, FDMI_DID);
4136 			ndlp_fdmi->nlp_type |= NLP_FABRIC;
4137 			ndlp_fdmi->nlp_state =
4138 				NLP_STE_PLOGI_ISSUE;
4139 			lpfc_issue_els_plogi(vport, ndlp_fdmi->nlp_DID,
4140 					     0);
4141 		}
4142 	}
4143 	return;
4144 }
4145 
4146 static void
4147 lpfc_cmpl_reg_new_vport(struct lpfc_hba *phba, LPFC_MBOXQ_t *pmb)
4148 {
4149 	struct lpfc_vport *vport = pmb->vport;
4150 	struct Scsi_Host  *shost = lpfc_shost_from_vport(vport);
4151 	struct lpfc_nodelist *ndlp = (struct lpfc_nodelist *) pmb->context2;
4152 	MAILBOX_t *mb = &pmb->mb;
4153 
4154 	vport->fc_flag &= ~FC_VPORT_NEEDS_REG_VPI;
4155 	lpfc_nlp_put(ndlp);
4156 
4157 	if (mb->mbxStatus) {
4158 		lpfc_printf_log(phba, KERN_ERR, LOG_MBOX,
4159 				"%d (%d):0915 Register VPI failed: 0x%x\n",
4160 				phba->brd_no, vport->vpi, mb->mbxStatus);
4161 
4162 		switch (mb->mbxStatus) {
4163 		case 0x11:	/* unsupported feature */
4164 		case 0x9603:	/* max_vpi exceeded */
4165 			/* giving up on vport registration */
4166 			lpfc_vport_set_state(vport, FC_VPORT_FAILED);
4167 			spin_lock_irq(shost->host_lock);
4168 			vport->fc_flag &= ~(FC_FABRIC | FC_PUBLIC_LOOP);
4169 			spin_unlock_irq(shost->host_lock);
4170 			lpfc_can_disctmo(vport);
4171 			break;
4172 		default:
4173 			/* Try to recover from this error */
4174 			lpfc_mbx_unreg_vpi(vport);
4175 			vport->fc_flag |= FC_VPORT_NEEDS_REG_VPI;
4176 			lpfc_initial_fdisc(vport);
4177 			break;
4178 		}
4179 
4180 	} else {
4181 		if (vport == phba->pport)
4182 			lpfc_issue_fabric_reglogin(vport);
4183 		else
4184 			lpfc_do_scr_ns_plogi(phba, vport);
4185 	}
4186 	mempool_free(pmb, phba->mbox_mem_pool);
4187 	return;
4188 }
4189 
4190 void
4191 lpfc_register_new_vport(struct lpfc_hba *phba, struct lpfc_vport *vport,
4192 			struct lpfc_nodelist *ndlp)
4193 {
4194 	LPFC_MBOXQ_t *mbox;
4195 
4196 	mbox = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
4197 	if (mbox) {
4198 		lpfc_reg_vpi(phba, vport->vpi, vport->fc_myDID, mbox);
4199 		mbox->vport = vport;
4200 		mbox->context2 = lpfc_nlp_get(ndlp);
4201 		mbox->mbox_cmpl = lpfc_cmpl_reg_new_vport;
4202 		if (lpfc_sli_issue_mbox(phba, mbox,
4203 					MBX_NOWAIT | MBX_STOP_IOCB)
4204 		    == MBX_NOT_FINISHED) {
4205 			mempool_free(mbox, phba->mbox_mem_pool);
4206 			vport->fc_flag &= ~FC_VPORT_NEEDS_REG_VPI;
4207 
4208 			lpfc_vport_set_state(vport, FC_VPORT_FAILED);
4209 
4210 			lpfc_printf_log(phba, KERN_ERR, LOG_MBOX,
4211 				"%d (%d):0253 Register VPI: Cannot send mbox\n",
4212 				phba->brd_no, vport->vpi);
4213 		}
4214 	} else {
4215 		lpfc_vport_set_state(vport, FC_VPORT_FAILED);
4216 
4217 		lpfc_printf_log(phba, KERN_ERR, LOG_MBOX,
4218 			"%d (%d):0254 Register VPI: no memory\n",
4219 			phba->brd_no, vport->vpi);
4220 
4221 		vport->fc_flag &= ~FC_VPORT_NEEDS_REG_VPI;
4222 		lpfc_nlp_put(ndlp);
4223 	}
4224 }
4225 
4226 static void
4227 lpfc_cmpl_els_fdisc(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
4228 		    struct lpfc_iocbq *rspiocb)
4229 {
4230 	struct lpfc_vport *vport = cmdiocb->vport;
4231 	struct Scsi_Host  *shost = lpfc_shost_from_vport(vport);
4232 	struct lpfc_nodelist *ndlp = (struct lpfc_nodelist *) cmdiocb->context1;
4233 	struct lpfc_nodelist *np;
4234 	struct lpfc_nodelist *next_np;
4235 	IOCB_t *irsp = &rspiocb->iocb;
4236 	struct lpfc_iocbq *piocb;
4237 
4238 	lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
4239 		"%d (%d):0123 FDISC completes. x%x/x%x prevDID: x%x\n",
4240 		phba->brd_no, vport->vpi,
4241 		irsp->ulpStatus, irsp->un.ulpWord[4], vport->fc_prevDID);
4242 
4243 	/* Since all FDISCs are being single threaded, we
4244 	 * must reset the discovery timer for ALL vports
4245 	 * waiting to send FDISC when one completes.
4246 	 */
4247 	list_for_each_entry(piocb, &phba->fabric_iocb_list, list) {
4248 		lpfc_set_disctmo(piocb->vport);
4249 	}
4250 
4251 	lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
4252 		"FDISC cmpl:      status:x%x/x%x prevdid:x%x",
4253 		irsp->ulpStatus, irsp->un.ulpWord[4], vport->fc_prevDID);
4254 
4255 	if (irsp->ulpStatus) {
4256 		/* Check for retry */
4257 		if (lpfc_els_retry(phba, cmdiocb, rspiocb))
4258 			goto out;
4259 
4260 		/* FDISC failed */
4261 		lpfc_printf_log(phba, KERN_ERR, LOG_ELS,
4262 			"%d (%d):0124 FDISC failed. (%d/%d)\n",
4263 			phba->brd_no, vport->vpi,
4264 			irsp->ulpStatus, irsp->un.ulpWord[4]);
4265 
4266 		if (vport->fc_vport->vport_state == FC_VPORT_INITIALIZING)
4267 			lpfc_vport_set_state(vport, FC_VPORT_FAILED);
4268 
4269 		lpfc_nlp_put(ndlp);
4270 		/* giving up on FDISC. Cancel discovery timer */
4271 		lpfc_can_disctmo(vport);
4272 	} else {
4273 		spin_lock_irq(shost->host_lock);
4274 		vport->fc_flag |= FC_FABRIC;
4275 		if (vport->phba->fc_topology == TOPOLOGY_LOOP)
4276 			vport->fc_flag |=  FC_PUBLIC_LOOP;
4277 		spin_unlock_irq(shost->host_lock);
4278 
4279 		vport->fc_myDID = irsp->un.ulpWord[4] & Mask_DID;
4280 		lpfc_vport_set_state(vport, FC_VPORT_ACTIVE);
4281 		if ((vport->fc_prevDID != vport->fc_myDID) &&
4282 			!(vport->fc_flag & FC_VPORT_NEEDS_REG_VPI)) {
4283 			/* If our NportID changed, we need to ensure all
4284 			 * remaining NPORTs get unreg_login'ed so we can
4285 			 * issue unreg_vpi.
4286 			 */
4287 			list_for_each_entry_safe(np, next_np,
4288 				&vport->fc_nodes, nlp_listp) {
4289 				if (np->nlp_state != NLP_STE_NPR_NODE
4290 				   || !(np->nlp_flag & NLP_NPR_ADISC))
4291 					continue;
4292 				spin_lock_irq(shost->host_lock);
4293 				np->nlp_flag &= ~NLP_NPR_ADISC;
4294 				spin_unlock_irq(shost->host_lock);
4295 				lpfc_unreg_rpi(vport, np);
4296 			}
4297 			lpfc_mbx_unreg_vpi(vport);
4298 			vport->fc_flag |= FC_VPORT_NEEDS_REG_VPI;
4299 		}
4300 
4301 		if (vport->fc_flag & FC_VPORT_NEEDS_REG_VPI)
4302 			lpfc_register_new_vport(phba, vport, ndlp);
4303 		else
4304 			lpfc_do_scr_ns_plogi(phba, vport);
4305 
4306 		lpfc_nlp_put(ndlp); /* Free Fabric ndlp for vports */
4307 	}
4308 
4309 out:
4310 	lpfc_els_free_iocb(phba, cmdiocb);
4311 }
4312 
4313 int
4314 lpfc_issue_els_fdisc(struct lpfc_vport *vport, struct lpfc_nodelist *ndlp,
4315 		     uint8_t retry)
4316 {
4317 	struct lpfc_hba *phba = vport->phba;
4318 	IOCB_t *icmd;
4319 	struct lpfc_iocbq *elsiocb;
4320 	struct serv_parm *sp;
4321 	uint8_t *pcmd;
4322 	uint16_t cmdsize;
4323 	int did = ndlp->nlp_DID;
4324 	int rc;
4325 
4326 	cmdsize = (sizeof(uint32_t) + sizeof(struct serv_parm));
4327 	elsiocb = lpfc_prep_els_iocb(vport, 1, cmdsize, retry, ndlp, did,
4328 				     ELS_CMD_FDISC);
4329 	if (!elsiocb) {
4330 		lpfc_vport_set_state(vport, FC_VPORT_FAILED);
4331 
4332 		lpfc_printf_log(phba, KERN_ERR, LOG_ELS,
4333 			"%d (%d):0255 Issue FDISC: no IOCB\n",
4334 			phba->brd_no, vport->vpi);
4335 		return 1;
4336 	}
4337 
4338 	icmd = &elsiocb->iocb;
4339 	icmd->un.elsreq64.myID = 0;
4340 	icmd->un.elsreq64.fl = 1;
4341 
4342 	/* For FDISC, Let FDISC rsp set the NPortID for this VPI */
4343 	icmd->ulpCt_h = 1;
4344 	icmd->ulpCt_l = 0;
4345 
4346 	pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
4347 	*((uint32_t *) (pcmd)) = ELS_CMD_FDISC;
4348 	pcmd += sizeof(uint32_t); /* CSP Word 1 */
4349 	memcpy(pcmd, &vport->phba->pport->fc_sparam, sizeof(struct serv_parm));
4350 	sp = (struct serv_parm *) pcmd;
4351 	/* Setup CSPs accordingly for Fabric */
4352 	sp->cmn.e_d_tov = 0;
4353 	sp->cmn.w2.r_a_tov = 0;
4354 	sp->cls1.classValid = 0;
4355 	sp->cls2.seqDelivery = 1;
4356 	sp->cls3.seqDelivery = 1;
4357 
4358 	pcmd += sizeof(uint32_t); /* CSP Word 2 */
4359 	pcmd += sizeof(uint32_t); /* CSP Word 3 */
4360 	pcmd += sizeof(uint32_t); /* CSP Word 4 */
4361 	pcmd += sizeof(uint32_t); /* Port Name */
4362 	memcpy(pcmd, &vport->fc_portname, 8);
4363 	pcmd += sizeof(uint32_t); /* Node Name */
4364 	pcmd += sizeof(uint32_t); /* Node Name */
4365 	memcpy(pcmd, &vport->fc_nodename, 8);
4366 
4367 	lpfc_set_disctmo(vport);
4368 
4369 	phba->fc_stat.elsXmitFDISC++;
4370 	elsiocb->iocb_cmpl = lpfc_cmpl_els_fdisc;
4371 
4372 	lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
4373 		"Issue FDISC:     did:x%x",
4374 		did, 0, 0);
4375 
4376 	rc = lpfc_issue_fabric_iocb(phba, elsiocb);
4377 	if (rc == IOCB_ERROR) {
4378 		lpfc_els_free_iocb(phba, elsiocb);
4379 		lpfc_vport_set_state(vport, FC_VPORT_FAILED);
4380 
4381 		lpfc_printf_log(phba, KERN_ERR, LOG_ELS,
4382 			"%d (%d):0256 Issue FDISC: Cannot send IOCB\n",
4383 			phba->brd_no, vport->vpi);
4384 
4385 		return 1;
4386 	}
4387 	lpfc_vport_set_state(vport, FC_VPORT_INITIALIZING);
4388 	vport->port_state = LPFC_FDISC;
4389 	return 0;
4390 }
4391 
4392 static void
4393 lpfc_cmpl_els_npiv_logo(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
4394 			struct lpfc_iocbq *rspiocb)
4395 {
4396 	struct lpfc_vport *vport = cmdiocb->vport;
4397 	IOCB_t *irsp;
4398 
4399 	irsp = &rspiocb->iocb;
4400 	lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
4401 		"LOGO npiv cmpl:  status:x%x/x%x did:x%x",
4402 		irsp->ulpStatus, irsp->un.ulpWord[4], irsp->un.rcvels.remoteID);
4403 
4404 	lpfc_els_free_iocb(phba, cmdiocb);
4405 	vport->unreg_vpi_cmpl = VPORT_ERROR;
4406 }
4407 
4408 int
4409 lpfc_issue_els_npiv_logo(struct lpfc_vport *vport, struct lpfc_nodelist *ndlp)
4410 {
4411 	struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
4412 	struct lpfc_hba  *phba = vport->phba;
4413 	struct lpfc_sli_ring *pring = &phba->sli.ring[LPFC_ELS_RING];
4414 	IOCB_t *icmd;
4415 	struct lpfc_iocbq *elsiocb;
4416 	uint8_t *pcmd;
4417 	uint16_t cmdsize;
4418 
4419 	cmdsize = 2 * sizeof(uint32_t) + sizeof(struct lpfc_name);
4420 	elsiocb = lpfc_prep_els_iocb(vport, 1, cmdsize, 0, ndlp, ndlp->nlp_DID,
4421 				     ELS_CMD_LOGO);
4422 	if (!elsiocb)
4423 		return 1;
4424 
4425 	icmd = &elsiocb->iocb;
4426 	pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
4427 	*((uint32_t *) (pcmd)) = ELS_CMD_LOGO;
4428 	pcmd += sizeof(uint32_t);
4429 
4430 	/* Fill in LOGO payload */
4431 	*((uint32_t *) (pcmd)) = be32_to_cpu(vport->fc_myDID);
4432 	pcmd += sizeof(uint32_t);
4433 	memcpy(pcmd, &vport->fc_portname, sizeof(struct lpfc_name));
4434 
4435 	lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_ELS_CMD,
4436 		"Issue LOGO npiv  did:x%x flg:x%x",
4437 		ndlp->nlp_DID, ndlp->nlp_flag, 0);
4438 
4439 	elsiocb->iocb_cmpl = lpfc_cmpl_els_npiv_logo;
4440 	spin_lock_irq(shost->host_lock);
4441 	ndlp->nlp_flag |= NLP_LOGO_SND;
4442 	spin_unlock_irq(shost->host_lock);
4443 	if (lpfc_sli_issue_iocb(phba, pring, elsiocb, 0) == IOCB_ERROR) {
4444 		spin_lock_irq(shost->host_lock);
4445 		ndlp->nlp_flag &= ~NLP_LOGO_SND;
4446 		spin_unlock_irq(shost->host_lock);
4447 		lpfc_els_free_iocb(phba, elsiocb);
4448 		return 1;
4449 	}
4450 	return 0;
4451 }
4452 
4453 void
4454 lpfc_fabric_block_timeout(unsigned long ptr)
4455 {
4456 	struct lpfc_hba  *phba = (struct lpfc_hba *) ptr;
4457 	unsigned long iflags;
4458 	uint32_t tmo_posted;
4459 	spin_lock_irqsave(&phba->pport->work_port_lock, iflags);
4460 	tmo_posted = phba->pport->work_port_events & WORKER_FABRIC_BLOCK_TMO;
4461 	if (!tmo_posted)
4462 		phba->pport->work_port_events |= WORKER_FABRIC_BLOCK_TMO;
4463 	spin_unlock_irqrestore(&phba->pport->work_port_lock, iflags);
4464 
4465 	if (!tmo_posted) {
4466 		spin_lock_irqsave(&phba->hbalock, iflags);
4467 		if (phba->work_wait)
4468 			lpfc_worker_wake_up(phba);
4469 		spin_unlock_irqrestore(&phba->hbalock, iflags);
4470 	}
4471 }
4472 
4473 static void
4474 lpfc_resume_fabric_iocbs(struct lpfc_hba *phba)
4475 {
4476 	struct lpfc_iocbq *iocb;
4477 	unsigned long iflags;
4478 	int ret;
4479 	struct lpfc_sli_ring *pring = &phba->sli.ring[LPFC_ELS_RING];
4480 	IOCB_t *cmd;
4481 
4482 repeat:
4483 	iocb = NULL;
4484 	spin_lock_irqsave(&phba->hbalock, iflags);
4485 				/* Post any pending iocb to the SLI layer */
4486 	if (atomic_read(&phba->fabric_iocb_count) == 0) {
4487 		list_remove_head(&phba->fabric_iocb_list, iocb, typeof(*iocb),
4488 				 list);
4489 		if (iocb)
4490 			atomic_inc(&phba->fabric_iocb_count);
4491 	}
4492 	spin_unlock_irqrestore(&phba->hbalock, iflags);
4493 	if (iocb) {
4494 		iocb->fabric_iocb_cmpl = iocb->iocb_cmpl;
4495 		iocb->iocb_cmpl = lpfc_cmpl_fabric_iocb;
4496 		iocb->iocb_flag |= LPFC_IO_FABRIC;
4497 
4498 		lpfc_debugfs_disc_trc(iocb->vport, LPFC_DISC_TRC_ELS_CMD,
4499 			"Fabric sched1:   ste:x%x",
4500 			iocb->vport->port_state, 0, 0);
4501 
4502 		ret = lpfc_sli_issue_iocb(phba, pring, iocb, 0);
4503 
4504 		if (ret == IOCB_ERROR) {
4505 			iocb->iocb_cmpl = iocb->fabric_iocb_cmpl;
4506 			iocb->fabric_iocb_cmpl = NULL;
4507 			iocb->iocb_flag &= ~LPFC_IO_FABRIC;
4508 			cmd = &iocb->iocb;
4509 			cmd->ulpStatus = IOSTAT_LOCAL_REJECT;
4510 			cmd->un.ulpWord[4] = IOERR_SLI_ABORTED;
4511 			iocb->iocb_cmpl(phba, iocb, iocb);
4512 
4513 			atomic_dec(&phba->fabric_iocb_count);
4514 			goto repeat;
4515 		}
4516 	}
4517 
4518 	return;
4519 }
4520 
4521 void
4522 lpfc_unblock_fabric_iocbs(struct lpfc_hba *phba)
4523 {
4524 	clear_bit(FABRIC_COMANDS_BLOCKED, &phba->bit_flags);
4525 
4526 	lpfc_resume_fabric_iocbs(phba);
4527 	return;
4528 }
4529 
4530 static void
4531 lpfc_block_fabric_iocbs(struct lpfc_hba *phba)
4532 {
4533 	int blocked;
4534 
4535 	blocked = test_and_set_bit(FABRIC_COMANDS_BLOCKED, &phba->bit_flags);
4536 				/* Start a timer to unblock fabric
4537 				 * iocbs after 100ms
4538 				 */
4539 	if (!blocked)
4540 		mod_timer(&phba->fabric_block_timer, jiffies + HZ/10 );
4541 
4542 	return;
4543 }
4544 
4545 static void
4546 lpfc_cmpl_fabric_iocb(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
4547 	struct lpfc_iocbq *rspiocb)
4548 {
4549 	struct ls_rjt stat;
4550 
4551 	if ((cmdiocb->iocb_flag & LPFC_IO_FABRIC) != LPFC_IO_FABRIC)
4552 		BUG();
4553 
4554 	switch (rspiocb->iocb.ulpStatus) {
4555 		case IOSTAT_NPORT_RJT:
4556 		case IOSTAT_FABRIC_RJT:
4557 			if (rspiocb->iocb.un.ulpWord[4] & RJT_UNAVAIL_TEMP) {
4558 				lpfc_block_fabric_iocbs(phba);
4559 			}
4560 			break;
4561 
4562 		case IOSTAT_NPORT_BSY:
4563 		case IOSTAT_FABRIC_BSY:
4564 			lpfc_block_fabric_iocbs(phba);
4565 			break;
4566 
4567 		case IOSTAT_LS_RJT:
4568 			stat.un.lsRjtError =
4569 				be32_to_cpu(rspiocb->iocb.un.ulpWord[4]);
4570 			if ((stat.un.b.lsRjtRsnCode == LSRJT_UNABLE_TPC) ||
4571 				(stat.un.b.lsRjtRsnCode == LSRJT_LOGICAL_BSY))
4572 				lpfc_block_fabric_iocbs(phba);
4573 			break;
4574 	}
4575 
4576 	if (atomic_read(&phba->fabric_iocb_count) == 0)
4577 		BUG();
4578 
4579 	cmdiocb->iocb_cmpl = cmdiocb->fabric_iocb_cmpl;
4580 	cmdiocb->fabric_iocb_cmpl = NULL;
4581 	cmdiocb->iocb_flag &= ~LPFC_IO_FABRIC;
4582 	cmdiocb->iocb_cmpl(phba, cmdiocb, rspiocb);
4583 
4584 	atomic_dec(&phba->fabric_iocb_count);
4585 	if (!test_bit(FABRIC_COMANDS_BLOCKED, &phba->bit_flags)) {
4586 				/* Post any pending iocbs to HBA */
4587 		    lpfc_resume_fabric_iocbs(phba);
4588 	}
4589 }
4590 
4591 int
4592 lpfc_issue_fabric_iocb(struct lpfc_hba *phba, struct lpfc_iocbq *iocb)
4593 {
4594 	unsigned long iflags;
4595 	struct lpfc_sli_ring *pring = &phba->sli.ring[LPFC_ELS_RING];
4596 	int ready;
4597 	int ret;
4598 
4599 	if (atomic_read(&phba->fabric_iocb_count) > 1)
4600 		BUG();
4601 
4602 	spin_lock_irqsave(&phba->hbalock, iflags);
4603 	ready = atomic_read(&phba->fabric_iocb_count) == 0 &&
4604 		!test_bit(FABRIC_COMANDS_BLOCKED, &phba->bit_flags);
4605 
4606 	spin_unlock_irqrestore(&phba->hbalock, iflags);
4607 	if (ready) {
4608 		iocb->fabric_iocb_cmpl = iocb->iocb_cmpl;
4609 		iocb->iocb_cmpl = lpfc_cmpl_fabric_iocb;
4610 		iocb->iocb_flag |= LPFC_IO_FABRIC;
4611 
4612 		lpfc_debugfs_disc_trc(iocb->vport, LPFC_DISC_TRC_ELS_CMD,
4613 			"Fabric sched2:   ste:x%x",
4614 			iocb->vport->port_state, 0, 0);
4615 
4616 		atomic_inc(&phba->fabric_iocb_count);
4617 		ret = lpfc_sli_issue_iocb(phba, pring, iocb, 0);
4618 
4619 		if (ret == IOCB_ERROR) {
4620 			iocb->iocb_cmpl = iocb->fabric_iocb_cmpl;
4621 			iocb->fabric_iocb_cmpl = NULL;
4622 			iocb->iocb_flag &= ~LPFC_IO_FABRIC;
4623 			atomic_dec(&phba->fabric_iocb_count);
4624 		}
4625 	} else {
4626 		spin_lock_irqsave(&phba->hbalock, iflags);
4627 		list_add_tail(&iocb->list, &phba->fabric_iocb_list);
4628 		spin_unlock_irqrestore(&phba->hbalock, iflags);
4629 		ret = IOCB_SUCCESS;
4630 	}
4631 	return ret;
4632 }
4633 
4634 
4635 void lpfc_fabric_abort_vport(struct lpfc_vport *vport)
4636 {
4637 	LIST_HEAD(completions);
4638 	struct lpfc_hba  *phba = vport->phba;
4639 	struct lpfc_iocbq *tmp_iocb, *piocb;
4640 	IOCB_t *cmd;
4641 
4642 	spin_lock_irq(&phba->hbalock);
4643 	list_for_each_entry_safe(piocb, tmp_iocb, &phba->fabric_iocb_list,
4644 				 list) {
4645 
4646 		if (piocb->vport != vport)
4647 			continue;
4648 
4649 		list_move_tail(&piocb->list, &completions);
4650 	}
4651 	spin_unlock_irq(&phba->hbalock);
4652 
4653 	while (!list_empty(&completions)) {
4654 		piocb = list_get_first(&completions, struct lpfc_iocbq, list);
4655 		list_del_init(&piocb->list);
4656 
4657 		cmd = &piocb->iocb;
4658 		cmd->ulpStatus = IOSTAT_LOCAL_REJECT;
4659 		cmd->un.ulpWord[4] = IOERR_SLI_ABORTED;
4660 		(piocb->iocb_cmpl) (phba, piocb, piocb);
4661 	}
4662 }
4663 
4664 void lpfc_fabric_abort_nport(struct lpfc_nodelist *ndlp)
4665 {
4666 	LIST_HEAD(completions);
4667 	struct lpfc_hba  *phba = ndlp->vport->phba;
4668 	struct lpfc_iocbq *tmp_iocb, *piocb;
4669 	struct lpfc_sli_ring *pring = &phba->sli.ring[LPFC_ELS_RING];
4670 	IOCB_t *cmd;
4671 
4672 	spin_lock_irq(&phba->hbalock);
4673 	list_for_each_entry_safe(piocb, tmp_iocb, &phba->fabric_iocb_list,
4674 				 list) {
4675 		if ((lpfc_check_sli_ndlp(phba, pring, piocb, ndlp))) {
4676 
4677 			list_move_tail(&piocb->list, &completions);
4678 		}
4679 	}
4680 	spin_unlock_irq(&phba->hbalock);
4681 
4682 	while (!list_empty(&completions)) {
4683 		piocb = list_get_first(&completions, struct lpfc_iocbq, list);
4684 		list_del_init(&piocb->list);
4685 
4686 		cmd = &piocb->iocb;
4687 		cmd->ulpStatus = IOSTAT_LOCAL_REJECT;
4688 		cmd->un.ulpWord[4] = IOERR_SLI_ABORTED;
4689 		(piocb->iocb_cmpl) (phba, piocb, piocb);
4690 	}
4691 }
4692 
4693 void lpfc_fabric_abort_hba(struct lpfc_hba *phba)
4694 {
4695 	LIST_HEAD(completions);
4696 	struct lpfc_iocbq *piocb;
4697 	IOCB_t *cmd;
4698 
4699 	spin_lock_irq(&phba->hbalock);
4700 	list_splice_init(&phba->fabric_iocb_list, &completions);
4701 	spin_unlock_irq(&phba->hbalock);
4702 
4703 	while (!list_empty(&completions)) {
4704 		piocb = list_get_first(&completions, struct lpfc_iocbq, list);
4705 		list_del_init(&piocb->list);
4706 
4707 		cmd = &piocb->iocb;
4708 		cmd->ulpStatus = IOSTAT_LOCAL_REJECT;
4709 		cmd->un.ulpWord[4] = IOERR_SLI_ABORTED;
4710 		(piocb->iocb_cmpl) (phba, piocb, piocb);
4711 	}
4712 }
4713 
4714 
4715 void lpfc_fabric_abort_flogi(struct lpfc_hba *phba)
4716 {
4717 	LIST_HEAD(completions);
4718 	struct lpfc_iocbq *tmp_iocb, *piocb;
4719 	IOCB_t *cmd;
4720 	struct lpfc_nodelist *ndlp;
4721 
4722 	spin_lock_irq(&phba->hbalock);
4723 	list_for_each_entry_safe(piocb, tmp_iocb, &phba->fabric_iocb_list,
4724 				 list) {
4725 
4726 		cmd = &piocb->iocb;
4727 		ndlp = (struct lpfc_nodelist *) piocb->context1;
4728 		if (cmd->ulpCommand == CMD_ELS_REQUEST64_CR &&
4729 		    ndlp != NULL &&
4730 		    ndlp->nlp_DID == Fabric_DID)
4731 			list_move_tail(&piocb->list, &completions);
4732 	}
4733 	spin_unlock_irq(&phba->hbalock);
4734 
4735 	while (!list_empty(&completions)) {
4736 		piocb = list_get_first(&completions, struct lpfc_iocbq, list);
4737 		list_del_init(&piocb->list);
4738 
4739 		cmd = &piocb->iocb;
4740 		cmd->ulpStatus = IOSTAT_LOCAL_REJECT;
4741 		cmd->un.ulpWord[4] = IOERR_SLI_ABORTED;
4742 		(piocb->iocb_cmpl) (phba, piocb, piocb);
4743 	}
4744 }
4745 
4746 
4747