xref: /openbmc/linux/drivers/scsi/qla2xxx/qla_gs.c (revision a72b9869)
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * QLogic Fibre Channel HBA Driver
4  * Copyright (c)  2003-2014 QLogic Corporation
5  */
6 #include "qla_def.h"
7 #include "qla_target.h"
8 #include <linux/utsname.h>
9 
10 static int qla2x00_sns_ga_nxt(scsi_qla_host_t *, fc_port_t *);
11 static int qla2x00_sns_gid_pt(scsi_qla_host_t *, sw_info_t *);
12 static int qla2x00_sns_gpn_id(scsi_qla_host_t *, sw_info_t *);
13 static int qla2x00_sns_gnn_id(scsi_qla_host_t *, sw_info_t *);
14 static int qla2x00_sns_rft_id(scsi_qla_host_t *);
15 static int qla2x00_sns_rnn_id(scsi_qla_host_t *);
16 static int qla_async_rftid(scsi_qla_host_t *, port_id_t *);
17 static int qla_async_rffid(scsi_qla_host_t *, port_id_t *, u8, u8);
18 static int qla_async_rnnid(scsi_qla_host_t *, port_id_t *, u8*);
19 static int qla_async_rsnn_nn(scsi_qla_host_t *);
20 
21 
22 
23 /**
24  * qla2x00_prep_ms_iocb() - Prepare common MS/CT IOCB fields for SNS CT query.
25  * @vha: HA context
26  * @arg: CT arguments
27  *
28  * Returns a pointer to the @vha's ms_iocb.
29  */
30 void *
31 qla2x00_prep_ms_iocb(scsi_qla_host_t *vha, struct ct_arg *arg)
32 {
33 	struct qla_hw_data *ha = vha->hw;
34 	ms_iocb_entry_t *ms_pkt;
35 
36 	ms_pkt = (ms_iocb_entry_t *)arg->iocb;
37 	memset(ms_pkt, 0, sizeof(ms_iocb_entry_t));
38 
39 	ms_pkt->entry_type = MS_IOCB_TYPE;
40 	ms_pkt->entry_count = 1;
41 	SET_TARGET_ID(ha, ms_pkt->loop_id, SIMPLE_NAME_SERVER);
42 	ms_pkt->control_flags = cpu_to_le16(CF_READ | CF_HEAD_TAG);
43 	ms_pkt->timeout = cpu_to_le16(ha->r_a_tov / 10 * 2);
44 	ms_pkt->cmd_dsd_count = cpu_to_le16(1);
45 	ms_pkt->total_dsd_count = cpu_to_le16(2);
46 	ms_pkt->rsp_bytecount = cpu_to_le32(arg->rsp_size);
47 	ms_pkt->req_bytecount = cpu_to_le32(arg->req_size);
48 
49 	put_unaligned_le64(arg->req_dma, &ms_pkt->req_dsd.address);
50 	ms_pkt->req_dsd.length = ms_pkt->req_bytecount;
51 
52 	put_unaligned_le64(arg->rsp_dma, &ms_pkt->rsp_dsd.address);
53 	ms_pkt->rsp_dsd.length = ms_pkt->rsp_bytecount;
54 
55 	vha->qla_stats.control_requests++;
56 
57 	return (ms_pkt);
58 }
59 
60 /**
61  * qla24xx_prep_ms_iocb() - Prepare common CT IOCB fields for SNS CT query.
62  * @vha: HA context
63  * @arg: CT arguments
64  *
65  * Returns a pointer to the @ha's ms_iocb.
66  */
67 void *
68 qla24xx_prep_ms_iocb(scsi_qla_host_t *vha, struct ct_arg *arg)
69 {
70 	struct qla_hw_data *ha = vha->hw;
71 	struct ct_entry_24xx *ct_pkt;
72 
73 	ct_pkt = (struct ct_entry_24xx *)arg->iocb;
74 	memset(ct_pkt, 0, sizeof(struct ct_entry_24xx));
75 
76 	ct_pkt->entry_type = CT_IOCB_TYPE;
77 	ct_pkt->entry_count = 1;
78 	ct_pkt->nport_handle = cpu_to_le16(arg->nport_handle);
79 	ct_pkt->timeout = cpu_to_le16(ha->r_a_tov / 10 * 2);
80 	ct_pkt->cmd_dsd_count = cpu_to_le16(1);
81 	ct_pkt->rsp_dsd_count = cpu_to_le16(1);
82 	ct_pkt->rsp_byte_count = cpu_to_le32(arg->rsp_size);
83 	ct_pkt->cmd_byte_count = cpu_to_le32(arg->req_size);
84 
85 	put_unaligned_le64(arg->req_dma, &ct_pkt->dsd[0].address);
86 	ct_pkt->dsd[0].length = ct_pkt->cmd_byte_count;
87 
88 	put_unaligned_le64(arg->rsp_dma, &ct_pkt->dsd[1].address);
89 	ct_pkt->dsd[1].length = ct_pkt->rsp_byte_count;
90 	ct_pkt->vp_index = vha->vp_idx;
91 
92 	vha->qla_stats.control_requests++;
93 
94 	return (ct_pkt);
95 }
96 
97 /**
98  * qla2x00_prep_ct_req() - Prepare common CT request fields for SNS query.
99  * @p: CT request buffer
100  * @cmd: GS command
101  * @rsp_size: response size in bytes
102  *
103  * Returns a pointer to the intitialized @ct_req.
104  */
105 static inline struct ct_sns_req *
106 qla2x00_prep_ct_req(struct ct_sns_pkt *p, uint16_t cmd, uint16_t rsp_size)
107 {
108 	memset(p, 0, sizeof(struct ct_sns_pkt));
109 
110 	p->p.req.header.revision = 0x01;
111 	p->p.req.header.gs_type = 0xFC;
112 	p->p.req.header.gs_subtype = 0x02;
113 	p->p.req.command = cpu_to_be16(cmd);
114 	p->p.req.max_rsp_size = cpu_to_be16((rsp_size - 16) / 4);
115 
116 	return &p->p.req;
117 }
118 
119 int
120 qla2x00_chk_ms_status(scsi_qla_host_t *vha, ms_iocb_entry_t *ms_pkt,
121     struct ct_sns_rsp *ct_rsp, const char *routine)
122 {
123 	int rval;
124 	uint16_t comp_status;
125 	struct qla_hw_data *ha = vha->hw;
126 	bool lid_is_sns = false;
127 
128 	rval = QLA_FUNCTION_FAILED;
129 	if (ms_pkt->entry_status != 0) {
130 		ql_dbg(ql_dbg_disc, vha, 0x2031,
131 		    "%s failed, error status (%x) on port_id: %02x%02x%02x.\n",
132 		    routine, ms_pkt->entry_status, vha->d_id.b.domain,
133 		    vha->d_id.b.area, vha->d_id.b.al_pa);
134 	} else {
135 		if (IS_FWI2_CAPABLE(ha))
136 			comp_status = le16_to_cpu(
137 			    ((struct ct_entry_24xx *)ms_pkt)->comp_status);
138 		else
139 			comp_status = le16_to_cpu(ms_pkt->status);
140 		switch (comp_status) {
141 		case CS_COMPLETE:
142 		case CS_DATA_UNDERRUN:
143 		case CS_DATA_OVERRUN:		/* Overrun? */
144 			if (ct_rsp->header.response !=
145 			    cpu_to_be16(CT_ACCEPT_RESPONSE)) {
146 				ql_dbg(ql_dbg_disc + ql_dbg_buffer, vha, 0x2077,
147 				    "%s failed rejected request on port_id: %02x%02x%02x Completion status 0x%x, response 0x%x\n",
148 				    routine, vha->d_id.b.domain,
149 				    vha->d_id.b.area, vha->d_id.b.al_pa,
150 				    comp_status, ct_rsp->header.response);
151 				ql_dump_buffer(ql_dbg_disc + ql_dbg_buffer, vha,
152 				    0x2078, ct_rsp,
153 				    offsetof(typeof(*ct_rsp), rsp));
154 				rval = QLA_INVALID_COMMAND;
155 			} else
156 				rval = QLA_SUCCESS;
157 			break;
158 		case CS_PORT_LOGGED_OUT:
159 			if (IS_FWI2_CAPABLE(ha)) {
160 				if (le16_to_cpu(ms_pkt->loop_id.extended) ==
161 				    NPH_SNS)
162 					lid_is_sns = true;
163 			} else {
164 				if (le16_to_cpu(ms_pkt->loop_id.extended) ==
165 				    SIMPLE_NAME_SERVER)
166 					lid_is_sns = true;
167 			}
168 			if (lid_is_sns) {
169 				ql_dbg(ql_dbg_async, vha, 0x502b,
170 					"%s failed, Name server has logged out",
171 					routine);
172 				rval = QLA_NOT_LOGGED_IN;
173 				set_bit(LOOP_RESYNC_NEEDED, &vha->dpc_flags);
174 				set_bit(LOCAL_LOOP_UPDATE, &vha->dpc_flags);
175 			}
176 			break;
177 		case CS_TIMEOUT:
178 			rval = QLA_FUNCTION_TIMEOUT;
179 			fallthrough;
180 		default:
181 			ql_dbg(ql_dbg_disc, vha, 0x2033,
182 			    "%s failed, completion status (%x) on port_id: "
183 			    "%02x%02x%02x.\n", routine, comp_status,
184 			    vha->d_id.b.domain, vha->d_id.b.area,
185 			    vha->d_id.b.al_pa);
186 			break;
187 		}
188 	}
189 	return rval;
190 }
191 
192 /**
193  * qla2x00_ga_nxt() - SNS scan for fabric devices via GA_NXT command.
194  * @vha: HA context
195  * @fcport: fcport entry to updated
196  *
197  * Returns 0 on success.
198  */
199 int
200 qla2x00_ga_nxt(scsi_qla_host_t *vha, fc_port_t *fcport)
201 {
202 	int		rval;
203 
204 	ms_iocb_entry_t	*ms_pkt;
205 	struct ct_sns_req	*ct_req;
206 	struct ct_sns_rsp	*ct_rsp;
207 	struct qla_hw_data *ha = vha->hw;
208 	struct ct_arg arg;
209 
210 	if (IS_QLA2100(ha) || IS_QLA2200(ha))
211 		return qla2x00_sns_ga_nxt(vha, fcport);
212 
213 	arg.iocb = ha->ms_iocb;
214 	arg.req_dma = ha->ct_sns_dma;
215 	arg.rsp_dma = ha->ct_sns_dma;
216 	arg.req_size = GA_NXT_REQ_SIZE;
217 	arg.rsp_size = GA_NXT_RSP_SIZE;
218 	arg.nport_handle = NPH_SNS;
219 
220 	/* Issue GA_NXT */
221 	/* Prepare common MS IOCB */
222 	ms_pkt = ha->isp_ops->prep_ms_iocb(vha, &arg);
223 
224 	/* Prepare CT request */
225 	ct_req = qla2x00_prep_ct_req(ha->ct_sns, GA_NXT_CMD,
226 	    GA_NXT_RSP_SIZE);
227 	ct_rsp = &ha->ct_sns->p.rsp;
228 
229 	/* Prepare CT arguments -- port_id */
230 	ct_req->req.port_id.port_id = port_id_to_be_id(fcport->d_id);
231 
232 	/* Execute MS IOCB */
233 	rval = qla2x00_issue_iocb(vha, ha->ms_iocb, ha->ms_iocb_dma,
234 	    sizeof(ms_iocb_entry_t));
235 	if (rval != QLA_SUCCESS) {
236 		/*EMPTY*/
237 		ql_dbg(ql_dbg_disc, vha, 0x2062,
238 		    "GA_NXT issue IOCB failed (%d).\n", rval);
239 	} else if (qla2x00_chk_ms_status(vha, ms_pkt, ct_rsp, "GA_NXT") !=
240 	    QLA_SUCCESS) {
241 		rval = QLA_FUNCTION_FAILED;
242 	} else {
243 		/* Populate fc_port_t entry. */
244 		fcport->d_id = be_to_port_id(ct_rsp->rsp.ga_nxt.port_id);
245 
246 		memcpy(fcport->node_name, ct_rsp->rsp.ga_nxt.node_name,
247 		    WWN_SIZE);
248 		memcpy(fcport->port_name, ct_rsp->rsp.ga_nxt.port_name,
249 		    WWN_SIZE);
250 
251 		fcport->fc4_type = (ct_rsp->rsp.ga_nxt.fc4_types[2] & BIT_0) ?
252 		    FS_FC4TYPE_FCP : FC4_TYPE_OTHER;
253 
254 		if (ct_rsp->rsp.ga_nxt.port_type != NS_N_PORT_TYPE &&
255 		    ct_rsp->rsp.ga_nxt.port_type != NS_NL_PORT_TYPE)
256 			fcport->d_id.b.domain = 0xf0;
257 
258 		ql_dbg(ql_dbg_disc, vha, 0x2063,
259 		    "GA_NXT entry - nn %8phN pn %8phN "
260 		    "port_id=%02x%02x%02x.\n",
261 		    fcport->node_name, fcport->port_name,
262 		    fcport->d_id.b.domain, fcport->d_id.b.area,
263 		    fcport->d_id.b.al_pa);
264 	}
265 
266 	return (rval);
267 }
268 
269 static inline int
270 qla2x00_gid_pt_rsp_size(scsi_qla_host_t *vha)
271 {
272 	return vha->hw->max_fibre_devices * 4 + 16;
273 }
274 
275 /**
276  * qla2x00_gid_pt() - SNS scan for fabric devices via GID_PT command.
277  * @vha: HA context
278  * @list: switch info entries to populate
279  *
280  * NOTE: Non-Nx_Ports are not requested.
281  *
282  * Returns 0 on success.
283  */
284 int
285 qla2x00_gid_pt(scsi_qla_host_t *vha, sw_info_t *list)
286 {
287 	int		rval;
288 	uint16_t	i;
289 
290 	ms_iocb_entry_t	*ms_pkt;
291 	struct ct_sns_req	*ct_req;
292 	struct ct_sns_rsp	*ct_rsp;
293 
294 	struct ct_sns_gid_pt_data *gid_data;
295 	struct qla_hw_data *ha = vha->hw;
296 	uint16_t gid_pt_rsp_size;
297 	struct ct_arg arg;
298 
299 	if (IS_QLA2100(ha) || IS_QLA2200(ha))
300 		return qla2x00_sns_gid_pt(vha, list);
301 
302 	gid_data = NULL;
303 	gid_pt_rsp_size = qla2x00_gid_pt_rsp_size(vha);
304 
305 	arg.iocb = ha->ms_iocb;
306 	arg.req_dma = ha->ct_sns_dma;
307 	arg.rsp_dma = ha->ct_sns_dma;
308 	arg.req_size = GID_PT_REQ_SIZE;
309 	arg.rsp_size = gid_pt_rsp_size;
310 	arg.nport_handle = NPH_SNS;
311 
312 	/* Issue GID_PT */
313 	/* Prepare common MS IOCB */
314 	ms_pkt = ha->isp_ops->prep_ms_iocb(vha, &arg);
315 
316 	/* Prepare CT request */
317 	ct_req = qla2x00_prep_ct_req(ha->ct_sns, GID_PT_CMD, gid_pt_rsp_size);
318 	ct_rsp = &ha->ct_sns->p.rsp;
319 
320 	/* Prepare CT arguments -- port_type */
321 	ct_req->req.gid_pt.port_type = NS_NX_PORT_TYPE;
322 
323 	/* Execute MS IOCB */
324 	rval = qla2x00_issue_iocb(vha, ha->ms_iocb, ha->ms_iocb_dma,
325 	    sizeof(ms_iocb_entry_t));
326 	if (rval != QLA_SUCCESS) {
327 		/*EMPTY*/
328 		ql_dbg(ql_dbg_disc, vha, 0x2055,
329 		    "GID_PT issue IOCB failed (%d).\n", rval);
330 	} else if (qla2x00_chk_ms_status(vha, ms_pkt, ct_rsp, "GID_PT") !=
331 	    QLA_SUCCESS) {
332 		rval = QLA_FUNCTION_FAILED;
333 	} else {
334 		/* Set port IDs in switch info list. */
335 		for (i = 0; i < ha->max_fibre_devices; i++) {
336 			gid_data = &ct_rsp->rsp.gid_pt.entries[i];
337 			list[i].d_id = be_to_port_id(gid_data->port_id);
338 			memset(list[i].fabric_port_name, 0, WWN_SIZE);
339 			list[i].fp_speed = PORT_SPEED_UNKNOWN;
340 
341 			/* Last one exit. */
342 			if (gid_data->control_byte & BIT_7) {
343 				list[i].d_id.b.rsvd_1 = gid_data->control_byte;
344 				break;
345 			}
346 		}
347 
348 		/*
349 		 * If we've used all available slots, then the switch is
350 		 * reporting back more devices than we can handle with this
351 		 * single call.  Return a failed status, and let GA_NXT handle
352 		 * the overload.
353 		 */
354 		if (i == ha->max_fibre_devices)
355 			rval = QLA_FUNCTION_FAILED;
356 	}
357 
358 	return (rval);
359 }
360 
361 /**
362  * qla2x00_gpn_id() - SNS Get Port Name (GPN_ID) query.
363  * @vha: HA context
364  * @list: switch info entries to populate
365  *
366  * Returns 0 on success.
367  */
368 int
369 qla2x00_gpn_id(scsi_qla_host_t *vha, sw_info_t *list)
370 {
371 	int		rval = QLA_SUCCESS;
372 	uint16_t	i;
373 
374 	ms_iocb_entry_t	*ms_pkt;
375 	struct ct_sns_req	*ct_req;
376 	struct ct_sns_rsp	*ct_rsp;
377 	struct qla_hw_data *ha = vha->hw;
378 	struct ct_arg arg;
379 
380 	if (IS_QLA2100(ha) || IS_QLA2200(ha))
381 		return qla2x00_sns_gpn_id(vha, list);
382 
383 	arg.iocb = ha->ms_iocb;
384 	arg.req_dma = ha->ct_sns_dma;
385 	arg.rsp_dma = ha->ct_sns_dma;
386 	arg.req_size = GPN_ID_REQ_SIZE;
387 	arg.rsp_size = GPN_ID_RSP_SIZE;
388 	arg.nport_handle = NPH_SNS;
389 
390 	for (i = 0; i < ha->max_fibre_devices; i++) {
391 		/* Issue GPN_ID */
392 		/* Prepare common MS IOCB */
393 		ms_pkt = ha->isp_ops->prep_ms_iocb(vha, &arg);
394 
395 		/* Prepare CT request */
396 		ct_req = qla2x00_prep_ct_req(ha->ct_sns, GPN_ID_CMD,
397 		    GPN_ID_RSP_SIZE);
398 		ct_rsp = &ha->ct_sns->p.rsp;
399 
400 		/* Prepare CT arguments -- port_id */
401 		ct_req->req.port_id.port_id = port_id_to_be_id(list[i].d_id);
402 
403 		/* Execute MS IOCB */
404 		rval = qla2x00_issue_iocb(vha, ha->ms_iocb, ha->ms_iocb_dma,
405 		    sizeof(ms_iocb_entry_t));
406 		if (rval != QLA_SUCCESS) {
407 			/*EMPTY*/
408 			ql_dbg(ql_dbg_disc, vha, 0x2056,
409 			    "GPN_ID issue IOCB failed (%d).\n", rval);
410 			break;
411 		} else if (qla2x00_chk_ms_status(vha, ms_pkt, ct_rsp,
412 		    "GPN_ID") != QLA_SUCCESS) {
413 			rval = QLA_FUNCTION_FAILED;
414 			break;
415 		} else {
416 			/* Save portname */
417 			memcpy(list[i].port_name,
418 			    ct_rsp->rsp.gpn_id.port_name, WWN_SIZE);
419 		}
420 
421 		/* Last device exit. */
422 		if (list[i].d_id.b.rsvd_1 != 0)
423 			break;
424 	}
425 
426 	return (rval);
427 }
428 
429 /**
430  * qla2x00_gnn_id() - SNS Get Node Name (GNN_ID) query.
431  * @vha: HA context
432  * @list: switch info entries to populate
433  *
434  * Returns 0 on success.
435  */
436 int
437 qla2x00_gnn_id(scsi_qla_host_t *vha, sw_info_t *list)
438 {
439 	int		rval = QLA_SUCCESS;
440 	uint16_t	i;
441 	struct qla_hw_data *ha = vha->hw;
442 	ms_iocb_entry_t	*ms_pkt;
443 	struct ct_sns_req	*ct_req;
444 	struct ct_sns_rsp	*ct_rsp;
445 	struct ct_arg arg;
446 
447 	if (IS_QLA2100(ha) || IS_QLA2200(ha))
448 		return qla2x00_sns_gnn_id(vha, list);
449 
450 	arg.iocb = ha->ms_iocb;
451 	arg.req_dma = ha->ct_sns_dma;
452 	arg.rsp_dma = ha->ct_sns_dma;
453 	arg.req_size = GNN_ID_REQ_SIZE;
454 	arg.rsp_size = GNN_ID_RSP_SIZE;
455 	arg.nport_handle = NPH_SNS;
456 
457 	for (i = 0; i < ha->max_fibre_devices; i++) {
458 		/* Issue GNN_ID */
459 		/* Prepare common MS IOCB */
460 		ms_pkt = ha->isp_ops->prep_ms_iocb(vha, &arg);
461 
462 		/* Prepare CT request */
463 		ct_req = qla2x00_prep_ct_req(ha->ct_sns, GNN_ID_CMD,
464 		    GNN_ID_RSP_SIZE);
465 		ct_rsp = &ha->ct_sns->p.rsp;
466 
467 		/* Prepare CT arguments -- port_id */
468 		ct_req->req.port_id.port_id = port_id_to_be_id(list[i].d_id);
469 
470 		/* Execute MS IOCB */
471 		rval = qla2x00_issue_iocb(vha, ha->ms_iocb, ha->ms_iocb_dma,
472 		    sizeof(ms_iocb_entry_t));
473 		if (rval != QLA_SUCCESS) {
474 			/*EMPTY*/
475 			ql_dbg(ql_dbg_disc, vha, 0x2057,
476 			    "GNN_ID issue IOCB failed (%d).\n", rval);
477 			break;
478 		} else if (qla2x00_chk_ms_status(vha, ms_pkt, ct_rsp,
479 		    "GNN_ID") != QLA_SUCCESS) {
480 			rval = QLA_FUNCTION_FAILED;
481 			break;
482 		} else {
483 			/* Save nodename */
484 			memcpy(list[i].node_name,
485 			    ct_rsp->rsp.gnn_id.node_name, WWN_SIZE);
486 
487 			ql_dbg(ql_dbg_disc, vha, 0x2058,
488 			    "GID_PT entry - nn %8phN pn %8phN "
489 			    "portid=%02x%02x%02x.\n",
490 			    list[i].node_name, list[i].port_name,
491 			    list[i].d_id.b.domain, list[i].d_id.b.area,
492 			    list[i].d_id.b.al_pa);
493 		}
494 
495 		/* Last device exit. */
496 		if (list[i].d_id.b.rsvd_1 != 0)
497 			break;
498 	}
499 
500 	return (rval);
501 }
502 
503 static void qla2x00_async_sns_sp_done(srb_t *sp, int rc)
504 {
505 	struct scsi_qla_host *vha = sp->vha;
506 	struct ct_sns_pkt *ct_sns;
507 	struct qla_work_evt *e;
508 
509 	sp->rc = rc;
510 	if (rc == QLA_SUCCESS) {
511 		ql_dbg(ql_dbg_disc, vha, 0x204f,
512 		    "Async done-%s exiting normally.\n",
513 		    sp->name);
514 	} else if (rc == QLA_FUNCTION_TIMEOUT) {
515 		ql_dbg(ql_dbg_disc, vha, 0x204f,
516 		    "Async done-%s timeout\n", sp->name);
517 	} else {
518 		ct_sns = (struct ct_sns_pkt *)sp->u.iocb_cmd.u.ctarg.rsp;
519 		memset(ct_sns, 0, sizeof(*ct_sns));
520 		sp->retry_count++;
521 		if (sp->retry_count > 3)
522 			goto err;
523 
524 		ql_dbg(ql_dbg_disc, vha, 0x204f,
525 		    "Async done-%s fail rc %x.  Retry count %d\n",
526 		    sp->name, rc, sp->retry_count);
527 
528 		e = qla2x00_alloc_work(vha, QLA_EVT_SP_RETRY);
529 		if (!e)
530 			goto err2;
531 
532 		e->u.iosb.sp = sp;
533 		qla2x00_post_work(vha, e);
534 		return;
535 	}
536 
537 err:
538 	e = qla2x00_alloc_work(vha, QLA_EVT_UNMAP);
539 err2:
540 	if (!e) {
541 		/* please ignore kernel warning. otherwise, we have mem leak. */
542 		if (sp->u.iocb_cmd.u.ctarg.req) {
543 			dma_free_coherent(&vha->hw->pdev->dev,
544 			    sp->u.iocb_cmd.u.ctarg.req_allocated_size,
545 			    sp->u.iocb_cmd.u.ctarg.req,
546 			    sp->u.iocb_cmd.u.ctarg.req_dma);
547 			sp->u.iocb_cmd.u.ctarg.req = NULL;
548 		}
549 
550 		if (sp->u.iocb_cmd.u.ctarg.rsp) {
551 			dma_free_coherent(&vha->hw->pdev->dev,
552 			    sp->u.iocb_cmd.u.ctarg.rsp_allocated_size,
553 			    sp->u.iocb_cmd.u.ctarg.rsp,
554 			    sp->u.iocb_cmd.u.ctarg.rsp_dma);
555 			sp->u.iocb_cmd.u.ctarg.rsp = NULL;
556 		}
557 
558 		/* ref: INIT */
559 		kref_put(&sp->cmd_kref, qla2x00_sp_release);
560 		return;
561 	}
562 
563 	e->u.iosb.sp = sp;
564 	qla2x00_post_work(vha, e);
565 }
566 
567 /**
568  * qla2x00_rft_id() - SNS Register FC-4 TYPEs (RFT_ID) supported by the HBA.
569  * @vha: HA context
570  *
571  * Returns 0 on success.
572  */
573 int
574 qla2x00_rft_id(scsi_qla_host_t *vha)
575 {
576 	struct qla_hw_data *ha = vha->hw;
577 
578 	if (IS_QLA2100(ha) || IS_QLA2200(ha))
579 		return qla2x00_sns_rft_id(vha);
580 
581 	return qla_async_rftid(vha, &vha->d_id);
582 }
583 
584 static int qla_async_rftid(scsi_qla_host_t *vha, port_id_t *d_id)
585 {
586 	int rval = QLA_MEMORY_ALLOC_FAILED;
587 	struct ct_sns_req *ct_req;
588 	srb_t *sp;
589 	struct ct_sns_pkt *ct_sns;
590 
591 	if (!vha->flags.online)
592 		goto done;
593 
594 	/* ref: INIT */
595 	sp = qla2x00_get_sp(vha, NULL, GFP_KERNEL);
596 	if (!sp)
597 		goto done;
598 
599 	sp->type = SRB_CT_PTHRU_CMD;
600 	sp->name = "rft_id";
601 	qla2x00_init_async_sp(sp, qla2x00_get_async_timeout(vha) + 2,
602 			      qla2x00_async_sns_sp_done);
603 
604 	sp->u.iocb_cmd.u.ctarg.req = dma_alloc_coherent(&vha->hw->pdev->dev,
605 	    sizeof(struct ct_sns_pkt), &sp->u.iocb_cmd.u.ctarg.req_dma,
606 	    GFP_KERNEL);
607 	sp->u.iocb_cmd.u.ctarg.req_allocated_size = sizeof(struct ct_sns_pkt);
608 	if (!sp->u.iocb_cmd.u.ctarg.req) {
609 		ql_log(ql_log_warn, vha, 0xd041,
610 		    "%s: Failed to allocate ct_sns request.\n",
611 		    __func__);
612 		goto done_free_sp;
613 	}
614 
615 	sp->u.iocb_cmd.u.ctarg.rsp = dma_alloc_coherent(&vha->hw->pdev->dev,
616 	    sizeof(struct ct_sns_pkt), &sp->u.iocb_cmd.u.ctarg.rsp_dma,
617 	    GFP_KERNEL);
618 	sp->u.iocb_cmd.u.ctarg.rsp_allocated_size = sizeof(struct ct_sns_pkt);
619 	if (!sp->u.iocb_cmd.u.ctarg.rsp) {
620 		ql_log(ql_log_warn, vha, 0xd042,
621 		    "%s: Failed to allocate ct_sns request.\n",
622 		    __func__);
623 		goto done_free_sp;
624 	}
625 	ct_sns = (struct ct_sns_pkt *)sp->u.iocb_cmd.u.ctarg.rsp;
626 	memset(ct_sns, 0, sizeof(*ct_sns));
627 	ct_sns = (struct ct_sns_pkt *)sp->u.iocb_cmd.u.ctarg.req;
628 
629 	/* Prepare CT request */
630 	ct_req = qla2x00_prep_ct_req(ct_sns, RFT_ID_CMD, RFT_ID_RSP_SIZE);
631 
632 	/* Prepare CT arguments -- port_id, FC-4 types */
633 	ct_req->req.rft_id.port_id = port_id_to_be_id(vha->d_id);
634 	ct_req->req.rft_id.fc4_types[2] = 0x01;		/* FCP-3 */
635 
636 	if (vha->flags.nvme_enabled && qla_ini_mode_enabled(vha))
637 		ct_req->req.rft_id.fc4_types[6] = 1;    /* NVMe type 28h */
638 
639 	sp->u.iocb_cmd.u.ctarg.req_size = RFT_ID_REQ_SIZE;
640 	sp->u.iocb_cmd.u.ctarg.rsp_size = RFT_ID_RSP_SIZE;
641 	sp->u.iocb_cmd.u.ctarg.nport_handle = NPH_SNS;
642 
643 	ql_dbg(ql_dbg_disc, vha, 0xffff,
644 	    "Async-%s - hdl=%x portid %06x.\n",
645 	    sp->name, sp->handle, d_id->b24);
646 
647 	rval = qla2x00_start_sp(sp);
648 	if (rval != QLA_SUCCESS) {
649 		ql_dbg(ql_dbg_disc, vha, 0x2043,
650 		    "RFT_ID issue IOCB failed (%d).\n", rval);
651 		goto done_free_sp;
652 	}
653 	return rval;
654 done_free_sp:
655 	/* ref: INIT */
656 	kref_put(&sp->cmd_kref, qla2x00_sp_release);
657 done:
658 	return rval;
659 }
660 
661 /**
662  * qla2x00_rff_id() - SNS Register FC-4 Features (RFF_ID) supported by the HBA.
663  * @vha: HA context
664  * @type: not used
665  *
666  * Returns 0 on success.
667  */
668 int
669 qla2x00_rff_id(scsi_qla_host_t *vha, u8 type)
670 {
671 	struct qla_hw_data *ha = vha->hw;
672 
673 	if (IS_QLA2100(ha) || IS_QLA2200(ha)) {
674 		ql_dbg(ql_dbg_disc, vha, 0x2046,
675 		    "RFF_ID call not supported on ISP2100/ISP2200.\n");
676 		return (QLA_SUCCESS);
677 	}
678 
679 	return qla_async_rffid(vha, &vha->d_id, qlt_rff_id(vha), type);
680 }
681 
682 static int qla_async_rffid(scsi_qla_host_t *vha, port_id_t *d_id,
683     u8 fc4feature, u8 fc4type)
684 {
685 	int rval = QLA_MEMORY_ALLOC_FAILED;
686 	struct ct_sns_req *ct_req;
687 	srb_t *sp;
688 	struct ct_sns_pkt *ct_sns;
689 
690 	/* ref: INIT */
691 	sp = qla2x00_get_sp(vha, NULL, GFP_KERNEL);
692 	if (!sp)
693 		goto done;
694 
695 	sp->type = SRB_CT_PTHRU_CMD;
696 	sp->name = "rff_id";
697 	qla2x00_init_async_sp(sp, qla2x00_get_async_timeout(vha) + 2,
698 			      qla2x00_async_sns_sp_done);
699 
700 	sp->u.iocb_cmd.u.ctarg.req = dma_alloc_coherent(&vha->hw->pdev->dev,
701 	    sizeof(struct ct_sns_pkt), &sp->u.iocb_cmd.u.ctarg.req_dma,
702 	    GFP_KERNEL);
703 	sp->u.iocb_cmd.u.ctarg.req_allocated_size = sizeof(struct ct_sns_pkt);
704 	if (!sp->u.iocb_cmd.u.ctarg.req) {
705 		ql_log(ql_log_warn, vha, 0xd041,
706 		    "%s: Failed to allocate ct_sns request.\n",
707 		    __func__);
708 		goto done_free_sp;
709 	}
710 
711 	sp->u.iocb_cmd.u.ctarg.rsp = dma_alloc_coherent(&vha->hw->pdev->dev,
712 	    sizeof(struct ct_sns_pkt), &sp->u.iocb_cmd.u.ctarg.rsp_dma,
713 	    GFP_KERNEL);
714 	sp->u.iocb_cmd.u.ctarg.rsp_allocated_size = sizeof(struct ct_sns_pkt);
715 	if (!sp->u.iocb_cmd.u.ctarg.rsp) {
716 		ql_log(ql_log_warn, vha, 0xd042,
717 		    "%s: Failed to allocate ct_sns request.\n",
718 		    __func__);
719 		goto done_free_sp;
720 	}
721 	ct_sns = (struct ct_sns_pkt *)sp->u.iocb_cmd.u.ctarg.rsp;
722 	memset(ct_sns, 0, sizeof(*ct_sns));
723 	ct_sns = (struct ct_sns_pkt *)sp->u.iocb_cmd.u.ctarg.req;
724 
725 	/* Prepare CT request */
726 	ct_req = qla2x00_prep_ct_req(ct_sns, RFF_ID_CMD, RFF_ID_RSP_SIZE);
727 
728 	/* Prepare CT arguments -- port_id, FC-4 feature, FC-4 type */
729 	ct_req->req.rff_id.port_id = port_id_to_be_id(*d_id);
730 	ct_req->req.rff_id.fc4_feature = fc4feature;
731 	ct_req->req.rff_id.fc4_type = fc4type;		/* SCSI-FCP or FC-NVMe */
732 
733 	sp->u.iocb_cmd.u.ctarg.req_size = RFF_ID_REQ_SIZE;
734 	sp->u.iocb_cmd.u.ctarg.rsp_size = RFF_ID_RSP_SIZE;
735 	sp->u.iocb_cmd.u.ctarg.nport_handle = NPH_SNS;
736 
737 	ql_dbg(ql_dbg_disc, vha, 0xffff,
738 	    "Async-%s - hdl=%x portid %06x feature %x type %x.\n",
739 	    sp->name, sp->handle, d_id->b24, fc4feature, fc4type);
740 
741 	rval = qla2x00_start_sp(sp);
742 	if (rval != QLA_SUCCESS) {
743 		ql_dbg(ql_dbg_disc, vha, 0x2047,
744 		    "RFF_ID issue IOCB failed (%d).\n", rval);
745 		goto done_free_sp;
746 	}
747 
748 	return rval;
749 
750 done_free_sp:
751 	/* ref: INIT */
752 	kref_put(&sp->cmd_kref, qla2x00_sp_release);
753 done:
754 	return rval;
755 }
756 
757 /**
758  * qla2x00_rnn_id() - SNS Register Node Name (RNN_ID) of the HBA.
759  * @vha: HA context
760  *
761  * Returns 0 on success.
762  */
763 int
764 qla2x00_rnn_id(scsi_qla_host_t *vha)
765 {
766 	struct qla_hw_data *ha = vha->hw;
767 
768 	if (IS_QLA2100(ha) || IS_QLA2200(ha))
769 		return qla2x00_sns_rnn_id(vha);
770 
771 	return  qla_async_rnnid(vha, &vha->d_id, vha->node_name);
772 }
773 
774 static int qla_async_rnnid(scsi_qla_host_t *vha, port_id_t *d_id,
775 	u8 *node_name)
776 {
777 	int rval = QLA_MEMORY_ALLOC_FAILED;
778 	struct ct_sns_req *ct_req;
779 	srb_t *sp;
780 	struct ct_sns_pkt *ct_sns;
781 
782 	/* ref: INIT */
783 	sp = qla2x00_get_sp(vha, NULL, GFP_KERNEL);
784 	if (!sp)
785 		goto done;
786 
787 	sp->type = SRB_CT_PTHRU_CMD;
788 	sp->name = "rnid";
789 	qla2x00_init_async_sp(sp, qla2x00_get_async_timeout(vha) + 2,
790 			      qla2x00_async_sns_sp_done);
791 
792 	sp->u.iocb_cmd.u.ctarg.req = dma_alloc_coherent(&vha->hw->pdev->dev,
793 	    sizeof(struct ct_sns_pkt), &sp->u.iocb_cmd.u.ctarg.req_dma,
794 	    GFP_KERNEL);
795 	sp->u.iocb_cmd.u.ctarg.req_allocated_size = sizeof(struct ct_sns_pkt);
796 	if (!sp->u.iocb_cmd.u.ctarg.req) {
797 		ql_log(ql_log_warn, vha, 0xd041,
798 		    "%s: Failed to allocate ct_sns request.\n",
799 		    __func__);
800 		goto done_free_sp;
801 	}
802 
803 	sp->u.iocb_cmd.u.ctarg.rsp = dma_alloc_coherent(&vha->hw->pdev->dev,
804 	    sizeof(struct ct_sns_pkt), &sp->u.iocb_cmd.u.ctarg.rsp_dma,
805 	    GFP_KERNEL);
806 	sp->u.iocb_cmd.u.ctarg.rsp_allocated_size = sizeof(struct ct_sns_pkt);
807 	if (!sp->u.iocb_cmd.u.ctarg.rsp) {
808 		ql_log(ql_log_warn, vha, 0xd042,
809 		    "%s: Failed to allocate ct_sns request.\n",
810 		    __func__);
811 		goto done_free_sp;
812 	}
813 	ct_sns = (struct ct_sns_pkt *)sp->u.iocb_cmd.u.ctarg.rsp;
814 	memset(ct_sns, 0, sizeof(*ct_sns));
815 	ct_sns = (struct ct_sns_pkt *)sp->u.iocb_cmd.u.ctarg.req;
816 
817 	/* Prepare CT request */
818 	ct_req = qla2x00_prep_ct_req(ct_sns, RNN_ID_CMD, RNN_ID_RSP_SIZE);
819 
820 	/* Prepare CT arguments -- port_id, node_name */
821 	ct_req->req.rnn_id.port_id = port_id_to_be_id(vha->d_id);
822 	memcpy(ct_req->req.rnn_id.node_name, vha->node_name, WWN_SIZE);
823 
824 	sp->u.iocb_cmd.u.ctarg.req_size = RNN_ID_REQ_SIZE;
825 	sp->u.iocb_cmd.u.ctarg.rsp_size = RNN_ID_RSP_SIZE;
826 	sp->u.iocb_cmd.u.ctarg.nport_handle = NPH_SNS;
827 
828 	ql_dbg(ql_dbg_disc, vha, 0xffff,
829 	    "Async-%s - hdl=%x portid %06x\n",
830 	    sp->name, sp->handle, d_id->b24);
831 
832 	rval = qla2x00_start_sp(sp);
833 	if (rval != QLA_SUCCESS) {
834 		ql_dbg(ql_dbg_disc, vha, 0x204d,
835 		    "RNN_ID issue IOCB failed (%d).\n", rval);
836 		goto done_free_sp;
837 	}
838 
839 	return rval;
840 
841 done_free_sp:
842 	/* ref: INIT */
843 	kref_put(&sp->cmd_kref, qla2x00_sp_release);
844 done:
845 	return rval;
846 }
847 
848 size_t
849 qla2x00_get_sym_node_name(scsi_qla_host_t *vha, uint8_t *snn, size_t size)
850 {
851 	struct qla_hw_data *ha = vha->hw;
852 
853 	if (IS_QLAFX00(ha))
854 		return scnprintf(snn, size, "%s FW:v%s DVR:v%s",
855 		    ha->model_number, ha->mr.fw_version, qla2x00_version_str);
856 
857 	return scnprintf(snn, size, "%s FW:v%d.%02d.%02d DVR:v%s",
858 	    ha->model_number, ha->fw_major_version, ha->fw_minor_version,
859 	    ha->fw_subminor_version, qla2x00_version_str);
860 }
861 
862 /**
863  * qla2x00_rsnn_nn() - SNS Register Symbolic Node Name (RSNN_NN) of the HBA.
864  * @vha: HA context
865  *
866  * Returns 0 on success.
867  */
868 int
869 qla2x00_rsnn_nn(scsi_qla_host_t *vha)
870 {
871 	struct qla_hw_data *ha = vha->hw;
872 
873 	if (IS_QLA2100(ha) || IS_QLA2200(ha)) {
874 		ql_dbg(ql_dbg_disc, vha, 0x2050,
875 		    "RSNN_ID call unsupported on ISP2100/ISP2200.\n");
876 		return (QLA_SUCCESS);
877 	}
878 
879 	return qla_async_rsnn_nn(vha);
880 }
881 
882 static int qla_async_rsnn_nn(scsi_qla_host_t *vha)
883 {
884 	int rval = QLA_MEMORY_ALLOC_FAILED;
885 	struct ct_sns_req *ct_req;
886 	srb_t *sp;
887 	struct ct_sns_pkt *ct_sns;
888 
889 	/* ref: INIT */
890 	sp = qla2x00_get_sp(vha, NULL, GFP_KERNEL);
891 	if (!sp)
892 		goto done;
893 
894 	sp->type = SRB_CT_PTHRU_CMD;
895 	sp->name = "rsnn_nn";
896 	qla2x00_init_async_sp(sp, qla2x00_get_async_timeout(vha) + 2,
897 			      qla2x00_async_sns_sp_done);
898 
899 	sp->u.iocb_cmd.u.ctarg.req = dma_alloc_coherent(&vha->hw->pdev->dev,
900 	    sizeof(struct ct_sns_pkt), &sp->u.iocb_cmd.u.ctarg.req_dma,
901 	    GFP_KERNEL);
902 	sp->u.iocb_cmd.u.ctarg.req_allocated_size = sizeof(struct ct_sns_pkt);
903 	if (!sp->u.iocb_cmd.u.ctarg.req) {
904 		ql_log(ql_log_warn, vha, 0xd041,
905 		    "%s: Failed to allocate ct_sns request.\n",
906 		    __func__);
907 		goto done_free_sp;
908 	}
909 
910 	sp->u.iocb_cmd.u.ctarg.rsp = dma_alloc_coherent(&vha->hw->pdev->dev,
911 	    sizeof(struct ct_sns_pkt), &sp->u.iocb_cmd.u.ctarg.rsp_dma,
912 	    GFP_KERNEL);
913 	sp->u.iocb_cmd.u.ctarg.rsp_allocated_size = sizeof(struct ct_sns_pkt);
914 	if (!sp->u.iocb_cmd.u.ctarg.rsp) {
915 		ql_log(ql_log_warn, vha, 0xd042,
916 		    "%s: Failed to allocate ct_sns request.\n",
917 		    __func__);
918 		goto done_free_sp;
919 	}
920 	ct_sns = (struct ct_sns_pkt *)sp->u.iocb_cmd.u.ctarg.rsp;
921 	memset(ct_sns, 0, sizeof(*ct_sns));
922 	ct_sns = (struct ct_sns_pkt *)sp->u.iocb_cmd.u.ctarg.req;
923 
924 	/* Prepare CT request */
925 	ct_req = qla2x00_prep_ct_req(ct_sns, RSNN_NN_CMD, RSNN_NN_RSP_SIZE);
926 
927 	/* Prepare CT arguments -- node_name, symbolic node_name, size */
928 	memcpy(ct_req->req.rsnn_nn.node_name, vha->node_name, WWN_SIZE);
929 
930 	/* Prepare the Symbolic Node Name */
931 	qla2x00_get_sym_node_name(vha, ct_req->req.rsnn_nn.sym_node_name,
932 	    sizeof(ct_req->req.rsnn_nn.sym_node_name));
933 	ct_req->req.rsnn_nn.name_len =
934 	    (uint8_t)strlen(ct_req->req.rsnn_nn.sym_node_name);
935 
936 
937 	sp->u.iocb_cmd.u.ctarg.req_size = 24 + 1 + ct_req->req.rsnn_nn.name_len;
938 	sp->u.iocb_cmd.u.ctarg.rsp_size = RSNN_NN_RSP_SIZE;
939 	sp->u.iocb_cmd.u.ctarg.nport_handle = NPH_SNS;
940 
941 	ql_dbg(ql_dbg_disc, vha, 0xffff,
942 	    "Async-%s - hdl=%x.\n",
943 	    sp->name, sp->handle);
944 
945 	rval = qla2x00_start_sp(sp);
946 	if (rval != QLA_SUCCESS) {
947 		ql_dbg(ql_dbg_disc, vha, 0x2043,
948 		    "RFT_ID issue IOCB failed (%d).\n", rval);
949 		goto done_free_sp;
950 	}
951 
952 	return rval;
953 
954 done_free_sp:
955 	/* ref: INIT */
956 	kref_put(&sp->cmd_kref, qla2x00_sp_release);
957 done:
958 	return rval;
959 }
960 
961 /**
962  * qla2x00_prep_sns_cmd() - Prepare common SNS command request fields for query.
963  * @vha: HA context
964  * @cmd: GS command
965  * @scmd_len: Subcommand length
966  * @data_size: response size in bytes
967  *
968  * Returns a pointer to the @ha's sns_cmd.
969  */
970 static inline struct sns_cmd_pkt *
971 qla2x00_prep_sns_cmd(scsi_qla_host_t *vha, uint16_t cmd, uint16_t scmd_len,
972     uint16_t data_size)
973 {
974 	uint16_t		wc;
975 	struct sns_cmd_pkt	*sns_cmd;
976 	struct qla_hw_data *ha = vha->hw;
977 
978 	sns_cmd = ha->sns_cmd;
979 	memset(sns_cmd, 0, sizeof(struct sns_cmd_pkt));
980 	wc = data_size / 2;			/* Size in 16bit words. */
981 	sns_cmd->p.cmd.buffer_length = cpu_to_le16(wc);
982 	put_unaligned_le64(ha->sns_cmd_dma, &sns_cmd->p.cmd.buffer_address);
983 	sns_cmd->p.cmd.subcommand_length = cpu_to_le16(scmd_len);
984 	sns_cmd->p.cmd.subcommand = cpu_to_le16(cmd);
985 	wc = (data_size - 16) / 4;		/* Size in 32bit words. */
986 	sns_cmd->p.cmd.size = cpu_to_le16(wc);
987 
988 	vha->qla_stats.control_requests++;
989 
990 	return (sns_cmd);
991 }
992 
993 /**
994  * qla2x00_sns_ga_nxt() - SNS scan for fabric devices via GA_NXT command.
995  * @vha: HA context
996  * @fcport: fcport entry to updated
997  *
998  * This command uses the old Exectute SNS Command mailbox routine.
999  *
1000  * Returns 0 on success.
1001  */
1002 static int
1003 qla2x00_sns_ga_nxt(scsi_qla_host_t *vha, fc_port_t *fcport)
1004 {
1005 	int		rval = QLA_SUCCESS;
1006 	struct qla_hw_data *ha = vha->hw;
1007 	struct sns_cmd_pkt	*sns_cmd;
1008 
1009 	/* Issue GA_NXT. */
1010 	/* Prepare SNS command request. */
1011 	sns_cmd = qla2x00_prep_sns_cmd(vha, GA_NXT_CMD, GA_NXT_SNS_SCMD_LEN,
1012 	    GA_NXT_SNS_DATA_SIZE);
1013 
1014 	/* Prepare SNS command arguments -- port_id. */
1015 	sns_cmd->p.cmd.param[0] = fcport->d_id.b.al_pa;
1016 	sns_cmd->p.cmd.param[1] = fcport->d_id.b.area;
1017 	sns_cmd->p.cmd.param[2] = fcport->d_id.b.domain;
1018 
1019 	/* Execute SNS command. */
1020 	rval = qla2x00_send_sns(vha, ha->sns_cmd_dma, GA_NXT_SNS_CMD_SIZE / 2,
1021 	    sizeof(struct sns_cmd_pkt));
1022 	if (rval != QLA_SUCCESS) {
1023 		/*EMPTY*/
1024 		ql_dbg(ql_dbg_disc, vha, 0x205f,
1025 		    "GA_NXT Send SNS failed (%d).\n", rval);
1026 	} else if (sns_cmd->p.gan_data[8] != 0x80 ||
1027 	    sns_cmd->p.gan_data[9] != 0x02) {
1028 		ql_dbg(ql_dbg_disc + ql_dbg_buffer, vha, 0x2084,
1029 		    "GA_NXT failed, rejected request ga_nxt_rsp:\n");
1030 		ql_dump_buffer(ql_dbg_disc + ql_dbg_buffer, vha, 0x2074,
1031 		    sns_cmd->p.gan_data, 16);
1032 		rval = QLA_FUNCTION_FAILED;
1033 	} else {
1034 		/* Populate fc_port_t entry. */
1035 		fcport->d_id.b.domain = sns_cmd->p.gan_data[17];
1036 		fcport->d_id.b.area = sns_cmd->p.gan_data[18];
1037 		fcport->d_id.b.al_pa = sns_cmd->p.gan_data[19];
1038 
1039 		memcpy(fcport->node_name, &sns_cmd->p.gan_data[284], WWN_SIZE);
1040 		memcpy(fcport->port_name, &sns_cmd->p.gan_data[20], WWN_SIZE);
1041 
1042 		if (sns_cmd->p.gan_data[16] != NS_N_PORT_TYPE &&
1043 		    sns_cmd->p.gan_data[16] != NS_NL_PORT_TYPE)
1044 			fcport->d_id.b.domain = 0xf0;
1045 
1046 		ql_dbg(ql_dbg_disc, vha, 0x2061,
1047 		    "GA_NXT entry - nn %8phN pn %8phN "
1048 		    "port_id=%02x%02x%02x.\n",
1049 		    fcport->node_name, fcport->port_name,
1050 		    fcport->d_id.b.domain, fcport->d_id.b.area,
1051 		    fcport->d_id.b.al_pa);
1052 	}
1053 
1054 	return (rval);
1055 }
1056 
1057 /**
1058  * qla2x00_sns_gid_pt() - SNS scan for fabric devices via GID_PT command.
1059  * @vha: HA context
1060  * @list: switch info entries to populate
1061  *
1062  * This command uses the old Exectute SNS Command mailbox routine.
1063  *
1064  * NOTE: Non-Nx_Ports are not requested.
1065  *
1066  * Returns 0 on success.
1067  */
1068 static int
1069 qla2x00_sns_gid_pt(scsi_qla_host_t *vha, sw_info_t *list)
1070 {
1071 	int		rval;
1072 	struct qla_hw_data *ha = vha->hw;
1073 	uint16_t	i;
1074 	uint8_t		*entry;
1075 	struct sns_cmd_pkt	*sns_cmd;
1076 	uint16_t gid_pt_sns_data_size;
1077 
1078 	gid_pt_sns_data_size = qla2x00_gid_pt_rsp_size(vha);
1079 
1080 	/* Issue GID_PT. */
1081 	/* Prepare SNS command request. */
1082 	sns_cmd = qla2x00_prep_sns_cmd(vha, GID_PT_CMD, GID_PT_SNS_SCMD_LEN,
1083 	    gid_pt_sns_data_size);
1084 
1085 	/* Prepare SNS command arguments -- port_type. */
1086 	sns_cmd->p.cmd.param[0] = NS_NX_PORT_TYPE;
1087 
1088 	/* Execute SNS command. */
1089 	rval = qla2x00_send_sns(vha, ha->sns_cmd_dma, GID_PT_SNS_CMD_SIZE / 2,
1090 	    sizeof(struct sns_cmd_pkt));
1091 	if (rval != QLA_SUCCESS) {
1092 		/*EMPTY*/
1093 		ql_dbg(ql_dbg_disc, vha, 0x206d,
1094 		    "GID_PT Send SNS failed (%d).\n", rval);
1095 	} else if (sns_cmd->p.gid_data[8] != 0x80 ||
1096 	    sns_cmd->p.gid_data[9] != 0x02) {
1097 		ql_dbg(ql_dbg_disc, vha, 0x202f,
1098 		    "GID_PT failed, rejected request, gid_rsp:\n");
1099 		ql_dump_buffer(ql_dbg_disc + ql_dbg_buffer, vha, 0x2081,
1100 		    sns_cmd->p.gid_data, 16);
1101 		rval = QLA_FUNCTION_FAILED;
1102 	} else {
1103 		/* Set port IDs in switch info list. */
1104 		for (i = 0; i < ha->max_fibre_devices; i++) {
1105 			entry = &sns_cmd->p.gid_data[(i * 4) + 16];
1106 			list[i].d_id.b.domain = entry[1];
1107 			list[i].d_id.b.area = entry[2];
1108 			list[i].d_id.b.al_pa = entry[3];
1109 
1110 			/* Last one exit. */
1111 			if (entry[0] & BIT_7) {
1112 				list[i].d_id.b.rsvd_1 = entry[0];
1113 				break;
1114 			}
1115 		}
1116 
1117 		/*
1118 		 * If we've used all available slots, then the switch is
1119 		 * reporting back more devices that we can handle with this
1120 		 * single call.  Return a failed status, and let GA_NXT handle
1121 		 * the overload.
1122 		 */
1123 		if (i == ha->max_fibre_devices)
1124 			rval = QLA_FUNCTION_FAILED;
1125 	}
1126 
1127 	return (rval);
1128 }
1129 
1130 /**
1131  * qla2x00_sns_gpn_id() - SNS Get Port Name (GPN_ID) query.
1132  * @vha: HA context
1133  * @list: switch info entries to populate
1134  *
1135  * This command uses the old Exectute SNS Command mailbox routine.
1136  *
1137  * Returns 0 on success.
1138  */
1139 static int
1140 qla2x00_sns_gpn_id(scsi_qla_host_t *vha, sw_info_t *list)
1141 {
1142 	int		rval = QLA_SUCCESS;
1143 	struct qla_hw_data *ha = vha->hw;
1144 	uint16_t	i;
1145 	struct sns_cmd_pkt	*sns_cmd;
1146 
1147 	for (i = 0; i < ha->max_fibre_devices; i++) {
1148 		/* Issue GPN_ID */
1149 		/* Prepare SNS command request. */
1150 		sns_cmd = qla2x00_prep_sns_cmd(vha, GPN_ID_CMD,
1151 		    GPN_ID_SNS_SCMD_LEN, GPN_ID_SNS_DATA_SIZE);
1152 
1153 		/* Prepare SNS command arguments -- port_id. */
1154 		sns_cmd->p.cmd.param[0] = list[i].d_id.b.al_pa;
1155 		sns_cmd->p.cmd.param[1] = list[i].d_id.b.area;
1156 		sns_cmd->p.cmd.param[2] = list[i].d_id.b.domain;
1157 
1158 		/* Execute SNS command. */
1159 		rval = qla2x00_send_sns(vha, ha->sns_cmd_dma,
1160 		    GPN_ID_SNS_CMD_SIZE / 2, sizeof(struct sns_cmd_pkt));
1161 		if (rval != QLA_SUCCESS) {
1162 			/*EMPTY*/
1163 			ql_dbg(ql_dbg_disc, vha, 0x2032,
1164 			    "GPN_ID Send SNS failed (%d).\n", rval);
1165 		} else if (sns_cmd->p.gpn_data[8] != 0x80 ||
1166 		    sns_cmd->p.gpn_data[9] != 0x02) {
1167 			ql_dbg(ql_dbg_disc + ql_dbg_buffer, vha, 0x207e,
1168 			    "GPN_ID failed, rejected request, gpn_rsp:\n");
1169 			ql_dump_buffer(ql_dbg_disc + ql_dbg_buffer, vha, 0x207f,
1170 			    sns_cmd->p.gpn_data, 16);
1171 			rval = QLA_FUNCTION_FAILED;
1172 		} else {
1173 			/* Save portname */
1174 			memcpy(list[i].port_name, &sns_cmd->p.gpn_data[16],
1175 			    WWN_SIZE);
1176 		}
1177 
1178 		/* Last device exit. */
1179 		if (list[i].d_id.b.rsvd_1 != 0)
1180 			break;
1181 	}
1182 
1183 	return (rval);
1184 }
1185 
1186 /**
1187  * qla2x00_sns_gnn_id() - SNS Get Node Name (GNN_ID) query.
1188  * @vha: HA context
1189  * @list: switch info entries to populate
1190  *
1191  * This command uses the old Exectute SNS Command mailbox routine.
1192  *
1193  * Returns 0 on success.
1194  */
1195 static int
1196 qla2x00_sns_gnn_id(scsi_qla_host_t *vha, sw_info_t *list)
1197 {
1198 	int		rval = QLA_SUCCESS;
1199 	struct qla_hw_data *ha = vha->hw;
1200 	uint16_t	i;
1201 	struct sns_cmd_pkt	*sns_cmd;
1202 
1203 	for (i = 0; i < ha->max_fibre_devices; i++) {
1204 		/* Issue GNN_ID */
1205 		/* Prepare SNS command request. */
1206 		sns_cmd = qla2x00_prep_sns_cmd(vha, GNN_ID_CMD,
1207 		    GNN_ID_SNS_SCMD_LEN, GNN_ID_SNS_DATA_SIZE);
1208 
1209 		/* Prepare SNS command arguments -- port_id. */
1210 		sns_cmd->p.cmd.param[0] = list[i].d_id.b.al_pa;
1211 		sns_cmd->p.cmd.param[1] = list[i].d_id.b.area;
1212 		sns_cmd->p.cmd.param[2] = list[i].d_id.b.domain;
1213 
1214 		/* Execute SNS command. */
1215 		rval = qla2x00_send_sns(vha, ha->sns_cmd_dma,
1216 		    GNN_ID_SNS_CMD_SIZE / 2, sizeof(struct sns_cmd_pkt));
1217 		if (rval != QLA_SUCCESS) {
1218 			/*EMPTY*/
1219 			ql_dbg(ql_dbg_disc, vha, 0x203f,
1220 			    "GNN_ID Send SNS failed (%d).\n", rval);
1221 		} else if (sns_cmd->p.gnn_data[8] != 0x80 ||
1222 		    sns_cmd->p.gnn_data[9] != 0x02) {
1223 			ql_dbg(ql_dbg_disc + ql_dbg_buffer, vha, 0x2082,
1224 			    "GNN_ID failed, rejected request, gnn_rsp:\n");
1225 			ql_dump_buffer(ql_dbg_disc + ql_dbg_buffer, vha, 0x207a,
1226 			    sns_cmd->p.gnn_data, 16);
1227 			rval = QLA_FUNCTION_FAILED;
1228 		} else {
1229 			/* Save nodename */
1230 			memcpy(list[i].node_name, &sns_cmd->p.gnn_data[16],
1231 			    WWN_SIZE);
1232 
1233 			ql_dbg(ql_dbg_disc, vha, 0x206e,
1234 			    "GID_PT entry - nn %8phN pn %8phN "
1235 			    "port_id=%02x%02x%02x.\n",
1236 			    list[i].node_name, list[i].port_name,
1237 			    list[i].d_id.b.domain, list[i].d_id.b.area,
1238 			    list[i].d_id.b.al_pa);
1239 		}
1240 
1241 		/* Last device exit. */
1242 		if (list[i].d_id.b.rsvd_1 != 0)
1243 			break;
1244 	}
1245 
1246 	return (rval);
1247 }
1248 
1249 /**
1250  * qla2x00_sns_rft_id() - SNS Register FC-4 TYPEs (RFT_ID) supported by the HBA.
1251  * @vha: HA context
1252  *
1253  * This command uses the old Exectute SNS Command mailbox routine.
1254  *
1255  * Returns 0 on success.
1256  */
1257 static int
1258 qla2x00_sns_rft_id(scsi_qla_host_t *vha)
1259 {
1260 	int		rval;
1261 	struct qla_hw_data *ha = vha->hw;
1262 	struct sns_cmd_pkt	*sns_cmd;
1263 
1264 	/* Issue RFT_ID. */
1265 	/* Prepare SNS command request. */
1266 	sns_cmd = qla2x00_prep_sns_cmd(vha, RFT_ID_CMD, RFT_ID_SNS_SCMD_LEN,
1267 	    RFT_ID_SNS_DATA_SIZE);
1268 
1269 	/* Prepare SNS command arguments -- port_id, FC-4 types */
1270 	sns_cmd->p.cmd.param[0] = vha->d_id.b.al_pa;
1271 	sns_cmd->p.cmd.param[1] = vha->d_id.b.area;
1272 	sns_cmd->p.cmd.param[2] = vha->d_id.b.domain;
1273 
1274 	sns_cmd->p.cmd.param[5] = 0x01;			/* FCP-3 */
1275 
1276 	/* Execute SNS command. */
1277 	rval = qla2x00_send_sns(vha, ha->sns_cmd_dma, RFT_ID_SNS_CMD_SIZE / 2,
1278 	    sizeof(struct sns_cmd_pkt));
1279 	if (rval != QLA_SUCCESS) {
1280 		/*EMPTY*/
1281 		ql_dbg(ql_dbg_disc, vha, 0x2060,
1282 		    "RFT_ID Send SNS failed (%d).\n", rval);
1283 	} else if (sns_cmd->p.rft_data[8] != 0x80 ||
1284 	    sns_cmd->p.rft_data[9] != 0x02) {
1285 		ql_dbg(ql_dbg_disc + ql_dbg_buffer, vha, 0x2083,
1286 		    "RFT_ID failed, rejected request rft_rsp:\n");
1287 		ql_dump_buffer(ql_dbg_disc + ql_dbg_buffer, vha, 0x2080,
1288 		    sns_cmd->p.rft_data, 16);
1289 		rval = QLA_FUNCTION_FAILED;
1290 	} else {
1291 		ql_dbg(ql_dbg_disc, vha, 0x2073,
1292 		    "RFT_ID exiting normally.\n");
1293 	}
1294 
1295 	return (rval);
1296 }
1297 
1298 /**
1299  * qla2x00_sns_rnn_id() - SNS Register Node Name (RNN_ID) of the HBA.
1300  * @vha: HA context
1301  *
1302  * This command uses the old Exectute SNS Command mailbox routine.
1303  *
1304  * Returns 0 on success.
1305  */
1306 static int
1307 qla2x00_sns_rnn_id(scsi_qla_host_t *vha)
1308 {
1309 	int		rval;
1310 	struct qla_hw_data *ha = vha->hw;
1311 	struct sns_cmd_pkt	*sns_cmd;
1312 
1313 	/* Issue RNN_ID. */
1314 	/* Prepare SNS command request. */
1315 	sns_cmd = qla2x00_prep_sns_cmd(vha, RNN_ID_CMD, RNN_ID_SNS_SCMD_LEN,
1316 	    RNN_ID_SNS_DATA_SIZE);
1317 
1318 	/* Prepare SNS command arguments -- port_id, nodename. */
1319 	sns_cmd->p.cmd.param[0] = vha->d_id.b.al_pa;
1320 	sns_cmd->p.cmd.param[1] = vha->d_id.b.area;
1321 	sns_cmd->p.cmd.param[2] = vha->d_id.b.domain;
1322 
1323 	sns_cmd->p.cmd.param[4] = vha->node_name[7];
1324 	sns_cmd->p.cmd.param[5] = vha->node_name[6];
1325 	sns_cmd->p.cmd.param[6] = vha->node_name[5];
1326 	sns_cmd->p.cmd.param[7] = vha->node_name[4];
1327 	sns_cmd->p.cmd.param[8] = vha->node_name[3];
1328 	sns_cmd->p.cmd.param[9] = vha->node_name[2];
1329 	sns_cmd->p.cmd.param[10] = vha->node_name[1];
1330 	sns_cmd->p.cmd.param[11] = vha->node_name[0];
1331 
1332 	/* Execute SNS command. */
1333 	rval = qla2x00_send_sns(vha, ha->sns_cmd_dma, RNN_ID_SNS_CMD_SIZE / 2,
1334 	    sizeof(struct sns_cmd_pkt));
1335 	if (rval != QLA_SUCCESS) {
1336 		/*EMPTY*/
1337 		ql_dbg(ql_dbg_disc, vha, 0x204a,
1338 		    "RNN_ID Send SNS failed (%d).\n", rval);
1339 	} else if (sns_cmd->p.rnn_data[8] != 0x80 ||
1340 	    sns_cmd->p.rnn_data[9] != 0x02) {
1341 		ql_dbg(ql_dbg_disc + ql_dbg_buffer, vha, 0x207b,
1342 		    "RNN_ID failed, rejected request, rnn_rsp:\n");
1343 		ql_dump_buffer(ql_dbg_disc + ql_dbg_buffer, vha, 0x207c,
1344 		    sns_cmd->p.rnn_data, 16);
1345 		rval = QLA_FUNCTION_FAILED;
1346 	} else {
1347 		ql_dbg(ql_dbg_disc, vha, 0x204c,
1348 		    "RNN_ID exiting normally.\n");
1349 	}
1350 
1351 	return (rval);
1352 }
1353 
1354 /**
1355  * qla2x00_mgmt_svr_login() - Login to fabric Management Service.
1356  * @vha: HA context
1357  *
1358  * Returns 0 on success.
1359  */
1360 int
1361 qla2x00_mgmt_svr_login(scsi_qla_host_t *vha)
1362 {
1363 	int ret, rval;
1364 	uint16_t mb[MAILBOX_REGISTER_COUNT];
1365 	struct qla_hw_data *ha = vha->hw;
1366 
1367 	ret = QLA_SUCCESS;
1368 	if (vha->flags.management_server_logged_in)
1369 		return ret;
1370 
1371 	rval = ha->isp_ops->fabric_login(vha, vha->mgmt_svr_loop_id, 0xff, 0xff,
1372 	    0xfa, mb, BIT_1);
1373 	if (rval != QLA_SUCCESS || mb[0] != MBS_COMMAND_COMPLETE) {
1374 		if (rval == QLA_MEMORY_ALLOC_FAILED)
1375 			ql_dbg(ql_dbg_disc, vha, 0x2085,
1376 			    "Failed management_server login: loopid=%x "
1377 			    "rval=%d\n", vha->mgmt_svr_loop_id, rval);
1378 		else
1379 			ql_dbg(ql_dbg_disc, vha, 0x2024,
1380 			    "Failed management_server login: loopid=%x "
1381 			    "mb[0]=%x mb[1]=%x mb[2]=%x mb[6]=%x mb[7]=%x.\n",
1382 			    vha->mgmt_svr_loop_id, mb[0], mb[1], mb[2], mb[6],
1383 			    mb[7]);
1384 		ret = QLA_FUNCTION_FAILED;
1385 	} else
1386 		vha->flags.management_server_logged_in = 1;
1387 
1388 	return ret;
1389 }
1390 
1391 /**
1392  * qla2x00_prep_ms_fdmi_iocb() - Prepare common MS IOCB fields for FDMI query.
1393  * @vha: HA context
1394  * @req_size: request size in bytes
1395  * @rsp_size: response size in bytes
1396  *
1397  * Returns a pointer to the @ha's ms_iocb.
1398  */
1399 void *
1400 qla2x00_prep_ms_fdmi_iocb(scsi_qla_host_t *vha, uint32_t req_size,
1401     uint32_t rsp_size)
1402 {
1403 	ms_iocb_entry_t *ms_pkt;
1404 	struct qla_hw_data *ha = vha->hw;
1405 
1406 	ms_pkt = ha->ms_iocb;
1407 	memset(ms_pkt, 0, sizeof(ms_iocb_entry_t));
1408 
1409 	ms_pkt->entry_type = MS_IOCB_TYPE;
1410 	ms_pkt->entry_count = 1;
1411 	SET_TARGET_ID(ha, ms_pkt->loop_id, vha->mgmt_svr_loop_id);
1412 	ms_pkt->control_flags = cpu_to_le16(CF_READ | CF_HEAD_TAG);
1413 	ms_pkt->timeout = cpu_to_le16(ha->r_a_tov / 10 * 2);
1414 	ms_pkt->cmd_dsd_count = cpu_to_le16(1);
1415 	ms_pkt->total_dsd_count = cpu_to_le16(2);
1416 	ms_pkt->rsp_bytecount = cpu_to_le32(rsp_size);
1417 	ms_pkt->req_bytecount = cpu_to_le32(req_size);
1418 
1419 	put_unaligned_le64(ha->ct_sns_dma, &ms_pkt->req_dsd.address);
1420 	ms_pkt->req_dsd.length = ms_pkt->req_bytecount;
1421 
1422 	put_unaligned_le64(ha->ct_sns_dma, &ms_pkt->rsp_dsd.address);
1423 	ms_pkt->rsp_dsd.length = ms_pkt->rsp_bytecount;
1424 
1425 	return ms_pkt;
1426 }
1427 
1428 /**
1429  * qla24xx_prep_ms_fdmi_iocb() - Prepare common MS IOCB fields for FDMI query.
1430  * @vha: HA context
1431  * @req_size: request size in bytes
1432  * @rsp_size: response size in bytes
1433  *
1434  * Returns a pointer to the @ha's ms_iocb.
1435  */
1436 void *
1437 qla24xx_prep_ms_fdmi_iocb(scsi_qla_host_t *vha, uint32_t req_size,
1438     uint32_t rsp_size)
1439 {
1440 	struct ct_entry_24xx *ct_pkt;
1441 	struct qla_hw_data *ha = vha->hw;
1442 
1443 	ct_pkt = (struct ct_entry_24xx *)ha->ms_iocb;
1444 	memset(ct_pkt, 0, sizeof(struct ct_entry_24xx));
1445 
1446 	ct_pkt->entry_type = CT_IOCB_TYPE;
1447 	ct_pkt->entry_count = 1;
1448 	ct_pkt->nport_handle = cpu_to_le16(vha->mgmt_svr_loop_id);
1449 	ct_pkt->timeout = cpu_to_le16(ha->r_a_tov / 10 * 2);
1450 	ct_pkt->cmd_dsd_count = cpu_to_le16(1);
1451 	ct_pkt->rsp_dsd_count = cpu_to_le16(1);
1452 	ct_pkt->rsp_byte_count = cpu_to_le32(rsp_size);
1453 	ct_pkt->cmd_byte_count = cpu_to_le32(req_size);
1454 
1455 	put_unaligned_le64(ha->ct_sns_dma, &ct_pkt->dsd[0].address);
1456 	ct_pkt->dsd[0].length = ct_pkt->cmd_byte_count;
1457 
1458 	put_unaligned_le64(ha->ct_sns_dma, &ct_pkt->dsd[1].address);
1459 	ct_pkt->dsd[1].length = ct_pkt->rsp_byte_count;
1460 	ct_pkt->vp_index = vha->vp_idx;
1461 
1462 	return ct_pkt;
1463 }
1464 
1465 static void
1466 qla2x00_update_ms_fdmi_iocb(scsi_qla_host_t *vha, uint32_t req_size)
1467 {
1468 	struct qla_hw_data *ha = vha->hw;
1469 	ms_iocb_entry_t *ms_pkt = ha->ms_iocb;
1470 	struct ct_entry_24xx *ct_pkt = (struct ct_entry_24xx *)ha->ms_iocb;
1471 
1472 	if (IS_FWI2_CAPABLE(ha)) {
1473 		ct_pkt->cmd_byte_count = cpu_to_le32(req_size);
1474 		ct_pkt->dsd[0].length = ct_pkt->cmd_byte_count;
1475 	} else {
1476 		ms_pkt->req_bytecount = cpu_to_le32(req_size);
1477 		ms_pkt->req_dsd.length = ms_pkt->req_bytecount;
1478 	}
1479 }
1480 
1481 /**
1482  * qla2x00_prep_ct_fdmi_req() - Prepare common CT request fields for SNS query.
1483  * @p: CT request buffer
1484  * @cmd: GS command
1485  * @rsp_size: response size in bytes
1486  *
1487  * Returns a pointer to the intitialized @ct_req.
1488  */
1489 static inline struct ct_sns_req *
1490 qla2x00_prep_ct_fdmi_req(struct ct_sns_pkt *p, uint16_t cmd,
1491     uint16_t rsp_size)
1492 {
1493 	memset(p, 0, sizeof(struct ct_sns_pkt));
1494 
1495 	p->p.req.header.revision = 0x01;
1496 	p->p.req.header.gs_type = 0xFA;
1497 	p->p.req.header.gs_subtype = 0x10;
1498 	p->p.req.command = cpu_to_be16(cmd);
1499 	p->p.req.max_rsp_size = cpu_to_be16((rsp_size - 16) / 4);
1500 
1501 	return &p->p.req;
1502 }
1503 
1504 uint
1505 qla25xx_fdmi_port_speed_capability(struct qla_hw_data *ha)
1506 {
1507 	uint speeds = 0;
1508 
1509 	if (IS_CNA_CAPABLE(ha))
1510 		return FDMI_PORT_SPEED_10GB;
1511 	if (IS_QLA28XX(ha) || IS_QLA27XX(ha)) {
1512 		if (ha->max_supported_speed == 2) {
1513 			if (ha->min_supported_speed <= 6)
1514 				speeds |= FDMI_PORT_SPEED_64GB;
1515 		}
1516 		if (ha->max_supported_speed == 2 ||
1517 		    ha->max_supported_speed == 1) {
1518 			if (ha->min_supported_speed <= 5)
1519 				speeds |= FDMI_PORT_SPEED_32GB;
1520 		}
1521 		if (ha->max_supported_speed == 2 ||
1522 		    ha->max_supported_speed == 1 ||
1523 		    ha->max_supported_speed == 0) {
1524 			if (ha->min_supported_speed <= 4)
1525 				speeds |= FDMI_PORT_SPEED_16GB;
1526 		}
1527 		if (ha->max_supported_speed == 1 ||
1528 		    ha->max_supported_speed == 0) {
1529 			if (ha->min_supported_speed <= 3)
1530 				speeds |= FDMI_PORT_SPEED_8GB;
1531 		}
1532 		if (ha->max_supported_speed == 0) {
1533 			if (ha->min_supported_speed <= 2)
1534 				speeds |= FDMI_PORT_SPEED_4GB;
1535 		}
1536 		return speeds;
1537 	}
1538 	if (IS_QLA2031(ha)) {
1539 		if ((ha->pdev->subsystem_vendor == 0x103C) &&
1540 		    ((ha->pdev->subsystem_device == 0x8002) ||
1541 		    (ha->pdev->subsystem_device == 0x8086))) {
1542 			speeds = FDMI_PORT_SPEED_16GB;
1543 		} else {
1544 			speeds = FDMI_PORT_SPEED_16GB|FDMI_PORT_SPEED_8GB|
1545 				FDMI_PORT_SPEED_4GB;
1546 		}
1547 		return speeds;
1548 	}
1549 	if (IS_QLA25XX(ha) || IS_QLAFX00(ha))
1550 		return FDMI_PORT_SPEED_8GB|FDMI_PORT_SPEED_4GB|
1551 			FDMI_PORT_SPEED_2GB|FDMI_PORT_SPEED_1GB;
1552 	if (IS_QLA24XX_TYPE(ha))
1553 		return FDMI_PORT_SPEED_4GB|FDMI_PORT_SPEED_2GB|
1554 			FDMI_PORT_SPEED_1GB;
1555 	if (IS_QLA23XX(ha))
1556 		return FDMI_PORT_SPEED_2GB|FDMI_PORT_SPEED_1GB;
1557 	return FDMI_PORT_SPEED_1GB;
1558 }
1559 
1560 uint
1561 qla25xx_fdmi_port_speed_currently(struct qla_hw_data *ha)
1562 {
1563 	switch (ha->link_data_rate) {
1564 	case PORT_SPEED_1GB:
1565 		return FDMI_PORT_SPEED_1GB;
1566 	case PORT_SPEED_2GB:
1567 		return FDMI_PORT_SPEED_2GB;
1568 	case PORT_SPEED_4GB:
1569 		return FDMI_PORT_SPEED_4GB;
1570 	case PORT_SPEED_8GB:
1571 		return FDMI_PORT_SPEED_8GB;
1572 	case PORT_SPEED_10GB:
1573 		return FDMI_PORT_SPEED_10GB;
1574 	case PORT_SPEED_16GB:
1575 		return FDMI_PORT_SPEED_16GB;
1576 	case PORT_SPEED_32GB:
1577 		return FDMI_PORT_SPEED_32GB;
1578 	case PORT_SPEED_64GB:
1579 		return FDMI_PORT_SPEED_64GB;
1580 	default:
1581 		return FDMI_PORT_SPEED_UNKNOWN;
1582 	}
1583 }
1584 
1585 /**
1586  * qla2x00_hba_attributes() - perform HBA attributes registration
1587  * @vha: HA context
1588  * @entries: number of entries to use
1589  * @callopt: Option to issue extended or standard FDMI
1590  *           command parameter
1591  *
1592  * Returns 0 on success.
1593  */
1594 static unsigned long
1595 qla2x00_hba_attributes(scsi_qla_host_t *vha, void *entries,
1596 	unsigned int callopt)
1597 {
1598 	struct qla_hw_data *ha = vha->hw;
1599 	struct new_utsname *p_sysid = utsname();
1600 	struct ct_fdmi_hba_attr *eiter;
1601 	uint16_t alen;
1602 	unsigned long size = 0;
1603 
1604 	/* Nodename. */
1605 	eiter = entries + size;
1606 	eiter->type = cpu_to_be16(FDMI_HBA_NODE_NAME);
1607 	memcpy(eiter->a.node_name, vha->node_name, sizeof(eiter->a.node_name));
1608 	alen = sizeof(eiter->a.node_name);
1609 	alen += FDMI_ATTR_TYPELEN(eiter);
1610 	eiter->len = cpu_to_be16(alen);
1611 	size += alen;
1612 	ql_dbg(ql_dbg_disc, vha, 0x20a0,
1613 	    "NODENAME = %016llx.\n", wwn_to_u64(eiter->a.node_name));
1614 	/* Manufacturer. */
1615 	eiter = entries + size;
1616 	eiter->type = cpu_to_be16(FDMI_HBA_MANUFACTURER);
1617 	alen = scnprintf(
1618 		eiter->a.manufacturer, sizeof(eiter->a.manufacturer),
1619 		"%s", QLA2XXX_MANUFACTURER);
1620 	alen += FDMI_ATTR_ALIGNMENT(alen);
1621 	alen += FDMI_ATTR_TYPELEN(eiter);
1622 	eiter->len = cpu_to_be16(alen);
1623 	size += alen;
1624 	ql_dbg(ql_dbg_disc, vha, 0x20a1,
1625 	    "MANUFACTURER = %s.\n", eiter->a.manufacturer);
1626 	/* Serial number. */
1627 	eiter = entries + size;
1628 	eiter->type = cpu_to_be16(FDMI_HBA_SERIAL_NUMBER);
1629 	alen = 0;
1630 	if (IS_FWI2_CAPABLE(ha)) {
1631 		alen = qla2xxx_get_vpd_field(vha, "SN",
1632 		    eiter->a.serial_num, sizeof(eiter->a.serial_num));
1633 	}
1634 	if (!alen) {
1635 		uint32_t sn = ((ha->serial0 & 0x1f) << 16) |
1636 			(ha->serial2 << 8) | ha->serial1;
1637 		alen = scnprintf(
1638 			eiter->a.serial_num, sizeof(eiter->a.serial_num),
1639 			"%c%05d", 'A' + sn / 100000, sn % 100000);
1640 	}
1641 	alen += FDMI_ATTR_ALIGNMENT(alen);
1642 	alen += FDMI_ATTR_TYPELEN(eiter);
1643 	eiter->len = cpu_to_be16(alen);
1644 	size += alen;
1645 	ql_dbg(ql_dbg_disc, vha, 0x20a2,
1646 	    "SERIAL NUMBER = %s.\n", eiter->a.serial_num);
1647 	/* Model name. */
1648 	eiter = entries + size;
1649 	eiter->type = cpu_to_be16(FDMI_HBA_MODEL);
1650 	alen = scnprintf(
1651 		eiter->a.model, sizeof(eiter->a.model),
1652 		"%s", ha->model_number);
1653 	alen += FDMI_ATTR_ALIGNMENT(alen);
1654 	alen += FDMI_ATTR_TYPELEN(eiter);
1655 	eiter->len = cpu_to_be16(alen);
1656 	size += alen;
1657 	ql_dbg(ql_dbg_disc, vha, 0x20a3,
1658 	    "MODEL NAME = %s.\n", eiter->a.model);
1659 	/* Model description. */
1660 	eiter = entries + size;
1661 	eiter->type = cpu_to_be16(FDMI_HBA_MODEL_DESCRIPTION);
1662 	alen = scnprintf(
1663 		eiter->a.model_desc, sizeof(eiter->a.model_desc),
1664 		"%s", ha->model_desc);
1665 	alen += FDMI_ATTR_ALIGNMENT(alen);
1666 	alen += FDMI_ATTR_TYPELEN(eiter);
1667 	eiter->len = cpu_to_be16(alen);
1668 	size += alen;
1669 	ql_dbg(ql_dbg_disc, vha, 0x20a4,
1670 	    "MODEL DESCRIPTION = %s.\n", eiter->a.model_desc);
1671 	/* Hardware version. */
1672 	eiter = entries + size;
1673 	eiter->type = cpu_to_be16(FDMI_HBA_HARDWARE_VERSION);
1674 	alen = 0;
1675 	if (IS_FWI2_CAPABLE(ha)) {
1676 		if (!alen) {
1677 			alen = qla2xxx_get_vpd_field(vha, "MN",
1678 			    eiter->a.hw_version, sizeof(eiter->a.hw_version));
1679 		}
1680 		if (!alen) {
1681 			alen = qla2xxx_get_vpd_field(vha, "EC",
1682 			    eiter->a.hw_version, sizeof(eiter->a.hw_version));
1683 		}
1684 	}
1685 	if (!alen) {
1686 		alen = scnprintf(
1687 			eiter->a.hw_version, sizeof(eiter->a.hw_version),
1688 			"HW:%s", ha->adapter_id);
1689 	}
1690 	alen += FDMI_ATTR_ALIGNMENT(alen);
1691 	alen += FDMI_ATTR_TYPELEN(eiter);
1692 	eiter->len = cpu_to_be16(alen);
1693 	size += alen;
1694 	ql_dbg(ql_dbg_disc, vha, 0x20a5,
1695 	    "HARDWARE VERSION = %s.\n", eiter->a.hw_version);
1696 	/* Driver version. */
1697 	eiter = entries + size;
1698 	eiter->type = cpu_to_be16(FDMI_HBA_DRIVER_VERSION);
1699 	alen = scnprintf(
1700 		eiter->a.driver_version, sizeof(eiter->a.driver_version),
1701 		"%s", qla2x00_version_str);
1702 	alen += FDMI_ATTR_ALIGNMENT(alen);
1703 	alen += FDMI_ATTR_TYPELEN(eiter);
1704 	eiter->len = cpu_to_be16(alen);
1705 	size += alen;
1706 	ql_dbg(ql_dbg_disc, vha, 0x20a6,
1707 	    "DRIVER VERSION = %s.\n", eiter->a.driver_version);
1708 	/* Option ROM version. */
1709 	eiter = entries + size;
1710 	eiter->type = cpu_to_be16(FDMI_HBA_OPTION_ROM_VERSION);
1711 	alen = scnprintf(
1712 		eiter->a.orom_version, sizeof(eiter->a.orom_version),
1713 		"%d.%02d", ha->bios_revision[1], ha->bios_revision[0]);
1714 	alen += FDMI_ATTR_ALIGNMENT(alen);
1715 	alen += FDMI_ATTR_TYPELEN(eiter);
1716 	eiter->len = cpu_to_be16(alen);
1717 	size += alen;
1718 
1719 	ql_dbg(ql_dbg_disc, vha, 0x20a7,
1720 	    "OPTROM VERSION = %d.%02d.\n",
1721 	    eiter->a.orom_version[1], eiter->a.orom_version[0]);
1722 	/* Firmware version */
1723 	eiter = entries + size;
1724 	eiter->type = cpu_to_be16(FDMI_HBA_FIRMWARE_VERSION);
1725 	ha->isp_ops->fw_version_str(vha, eiter->a.fw_version,
1726 	    sizeof(eiter->a.fw_version));
1727 	alen += FDMI_ATTR_ALIGNMENT(alen);
1728 	alen += FDMI_ATTR_TYPELEN(eiter);
1729 	eiter->len = cpu_to_be16(alen);
1730 	size += alen;
1731 	ql_dbg(ql_dbg_disc, vha, 0x20a8,
1732 	    "FIRMWARE VERSION = %s.\n", eiter->a.fw_version);
1733 	/* OS Name and Version */
1734 	eiter = entries + size;
1735 	eiter->type = cpu_to_be16(FDMI_HBA_OS_NAME_AND_VERSION);
1736 	alen = 0;
1737 	if (p_sysid) {
1738 		alen = scnprintf(
1739 			eiter->a.os_version, sizeof(eiter->a.os_version),
1740 			"%s %s %s",
1741 			p_sysid->sysname, p_sysid->release, p_sysid->machine);
1742 	}
1743 	if (!alen) {
1744 		alen = scnprintf(
1745 			eiter->a.os_version, sizeof(eiter->a.os_version),
1746 			"%s %s",
1747 			"Linux", fc_host_system_hostname(vha->host));
1748 	}
1749 	alen += FDMI_ATTR_ALIGNMENT(alen);
1750 	alen += FDMI_ATTR_TYPELEN(eiter);
1751 	eiter->len = cpu_to_be16(alen);
1752 	size += alen;
1753 	ql_dbg(ql_dbg_disc, vha, 0x20a9,
1754 	    "OS VERSION = %s.\n", eiter->a.os_version);
1755 	if (callopt == CALLOPT_FDMI1)
1756 		goto done;
1757 	/* MAX CT Payload Length */
1758 	eiter = entries + size;
1759 	eiter->type = cpu_to_be16(FDMI_HBA_MAXIMUM_CT_PAYLOAD_LENGTH);
1760 	eiter->a.max_ct_len = cpu_to_be32(ha->frame_payload_size >> 2);
1761 
1762 	alen = sizeof(eiter->a.max_ct_len);
1763 	alen += FDMI_ATTR_TYPELEN(eiter);
1764 	eiter->len = cpu_to_be16(alen);
1765 	size += alen;
1766 	ql_dbg(ql_dbg_disc, vha, 0x20aa,
1767 	    "CT PAYLOAD LENGTH = 0x%x.\n", be32_to_cpu(eiter->a.max_ct_len));
1768 	/* Node Symbolic Name */
1769 	eiter = entries + size;
1770 	eiter->type = cpu_to_be16(FDMI_HBA_NODE_SYMBOLIC_NAME);
1771 	alen = qla2x00_get_sym_node_name(vha, eiter->a.sym_name,
1772 	    sizeof(eiter->a.sym_name));
1773 	alen += FDMI_ATTR_ALIGNMENT(alen);
1774 	alen += FDMI_ATTR_TYPELEN(eiter);
1775 	eiter->len = cpu_to_be16(alen);
1776 	size += alen;
1777 	ql_dbg(ql_dbg_disc, vha, 0x20ab,
1778 	    "SYMBOLIC NAME = %s.\n", eiter->a.sym_name);
1779 	/* Vendor Specific information */
1780 	eiter = entries + size;
1781 	eiter->type = cpu_to_be16(FDMI_HBA_VENDOR_SPECIFIC_INFO);
1782 	eiter->a.vendor_specific_info = cpu_to_be32(PCI_VENDOR_ID_QLOGIC);
1783 	alen = sizeof(eiter->a.vendor_specific_info);
1784 	alen += FDMI_ATTR_TYPELEN(eiter);
1785 	eiter->len = cpu_to_be16(alen);
1786 	size += alen;
1787 	ql_dbg(ql_dbg_disc, vha, 0x20ac,
1788 	    "VENDOR SPECIFIC INFO = 0x%x.\n",
1789 	    be32_to_cpu(eiter->a.vendor_specific_info));
1790 	/* Num Ports */
1791 	eiter = entries + size;
1792 	eiter->type = cpu_to_be16(FDMI_HBA_NUM_PORTS);
1793 	eiter->a.num_ports = cpu_to_be32(1);
1794 	alen = sizeof(eiter->a.num_ports);
1795 	alen += FDMI_ATTR_TYPELEN(eiter);
1796 	eiter->len = cpu_to_be16(alen);
1797 	size += alen;
1798 	ql_dbg(ql_dbg_disc, vha, 0x20ad,
1799 	    "PORT COUNT = %x.\n", be32_to_cpu(eiter->a.num_ports));
1800 	/* Fabric Name */
1801 	eiter = entries + size;
1802 	eiter->type = cpu_to_be16(FDMI_HBA_FABRIC_NAME);
1803 	memcpy(eiter->a.fabric_name, vha->fabric_node_name,
1804 	    sizeof(eiter->a.fabric_name));
1805 	alen = sizeof(eiter->a.fabric_name);
1806 	alen += FDMI_ATTR_TYPELEN(eiter);
1807 	eiter->len = cpu_to_be16(alen);
1808 	size += alen;
1809 	ql_dbg(ql_dbg_disc, vha, 0x20ae,
1810 	    "FABRIC NAME = %016llx.\n", wwn_to_u64(eiter->a.fabric_name));
1811 	/* BIOS Version */
1812 	eiter = entries + size;
1813 	eiter->type = cpu_to_be16(FDMI_HBA_BOOT_BIOS_NAME);
1814 	alen = scnprintf(
1815 		eiter->a.bios_name, sizeof(eiter->a.bios_name),
1816 		"BIOS %d.%02d", ha->bios_revision[1], ha->bios_revision[0]);
1817 	alen += FDMI_ATTR_ALIGNMENT(alen);
1818 	alen += FDMI_ATTR_TYPELEN(eiter);
1819 	eiter->len = cpu_to_be16(alen);
1820 	size += alen;
1821 	ql_dbg(ql_dbg_disc, vha, 0x20af,
1822 	    "BIOS NAME = %s\n", eiter->a.bios_name);
1823 	/* Vendor Identifier */
1824 	eiter = entries + size;
1825 	eiter->type = cpu_to_be16(FDMI_HBA_VENDOR_IDENTIFIER);
1826 	alen = scnprintf(
1827 		eiter->a.vendor_identifier, sizeof(eiter->a.vendor_identifier),
1828 		"%s", "QLGC");
1829 	alen += FDMI_ATTR_ALIGNMENT(alen);
1830 	alen += FDMI_ATTR_TYPELEN(eiter);
1831 	eiter->len = cpu_to_be16(alen);
1832 	size += alen;
1833 	ql_dbg(ql_dbg_disc, vha, 0x20b0,
1834 	    "VENDOR IDENTIFIER = %s.\n", eiter->a.vendor_identifier);
1835 done:
1836 	return size;
1837 }
1838 
1839 /**
1840  * qla2x00_port_attributes() - perform Port attributes registration
1841  * @vha: HA context
1842  * @entries: number of entries to use
1843  * @callopt: Option to issue extended or standard FDMI
1844  *           command parameter
1845  *
1846  * Returns 0 on success.
1847  */
1848 static unsigned long
1849 qla2x00_port_attributes(scsi_qla_host_t *vha, void *entries,
1850 	unsigned int callopt)
1851 {
1852 	struct qla_hw_data *ha = vha->hw;
1853 	struct new_utsname *p_sysid = utsname();
1854 	char *hostname = p_sysid ?
1855 		p_sysid->nodename : fc_host_system_hostname(vha->host);
1856 	struct ct_fdmi_port_attr *eiter;
1857 	uint16_t alen;
1858 	unsigned long size = 0;
1859 
1860 	/* FC4 types. */
1861 	eiter = entries + size;
1862 	eiter->type = cpu_to_be16(FDMI_PORT_FC4_TYPES);
1863 	eiter->a.fc4_types[0] = 0x00;
1864 	eiter->a.fc4_types[1] = 0x00;
1865 	eiter->a.fc4_types[2] = 0x01;
1866 	eiter->a.fc4_types[3] = 0x00;
1867 	alen = sizeof(eiter->a.fc4_types);
1868 	alen += FDMI_ATTR_TYPELEN(eiter);
1869 	eiter->len = cpu_to_be16(alen);
1870 	size += alen;
1871 	ql_dbg(ql_dbg_disc, vha, 0x20c0,
1872 	    "FC4 TYPES = %016llx.\n", *(uint64_t *)eiter->a.fc4_types);
1873 	if (vha->flags.nvme_enabled) {
1874 		eiter->a.fc4_types[6] = 1;      /* NVMe type 28h */
1875 		ql_dbg(ql_dbg_disc, vha, 0x211f,
1876 		    "NVME FC4 Type = %02x 0x0 0x0 0x0 0x0 0x0.\n",
1877 		    eiter->a.fc4_types[6]);
1878 	}
1879 	/* Supported speed. */
1880 	eiter = entries + size;
1881 	eiter->type = cpu_to_be16(FDMI_PORT_SUPPORT_SPEED);
1882 	eiter->a.sup_speed = cpu_to_be32(
1883 		qla25xx_fdmi_port_speed_capability(ha));
1884 	alen = sizeof(eiter->a.sup_speed);
1885 	alen += FDMI_ATTR_TYPELEN(eiter);
1886 	eiter->len = cpu_to_be16(alen);
1887 	size += alen;
1888 	ql_dbg(ql_dbg_disc, vha, 0x20c1,
1889 	    "SUPPORTED SPEED = %x.\n", be32_to_cpu(eiter->a.sup_speed));
1890 	/* Current speed. */
1891 	eiter = entries + size;
1892 	eiter->type = cpu_to_be16(FDMI_PORT_CURRENT_SPEED);
1893 	eiter->a.cur_speed = cpu_to_be32(
1894 		qla25xx_fdmi_port_speed_currently(ha));
1895 	alen = sizeof(eiter->a.cur_speed);
1896 	alen += FDMI_ATTR_TYPELEN(eiter);
1897 	eiter->len = cpu_to_be16(alen);
1898 	size += alen;
1899 	ql_dbg(ql_dbg_disc, vha, 0x20c2,
1900 	    "CURRENT SPEED = %x.\n", be32_to_cpu(eiter->a.cur_speed));
1901 	/* Max frame size. */
1902 	eiter = entries + size;
1903 	eiter->type = cpu_to_be16(FDMI_PORT_MAX_FRAME_SIZE);
1904 	eiter->a.max_frame_size = cpu_to_be32(ha->frame_payload_size);
1905 	alen = sizeof(eiter->a.max_frame_size);
1906 	alen += FDMI_ATTR_TYPELEN(eiter);
1907 	eiter->len = cpu_to_be16(alen);
1908 	size += alen;
1909 	ql_dbg(ql_dbg_disc, vha, 0x20c3,
1910 	    "MAX FRAME SIZE = %x.\n", be32_to_cpu(eiter->a.max_frame_size));
1911 	/* OS device name. */
1912 	eiter = entries + size;
1913 	eiter->type = cpu_to_be16(FDMI_PORT_OS_DEVICE_NAME);
1914 	alen = scnprintf(
1915 		eiter->a.os_dev_name, sizeof(eiter->a.os_dev_name),
1916 		"%s:host%lu", QLA2XXX_DRIVER_NAME, vha->host_no);
1917 	alen += FDMI_ATTR_ALIGNMENT(alen);
1918 	alen += FDMI_ATTR_TYPELEN(eiter);
1919 	eiter->len = cpu_to_be16(alen);
1920 	size += alen;
1921 	ql_dbg(ql_dbg_disc, vha, 0x20c4,
1922 	    "OS DEVICE NAME = %s.\n", eiter->a.os_dev_name);
1923 	/* Hostname. */
1924 	eiter = entries + size;
1925 	eiter->type = cpu_to_be16(FDMI_PORT_HOST_NAME);
1926 	if (!*hostname || !strncmp(hostname, "(none)", 6))
1927 		hostname = "Linux-default";
1928 	alen = scnprintf(
1929 		eiter->a.host_name, sizeof(eiter->a.host_name),
1930 		"%s", hostname);
1931 	alen += FDMI_ATTR_ALIGNMENT(alen);
1932 	alen += FDMI_ATTR_TYPELEN(eiter);
1933 	eiter->len = cpu_to_be16(alen);
1934 	size += alen;
1935 	ql_dbg(ql_dbg_disc, vha, 0x20c5,
1936 	    "HOSTNAME = %s.\n", eiter->a.host_name);
1937 
1938 	if (callopt == CALLOPT_FDMI1)
1939 		goto done;
1940 
1941 	/* Node Name */
1942 	eiter = entries + size;
1943 	eiter->type = cpu_to_be16(FDMI_PORT_NODE_NAME);
1944 	memcpy(eiter->a.node_name, vha->node_name, sizeof(eiter->a.node_name));
1945 	alen = sizeof(eiter->a.node_name);
1946 	alen += FDMI_ATTR_TYPELEN(eiter);
1947 	eiter->len = cpu_to_be16(alen);
1948 	size += alen;
1949 	ql_dbg(ql_dbg_disc, vha, 0x20c6,
1950 	    "NODENAME = %016llx.\n", wwn_to_u64(eiter->a.node_name));
1951 
1952 	/* Port Name */
1953 	eiter = entries + size;
1954 	eiter->type = cpu_to_be16(FDMI_PORT_NAME);
1955 	memcpy(eiter->a.port_name, vha->port_name, sizeof(eiter->a.port_name));
1956 	alen = sizeof(eiter->a.port_name);
1957 	alen += FDMI_ATTR_TYPELEN(eiter);
1958 	eiter->len = cpu_to_be16(alen);
1959 	size += alen;
1960 	ql_dbg(ql_dbg_disc, vha, 0x20c7,
1961 	    "PORTNAME = %016llx.\n", wwn_to_u64(eiter->a.port_name));
1962 
1963 	/* Port Symbolic Name */
1964 	eiter = entries + size;
1965 	eiter->type = cpu_to_be16(FDMI_PORT_SYM_NAME);
1966 	alen = qla2x00_get_sym_node_name(vha, eiter->a.port_sym_name,
1967 	    sizeof(eiter->a.port_sym_name));
1968 	alen += FDMI_ATTR_ALIGNMENT(alen);
1969 	alen += FDMI_ATTR_TYPELEN(eiter);
1970 	eiter->len = cpu_to_be16(alen);
1971 	size += alen;
1972 	ql_dbg(ql_dbg_disc, vha, 0x20c8,
1973 	    "PORT SYMBOLIC NAME = %s\n", eiter->a.port_sym_name);
1974 
1975 	/* Port Type */
1976 	eiter = entries + size;
1977 	eiter->type = cpu_to_be16(FDMI_PORT_TYPE);
1978 	eiter->a.port_type = cpu_to_be32(NS_NX_PORT_TYPE);
1979 	alen = sizeof(eiter->a.port_type);
1980 	alen += FDMI_ATTR_TYPELEN(eiter);
1981 	eiter->len = cpu_to_be16(alen);
1982 	size += alen;
1983 	ql_dbg(ql_dbg_disc, vha, 0x20c9,
1984 	    "PORT TYPE = %x.\n", be32_to_cpu(eiter->a.port_type));
1985 
1986 	/* Supported Class of Service */
1987 	eiter = entries + size;
1988 	eiter->type = cpu_to_be16(FDMI_PORT_SUPP_COS);
1989 	eiter->a.port_supported_cos = cpu_to_be32(FC_CLASS_3);
1990 	alen = sizeof(eiter->a.port_supported_cos);
1991 	alen += FDMI_ATTR_TYPELEN(eiter);
1992 	eiter->len = cpu_to_be16(alen);
1993 	size += alen;
1994 	ql_dbg(ql_dbg_disc, vha, 0x20ca,
1995 	    "SUPPORTED COS = %08x\n", be32_to_cpu(eiter->a.port_supported_cos));
1996 
1997 	/* Port Fabric Name */
1998 	eiter = entries + size;
1999 	eiter->type = cpu_to_be16(FDMI_PORT_FABRIC_NAME);
2000 	memcpy(eiter->a.fabric_name, vha->fabric_node_name,
2001 	    sizeof(eiter->a.fabric_name));
2002 	alen = sizeof(eiter->a.fabric_name);
2003 	alen += FDMI_ATTR_TYPELEN(eiter);
2004 	eiter->len = cpu_to_be16(alen);
2005 	size += alen;
2006 	ql_dbg(ql_dbg_disc, vha, 0x20cb,
2007 	    "FABRIC NAME = %016llx.\n", wwn_to_u64(eiter->a.fabric_name));
2008 
2009 	/* FC4_type */
2010 	eiter = entries + size;
2011 	eiter->type = cpu_to_be16(FDMI_PORT_FC4_TYPE);
2012 	eiter->a.port_fc4_type[0] = 0x00;
2013 	eiter->a.port_fc4_type[1] = 0x00;
2014 	eiter->a.port_fc4_type[2] = 0x01;
2015 	eiter->a.port_fc4_type[3] = 0x00;
2016 	alen = sizeof(eiter->a.port_fc4_type);
2017 	alen += FDMI_ATTR_TYPELEN(eiter);
2018 	eiter->len = cpu_to_be16(alen);
2019 	size += alen;
2020 	ql_dbg(ql_dbg_disc, vha, 0x20cc,
2021 	    "PORT ACTIVE FC4 TYPE = %016llx.\n",
2022 	    *(uint64_t *)eiter->a.port_fc4_type);
2023 
2024 	/* Port State */
2025 	eiter = entries + size;
2026 	eiter->type = cpu_to_be16(FDMI_PORT_STATE);
2027 	eiter->a.port_state = cpu_to_be32(2);
2028 	alen = sizeof(eiter->a.port_state);
2029 	alen += FDMI_ATTR_TYPELEN(eiter);
2030 	eiter->len = cpu_to_be16(alen);
2031 	size += alen;
2032 	ql_dbg(ql_dbg_disc, vha, 0x20cd,
2033 	    "PORT_STATE = %x.\n", be32_to_cpu(eiter->a.port_state));
2034 
2035 	/* Number of Ports */
2036 	eiter = entries + size;
2037 	eiter->type = cpu_to_be16(FDMI_PORT_COUNT);
2038 	eiter->a.num_ports = cpu_to_be32(1);
2039 	alen = sizeof(eiter->a.num_ports);
2040 	alen += FDMI_ATTR_TYPELEN(eiter);
2041 	eiter->len = cpu_to_be16(alen);
2042 	size += alen;
2043 	ql_dbg(ql_dbg_disc, vha, 0x20ce,
2044 	    "PORT COUNT = %x.\n", be32_to_cpu(eiter->a.num_ports));
2045 
2046 	/* Port Identifier */
2047 	eiter = entries + size;
2048 	eiter->type = cpu_to_be16(FDMI_PORT_IDENTIFIER);
2049 	eiter->a.port_id = cpu_to_be32(vha->d_id.b24);
2050 	alen = sizeof(eiter->a.port_id);
2051 	alen += FDMI_ATTR_TYPELEN(eiter);
2052 	eiter->len = cpu_to_be16(alen);
2053 	size += alen;
2054 	ql_dbg(ql_dbg_disc, vha, 0x20cf,
2055 	    "PORT ID = %x.\n", be32_to_cpu(eiter->a.port_id));
2056 
2057 	if (callopt == CALLOPT_FDMI2 || !ql2xsmartsan)
2058 		goto done;
2059 
2060 	/* Smart SAN Service Category (Populate Smart SAN Initiator)*/
2061 	eiter = entries + size;
2062 	eiter->type = cpu_to_be16(FDMI_SMARTSAN_SERVICE);
2063 	alen = scnprintf(
2064 		eiter->a.smartsan_service, sizeof(eiter->a.smartsan_service),
2065 		"%s", "Smart SAN Initiator");
2066 	alen += FDMI_ATTR_ALIGNMENT(alen);
2067 	alen += FDMI_ATTR_TYPELEN(eiter);
2068 	eiter->len = cpu_to_be16(alen);
2069 	size += alen;
2070 	ql_dbg(ql_dbg_disc, vha, 0x20d0,
2071 	    "SMARTSAN SERVICE CATEGORY = %s.\n", eiter->a.smartsan_service);
2072 
2073 	/* Smart SAN GUID (NWWN+PWWN) */
2074 	eiter = entries + size;
2075 	eiter->type = cpu_to_be16(FDMI_SMARTSAN_GUID);
2076 	memcpy(eiter->a.smartsan_guid, vha->node_name, WWN_SIZE);
2077 	memcpy(eiter->a.smartsan_guid + WWN_SIZE, vha->port_name, WWN_SIZE);
2078 	alen = sizeof(eiter->a.smartsan_guid);
2079 	alen += FDMI_ATTR_TYPELEN(eiter);
2080 	eiter->len = cpu_to_be16(alen);
2081 	size += alen;
2082 	ql_dbg(ql_dbg_disc, vha, 0x20d1,
2083 	    "Smart SAN GUID = %016llx-%016llx\n",
2084 	    wwn_to_u64(eiter->a.smartsan_guid),
2085 	    wwn_to_u64(eiter->a.smartsan_guid + WWN_SIZE));
2086 
2087 	/* Smart SAN Version (populate "Smart SAN Version 1.0") */
2088 	eiter = entries + size;
2089 	eiter->type = cpu_to_be16(FDMI_SMARTSAN_VERSION);
2090 	alen = scnprintf(
2091 		eiter->a.smartsan_version, sizeof(eiter->a.smartsan_version),
2092 		"%s", "Smart SAN Version 2.0");
2093 	alen += FDMI_ATTR_ALIGNMENT(alen);
2094 	alen += FDMI_ATTR_TYPELEN(eiter);
2095 	eiter->len = cpu_to_be16(alen);
2096 	size += alen;
2097 	ql_dbg(ql_dbg_disc, vha, 0x20d2,
2098 	    "SMARTSAN VERSION = %s\n", eiter->a.smartsan_version);
2099 
2100 	/* Smart SAN Product Name (Specify Adapter Model No) */
2101 	eiter = entries + size;
2102 	eiter->type = cpu_to_be16(FDMI_SMARTSAN_PROD_NAME);
2103 	alen = scnprintf(eiter->a.smartsan_prod_name,
2104 		sizeof(eiter->a.smartsan_prod_name),
2105 		"ISP%04x", ha->pdev->device);
2106 	alen += FDMI_ATTR_ALIGNMENT(alen);
2107 	alen += FDMI_ATTR_TYPELEN(eiter);
2108 	eiter->len = cpu_to_be16(alen);
2109 	size += alen;
2110 	ql_dbg(ql_dbg_disc, vha, 0x20d3,
2111 	    "SMARTSAN PRODUCT NAME = %s\n", eiter->a.smartsan_prod_name);
2112 
2113 	/* Smart SAN Port Info (specify: 1=Physical, 2=NPIV, 3=SRIOV) */
2114 	eiter = entries + size;
2115 	eiter->type = cpu_to_be16(FDMI_SMARTSAN_PORT_INFO);
2116 	eiter->a.smartsan_port_info = cpu_to_be32(vha->vp_idx ? 2 : 1);
2117 	alen = sizeof(eiter->a.smartsan_port_info);
2118 	alen += FDMI_ATTR_TYPELEN(eiter);
2119 	eiter->len = cpu_to_be16(alen);
2120 	size += alen;
2121 	ql_dbg(ql_dbg_disc, vha, 0x20d4,
2122 	    "SMARTSAN PORT INFO = %x\n", eiter->a.smartsan_port_info);
2123 
2124 	/* Smart SAN Security Support */
2125 	eiter = entries + size;
2126 	eiter->type = cpu_to_be16(FDMI_SMARTSAN_SECURITY_SUPPORT);
2127 	eiter->a.smartsan_security_support = cpu_to_be32(1);
2128 	alen = sizeof(eiter->a.smartsan_security_support);
2129 	alen += FDMI_ATTR_TYPELEN(eiter);
2130 	eiter->len = cpu_to_be16(alen);
2131 	size += alen;
2132 	ql_dbg(ql_dbg_disc, vha, 0x20d6,
2133 	    "SMARTSAN SECURITY SUPPORT = %d\n",
2134 	    be32_to_cpu(eiter->a.smartsan_security_support));
2135 
2136 done:
2137 	return size;
2138 }
2139 
2140 /**
2141  * qla2x00_fdmi_rhba() - perform RHBA FDMI registration
2142  * @vha: HA context
2143  * @callopt: Option to issue FDMI registration
2144  *
2145  * Returns 0 on success.
2146  */
2147 static int
2148 qla2x00_fdmi_rhba(scsi_qla_host_t *vha, unsigned int callopt)
2149 {
2150 	struct qla_hw_data *ha = vha->hw;
2151 	unsigned long size = 0;
2152 	unsigned int rval, count;
2153 	ms_iocb_entry_t *ms_pkt;
2154 	struct ct_sns_req *ct_req;
2155 	struct ct_sns_rsp *ct_rsp;
2156 	void *entries;
2157 
2158 	count = callopt != CALLOPT_FDMI1 ?
2159 	    FDMI2_HBA_ATTR_COUNT : FDMI1_HBA_ATTR_COUNT;
2160 
2161 	size = RHBA_RSP_SIZE;
2162 
2163 	ql_dbg(ql_dbg_disc, vha, 0x20e0,
2164 	    "RHBA (callopt=%x count=%u size=%lu).\n", callopt, count, size);
2165 
2166 	/*   Request size adjusted after CT preparation */
2167 	ms_pkt = ha->isp_ops->prep_ms_fdmi_iocb(vha, 0, size);
2168 
2169 	/* Prepare CT request */
2170 	ct_req = qla2x00_prep_ct_fdmi_req(ha->ct_sns, RHBA_CMD, size);
2171 	ct_rsp = &ha->ct_sns->p.rsp;
2172 
2173 	/* Prepare FDMI command entries */
2174 	memcpy(ct_req->req.rhba.hba_identifier, vha->port_name,
2175 	    sizeof(ct_req->req.rhba.hba_identifier));
2176 	size += sizeof(ct_req->req.rhba.hba_identifier);
2177 
2178 	ct_req->req.rhba.entry_count = cpu_to_be32(1);
2179 	size += sizeof(ct_req->req.rhba.entry_count);
2180 
2181 	memcpy(ct_req->req.rhba.port_name, vha->port_name,
2182 	    sizeof(ct_req->req.rhba.port_name));
2183 	size += sizeof(ct_req->req.rhba.port_name);
2184 
2185 	/* Attribute count */
2186 	ct_req->req.rhba.attrs.count = cpu_to_be32(count);
2187 	size += sizeof(ct_req->req.rhba.attrs.count);
2188 
2189 	/* Attribute block */
2190 	entries = &ct_req->req.rhba.attrs.entry;
2191 
2192 	size += qla2x00_hba_attributes(vha, entries, callopt);
2193 
2194 	/* Update MS request size. */
2195 	qla2x00_update_ms_fdmi_iocb(vha, size + 16);
2196 
2197 	ql_dbg(ql_dbg_disc, vha, 0x20e1,
2198 	    "RHBA %016llx %016llx.\n",
2199 	    wwn_to_u64(ct_req->req.rhba.hba_identifier),
2200 	    wwn_to_u64(ct_req->req.rhba.port_name));
2201 
2202 	ql_dump_buffer(ql_dbg_disc + ql_dbg_buffer, vha, 0x20e2,
2203 	    entries, size);
2204 
2205 	/* Execute MS IOCB */
2206 	rval = qla2x00_issue_iocb(vha, ha->ms_iocb, ha->ms_iocb_dma,
2207 	    sizeof(*ha->ms_iocb));
2208 	if (rval) {
2209 		ql_dbg(ql_dbg_disc, vha, 0x20e3,
2210 		    "RHBA iocb failed (%d).\n", rval);
2211 		return rval;
2212 	}
2213 
2214 	rval = qla2x00_chk_ms_status(vha, ms_pkt, ct_rsp, "RHBA");
2215 	if (rval) {
2216 		if (ct_rsp->header.reason_code == CT_REASON_CANNOT_PERFORM &&
2217 		    ct_rsp->header.explanation_code ==
2218 		    CT_EXPL_ALREADY_REGISTERED) {
2219 			ql_dbg(ql_dbg_disc, vha, 0x20e4,
2220 			    "RHBA already registered.\n");
2221 			return QLA_ALREADY_REGISTERED;
2222 		}
2223 
2224 		ql_dbg(ql_dbg_disc, vha, 0x20e5,
2225 		    "RHBA failed, CT Reason %#x, CT Explanation %#x\n",
2226 		    ct_rsp->header.reason_code,
2227 		    ct_rsp->header.explanation_code);
2228 		return rval;
2229 	}
2230 
2231 	ql_dbg(ql_dbg_disc, vha, 0x20e6, "RHBA exiting normally.\n");
2232 	return rval;
2233 }
2234 
2235 
2236 static int
2237 qla2x00_fdmi_dhba(scsi_qla_host_t *vha)
2238 {
2239 	int rval;
2240 	struct qla_hw_data *ha = vha->hw;
2241 	ms_iocb_entry_t *ms_pkt;
2242 	struct ct_sns_req *ct_req;
2243 	struct ct_sns_rsp *ct_rsp;
2244 	/* Issue RPA */
2245 	/* Prepare common MS IOCB */
2246 	ms_pkt = ha->isp_ops->prep_ms_fdmi_iocb(vha, DHBA_REQ_SIZE,
2247 	    DHBA_RSP_SIZE);
2248 	/* Prepare CT request */
2249 	ct_req = qla2x00_prep_ct_fdmi_req(ha->ct_sns, DHBA_CMD, DHBA_RSP_SIZE);
2250 	ct_rsp = &ha->ct_sns->p.rsp;
2251 	/* Prepare FDMI command arguments -- portname. */
2252 	memcpy(ct_req->req.dhba.port_name, vha->port_name, WWN_SIZE);
2253 	ql_dbg(ql_dbg_disc, vha, 0x2036,
2254 	    "DHBA portname = %8phN.\n", ct_req->req.dhba.port_name);
2255 	/* Execute MS IOCB */
2256 	rval = qla2x00_issue_iocb(vha, ha->ms_iocb, ha->ms_iocb_dma,
2257 	    sizeof(ms_iocb_entry_t));
2258 	if (rval != QLA_SUCCESS) {
2259 		/*EMPTY*/
2260 		ql_dbg(ql_dbg_disc, vha, 0x2037,
2261 		    "DHBA issue IOCB failed (%d).\n", rval);
2262 	} else if (qla2x00_chk_ms_status(vha, ms_pkt, ct_rsp, "DHBA") !=
2263 	    QLA_SUCCESS) {
2264 		rval = QLA_FUNCTION_FAILED;
2265 	} else {
2266 		ql_dbg(ql_dbg_disc, vha, 0x2038,
2267 		    "DHBA exiting normally.\n");
2268 	}
2269 	return rval;
2270 }
2271 
2272 /**
2273  * qla2x00_fdmi_rprt() - perform RPRT registration
2274  * @vha: HA context
2275  * @callopt: Option to issue extended or standard FDMI
2276  *           command parameter
2277  *
2278  * Returns 0 on success.
2279  */
2280 static int
2281 qla2x00_fdmi_rprt(scsi_qla_host_t *vha, int callopt)
2282 {
2283 	struct scsi_qla_host *base_vha = pci_get_drvdata(vha->hw->pdev);
2284 	struct qla_hw_data *ha = vha->hw;
2285 	ulong size = 0;
2286 	uint rval, count;
2287 	ms_iocb_entry_t *ms_pkt;
2288 	struct ct_sns_req *ct_req;
2289 	struct ct_sns_rsp *ct_rsp;
2290 	void *entries;
2291 	count = callopt == CALLOPT_FDMI2_SMARTSAN && ql2xsmartsan ?
2292 		FDMI2_SMARTSAN_PORT_ATTR_COUNT :
2293 		callopt != CALLOPT_FDMI1 ?
2294 		FDMI2_PORT_ATTR_COUNT : FDMI1_PORT_ATTR_COUNT;
2295 
2296 	size = RPRT_RSP_SIZE;
2297 	ql_dbg(ql_dbg_disc, vha, 0x20e8,
2298 	    "RPRT (callopt=%x count=%u size=%lu).\n", callopt, count, size);
2299 	/* Request size adjusted after CT preparation */
2300 	ms_pkt = ha->isp_ops->prep_ms_fdmi_iocb(vha, 0, size);
2301 	/* Prepare CT request */
2302 	ct_req = qla2x00_prep_ct_fdmi_req(ha->ct_sns, RPRT_CMD, size);
2303 	ct_rsp = &ha->ct_sns->p.rsp;
2304 	/* Prepare FDMI command entries */
2305 	memcpy(ct_req->req.rprt.hba_identifier, base_vha->port_name,
2306 	    sizeof(ct_req->req.rprt.hba_identifier));
2307 	size += sizeof(ct_req->req.rprt.hba_identifier);
2308 	memcpy(ct_req->req.rprt.port_name, vha->port_name,
2309 	    sizeof(ct_req->req.rprt.port_name));
2310 	size += sizeof(ct_req->req.rprt.port_name);
2311 	/* Attribute count */
2312 	ct_req->req.rprt.attrs.count = cpu_to_be32(count);
2313 	size += sizeof(ct_req->req.rprt.attrs.count);
2314 	/* Attribute block */
2315 	entries = ct_req->req.rprt.attrs.entry;
2316 	size += qla2x00_port_attributes(vha, entries, callopt);
2317 	/* Update MS request size. */
2318 	qla2x00_update_ms_fdmi_iocb(vha, size + 16);
2319 	ql_dbg(ql_dbg_disc, vha, 0x20e9,
2320 	    "RPRT %016llx  %016llx.\n",
2321 	    wwn_to_u64(ct_req->req.rprt.port_name),
2322 	    wwn_to_u64(ct_req->req.rprt.port_name));
2323 	ql_dump_buffer(ql_dbg_disc + ql_dbg_buffer, vha, 0x20ea,
2324 	    entries, size);
2325 	/* Execute MS IOCB */
2326 	rval = qla2x00_issue_iocb(vha, ha->ms_iocb, ha->ms_iocb_dma,
2327 	    sizeof(*ha->ms_iocb));
2328 	if (rval) {
2329 		ql_dbg(ql_dbg_disc, vha, 0x20eb,
2330 		    "RPRT iocb failed (%d).\n", rval);
2331 		return rval;
2332 	}
2333 	rval = qla2x00_chk_ms_status(vha, ms_pkt, ct_rsp, "RPRT");
2334 	if (rval) {
2335 		if (ct_rsp->header.reason_code == CT_REASON_CANNOT_PERFORM &&
2336 		    ct_rsp->header.explanation_code ==
2337 		    CT_EXPL_ALREADY_REGISTERED) {
2338 			ql_dbg(ql_dbg_disc, vha, 0x20ec,
2339 			    "RPRT already registered.\n");
2340 			return QLA_ALREADY_REGISTERED;
2341 		}
2342 
2343 		ql_dbg(ql_dbg_disc, vha, 0x20ed,
2344 		    "RPRT failed, CT Reason code: %#x, CT Explanation %#x\n",
2345 		    ct_rsp->header.reason_code,
2346 		    ct_rsp->header.explanation_code);
2347 		return rval;
2348 	}
2349 	ql_dbg(ql_dbg_disc, vha, 0x20ee, "RPRT exiting normally.\n");
2350 	return rval;
2351 }
2352 
2353 /**
2354  * qla2x00_fdmi_rpa() - perform RPA registration
2355  * @vha: HA context
2356  * @callopt: Option to issue FDMI registration
2357  *
2358  * Returns 0 on success.
2359  */
2360 static int
2361 qla2x00_fdmi_rpa(scsi_qla_host_t *vha, uint callopt)
2362 {
2363 	struct qla_hw_data *ha = vha->hw;
2364 	ulong size = 0;
2365 	uint rval, count;
2366 	ms_iocb_entry_t *ms_pkt;
2367 	struct ct_sns_req *ct_req;
2368 	struct ct_sns_rsp *ct_rsp;
2369 	void *entries;
2370 
2371 	count =
2372 	    callopt == CALLOPT_FDMI2_SMARTSAN && ql2xsmartsan ?
2373 		FDMI2_SMARTSAN_PORT_ATTR_COUNT :
2374 	    callopt != CALLOPT_FDMI1 ?
2375 		FDMI2_PORT_ATTR_COUNT : FDMI1_PORT_ATTR_COUNT;
2376 
2377 	size =
2378 	    callopt != CALLOPT_FDMI1 ?
2379 		SMARTSAN_RPA_RSP_SIZE : RPA_RSP_SIZE;
2380 
2381 	ql_dbg(ql_dbg_disc, vha, 0x20f0,
2382 	    "RPA (callopt=%x count=%u size=%lu).\n", callopt, count, size);
2383 
2384 	/* Request size adjusted after CT preparation */
2385 	ms_pkt = ha->isp_ops->prep_ms_fdmi_iocb(vha, 0, size);
2386 
2387 	/* Prepare CT request */
2388 	ct_req = qla2x00_prep_ct_fdmi_req(ha->ct_sns, RPA_CMD, size);
2389 	ct_rsp = &ha->ct_sns->p.rsp;
2390 
2391 	/* Prepare FDMI command entries. */
2392 	memcpy(ct_req->req.rpa.port_name, vha->port_name,
2393 	    sizeof(ct_req->req.rpa.port_name));
2394 	size += sizeof(ct_req->req.rpa.port_name);
2395 
2396 	/* Attribute count */
2397 	ct_req->req.rpa.attrs.count = cpu_to_be32(count);
2398 	size += sizeof(ct_req->req.rpa.attrs.count);
2399 
2400 	/* Attribute block */
2401 	entries = ct_req->req.rpa.attrs.entry;
2402 
2403 	size += qla2x00_port_attributes(vha, entries, callopt);
2404 
2405 	/* Update MS request size. */
2406 	qla2x00_update_ms_fdmi_iocb(vha, size + 16);
2407 
2408 	ql_dbg(ql_dbg_disc, vha, 0x20f1,
2409 	    "RPA %016llx.\n", wwn_to_u64(ct_req->req.rpa.port_name));
2410 
2411 	ql_dump_buffer(ql_dbg_disc + ql_dbg_buffer, vha, 0x20f2,
2412 	    entries, size);
2413 
2414 	/* Execute MS IOCB */
2415 	rval = qla2x00_issue_iocb(vha, ha->ms_iocb, ha->ms_iocb_dma,
2416 	    sizeof(*ha->ms_iocb));
2417 	if (rval) {
2418 		ql_dbg(ql_dbg_disc, vha, 0x20f3,
2419 		    "RPA iocb failed (%d).\n", rval);
2420 		return rval;
2421 	}
2422 
2423 	rval = qla2x00_chk_ms_status(vha, ms_pkt, ct_rsp, "RPA");
2424 	if (rval) {
2425 		if (ct_rsp->header.reason_code == CT_REASON_CANNOT_PERFORM &&
2426 		    ct_rsp->header.explanation_code ==
2427 		    CT_EXPL_ALREADY_REGISTERED) {
2428 			ql_dbg(ql_dbg_disc, vha, 0x20f4,
2429 			    "RPA already registered.\n");
2430 			return QLA_ALREADY_REGISTERED;
2431 		}
2432 
2433 		ql_dbg(ql_dbg_disc, vha, 0x20f5,
2434 		    "RPA failed, CT Reason code: %#x, CT Explanation %#x\n",
2435 		    ct_rsp->header.reason_code,
2436 		    ct_rsp->header.explanation_code);
2437 		return rval;
2438 	}
2439 
2440 	ql_dbg(ql_dbg_disc, vha, 0x20f6, "RPA exiting normally.\n");
2441 	return rval;
2442 }
2443 
2444 /**
2445  * qla2x00_fdmi_register() -
2446  * @vha: HA context
2447  *
2448  * Returns 0 on success.
2449  */
2450 int
2451 qla2x00_fdmi_register(scsi_qla_host_t *vha)
2452 {
2453 	int rval = QLA_SUCCESS;
2454 	struct qla_hw_data *ha = vha->hw;
2455 
2456 	if (IS_QLA2100(ha) || IS_QLA2200(ha) ||
2457 	    IS_QLAFX00(ha))
2458 		return rval;
2459 
2460 	rval = qla2x00_mgmt_svr_login(vha);
2461 	if (rval)
2462 		return rval;
2463 
2464 	/* For npiv/vport send rprt only */
2465 	if (vha->vp_idx) {
2466 		if (ql2xsmartsan)
2467 			rval = qla2x00_fdmi_rprt(vha, CALLOPT_FDMI2_SMARTSAN);
2468 		if (rval || !ql2xsmartsan)
2469 			rval = qla2x00_fdmi_rprt(vha, CALLOPT_FDMI2);
2470 		if (rval)
2471 			rval = qla2x00_fdmi_rprt(vha, CALLOPT_FDMI1);
2472 
2473 		return rval;
2474 	}
2475 
2476 	/* Try fdmi2 first, if fails then try fdmi1 */
2477 	rval = qla2x00_fdmi_rhba(vha, CALLOPT_FDMI2);
2478 	if (rval) {
2479 		if (rval != QLA_ALREADY_REGISTERED)
2480 			goto try_fdmi;
2481 
2482 		rval = qla2x00_fdmi_dhba(vha);
2483 		if (rval)
2484 			goto try_fdmi;
2485 
2486 		rval = qla2x00_fdmi_rhba(vha, CALLOPT_FDMI2);
2487 		if (rval)
2488 			goto try_fdmi;
2489 	}
2490 
2491 	if (ql2xsmartsan)
2492 		rval = qla2x00_fdmi_rpa(vha, CALLOPT_FDMI2_SMARTSAN);
2493 	if (rval || !ql2xsmartsan)
2494 		rval = qla2x00_fdmi_rpa(vha, CALLOPT_FDMI2);
2495 	if (rval)
2496 		goto try_fdmi;
2497 
2498 	return rval;
2499 
2500 try_fdmi:
2501 	rval = qla2x00_fdmi_rhba(vha, CALLOPT_FDMI1);
2502 	if (rval) {
2503 		if (rval != QLA_ALREADY_REGISTERED)
2504 			return rval;
2505 
2506 		rval = qla2x00_fdmi_dhba(vha);
2507 		if (rval)
2508 			return rval;
2509 
2510 		rval = qla2x00_fdmi_rhba(vha, CALLOPT_FDMI1);
2511 		if (rval)
2512 			return rval;
2513 	}
2514 
2515 	rval = qla2x00_fdmi_rpa(vha, CALLOPT_FDMI1);
2516 
2517 	return rval;
2518 }
2519 
2520 /**
2521  * qla2x00_gfpn_id() - SNS Get Fabric Port Name (GFPN_ID) query.
2522  * @vha: HA context
2523  * @list: switch info entries to populate
2524  *
2525  * Returns 0 on success.
2526  */
2527 int
2528 qla2x00_gfpn_id(scsi_qla_host_t *vha, sw_info_t *list)
2529 {
2530 	int		rval = QLA_SUCCESS;
2531 	uint16_t	i;
2532 	struct qla_hw_data *ha = vha->hw;
2533 	ms_iocb_entry_t	*ms_pkt;
2534 	struct ct_sns_req	*ct_req;
2535 	struct ct_sns_rsp	*ct_rsp;
2536 	struct ct_arg arg;
2537 
2538 	if (!IS_IIDMA_CAPABLE(ha))
2539 		return QLA_FUNCTION_FAILED;
2540 
2541 	arg.iocb = ha->ms_iocb;
2542 	arg.req_dma = ha->ct_sns_dma;
2543 	arg.rsp_dma = ha->ct_sns_dma;
2544 	arg.req_size = GFPN_ID_REQ_SIZE;
2545 	arg.rsp_size = GFPN_ID_RSP_SIZE;
2546 	arg.nport_handle = NPH_SNS;
2547 
2548 	for (i = 0; i < ha->max_fibre_devices; i++) {
2549 		/* Issue GFPN_ID */
2550 		/* Prepare common MS IOCB */
2551 		ms_pkt = ha->isp_ops->prep_ms_iocb(vha, &arg);
2552 
2553 		/* Prepare CT request */
2554 		ct_req = qla2x00_prep_ct_req(ha->ct_sns, GFPN_ID_CMD,
2555 		    GFPN_ID_RSP_SIZE);
2556 		ct_rsp = &ha->ct_sns->p.rsp;
2557 
2558 		/* Prepare CT arguments -- port_id */
2559 		ct_req->req.port_id.port_id = port_id_to_be_id(list[i].d_id);
2560 
2561 		/* Execute MS IOCB */
2562 		rval = qla2x00_issue_iocb(vha, ha->ms_iocb, ha->ms_iocb_dma,
2563 		    sizeof(ms_iocb_entry_t));
2564 		if (rval != QLA_SUCCESS) {
2565 			/*EMPTY*/
2566 			ql_dbg(ql_dbg_disc, vha, 0x2023,
2567 			    "GFPN_ID issue IOCB failed (%d).\n", rval);
2568 			break;
2569 		} else if (qla2x00_chk_ms_status(vha, ms_pkt, ct_rsp,
2570 		    "GFPN_ID") != QLA_SUCCESS) {
2571 			rval = QLA_FUNCTION_FAILED;
2572 			break;
2573 		} else {
2574 			/* Save fabric portname */
2575 			memcpy(list[i].fabric_port_name,
2576 			    ct_rsp->rsp.gfpn_id.port_name, WWN_SIZE);
2577 		}
2578 
2579 		/* Last device exit. */
2580 		if (list[i].d_id.b.rsvd_1 != 0)
2581 			break;
2582 	}
2583 
2584 	return (rval);
2585 }
2586 
2587 
2588 static inline struct ct_sns_req *
2589 qla24xx_prep_ct_fm_req(struct ct_sns_pkt *p, uint16_t cmd,
2590     uint16_t rsp_size)
2591 {
2592 	memset(p, 0, sizeof(struct ct_sns_pkt));
2593 
2594 	p->p.req.header.revision = 0x01;
2595 	p->p.req.header.gs_type = 0xFA;
2596 	p->p.req.header.gs_subtype = 0x01;
2597 	p->p.req.command = cpu_to_be16(cmd);
2598 	p->p.req.max_rsp_size = cpu_to_be16((rsp_size - 16) / 4);
2599 
2600 	return &p->p.req;
2601 }
2602 
2603 static uint16_t
2604 qla2x00_port_speed_capability(uint16_t speed)
2605 {
2606 	switch (speed) {
2607 	case BIT_15:
2608 		return PORT_SPEED_1GB;
2609 	case BIT_14:
2610 		return PORT_SPEED_2GB;
2611 	case BIT_13:
2612 		return PORT_SPEED_4GB;
2613 	case BIT_12:
2614 		return PORT_SPEED_10GB;
2615 	case BIT_11:
2616 		return PORT_SPEED_8GB;
2617 	case BIT_10:
2618 		return PORT_SPEED_16GB;
2619 	case BIT_8:
2620 		return PORT_SPEED_32GB;
2621 	case BIT_7:
2622 		return PORT_SPEED_64GB;
2623 	default:
2624 		return PORT_SPEED_UNKNOWN;
2625 	}
2626 }
2627 
2628 /**
2629  * qla2x00_gpsc() - FCS Get Port Speed Capabilities (GPSC) query.
2630  * @vha: HA context
2631  * @list: switch info entries to populate
2632  *
2633  * Returns 0 on success.
2634  */
2635 int
2636 qla2x00_gpsc(scsi_qla_host_t *vha, sw_info_t *list)
2637 {
2638 	int		rval;
2639 	uint16_t	i;
2640 	struct qla_hw_data *ha = vha->hw;
2641 	ms_iocb_entry_t *ms_pkt;
2642 	struct ct_sns_req	*ct_req;
2643 	struct ct_sns_rsp	*ct_rsp;
2644 	struct ct_arg arg;
2645 
2646 	if (!IS_IIDMA_CAPABLE(ha))
2647 		return QLA_FUNCTION_FAILED;
2648 	if (!ha->flags.gpsc_supported)
2649 		return QLA_FUNCTION_FAILED;
2650 
2651 	rval = qla2x00_mgmt_svr_login(vha);
2652 	if (rval)
2653 		return rval;
2654 
2655 	arg.iocb = ha->ms_iocb;
2656 	arg.req_dma = ha->ct_sns_dma;
2657 	arg.rsp_dma = ha->ct_sns_dma;
2658 	arg.req_size = GPSC_REQ_SIZE;
2659 	arg.rsp_size = GPSC_RSP_SIZE;
2660 	arg.nport_handle = vha->mgmt_svr_loop_id;
2661 
2662 	for (i = 0; i < ha->max_fibre_devices; i++) {
2663 		/* Issue GFPN_ID */
2664 		/* Prepare common MS IOCB */
2665 		ms_pkt = qla24xx_prep_ms_iocb(vha, &arg);
2666 
2667 		/* Prepare CT request */
2668 		ct_req = qla24xx_prep_ct_fm_req(ha->ct_sns, GPSC_CMD,
2669 		    GPSC_RSP_SIZE);
2670 		ct_rsp = &ha->ct_sns->p.rsp;
2671 
2672 		/* Prepare CT arguments -- port_name */
2673 		memcpy(ct_req->req.gpsc.port_name, list[i].fabric_port_name,
2674 		    WWN_SIZE);
2675 
2676 		/* Execute MS IOCB */
2677 		rval = qla2x00_issue_iocb(vha, ha->ms_iocb, ha->ms_iocb_dma,
2678 		    sizeof(ms_iocb_entry_t));
2679 		if (rval != QLA_SUCCESS) {
2680 			/*EMPTY*/
2681 			ql_dbg(ql_dbg_disc, vha, 0x2059,
2682 			    "GPSC issue IOCB failed (%d).\n", rval);
2683 		} else if ((rval = qla2x00_chk_ms_status(vha, ms_pkt, ct_rsp,
2684 		    "GPSC")) != QLA_SUCCESS) {
2685 			/* FM command unsupported? */
2686 			if (rval == QLA_INVALID_COMMAND &&
2687 			    (ct_rsp->header.reason_code ==
2688 				CT_REASON_INVALID_COMMAND_CODE ||
2689 			     ct_rsp->header.reason_code ==
2690 				CT_REASON_COMMAND_UNSUPPORTED)) {
2691 				ql_dbg(ql_dbg_disc, vha, 0x205a,
2692 				    "GPSC command unsupported, disabling "
2693 				    "query.\n");
2694 				ha->flags.gpsc_supported = 0;
2695 				rval = QLA_FUNCTION_FAILED;
2696 				break;
2697 			}
2698 			rval = QLA_FUNCTION_FAILED;
2699 		} else {
2700 			list->fp_speed = qla2x00_port_speed_capability(
2701 			    be16_to_cpu(ct_rsp->rsp.gpsc.speed));
2702 			ql_dbg(ql_dbg_disc, vha, 0x205b,
2703 			    "GPSC ext entry - fpn "
2704 			    "%8phN speeds=%04x speed=%04x.\n",
2705 			    list[i].fabric_port_name,
2706 			    be16_to_cpu(ct_rsp->rsp.gpsc.speeds),
2707 			    be16_to_cpu(ct_rsp->rsp.gpsc.speed));
2708 		}
2709 
2710 		/* Last device exit. */
2711 		if (list[i].d_id.b.rsvd_1 != 0)
2712 			break;
2713 	}
2714 
2715 	return (rval);
2716 }
2717 
2718 /**
2719  * qla2x00_gff_id() - SNS Get FC-4 Features (GFF_ID) query.
2720  *
2721  * @vha: HA context
2722  * @list: switch info entries to populate
2723  *
2724  */
2725 void
2726 qla2x00_gff_id(scsi_qla_host_t *vha, sw_info_t *list)
2727 {
2728 	int		rval;
2729 	uint16_t	i;
2730 
2731 	ms_iocb_entry_t	*ms_pkt;
2732 	struct ct_sns_req	*ct_req;
2733 	struct ct_sns_rsp	*ct_rsp;
2734 	struct qla_hw_data *ha = vha->hw;
2735 	uint8_t fcp_scsi_features = 0, nvme_features = 0;
2736 	struct ct_arg arg;
2737 
2738 	for (i = 0; i < ha->max_fibre_devices; i++) {
2739 		/* Set default FC4 Type as UNKNOWN so the default is to
2740 		 * Process this port */
2741 		list[i].fc4_type = 0;
2742 
2743 		/* Do not attempt GFF_ID if we are not FWI_2 capable */
2744 		if (!IS_FWI2_CAPABLE(ha))
2745 			continue;
2746 
2747 		arg.iocb = ha->ms_iocb;
2748 		arg.req_dma = ha->ct_sns_dma;
2749 		arg.rsp_dma = ha->ct_sns_dma;
2750 		arg.req_size = GFF_ID_REQ_SIZE;
2751 		arg.rsp_size = GFF_ID_RSP_SIZE;
2752 		arg.nport_handle = NPH_SNS;
2753 
2754 		/* Prepare common MS IOCB */
2755 		ms_pkt = ha->isp_ops->prep_ms_iocb(vha, &arg);
2756 
2757 		/* Prepare CT request */
2758 		ct_req = qla2x00_prep_ct_req(ha->ct_sns, GFF_ID_CMD,
2759 		    GFF_ID_RSP_SIZE);
2760 		ct_rsp = &ha->ct_sns->p.rsp;
2761 
2762 		/* Prepare CT arguments -- port_id */
2763 		ct_req->req.port_id.port_id = port_id_to_be_id(list[i].d_id);
2764 
2765 		/* Execute MS IOCB */
2766 		rval = qla2x00_issue_iocb(vha, ha->ms_iocb, ha->ms_iocb_dma,
2767 		   sizeof(ms_iocb_entry_t));
2768 
2769 		if (rval != QLA_SUCCESS) {
2770 			ql_dbg(ql_dbg_disc, vha, 0x205c,
2771 			    "GFF_ID issue IOCB failed (%d).\n", rval);
2772 		} else if (qla2x00_chk_ms_status(vha, ms_pkt, ct_rsp,
2773 			       "GFF_ID") != QLA_SUCCESS) {
2774 			ql_dbg(ql_dbg_disc, vha, 0x205d,
2775 			    "GFF_ID IOCB status had a failure status code.\n");
2776 		} else {
2777 			fcp_scsi_features =
2778 			   ct_rsp->rsp.gff_id.fc4_features[GFF_FCP_SCSI_OFFSET];
2779 			fcp_scsi_features &= 0x0f;
2780 
2781 			if (fcp_scsi_features) {
2782 				list[i].fc4_type = FS_FC4TYPE_FCP;
2783 				list[i].fc4_features = fcp_scsi_features;
2784 			}
2785 
2786 			nvme_features =
2787 			    ct_rsp->rsp.gff_id.fc4_features[GFF_NVME_OFFSET];
2788 			nvme_features &= 0xf;
2789 
2790 			if (nvme_features) {
2791 				list[i].fc4_type |= FS_FC4TYPE_NVME;
2792 				list[i].fc4_features = nvme_features;
2793 			}
2794 		}
2795 
2796 		/* Last device exit. */
2797 		if (list[i].d_id.b.rsvd_1 != 0)
2798 			break;
2799 	}
2800 }
2801 
2802 int qla24xx_post_gpsc_work(struct scsi_qla_host *vha, fc_port_t *fcport)
2803 {
2804 	struct qla_work_evt *e;
2805 
2806 	e = qla2x00_alloc_work(vha, QLA_EVT_GPSC);
2807 	if (!e)
2808 		return QLA_FUNCTION_FAILED;
2809 
2810 	e->u.fcport.fcport = fcport;
2811 	return qla2x00_post_work(vha, e);
2812 }
2813 
2814 void qla24xx_handle_gpsc_event(scsi_qla_host_t *vha, struct event_arg *ea)
2815 {
2816 	struct fc_port *fcport = ea->fcport;
2817 
2818 	ql_dbg(ql_dbg_disc, vha, 0x20d8,
2819 	    "%s %8phC DS %d LS %d rc %d login %d|%d rscn %d|%d lid %d\n",
2820 	    __func__, fcport->port_name, fcport->disc_state,
2821 	    fcport->fw_login_state, ea->rc, ea->sp->gen2, fcport->login_gen,
2822 	    ea->sp->gen2, fcport->rscn_gen|ea->sp->gen1, fcport->loop_id);
2823 
2824 	if (fcport->disc_state == DSC_DELETE_PEND)
2825 		return;
2826 
2827 	/* We will figure-out what happen after AUTH completes */
2828 	if (fcport->disc_state == DSC_LOGIN_AUTH_PEND)
2829 		return;
2830 
2831 	if (ea->sp->gen2 != fcport->login_gen) {
2832 		/* target side must have changed it. */
2833 		ql_dbg(ql_dbg_disc, vha, 0x20d3,
2834 		    "%s %8phC generation changed\n",
2835 		    __func__, fcport->port_name);
2836 		return;
2837 	} else if (ea->sp->gen1 != fcport->rscn_gen) {
2838 		return;
2839 	}
2840 
2841 	qla_post_iidma_work(vha, fcport);
2842 }
2843 
2844 static void qla24xx_async_gpsc_sp_done(srb_t *sp, int res)
2845 {
2846 	struct scsi_qla_host *vha = sp->vha;
2847 	struct qla_hw_data *ha = vha->hw;
2848 	fc_port_t *fcport = sp->fcport;
2849 	struct ct_sns_rsp       *ct_rsp;
2850 	struct event_arg ea;
2851 
2852 	ct_rsp = &fcport->ct_desc.ct_sns->p.rsp;
2853 
2854 	ql_dbg(ql_dbg_disc, vha, 0x2053,
2855 	    "Async done-%s res %x, WWPN %8phC \n",
2856 	    sp->name, res, fcport->port_name);
2857 
2858 	fcport->flags &= ~(FCF_ASYNC_SENT | FCF_ASYNC_ACTIVE);
2859 
2860 	if (res == QLA_FUNCTION_TIMEOUT)
2861 		goto done;
2862 
2863 	if (res == (DID_ERROR << 16)) {
2864 		/* entry status error */
2865 		goto done;
2866 	} else if (res) {
2867 		if ((ct_rsp->header.reason_code ==
2868 			 CT_REASON_INVALID_COMMAND_CODE) ||
2869 			(ct_rsp->header.reason_code ==
2870 			CT_REASON_COMMAND_UNSUPPORTED)) {
2871 			ql_dbg(ql_dbg_disc, vha, 0x2019,
2872 			    "GPSC command unsupported, disabling query.\n");
2873 			ha->flags.gpsc_supported = 0;
2874 			goto done;
2875 		}
2876 	} else {
2877 		fcport->fp_speed = qla2x00_port_speed_capability(
2878 		    be16_to_cpu(ct_rsp->rsp.gpsc.speed));
2879 
2880 		ql_dbg(ql_dbg_disc, vha, 0x2054,
2881 		    "Async-%s OUT WWPN %8phC speeds=%04x speed=%04x.\n",
2882 		    sp->name, fcport->fabric_port_name,
2883 		    be16_to_cpu(ct_rsp->rsp.gpsc.speeds),
2884 		    be16_to_cpu(ct_rsp->rsp.gpsc.speed));
2885 	}
2886 	memset(&ea, 0, sizeof(ea));
2887 	ea.rc = res;
2888 	ea.fcport = fcport;
2889 	ea.sp = sp;
2890 	qla24xx_handle_gpsc_event(vha, &ea);
2891 
2892 done:
2893 	/* ref: INIT */
2894 	kref_put(&sp->cmd_kref, qla2x00_sp_release);
2895 }
2896 
2897 int qla24xx_async_gpsc(scsi_qla_host_t *vha, fc_port_t *fcport)
2898 {
2899 	int rval = QLA_FUNCTION_FAILED;
2900 	struct ct_sns_req       *ct_req;
2901 	srb_t *sp;
2902 
2903 	if (!vha->flags.online || (fcport->flags & FCF_ASYNC_SENT))
2904 		return rval;
2905 
2906 	/* ref: INIT */
2907 	sp = qla2x00_get_sp(vha, fcport, GFP_KERNEL);
2908 	if (!sp)
2909 		goto done;
2910 
2911 	sp->type = SRB_CT_PTHRU_CMD;
2912 	sp->name = "gpsc";
2913 	sp->gen1 = fcport->rscn_gen;
2914 	sp->gen2 = fcport->login_gen;
2915 	qla2x00_init_async_sp(sp, qla2x00_get_async_timeout(vha) + 2,
2916 			      qla24xx_async_gpsc_sp_done);
2917 
2918 	/* CT_IU preamble  */
2919 	ct_req = qla24xx_prep_ct_fm_req(fcport->ct_desc.ct_sns, GPSC_CMD,
2920 		GPSC_RSP_SIZE);
2921 
2922 	/* GPSC req */
2923 	memcpy(ct_req->req.gpsc.port_name, fcport->fabric_port_name,
2924 		WWN_SIZE);
2925 
2926 	sp->u.iocb_cmd.u.ctarg.req = fcport->ct_desc.ct_sns;
2927 	sp->u.iocb_cmd.u.ctarg.req_dma = fcport->ct_desc.ct_sns_dma;
2928 	sp->u.iocb_cmd.u.ctarg.rsp = fcport->ct_desc.ct_sns;
2929 	sp->u.iocb_cmd.u.ctarg.rsp_dma = fcport->ct_desc.ct_sns_dma;
2930 	sp->u.iocb_cmd.u.ctarg.req_size = GPSC_REQ_SIZE;
2931 	sp->u.iocb_cmd.u.ctarg.rsp_size = GPSC_RSP_SIZE;
2932 	sp->u.iocb_cmd.u.ctarg.nport_handle = vha->mgmt_svr_loop_id;
2933 
2934 	ql_dbg(ql_dbg_disc, vha, 0x205e,
2935 	    "Async-%s %8phC hdl=%x loopid=%x portid=%02x%02x%02x.\n",
2936 	    sp->name, fcport->port_name, sp->handle,
2937 	    fcport->loop_id, fcport->d_id.b.domain,
2938 	    fcport->d_id.b.area, fcport->d_id.b.al_pa);
2939 
2940 	rval = qla2x00_start_sp(sp);
2941 	if (rval != QLA_SUCCESS)
2942 		goto done_free_sp;
2943 	return rval;
2944 
2945 done_free_sp:
2946 	/* ref: INIT */
2947 	kref_put(&sp->cmd_kref, qla2x00_sp_release);
2948 done:
2949 	return rval;
2950 }
2951 
2952 void qla24xx_sp_unmap(scsi_qla_host_t *vha, srb_t *sp)
2953 {
2954 	struct srb_iocb *c = &sp->u.iocb_cmd;
2955 
2956 	switch (sp->type) {
2957 	case SRB_ELS_DCMD:
2958 		qla2x00_els_dcmd2_free(vha, &c->u.els_plogi);
2959 		break;
2960 	case SRB_CT_PTHRU_CMD:
2961 	default:
2962 		if (sp->u.iocb_cmd.u.ctarg.req) {
2963 			dma_free_coherent(&vha->hw->pdev->dev,
2964 			    sp->u.iocb_cmd.u.ctarg.req_allocated_size,
2965 			    sp->u.iocb_cmd.u.ctarg.req,
2966 			    sp->u.iocb_cmd.u.ctarg.req_dma);
2967 			sp->u.iocb_cmd.u.ctarg.req = NULL;
2968 		}
2969 
2970 		if (sp->u.iocb_cmd.u.ctarg.rsp) {
2971 			dma_free_coherent(&vha->hw->pdev->dev,
2972 			    sp->u.iocb_cmd.u.ctarg.rsp_allocated_size,
2973 			    sp->u.iocb_cmd.u.ctarg.rsp,
2974 			    sp->u.iocb_cmd.u.ctarg.rsp_dma);
2975 			sp->u.iocb_cmd.u.ctarg.rsp = NULL;
2976 		}
2977 		break;
2978 	}
2979 
2980 	/* ref: INIT */
2981 	kref_put(&sp->cmd_kref, qla2x00_sp_release);
2982 }
2983 
2984 void qla24xx_async_gffid_sp_done(srb_t *sp, int res)
2985 {
2986 	struct scsi_qla_host *vha = sp->vha;
2987 	fc_port_t *fcport = sp->fcport;
2988 	struct ct_sns_rsp *ct_rsp;
2989 	uint8_t fc4_scsi_feat;
2990 	uint8_t fc4_nvme_feat;
2991 
2992 	ql_dbg(ql_dbg_disc, vha, 0x2133,
2993 	       "Async done-%s res %x ID %x. %8phC\n",
2994 	       sp->name, res, fcport->d_id.b24, fcport->port_name);
2995 
2996 	ct_rsp = sp->u.iocb_cmd.u.ctarg.rsp;
2997 	fc4_scsi_feat = ct_rsp->rsp.gff_id.fc4_features[GFF_FCP_SCSI_OFFSET];
2998 	fc4_nvme_feat = ct_rsp->rsp.gff_id.fc4_features[GFF_NVME_OFFSET];
2999 	sp->rc = res;
3000 
3001 	/*
3002 	 * FC-GS-7, 5.2.3.12 FC-4 Features - format
3003 	 * The format of the FC-4 Features object, as defined by the FC-4,
3004 	 * Shall be an array of 4-bit values, one for each type code value
3005 	 */
3006 	if (!res) {
3007 		if (fc4_scsi_feat & 0xf) {
3008 			/* w1 b00:03 */
3009 			fcport->fc4_type = FS_FC4TYPE_FCP;
3010 			fcport->fc4_features = fc4_scsi_feat & 0xf;
3011 		}
3012 
3013 		if (fc4_nvme_feat & 0xf) {
3014 			/* w5 [00:03]/28h */
3015 			fcport->fc4_type |= FS_FC4TYPE_NVME;
3016 			fcport->fc4_features = fc4_nvme_feat & 0xf;
3017 		}
3018 	}
3019 
3020 	if (sp->flags & SRB_WAKEUP_ON_COMP) {
3021 		complete(sp->comp);
3022 	} else  {
3023 		if (sp->u.iocb_cmd.u.ctarg.req) {
3024 			dma_free_coherent(&vha->hw->pdev->dev,
3025 				sp->u.iocb_cmd.u.ctarg.req_allocated_size,
3026 				sp->u.iocb_cmd.u.ctarg.req,
3027 				sp->u.iocb_cmd.u.ctarg.req_dma);
3028 			sp->u.iocb_cmd.u.ctarg.req = NULL;
3029 		}
3030 
3031 		if (sp->u.iocb_cmd.u.ctarg.rsp) {
3032 			dma_free_coherent(&vha->hw->pdev->dev,
3033 				sp->u.iocb_cmd.u.ctarg.rsp_allocated_size,
3034 				sp->u.iocb_cmd.u.ctarg.rsp,
3035 				sp->u.iocb_cmd.u.ctarg.rsp_dma);
3036 			sp->u.iocb_cmd.u.ctarg.rsp = NULL;
3037 		}
3038 
3039 		/* ref: INIT */
3040 		kref_put(&sp->cmd_kref, qla2x00_sp_release);
3041 		/* we should not be here */
3042 		dump_stack();
3043 	}
3044 }
3045 
3046 /* Get FC4 Feature with Nport ID. */
3047 int qla24xx_async_gffid(scsi_qla_host_t *vha, fc_port_t *fcport, bool wait)
3048 {
3049 	int rval = QLA_FUNCTION_FAILED;
3050 	struct ct_sns_req       *ct_req;
3051 	srb_t *sp;
3052 	DECLARE_COMPLETION_ONSTACK(comp);
3053 
3054 	/* this routine does not have handling for no wait */
3055 	if (!vha->flags.online || !wait)
3056 		return rval;
3057 
3058 	/* ref: INIT */
3059 	sp = qla2x00_get_sp(vha, fcport, GFP_KERNEL);
3060 	if (!sp)
3061 		return rval;
3062 
3063 	sp->type = SRB_CT_PTHRU_CMD;
3064 	sp->name = "gffid";
3065 	sp->gen1 = fcport->rscn_gen;
3066 	sp->gen2 = fcport->login_gen;
3067 	qla2x00_init_async_sp(sp, qla2x00_get_async_timeout(vha) + 2,
3068 			      qla24xx_async_gffid_sp_done);
3069 	sp->comp = &comp;
3070 	sp->u.iocb_cmd.timeout = qla2x00_els_dcmd2_iocb_timeout;
3071 
3072 	if (wait)
3073 		sp->flags = SRB_WAKEUP_ON_COMP;
3074 
3075 	sp->u.iocb_cmd.u.ctarg.req_allocated_size = sizeof(struct ct_sns_pkt);
3076 	sp->u.iocb_cmd.u.ctarg.req = dma_alloc_coherent(&vha->hw->pdev->dev,
3077 				sp->u.iocb_cmd.u.ctarg.req_allocated_size,
3078 				&sp->u.iocb_cmd.u.ctarg.req_dma,
3079 	    GFP_KERNEL);
3080 	if (!sp->u.iocb_cmd.u.ctarg.req) {
3081 		ql_log(ql_log_warn, vha, 0xd041,
3082 		       "%s: Failed to allocate ct_sns request.\n",
3083 		       __func__);
3084 		goto done_free_sp;
3085 	}
3086 
3087 	sp->u.iocb_cmd.u.ctarg.rsp_allocated_size = sizeof(struct ct_sns_pkt);
3088 	sp->u.iocb_cmd.u.ctarg.rsp = dma_alloc_coherent(&vha->hw->pdev->dev,
3089 				sp->u.iocb_cmd.u.ctarg.rsp_allocated_size,
3090 				&sp->u.iocb_cmd.u.ctarg.rsp_dma,
3091 	    GFP_KERNEL);
3092 	if (!sp->u.iocb_cmd.u.ctarg.rsp) {
3093 		ql_log(ql_log_warn, vha, 0xd041,
3094 		       "%s: Failed to allocate ct_sns response.\n",
3095 		       __func__);
3096 		goto done_free_sp;
3097 	}
3098 
3099 	/* CT_IU preamble  */
3100 	ct_req = qla2x00_prep_ct_req(sp->u.iocb_cmd.u.ctarg.req, GFF_ID_CMD, GFF_ID_RSP_SIZE);
3101 
3102 	ct_req->req.gff_id.port_id[0] = fcport->d_id.b.domain;
3103 	ct_req->req.gff_id.port_id[1] = fcport->d_id.b.area;
3104 	ct_req->req.gff_id.port_id[2] = fcport->d_id.b.al_pa;
3105 
3106 	sp->u.iocb_cmd.u.ctarg.req_size = GFF_ID_REQ_SIZE;
3107 	sp->u.iocb_cmd.u.ctarg.rsp_size = GFF_ID_RSP_SIZE;
3108 	sp->u.iocb_cmd.u.ctarg.nport_handle = NPH_SNS;
3109 
3110 	rval = qla2x00_start_sp(sp);
3111 
3112 	if (rval != QLA_SUCCESS) {
3113 		rval = QLA_FUNCTION_FAILED;
3114 		goto done_free_sp;
3115 	} else {
3116 		ql_dbg(ql_dbg_disc, vha, 0x3074,
3117 		       "Async-%s hdl=%x portid %06x\n",
3118 		       sp->name, sp->handle, fcport->d_id.b24);
3119 	}
3120 
3121 	wait_for_completion(sp->comp);
3122 	rval = sp->rc;
3123 
3124 done_free_sp:
3125 	if (sp->u.iocb_cmd.u.ctarg.req) {
3126 		dma_free_coherent(&vha->hw->pdev->dev,
3127 				  sp->u.iocb_cmd.u.ctarg.req_allocated_size,
3128 				  sp->u.iocb_cmd.u.ctarg.req,
3129 				  sp->u.iocb_cmd.u.ctarg.req_dma);
3130 		sp->u.iocb_cmd.u.ctarg.req = NULL;
3131 	}
3132 
3133 	if (sp->u.iocb_cmd.u.ctarg.rsp) {
3134 		dma_free_coherent(&vha->hw->pdev->dev,
3135 				  sp->u.iocb_cmd.u.ctarg.rsp_allocated_size,
3136 				  sp->u.iocb_cmd.u.ctarg.rsp,
3137 				  sp->u.iocb_cmd.u.ctarg.rsp_dma);
3138 		sp->u.iocb_cmd.u.ctarg.rsp = NULL;
3139 	}
3140 
3141 	/* ref: INIT */
3142 	kref_put(&sp->cmd_kref, qla2x00_sp_release);
3143 	return rval;
3144 }
3145 
3146 /* GPN_FT + GNN_FT*/
3147 static int qla2x00_is_a_vp(scsi_qla_host_t *vha, u64 wwn)
3148 {
3149 	struct qla_hw_data *ha = vha->hw;
3150 	scsi_qla_host_t *vp;
3151 	unsigned long flags;
3152 	u64 twwn;
3153 	int rc = 0;
3154 
3155 	if (!ha->num_vhosts)
3156 		return 0;
3157 
3158 	spin_lock_irqsave(&ha->vport_slock, flags);
3159 	list_for_each_entry(vp, &ha->vp_list, list) {
3160 		twwn = wwn_to_u64(vp->port_name);
3161 		if (wwn == twwn) {
3162 			rc = 1;
3163 			break;
3164 		}
3165 	}
3166 	spin_unlock_irqrestore(&ha->vport_slock, flags);
3167 
3168 	return rc;
3169 }
3170 
3171 void qla24xx_async_gnnft_done(scsi_qla_host_t *vha, srb_t *sp)
3172 {
3173 	fc_port_t *fcport;
3174 	u32 i, rc;
3175 	bool found;
3176 	struct fab_scan_rp *rp, *trp;
3177 	unsigned long flags;
3178 	u8 recheck = 0;
3179 	u16 dup = 0, dup_cnt = 0;
3180 
3181 	ql_dbg(ql_dbg_disc + ql_dbg_verbose, vha, 0xffff,
3182 	    "%s enter\n", __func__);
3183 
3184 	if (sp->gen1 != vha->hw->base_qpair->chip_reset) {
3185 		ql_dbg(ql_dbg_disc, vha, 0xffff,
3186 		    "%s scan stop due to chip reset %x/%x\n",
3187 		    sp->name, sp->gen1, vha->hw->base_qpair->chip_reset);
3188 		goto out;
3189 	}
3190 
3191 	rc = sp->rc;
3192 	if (rc) {
3193 		vha->scan.scan_retry++;
3194 		if (vha->scan.scan_retry < MAX_SCAN_RETRIES) {
3195 			set_bit(LOCAL_LOOP_UPDATE, &vha->dpc_flags);
3196 			set_bit(LOOP_RESYNC_NEEDED, &vha->dpc_flags);
3197 			goto out;
3198 		} else {
3199 			ql_dbg(ql_dbg_disc, vha, 0xffff,
3200 			    "%s: Fabric scan failed for %d retries.\n",
3201 			    __func__, vha->scan.scan_retry);
3202 			/*
3203 			 * Unable to scan any rports. logout loop below
3204 			 * will unregister all sessions.
3205 			 */
3206 			list_for_each_entry(fcport, &vha->vp_fcports, list) {
3207 				if ((fcport->flags & FCF_FABRIC_DEVICE) != 0) {
3208 					fcport->scan_state = QLA_FCPORT_SCAN;
3209 					if (fcport->loop_id == FC_NO_LOOP_ID)
3210 						fcport->logout_on_delete = 0;
3211 					else
3212 						fcport->logout_on_delete = 1;
3213 				}
3214 			}
3215 			goto login_logout;
3216 		}
3217 	}
3218 	vha->scan.scan_retry = 0;
3219 
3220 	list_for_each_entry(fcport, &vha->vp_fcports, list)
3221 		fcport->scan_state = QLA_FCPORT_SCAN;
3222 
3223 	for (i = 0; i < vha->hw->max_fibre_devices; i++) {
3224 		u64 wwn;
3225 		int k;
3226 
3227 		rp = &vha->scan.l[i];
3228 		found = false;
3229 
3230 		wwn = wwn_to_u64(rp->port_name);
3231 		if (wwn == 0)
3232 			continue;
3233 
3234 		/* Remove duplicate NPORT ID entries from switch data base */
3235 		for (k = i + 1; k < vha->hw->max_fibre_devices; k++) {
3236 			trp = &vha->scan.l[k];
3237 			if (rp->id.b24 == trp->id.b24) {
3238 				dup = 1;
3239 				dup_cnt++;
3240 				ql_dbg(ql_dbg_disc + ql_dbg_verbose,
3241 				    vha, 0xffff,
3242 				    "Detected duplicate NPORT ID from switch data base: ID %06x WWN %8phN WWN %8phN\n",
3243 				    rp->id.b24, rp->port_name, trp->port_name);
3244 				memset(trp, 0, sizeof(*trp));
3245 			}
3246 		}
3247 
3248 		if (!memcmp(rp->port_name, vha->port_name, WWN_SIZE))
3249 			continue;
3250 
3251 		/* Bypass reserved domain fields. */
3252 		if ((rp->id.b.domain & 0xf0) == 0xf0)
3253 			continue;
3254 
3255 		/* Bypass virtual ports of the same host. */
3256 		if (qla2x00_is_a_vp(vha, wwn))
3257 			continue;
3258 
3259 		list_for_each_entry(fcport, &vha->vp_fcports, list) {
3260 			if (memcmp(rp->port_name, fcport->port_name, WWN_SIZE))
3261 				continue;
3262 			fcport->scan_state = QLA_FCPORT_FOUND;
3263 			fcport->last_rscn_gen = fcport->rscn_gen;
3264 			fcport->fc4_type = rp->fc4type;
3265 			found = true;
3266 
3267 			if (fcport->scan_needed) {
3268 				if (NVME_PRIORITY(vha->hw, fcport))
3269 					fcport->do_prli_nvme = 1;
3270 				else
3271 					fcport->do_prli_nvme = 0;
3272 			}
3273 
3274 			/*
3275 			 * If device was not a fabric device before.
3276 			 */
3277 			if ((fcport->flags & FCF_FABRIC_DEVICE) == 0) {
3278 				qla2x00_clear_loop_id(fcport);
3279 				fcport->flags |= FCF_FABRIC_DEVICE;
3280 			} else if (fcport->d_id.b24 != rp->id.b24 ||
3281 				   (fcport->scan_needed &&
3282 				    fcport->port_type != FCT_INITIATOR &&
3283 				    fcport->port_type != FCT_NVME_INITIATOR)) {
3284 				qlt_schedule_sess_for_deletion(fcport);
3285 			}
3286 			fcport->d_id.b24 = rp->id.b24;
3287 			fcport->scan_needed = 0;
3288 			break;
3289 		}
3290 
3291 		if (!found) {
3292 			ql_dbg(ql_dbg_disc, vha, 0xffff,
3293 			    "%s %d %8phC post new sess\n",
3294 			    __func__, __LINE__, rp->port_name);
3295 			qla24xx_post_newsess_work(vha, &rp->id, rp->port_name,
3296 			    rp->node_name, NULL, rp->fc4type);
3297 		}
3298 	}
3299 
3300 	if (dup) {
3301 		ql_log(ql_log_warn, vha, 0xffff,
3302 		    "Detected %d duplicate NPORT ID(s) from switch data base\n",
3303 		    dup_cnt);
3304 	}
3305 
3306 login_logout:
3307 	/*
3308 	 * Logout all previous fabric dev marked lost, except FCP2 devices.
3309 	 */
3310 	list_for_each_entry(fcport, &vha->vp_fcports, list) {
3311 		if ((fcport->flags & FCF_FABRIC_DEVICE) == 0) {
3312 			fcport->scan_needed = 0;
3313 			continue;
3314 		}
3315 
3316 		if (fcport->scan_state != QLA_FCPORT_FOUND) {
3317 			bool do_delete = false;
3318 
3319 			if (fcport->scan_needed &&
3320 			    fcport->disc_state == DSC_LOGIN_PEND) {
3321 				/* Cable got disconnected after we sent
3322 				 * a login. Do delete to prevent timeout.
3323 				 */
3324 				fcport->logout_on_delete = 1;
3325 				do_delete = true;
3326 			}
3327 
3328 			fcport->scan_needed = 0;
3329 			if (((qla_dual_mode_enabled(vha) ||
3330 			      qla_ini_mode_enabled(vha)) &&
3331 			    atomic_read(&fcport->state) == FCS_ONLINE) ||
3332 				do_delete) {
3333 				if (fcport->loop_id != FC_NO_LOOP_ID) {
3334 					if (fcport->flags & FCF_FCP2_DEVICE)
3335 						continue;
3336 
3337 					ql_log(ql_log_warn, vha, 0x20f0,
3338 					       "%s %d %8phC post del sess\n",
3339 					       __func__, __LINE__,
3340 					       fcport->port_name);
3341 
3342 					fcport->tgt_link_down_time = 0;
3343 					qlt_schedule_sess_for_deletion(fcport);
3344 					continue;
3345 				}
3346 			}
3347 		} else {
3348 			if (fcport->scan_needed ||
3349 			    fcport->disc_state != DSC_LOGIN_COMPLETE) {
3350 				if (fcport->login_retry == 0) {
3351 					fcport->login_retry =
3352 						vha->hw->login_retry_count;
3353 					ql_dbg(ql_dbg_disc, vha, 0x20a3,
3354 					    "Port login retry %8phN, lid 0x%04x retry cnt=%d.\n",
3355 					    fcport->port_name, fcport->loop_id,
3356 					    fcport->login_retry);
3357 				}
3358 				fcport->scan_needed = 0;
3359 				qla24xx_fcport_handle_login(vha, fcport);
3360 			}
3361 		}
3362 	}
3363 
3364 	recheck = 1;
3365 out:
3366 	qla24xx_sp_unmap(vha, sp);
3367 	spin_lock_irqsave(&vha->work_lock, flags);
3368 	vha->scan.scan_flags &= ~SF_SCANNING;
3369 	spin_unlock_irqrestore(&vha->work_lock, flags);
3370 
3371 	if (recheck) {
3372 		list_for_each_entry(fcport, &vha->vp_fcports, list) {
3373 			if (fcport->scan_needed) {
3374 				set_bit(LOCAL_LOOP_UPDATE, &vha->dpc_flags);
3375 				set_bit(LOOP_RESYNC_NEEDED, &vha->dpc_flags);
3376 				break;
3377 			}
3378 		}
3379 	}
3380 }
3381 
3382 static int qla2x00_post_gnnft_gpnft_done_work(struct scsi_qla_host *vha,
3383     srb_t *sp, int cmd)
3384 {
3385 	struct qla_work_evt *e;
3386 
3387 	if (cmd != QLA_EVT_GPNFT_DONE && cmd != QLA_EVT_GNNFT_DONE)
3388 		return QLA_PARAMETER_ERROR;
3389 
3390 	e = qla2x00_alloc_work(vha, cmd);
3391 	if (!e)
3392 		return QLA_FUNCTION_FAILED;
3393 
3394 	e->u.iosb.sp = sp;
3395 
3396 	return qla2x00_post_work(vha, e);
3397 }
3398 
3399 static int qla2x00_post_nvme_gpnft_work(struct scsi_qla_host *vha,
3400     srb_t *sp, int cmd)
3401 {
3402 	struct qla_work_evt *e;
3403 
3404 	if (cmd != QLA_EVT_GPNFT)
3405 		return QLA_PARAMETER_ERROR;
3406 
3407 	e = qla2x00_alloc_work(vha, cmd);
3408 	if (!e)
3409 		return QLA_FUNCTION_FAILED;
3410 
3411 	e->u.gpnft.fc4_type = FC4_TYPE_NVME;
3412 	e->u.gpnft.sp = sp;
3413 
3414 	return qla2x00_post_work(vha, e);
3415 }
3416 
3417 static void qla2x00_find_free_fcp_nvme_slot(struct scsi_qla_host *vha,
3418 	struct srb *sp)
3419 {
3420 	struct qla_hw_data *ha = vha->hw;
3421 	int num_fibre_dev = ha->max_fibre_devices;
3422 	struct ct_sns_req *ct_req =
3423 		(struct ct_sns_req *)sp->u.iocb_cmd.u.ctarg.req;
3424 	struct ct_sns_gpnft_rsp *ct_rsp =
3425 		(struct ct_sns_gpnft_rsp *)sp->u.iocb_cmd.u.ctarg.rsp;
3426 	struct ct_sns_gpn_ft_data *d;
3427 	struct fab_scan_rp *rp;
3428 	u16 cmd = be16_to_cpu(ct_req->command);
3429 	u8 fc4_type = sp->gen2;
3430 	int i, j, k;
3431 	port_id_t id;
3432 	u8 found;
3433 	u64 wwn;
3434 
3435 	j = 0;
3436 	for (i = 0; i < num_fibre_dev; i++) {
3437 		d  = &ct_rsp->entries[i];
3438 
3439 		id.b.rsvd_1 = 0;
3440 		id.b.domain = d->port_id[0];
3441 		id.b.area   = d->port_id[1];
3442 		id.b.al_pa  = d->port_id[2];
3443 		wwn = wwn_to_u64(d->port_name);
3444 
3445 		if (id.b24 == 0 || wwn == 0)
3446 			continue;
3447 
3448 		if (fc4_type == FC4_TYPE_FCP_SCSI) {
3449 			if (cmd == GPN_FT_CMD) {
3450 				rp = &vha->scan.l[j];
3451 				rp->id = id;
3452 				memcpy(rp->port_name, d->port_name, 8);
3453 				j++;
3454 				rp->fc4type = FS_FC4TYPE_FCP;
3455 			} else {
3456 				for (k = 0; k < num_fibre_dev; k++) {
3457 					rp = &vha->scan.l[k];
3458 					if (id.b24 == rp->id.b24) {
3459 						memcpy(rp->node_name,
3460 						    d->port_name, 8);
3461 						break;
3462 					}
3463 				}
3464 			}
3465 		} else {
3466 			/* Search if the fibre device supports FC4_TYPE_NVME */
3467 			if (cmd == GPN_FT_CMD) {
3468 				found = 0;
3469 
3470 				for (k = 0; k < num_fibre_dev; k++) {
3471 					rp = &vha->scan.l[k];
3472 					if (!memcmp(rp->port_name,
3473 					    d->port_name, 8)) {
3474 						/*
3475 						 * Supports FC-NVMe & FCP
3476 						 */
3477 						rp->fc4type |= FS_FC4TYPE_NVME;
3478 						found = 1;
3479 						break;
3480 					}
3481 				}
3482 
3483 				/* We found new FC-NVMe only port */
3484 				if (!found) {
3485 					for (k = 0; k < num_fibre_dev; k++) {
3486 						rp = &vha->scan.l[k];
3487 						if (wwn_to_u64(rp->port_name)) {
3488 							continue;
3489 						} else {
3490 							rp->id = id;
3491 							memcpy(rp->port_name,
3492 							    d->port_name, 8);
3493 							rp->fc4type =
3494 							    FS_FC4TYPE_NVME;
3495 							break;
3496 						}
3497 					}
3498 				}
3499 			} else {
3500 				for (k = 0; k < num_fibre_dev; k++) {
3501 					rp = &vha->scan.l[k];
3502 					if (id.b24 == rp->id.b24) {
3503 						memcpy(rp->node_name,
3504 						    d->port_name, 8);
3505 						break;
3506 					}
3507 				}
3508 			}
3509 		}
3510 	}
3511 }
3512 
3513 static void qla2x00_async_gpnft_gnnft_sp_done(srb_t *sp, int res)
3514 {
3515 	struct scsi_qla_host *vha = sp->vha;
3516 	struct ct_sns_req *ct_req =
3517 		(struct ct_sns_req *)sp->u.iocb_cmd.u.ctarg.req;
3518 	u16 cmd = be16_to_cpu(ct_req->command);
3519 	u8 fc4_type = sp->gen2;
3520 	unsigned long flags;
3521 	int rc;
3522 
3523 	/* gen2 field is holding the fc4type */
3524 	ql_dbg(ql_dbg_disc, vha, 0xffff,
3525 	    "Async done-%s res %x FC4Type %x\n",
3526 	    sp->name, res, sp->gen2);
3527 
3528 	sp->rc = res;
3529 	if (res) {
3530 		unsigned long flags;
3531 		const char *name = sp->name;
3532 
3533 		if (res == QLA_OS_TIMER_EXPIRED) {
3534 			/* switch is ignoring all commands.
3535 			 * This might be a zone disable behavior.
3536 			 * This means we hit 64s timeout.
3537 			 * 22s GPNFT + 44s Abort = 64s
3538 			 */
3539 			ql_dbg(ql_dbg_disc, vha, 0xffff,
3540 			       "%s: Switch Zone check please .\n",
3541 			       name);
3542 			qla2x00_mark_all_devices_lost(vha);
3543 		}
3544 
3545 		/*
3546 		 * We are in an Interrupt context, queue up this
3547 		 * sp for GNNFT_DONE work. This will allow all
3548 		 * the resource to get freed up.
3549 		 */
3550 		rc = qla2x00_post_gnnft_gpnft_done_work(vha, sp,
3551 		    QLA_EVT_GNNFT_DONE);
3552 		if (rc) {
3553 			/* Cleanup here to prevent memory leak */
3554 			qla24xx_sp_unmap(vha, sp);
3555 
3556 			spin_lock_irqsave(&vha->work_lock, flags);
3557 			vha->scan.scan_flags &= ~SF_SCANNING;
3558 			vha->scan.scan_retry++;
3559 			spin_unlock_irqrestore(&vha->work_lock, flags);
3560 
3561 			if (vha->scan.scan_retry < MAX_SCAN_RETRIES) {
3562 				set_bit(LOCAL_LOOP_UPDATE, &vha->dpc_flags);
3563 				set_bit(LOOP_RESYNC_NEEDED, &vha->dpc_flags);
3564 				qla2xxx_wake_dpc(vha);
3565 			} else {
3566 				ql_dbg(ql_dbg_disc, vha, 0xffff,
3567 				    "Async done-%s rescan failed on all retries.\n",
3568 				    name);
3569 			}
3570 		}
3571 		return;
3572 	}
3573 
3574 	qla2x00_find_free_fcp_nvme_slot(vha, sp);
3575 
3576 	if ((fc4_type == FC4_TYPE_FCP_SCSI) && vha->flags.nvme_enabled &&
3577 	    cmd == GNN_FT_CMD) {
3578 		spin_lock_irqsave(&vha->work_lock, flags);
3579 		vha->scan.scan_flags &= ~SF_SCANNING;
3580 		spin_unlock_irqrestore(&vha->work_lock, flags);
3581 
3582 		sp->rc = res;
3583 		rc = qla2x00_post_nvme_gpnft_work(vha, sp, QLA_EVT_GPNFT);
3584 		if (rc) {
3585 			qla24xx_sp_unmap(vha, sp);
3586 			set_bit(LOCAL_LOOP_UPDATE, &vha->dpc_flags);
3587 			set_bit(LOOP_RESYNC_NEEDED, &vha->dpc_flags);
3588 		}
3589 		return;
3590 	}
3591 
3592 	if (cmd == GPN_FT_CMD) {
3593 		rc = qla2x00_post_gnnft_gpnft_done_work(vha, sp,
3594 		    QLA_EVT_GPNFT_DONE);
3595 	} else {
3596 		rc = qla2x00_post_gnnft_gpnft_done_work(vha, sp,
3597 		    QLA_EVT_GNNFT_DONE);
3598 	}
3599 
3600 	if (rc) {
3601 		qla24xx_sp_unmap(vha, sp);
3602 		set_bit(LOCAL_LOOP_UPDATE, &vha->dpc_flags);
3603 		set_bit(LOOP_RESYNC_NEEDED, &vha->dpc_flags);
3604 		return;
3605 	}
3606 }
3607 
3608 /*
3609  * Get WWNN list for fc4_type
3610  *
3611  * It is assumed the same SRB is re-used from GPNFT to avoid
3612  * mem free & re-alloc
3613  */
3614 static int qla24xx_async_gnnft(scsi_qla_host_t *vha, struct srb *sp,
3615     u8 fc4_type)
3616 {
3617 	int rval = QLA_FUNCTION_FAILED;
3618 	struct ct_sns_req *ct_req;
3619 	struct ct_sns_pkt *ct_sns;
3620 	unsigned long flags;
3621 
3622 	if (!vha->flags.online) {
3623 		spin_lock_irqsave(&vha->work_lock, flags);
3624 		vha->scan.scan_flags &= ~SF_SCANNING;
3625 		spin_unlock_irqrestore(&vha->work_lock, flags);
3626 		goto done_free_sp;
3627 	}
3628 
3629 	if (!sp->u.iocb_cmd.u.ctarg.req || !sp->u.iocb_cmd.u.ctarg.rsp) {
3630 		ql_log(ql_log_warn, vha, 0xffff,
3631 		    "%s: req %p rsp %p are not setup\n",
3632 		    __func__, sp->u.iocb_cmd.u.ctarg.req,
3633 		    sp->u.iocb_cmd.u.ctarg.rsp);
3634 		spin_lock_irqsave(&vha->work_lock, flags);
3635 		vha->scan.scan_flags &= ~SF_SCANNING;
3636 		spin_unlock_irqrestore(&vha->work_lock, flags);
3637 		WARN_ON(1);
3638 		set_bit(LOCAL_LOOP_UPDATE, &vha->dpc_flags);
3639 		set_bit(LOOP_RESYNC_NEEDED, &vha->dpc_flags);
3640 		goto done_free_sp;
3641 	}
3642 
3643 	ql_dbg(ql_dbg_disc, vha, 0xfffff,
3644 	    "%s: FC4Type %x, CT-PASSTHRU %s command ctarg rsp size %d, ctarg req size %d\n",
3645 	    __func__, fc4_type, sp->name, sp->u.iocb_cmd.u.ctarg.rsp_size,
3646 	     sp->u.iocb_cmd.u.ctarg.req_size);
3647 
3648 	sp->type = SRB_CT_PTHRU_CMD;
3649 	sp->name = "gnnft";
3650 	sp->gen1 = vha->hw->base_qpair->chip_reset;
3651 	sp->gen2 = fc4_type;
3652 	qla2x00_init_async_sp(sp, qla2x00_get_async_timeout(vha) + 2,
3653 			      qla2x00_async_gpnft_gnnft_sp_done);
3654 
3655 	memset(sp->u.iocb_cmd.u.ctarg.rsp, 0, sp->u.iocb_cmd.u.ctarg.rsp_size);
3656 	memset(sp->u.iocb_cmd.u.ctarg.req, 0, sp->u.iocb_cmd.u.ctarg.req_size);
3657 
3658 	ct_sns = (struct ct_sns_pkt *)sp->u.iocb_cmd.u.ctarg.req;
3659 	/* CT_IU preamble  */
3660 	ct_req = qla2x00_prep_ct_req(ct_sns, GNN_FT_CMD,
3661 	    sp->u.iocb_cmd.u.ctarg.rsp_size);
3662 
3663 	/* GPN_FT req */
3664 	ct_req->req.gpn_ft.port_type = fc4_type;
3665 
3666 	sp->u.iocb_cmd.u.ctarg.req_size = GNN_FT_REQ_SIZE;
3667 	sp->u.iocb_cmd.u.ctarg.nport_handle = NPH_SNS;
3668 
3669 	ql_dbg(ql_dbg_disc, vha, 0xffff,
3670 	    "Async-%s hdl=%x FC4Type %x.\n", sp->name,
3671 	    sp->handle, ct_req->req.gpn_ft.port_type);
3672 
3673 	rval = qla2x00_start_sp(sp);
3674 	if (rval != QLA_SUCCESS) {
3675 		goto done_free_sp;
3676 	}
3677 
3678 	return rval;
3679 
3680 done_free_sp:
3681 	if (sp->u.iocb_cmd.u.ctarg.req) {
3682 		dma_free_coherent(&vha->hw->pdev->dev,
3683 		    sp->u.iocb_cmd.u.ctarg.req_allocated_size,
3684 		    sp->u.iocb_cmd.u.ctarg.req,
3685 		    sp->u.iocb_cmd.u.ctarg.req_dma);
3686 		sp->u.iocb_cmd.u.ctarg.req = NULL;
3687 	}
3688 	if (sp->u.iocb_cmd.u.ctarg.rsp) {
3689 		dma_free_coherent(&vha->hw->pdev->dev,
3690 		    sp->u.iocb_cmd.u.ctarg.rsp_allocated_size,
3691 		    sp->u.iocb_cmd.u.ctarg.rsp,
3692 		    sp->u.iocb_cmd.u.ctarg.rsp_dma);
3693 		sp->u.iocb_cmd.u.ctarg.rsp = NULL;
3694 	}
3695 	/* ref: INIT */
3696 	kref_put(&sp->cmd_kref, qla2x00_sp_release);
3697 
3698 	spin_lock_irqsave(&vha->work_lock, flags);
3699 	vha->scan.scan_flags &= ~SF_SCANNING;
3700 	if (vha->scan.scan_flags == 0) {
3701 		ql_dbg(ql_dbg_disc, vha, 0xffff,
3702 		    "%s: schedule\n", __func__);
3703 		vha->scan.scan_flags |= SF_QUEUED;
3704 		schedule_delayed_work(&vha->scan.scan_work, 5);
3705 	}
3706 	spin_unlock_irqrestore(&vha->work_lock, flags);
3707 
3708 
3709 	return rval;
3710 } /* GNNFT */
3711 
3712 void qla24xx_async_gpnft_done(scsi_qla_host_t *vha, srb_t *sp)
3713 {
3714 	ql_dbg(ql_dbg_disc + ql_dbg_verbose, vha, 0xffff,
3715 	    "%s enter\n", __func__);
3716 	qla24xx_async_gnnft(vha, sp, sp->gen2);
3717 }
3718 
3719 /* Get WWPN list for certain fc4_type */
3720 int qla24xx_async_gpnft(scsi_qla_host_t *vha, u8 fc4_type, srb_t *sp)
3721 {
3722 	int rval = QLA_FUNCTION_FAILED;
3723 	struct ct_sns_req       *ct_req;
3724 	struct ct_sns_pkt *ct_sns;
3725 	u32 rspsz;
3726 	unsigned long flags;
3727 
3728 	ql_dbg(ql_dbg_disc + ql_dbg_verbose, vha, 0xffff,
3729 	    "%s enter\n", __func__);
3730 
3731 	if (!vha->flags.online)
3732 		return rval;
3733 
3734 	spin_lock_irqsave(&vha->work_lock, flags);
3735 	if (vha->scan.scan_flags & SF_SCANNING) {
3736 		spin_unlock_irqrestore(&vha->work_lock, flags);
3737 		ql_dbg(ql_dbg_disc + ql_dbg_verbose, vha, 0xffff,
3738 		    "%s: scan active\n", __func__);
3739 		return rval;
3740 	}
3741 	vha->scan.scan_flags |= SF_SCANNING;
3742 	spin_unlock_irqrestore(&vha->work_lock, flags);
3743 
3744 	if (fc4_type == FC4_TYPE_FCP_SCSI) {
3745 		ql_dbg(ql_dbg_disc + ql_dbg_verbose, vha, 0xffff,
3746 		    "%s: Performing FCP Scan\n", __func__);
3747 
3748 		if (sp) {
3749 			/* ref: INIT */
3750 			kref_put(&sp->cmd_kref, qla2x00_sp_release);
3751 		}
3752 
3753 		/* ref: INIT */
3754 		sp = qla2x00_get_sp(vha, NULL, GFP_KERNEL);
3755 		if (!sp) {
3756 			spin_lock_irqsave(&vha->work_lock, flags);
3757 			vha->scan.scan_flags &= ~SF_SCANNING;
3758 			spin_unlock_irqrestore(&vha->work_lock, flags);
3759 			return rval;
3760 		}
3761 
3762 		sp->u.iocb_cmd.u.ctarg.req = dma_alloc_coherent(&vha->hw->pdev->dev,
3763 								sizeof(struct ct_sns_pkt),
3764 								&sp->u.iocb_cmd.u.ctarg.req_dma,
3765 								GFP_KERNEL);
3766 		sp->u.iocb_cmd.u.ctarg.req_allocated_size = sizeof(struct ct_sns_pkt);
3767 		if (!sp->u.iocb_cmd.u.ctarg.req) {
3768 			ql_log(ql_log_warn, vha, 0xffff,
3769 			    "Failed to allocate ct_sns request.\n");
3770 			spin_lock_irqsave(&vha->work_lock, flags);
3771 			vha->scan.scan_flags &= ~SF_SCANNING;
3772 			spin_unlock_irqrestore(&vha->work_lock, flags);
3773 			qla2x00_rel_sp(sp);
3774 			return rval;
3775 		}
3776 		sp->u.iocb_cmd.u.ctarg.req_size = GPN_FT_REQ_SIZE;
3777 
3778 		rspsz = sizeof(struct ct_sns_gpnft_rsp) +
3779 			((vha->hw->max_fibre_devices - 1) *
3780 			    sizeof(struct ct_sns_gpn_ft_data));
3781 
3782 		sp->u.iocb_cmd.u.ctarg.rsp = dma_alloc_coherent(&vha->hw->pdev->dev,
3783 								rspsz,
3784 								&sp->u.iocb_cmd.u.ctarg.rsp_dma,
3785 								GFP_KERNEL);
3786 		sp->u.iocb_cmd.u.ctarg.rsp_allocated_size = rspsz;
3787 		if (!sp->u.iocb_cmd.u.ctarg.rsp) {
3788 			ql_log(ql_log_warn, vha, 0xffff,
3789 			    "Failed to allocate ct_sns request.\n");
3790 			spin_lock_irqsave(&vha->work_lock, flags);
3791 			vha->scan.scan_flags &= ~SF_SCANNING;
3792 			spin_unlock_irqrestore(&vha->work_lock, flags);
3793 			dma_free_coherent(&vha->hw->pdev->dev,
3794 			    sp->u.iocb_cmd.u.ctarg.req_allocated_size,
3795 			    sp->u.iocb_cmd.u.ctarg.req,
3796 			    sp->u.iocb_cmd.u.ctarg.req_dma);
3797 			sp->u.iocb_cmd.u.ctarg.req = NULL;
3798 			/* ref: INIT */
3799 			qla2x00_rel_sp(sp);
3800 			return rval;
3801 		}
3802 		sp->u.iocb_cmd.u.ctarg.rsp_size = rspsz;
3803 
3804 		ql_dbg(ql_dbg_disc + ql_dbg_verbose, vha, 0xffff,
3805 		    "%s scan list size %d\n", __func__, vha->scan.size);
3806 
3807 		memset(vha->scan.l, 0, vha->scan.size);
3808 	} else if (!sp) {
3809 		ql_dbg(ql_dbg_disc, vha, 0xffff,
3810 		    "NVME scan did not provide SP\n");
3811 		return rval;
3812 	}
3813 
3814 	sp->type = SRB_CT_PTHRU_CMD;
3815 	sp->name = "gpnft";
3816 	sp->gen1 = vha->hw->base_qpair->chip_reset;
3817 	sp->gen2 = fc4_type;
3818 	qla2x00_init_async_sp(sp, qla2x00_get_async_timeout(vha) + 2,
3819 			      qla2x00_async_gpnft_gnnft_sp_done);
3820 
3821 	rspsz = sp->u.iocb_cmd.u.ctarg.rsp_size;
3822 	memset(sp->u.iocb_cmd.u.ctarg.rsp, 0, sp->u.iocb_cmd.u.ctarg.rsp_size);
3823 	memset(sp->u.iocb_cmd.u.ctarg.req, 0, sp->u.iocb_cmd.u.ctarg.req_size);
3824 
3825 	ct_sns = (struct ct_sns_pkt *)sp->u.iocb_cmd.u.ctarg.req;
3826 	/* CT_IU preamble  */
3827 	ct_req = qla2x00_prep_ct_req(ct_sns, GPN_FT_CMD, rspsz);
3828 
3829 	/* GPN_FT req */
3830 	ct_req->req.gpn_ft.port_type = fc4_type;
3831 
3832 	sp->u.iocb_cmd.u.ctarg.nport_handle = NPH_SNS;
3833 
3834 	ql_dbg(ql_dbg_disc, vha, 0xffff,
3835 	    "Async-%s hdl=%x FC4Type %x.\n", sp->name,
3836 	    sp->handle, ct_req->req.gpn_ft.port_type);
3837 
3838 	rval = qla2x00_start_sp(sp);
3839 	if (rval != QLA_SUCCESS) {
3840 		goto done_free_sp;
3841 	}
3842 
3843 	return rval;
3844 
3845 done_free_sp:
3846 	if (sp->u.iocb_cmd.u.ctarg.req) {
3847 		dma_free_coherent(&vha->hw->pdev->dev,
3848 		    sp->u.iocb_cmd.u.ctarg.req_allocated_size,
3849 		    sp->u.iocb_cmd.u.ctarg.req,
3850 		    sp->u.iocb_cmd.u.ctarg.req_dma);
3851 		sp->u.iocb_cmd.u.ctarg.req = NULL;
3852 	}
3853 	if (sp->u.iocb_cmd.u.ctarg.rsp) {
3854 		dma_free_coherent(&vha->hw->pdev->dev,
3855 		    sp->u.iocb_cmd.u.ctarg.rsp_allocated_size,
3856 		    sp->u.iocb_cmd.u.ctarg.rsp,
3857 		    sp->u.iocb_cmd.u.ctarg.rsp_dma);
3858 		sp->u.iocb_cmd.u.ctarg.rsp = NULL;
3859 	}
3860 
3861 	/* ref: INIT */
3862 	kref_put(&sp->cmd_kref, qla2x00_sp_release);
3863 
3864 	spin_lock_irqsave(&vha->work_lock, flags);
3865 	vha->scan.scan_flags &= ~SF_SCANNING;
3866 	if (vha->scan.scan_flags == 0) {
3867 		ql_dbg(ql_dbg_disc + ql_dbg_verbose, vha, 0xffff,
3868 		    "%s: Scan scheduled.\n", __func__);
3869 		vha->scan.scan_flags |= SF_QUEUED;
3870 		schedule_delayed_work(&vha->scan.scan_work, 5);
3871 	}
3872 	spin_unlock_irqrestore(&vha->work_lock, flags);
3873 
3874 
3875 	return rval;
3876 }
3877 
3878 void qla_scan_work_fn(struct work_struct *work)
3879 {
3880 	struct fab_scan *s = container_of(to_delayed_work(work),
3881 	    struct fab_scan, scan_work);
3882 	struct scsi_qla_host *vha = container_of(s, struct scsi_qla_host,
3883 	    scan);
3884 	unsigned long flags;
3885 
3886 	ql_dbg(ql_dbg_disc, vha, 0xffff,
3887 	    "%s: schedule loop resync\n", __func__);
3888 	set_bit(LOCAL_LOOP_UPDATE, &vha->dpc_flags);
3889 	set_bit(LOOP_RESYNC_NEEDED, &vha->dpc_flags);
3890 	qla2xxx_wake_dpc(vha);
3891 	spin_lock_irqsave(&vha->work_lock, flags);
3892 	vha->scan.scan_flags &= ~SF_QUEUED;
3893 	spin_unlock_irqrestore(&vha->work_lock, flags);
3894 }
3895 
3896 /* GPFN_ID */
3897 void qla24xx_handle_gfpnid_event(scsi_qla_host_t *vha, struct event_arg *ea)
3898 {
3899 	fc_port_t *fcport = ea->fcport;
3900 
3901 	ql_dbg(ql_dbg_disc, vha, 0xffff,
3902 	    "%s %8phC DS %d LS %d rc %d login %d|%d rscn %d|%d fcpcnt %d\n",
3903 	    __func__, fcport->port_name, fcport->disc_state,
3904 	    fcport->fw_login_state, ea->rc, fcport->login_gen, ea->sp->gen2,
3905 	    fcport->rscn_gen, ea->sp->gen1, vha->fcport_count);
3906 
3907 	if (fcport->disc_state == DSC_DELETE_PEND)
3908 		return;
3909 
3910 	if (ea->sp->gen2 != fcport->login_gen) {
3911 		/* target side must have changed it. */
3912 		ql_dbg(ql_dbg_disc, vha, 0x20d3,
3913 		    "%s %8phC generation changed\n",
3914 		    __func__, fcport->port_name);
3915 		return;
3916 	} else if (ea->sp->gen1 != fcport->rscn_gen) {
3917 		return;
3918 	}
3919 
3920 	qla24xx_post_gpsc_work(vha, fcport);
3921 }
3922 
3923 static void qla2x00_async_gfpnid_sp_done(srb_t *sp, int res)
3924 {
3925 	struct scsi_qla_host *vha = sp->vha;
3926 	fc_port_t *fcport = sp->fcport;
3927 	u8 *fpn = fcport->ct_desc.ct_sns->p.rsp.rsp.gfpn_id.port_name;
3928 	struct event_arg ea;
3929 	u64 wwn;
3930 
3931 	wwn = wwn_to_u64(fpn);
3932 	if (wwn)
3933 		memcpy(fcport->fabric_port_name, fpn, WWN_SIZE);
3934 
3935 	memset(&ea, 0, sizeof(ea));
3936 	ea.fcport = fcport;
3937 	ea.sp = sp;
3938 	ea.rc = res;
3939 
3940 	ql_dbg(ql_dbg_disc, vha, 0x204f,
3941 	    "Async done-%s res %x, WWPN %8phC %8phC\n",
3942 	    sp->name, res, fcport->port_name, fcport->fabric_port_name);
3943 
3944 	qla24xx_handle_gfpnid_event(vha, &ea);
3945 
3946 	/* ref: INIT */
3947 	kref_put(&sp->cmd_kref, qla2x00_sp_release);
3948 }
3949 
3950 int qla24xx_async_gfpnid(scsi_qla_host_t *vha, fc_port_t *fcport)
3951 {
3952 	int rval = QLA_FUNCTION_FAILED;
3953 	struct ct_sns_req       *ct_req;
3954 	srb_t *sp;
3955 
3956 	if (!vha->flags.online || (fcport->flags & FCF_ASYNC_SENT))
3957 		return rval;
3958 
3959 	/* ref: INIT */
3960 	sp = qla2x00_get_sp(vha, fcport, GFP_ATOMIC);
3961 	if (!sp)
3962 		goto done;
3963 
3964 	sp->type = SRB_CT_PTHRU_CMD;
3965 	sp->name = "gfpnid";
3966 	sp->gen1 = fcport->rscn_gen;
3967 	sp->gen2 = fcport->login_gen;
3968 	qla2x00_init_async_sp(sp, qla2x00_get_async_timeout(vha) + 2,
3969 			      qla2x00_async_gfpnid_sp_done);
3970 
3971 	/* CT_IU preamble  */
3972 	ct_req = qla2x00_prep_ct_req(fcport->ct_desc.ct_sns, GFPN_ID_CMD,
3973 	    GFPN_ID_RSP_SIZE);
3974 
3975 	/* GFPN_ID req */
3976 	ct_req->req.port_id.port_id = port_id_to_be_id(fcport->d_id);
3977 
3978 
3979 	/* req & rsp use the same buffer */
3980 	sp->u.iocb_cmd.u.ctarg.req = fcport->ct_desc.ct_sns;
3981 	sp->u.iocb_cmd.u.ctarg.req_dma = fcport->ct_desc.ct_sns_dma;
3982 	sp->u.iocb_cmd.u.ctarg.rsp = fcport->ct_desc.ct_sns;
3983 	sp->u.iocb_cmd.u.ctarg.rsp_dma = fcport->ct_desc.ct_sns_dma;
3984 	sp->u.iocb_cmd.u.ctarg.req_size = GFPN_ID_REQ_SIZE;
3985 	sp->u.iocb_cmd.u.ctarg.rsp_size = GFPN_ID_RSP_SIZE;
3986 	sp->u.iocb_cmd.u.ctarg.nport_handle = NPH_SNS;
3987 
3988 	ql_dbg(ql_dbg_disc, vha, 0xffff,
3989 	    "Async-%s - %8phC hdl=%x loopid=%x portid %06x.\n",
3990 	    sp->name, fcport->port_name,
3991 	    sp->handle, fcport->loop_id, fcport->d_id.b24);
3992 
3993 	rval = qla2x00_start_sp(sp);
3994 	if (rval != QLA_SUCCESS)
3995 		goto done_free_sp;
3996 
3997 	return rval;
3998 
3999 done_free_sp:
4000 	/* ref: INIT */
4001 	kref_put(&sp->cmd_kref, qla2x00_sp_release);
4002 done:
4003 	return rval;
4004 }
4005 
4006 int qla24xx_post_gfpnid_work(struct scsi_qla_host *vha, fc_port_t *fcport)
4007 {
4008 	struct qla_work_evt *e;
4009 	int ls;
4010 
4011 	ls = atomic_read(&vha->loop_state);
4012 	if (((ls != LOOP_READY) && (ls != LOOP_UP)) ||
4013 		test_bit(UNLOADING, &vha->dpc_flags))
4014 		return 0;
4015 
4016 	e = qla2x00_alloc_work(vha, QLA_EVT_GFPNID);
4017 	if (!e)
4018 		return QLA_FUNCTION_FAILED;
4019 
4020 	e->u.fcport.fcport = fcport;
4021 	return qla2x00_post_work(vha, e);
4022 }
4023