xref: /linux/drivers/scsi/qla2xxx/qla_gs.c (revision c537b994505099b7197e7d3125b942ecbcc51eb6)
1 /*
2  * QLogic Fibre Channel HBA Driver
3  * Copyright (c)  2003-2005 QLogic Corporation
4  *
5  * See LICENSE.qla2xxx for copyright and licensing details.
6  */
7 #include "qla_def.h"
8 
9 static inline struct ct_sns_req *
10 qla2x00_prep_ct_req(struct ct_sns_req *, uint16_t, uint16_t);
11 
12 static inline struct sns_cmd_pkt *
13 qla2x00_prep_sns_cmd(scsi_qla_host_t *, uint16_t, uint16_t, uint16_t);
14 
15 static int qla2x00_sns_ga_nxt(scsi_qla_host_t *, fc_port_t *);
16 static int qla2x00_sns_gid_pt(scsi_qla_host_t *, sw_info_t *);
17 static int qla2x00_sns_gpn_id(scsi_qla_host_t *, sw_info_t *);
18 static int qla2x00_sns_gnn_id(scsi_qla_host_t *, sw_info_t *);
19 static int qla2x00_sns_rft_id(scsi_qla_host_t *);
20 static int qla2x00_sns_rnn_id(scsi_qla_host_t *);
21 
22 /**
23  * qla2x00_prep_ms_iocb() - Prepare common MS/CT IOCB fields for SNS CT query.
24  * @ha: HA context
25  * @req_size: request size in bytes
26  * @rsp_size: response size in bytes
27  *
28  * Returns a pointer to the @ha's ms_iocb.
29  */
30 void *
31 qla2x00_prep_ms_iocb(scsi_qla_host_t *ha, uint32_t req_size, uint32_t rsp_size)
32 {
33 	ms_iocb_entry_t *ms_pkt;
34 
35 	ms_pkt = ha->ms_iocb;
36 	memset(ms_pkt, 0, sizeof(ms_iocb_entry_t));
37 
38 	ms_pkt->entry_type = MS_IOCB_TYPE;
39 	ms_pkt->entry_count = 1;
40 	SET_TARGET_ID(ha, ms_pkt->loop_id, SIMPLE_NAME_SERVER);
41 	ms_pkt->control_flags = __constant_cpu_to_le16(CF_READ | CF_HEAD_TAG);
42 	ms_pkt->timeout = __constant_cpu_to_le16(25);
43 	ms_pkt->cmd_dsd_count = __constant_cpu_to_le16(1);
44 	ms_pkt->total_dsd_count = __constant_cpu_to_le16(2);
45 	ms_pkt->rsp_bytecount = cpu_to_le32(rsp_size);
46 	ms_pkt->req_bytecount = cpu_to_le32(req_size);
47 
48 	ms_pkt->dseg_req_address[0] = cpu_to_le32(LSD(ha->ct_sns_dma));
49 	ms_pkt->dseg_req_address[1] = cpu_to_le32(MSD(ha->ct_sns_dma));
50 	ms_pkt->dseg_req_length = ms_pkt->req_bytecount;
51 
52 	ms_pkt->dseg_rsp_address[0] = cpu_to_le32(LSD(ha->ct_sns_dma));
53 	ms_pkt->dseg_rsp_address[1] = cpu_to_le32(MSD(ha->ct_sns_dma));
54 	ms_pkt->dseg_rsp_length = ms_pkt->rsp_bytecount;
55 
56 	return (ms_pkt);
57 }
58 
59 /**
60  * qla24xx_prep_ms_iocb() - Prepare common CT IOCB fields for SNS CT query.
61  * @ha: HA context
62  * @req_size: request size in bytes
63  * @rsp_size: response size in bytes
64  *
65  * Returns a pointer to the @ha's ms_iocb.
66  */
67 void *
68 qla24xx_prep_ms_iocb(scsi_qla_host_t *ha, uint32_t req_size, uint32_t rsp_size)
69 {
70 	struct ct_entry_24xx *ct_pkt;
71 
72 	ct_pkt = (struct ct_entry_24xx *)ha->ms_iocb;
73 	memset(ct_pkt, 0, sizeof(struct ct_entry_24xx));
74 
75 	ct_pkt->entry_type = CT_IOCB_TYPE;
76 	ct_pkt->entry_count = 1;
77 	ct_pkt->nport_handle = __constant_cpu_to_le16(NPH_SNS);
78 	ct_pkt->timeout = __constant_cpu_to_le16(25);
79 	ct_pkt->cmd_dsd_count = __constant_cpu_to_le16(1);
80 	ct_pkt->rsp_dsd_count = __constant_cpu_to_le16(1);
81 	ct_pkt->rsp_byte_count = cpu_to_le32(rsp_size);
82 	ct_pkt->cmd_byte_count = cpu_to_le32(req_size);
83 
84 	ct_pkt->dseg_0_address[0] = cpu_to_le32(LSD(ha->ct_sns_dma));
85 	ct_pkt->dseg_0_address[1] = cpu_to_le32(MSD(ha->ct_sns_dma));
86 	ct_pkt->dseg_0_len = ct_pkt->cmd_byte_count;
87 
88 	ct_pkt->dseg_1_address[0] = cpu_to_le32(LSD(ha->ct_sns_dma));
89 	ct_pkt->dseg_1_address[1] = cpu_to_le32(MSD(ha->ct_sns_dma));
90 	ct_pkt->dseg_1_len = ct_pkt->rsp_byte_count;
91 
92 	return (ct_pkt);
93 }
94 
95 /**
96  * qla2x00_prep_ct_req() - Prepare common CT request fields for SNS query.
97  * @ct_req: CT request buffer
98  * @cmd: GS command
99  * @rsp_size: response size in bytes
100  *
101  * Returns a pointer to the intitialized @ct_req.
102  */
103 static inline struct ct_sns_req *
104 qla2x00_prep_ct_req(struct ct_sns_req *ct_req, uint16_t cmd, uint16_t rsp_size)
105 {
106 	memset(ct_req, 0, sizeof(struct ct_sns_pkt));
107 
108 	ct_req->header.revision = 0x01;
109 	ct_req->header.gs_type = 0xFC;
110 	ct_req->header.gs_subtype = 0x02;
111 	ct_req->command = cpu_to_be16(cmd);
112 	ct_req->max_rsp_size = cpu_to_be16((rsp_size - 16) / 4);
113 
114 	return (ct_req);
115 }
116 
117 static int
118 qla2x00_chk_ms_status(scsi_qla_host_t *ha, ms_iocb_entry_t *ms_pkt,
119     struct ct_sns_rsp *ct_rsp, const char *routine)
120 {
121 	int rval;
122 	uint16_t comp_status;
123 
124 	rval = QLA_FUNCTION_FAILED;
125 	if (ms_pkt->entry_status != 0) {
126 		DEBUG2_3(printk("scsi(%ld): %s failed, error status (%x).\n",
127 		    ha->host_no, routine, ms_pkt->entry_status));
128 	} else {
129 		if (IS_QLA24XX(ha) || IS_QLA54XX(ha))
130 			comp_status = le16_to_cpu(
131 			    ((struct ct_entry_24xx *)ms_pkt)->comp_status);
132 		else
133 			comp_status = le16_to_cpu(ms_pkt->status);
134 		switch (comp_status) {
135 		case CS_COMPLETE:
136 		case CS_DATA_UNDERRUN:
137 		case CS_DATA_OVERRUN:		/* Overrun? */
138 			if (ct_rsp->header.response !=
139 			    __constant_cpu_to_be16(CT_ACCEPT_RESPONSE)) {
140 				DEBUG2_3(printk("scsi(%ld): %s failed, "
141 				    "rejected request:\n", ha->host_no,
142 				    routine));
143 				DEBUG2_3(qla2x00_dump_buffer(
144 				    (uint8_t *)&ct_rsp->header,
145 				    sizeof(struct ct_rsp_hdr)));
146 				rval = QLA_INVALID_COMMAND;
147 			} else
148 				rval = QLA_SUCCESS;
149 			break;
150 		default:
151 			DEBUG2_3(printk("scsi(%ld): %s failed, completion "
152 			    "status (%x).\n", ha->host_no, routine,
153 			    comp_status));
154 			break;
155 		}
156 	}
157 	return rval;
158 }
159 
160 /**
161  * qla2x00_ga_nxt() - SNS scan for fabric devices via GA_NXT command.
162  * @ha: HA context
163  * @fcport: fcport entry to updated
164  *
165  * Returns 0 on success.
166  */
167 int
168 qla2x00_ga_nxt(scsi_qla_host_t *ha, fc_port_t *fcport)
169 {
170 	int		rval;
171 
172 	ms_iocb_entry_t	*ms_pkt;
173 	struct ct_sns_req	*ct_req;
174 	struct ct_sns_rsp	*ct_rsp;
175 
176 	if (IS_QLA2100(ha) || IS_QLA2200(ha)) {
177 		return (qla2x00_sns_ga_nxt(ha, fcport));
178 	}
179 
180 	/* Issue GA_NXT */
181 	/* Prepare common MS IOCB */
182 	ms_pkt = ha->isp_ops.prep_ms_iocb(ha, GA_NXT_REQ_SIZE, GA_NXT_RSP_SIZE);
183 
184 	/* Prepare CT request */
185 	ct_req = qla2x00_prep_ct_req(&ha->ct_sns->p.req, GA_NXT_CMD,
186 	    GA_NXT_RSP_SIZE);
187 	ct_rsp = &ha->ct_sns->p.rsp;
188 
189 	/* Prepare CT arguments -- port_id */
190 	ct_req->req.port_id.port_id[0] = fcport->d_id.b.domain;
191 	ct_req->req.port_id.port_id[1] = fcport->d_id.b.area;
192 	ct_req->req.port_id.port_id[2] = fcport->d_id.b.al_pa;
193 
194 	/* Execute MS IOCB */
195 	rval = qla2x00_issue_iocb(ha, ha->ms_iocb, ha->ms_iocb_dma,
196 	    sizeof(ms_iocb_entry_t));
197 	if (rval != QLA_SUCCESS) {
198 		/*EMPTY*/
199 		DEBUG2_3(printk("scsi(%ld): GA_NXT issue IOCB failed (%d).\n",
200 		    ha->host_no, rval));
201 	} else if (qla2x00_chk_ms_status(ha, ms_pkt, ct_rsp, "GA_NXT") !=
202 	    QLA_SUCCESS) {
203 		rval = QLA_FUNCTION_FAILED;
204 	} else {
205 		/* Populate fc_port_t entry. */
206 		fcport->d_id.b.domain = ct_rsp->rsp.ga_nxt.port_id[0];
207 		fcport->d_id.b.area = ct_rsp->rsp.ga_nxt.port_id[1];
208 		fcport->d_id.b.al_pa = ct_rsp->rsp.ga_nxt.port_id[2];
209 
210 		memcpy(fcport->node_name, ct_rsp->rsp.ga_nxt.node_name,
211 		    WWN_SIZE);
212 		memcpy(fcport->port_name, ct_rsp->rsp.ga_nxt.port_name,
213 		    WWN_SIZE);
214 
215 		if (ct_rsp->rsp.ga_nxt.port_type != NS_N_PORT_TYPE &&
216 		    ct_rsp->rsp.ga_nxt.port_type != NS_NL_PORT_TYPE)
217 			fcport->d_id.b.domain = 0xf0;
218 
219 		DEBUG2_3(printk("scsi(%ld): GA_NXT entry - "
220 		    "nn %02x%02x%02x%02x%02x%02x%02x%02x "
221 		    "pn %02x%02x%02x%02x%02x%02x%02x%02x "
222 		    "portid=%02x%02x%02x.\n",
223 		    ha->host_no,
224 		    fcport->node_name[0], fcport->node_name[1],
225 		    fcport->node_name[2], fcport->node_name[3],
226 		    fcport->node_name[4], fcport->node_name[5],
227 		    fcport->node_name[6], fcport->node_name[7],
228 		    fcport->port_name[0], fcport->port_name[1],
229 		    fcport->port_name[2], fcport->port_name[3],
230 		    fcport->port_name[4], fcport->port_name[5],
231 		    fcport->port_name[6], fcport->port_name[7],
232 		    fcport->d_id.b.domain, fcport->d_id.b.area,
233 		    fcport->d_id.b.al_pa));
234 	}
235 
236 	return (rval);
237 }
238 
239 /**
240  * qla2x00_gid_pt() - SNS scan for fabric devices via GID_PT command.
241  * @ha: HA context
242  * @list: switch info entries to populate
243  *
244  * NOTE: Non-Nx_Ports are not requested.
245  *
246  * Returns 0 on success.
247  */
248 int
249 qla2x00_gid_pt(scsi_qla_host_t *ha, sw_info_t *list)
250 {
251 	int		rval;
252 	uint16_t	i;
253 
254 	ms_iocb_entry_t	*ms_pkt;
255 	struct ct_sns_req	*ct_req;
256 	struct ct_sns_rsp	*ct_rsp;
257 
258 	struct ct_sns_gid_pt_data *gid_data;
259 
260 	if (IS_QLA2100(ha) || IS_QLA2200(ha)) {
261 		return (qla2x00_sns_gid_pt(ha, list));
262 	}
263 
264 	gid_data = NULL;
265 
266 	/* Issue GID_PT */
267 	/* Prepare common MS IOCB */
268 	ms_pkt = ha->isp_ops.prep_ms_iocb(ha, GID_PT_REQ_SIZE, GID_PT_RSP_SIZE);
269 
270 	/* Prepare CT request */
271 	ct_req = qla2x00_prep_ct_req(&ha->ct_sns->p.req, GID_PT_CMD,
272 	    GID_PT_RSP_SIZE);
273 	ct_rsp = &ha->ct_sns->p.rsp;
274 
275 	/* Prepare CT arguments -- port_type */
276 	ct_req->req.gid_pt.port_type = NS_NX_PORT_TYPE;
277 
278 	/* Execute MS IOCB */
279 	rval = qla2x00_issue_iocb(ha, ha->ms_iocb, ha->ms_iocb_dma,
280 	    sizeof(ms_iocb_entry_t));
281 	if (rval != QLA_SUCCESS) {
282 		/*EMPTY*/
283 		DEBUG2_3(printk("scsi(%ld): GID_PT issue IOCB failed (%d).\n",
284 		    ha->host_no, rval));
285 	} else if (qla2x00_chk_ms_status(ha, ms_pkt, ct_rsp, "GID_PT") !=
286 	    QLA_SUCCESS) {
287 		rval = QLA_FUNCTION_FAILED;
288 	} else {
289 		/* Set port IDs in switch info list. */
290 		for (i = 0; i < MAX_FIBRE_DEVICES; i++) {
291 			gid_data = &ct_rsp->rsp.gid_pt.entries[i];
292 			list[i].d_id.b.domain = gid_data->port_id[0];
293 			list[i].d_id.b.area = gid_data->port_id[1];
294 			list[i].d_id.b.al_pa = gid_data->port_id[2];
295 
296 			/* Last one exit. */
297 			if (gid_data->control_byte & BIT_7) {
298 				list[i].d_id.b.rsvd_1 = gid_data->control_byte;
299 				break;
300 			}
301 		}
302 
303 		/*
304 		 * If we've used all available slots, then the switch is
305 		 * reporting back more devices than we can handle with this
306 		 * single call.  Return a failed status, and let GA_NXT handle
307 		 * the overload.
308 		 */
309 		if (i == MAX_FIBRE_DEVICES)
310 			rval = QLA_FUNCTION_FAILED;
311 	}
312 
313 	return (rval);
314 }
315 
316 /**
317  * qla2x00_gpn_id() - SNS Get Port Name (GPN_ID) query.
318  * @ha: HA context
319  * @list: switch info entries to populate
320  *
321  * Returns 0 on success.
322  */
323 int
324 qla2x00_gpn_id(scsi_qla_host_t *ha, sw_info_t *list)
325 {
326 	int		rval;
327 	uint16_t	i;
328 
329 	ms_iocb_entry_t	*ms_pkt;
330 	struct ct_sns_req	*ct_req;
331 	struct ct_sns_rsp	*ct_rsp;
332 
333 	if (IS_QLA2100(ha) || IS_QLA2200(ha)) {
334 		return (qla2x00_sns_gpn_id(ha, list));
335 	}
336 
337 	for (i = 0; i < MAX_FIBRE_DEVICES; i++) {
338 		/* Issue GPN_ID */
339 		/* Prepare common MS IOCB */
340 		ms_pkt = ha->isp_ops.prep_ms_iocb(ha, GPN_ID_REQ_SIZE,
341 		    GPN_ID_RSP_SIZE);
342 
343 		/* Prepare CT request */
344 		ct_req = qla2x00_prep_ct_req(&ha->ct_sns->p.req, GPN_ID_CMD,
345 		    GPN_ID_RSP_SIZE);
346 		ct_rsp = &ha->ct_sns->p.rsp;
347 
348 		/* Prepare CT arguments -- port_id */
349 		ct_req->req.port_id.port_id[0] = list[i].d_id.b.domain;
350 		ct_req->req.port_id.port_id[1] = list[i].d_id.b.area;
351 		ct_req->req.port_id.port_id[2] = list[i].d_id.b.al_pa;
352 
353 		/* Execute MS IOCB */
354 		rval = qla2x00_issue_iocb(ha, ha->ms_iocb, ha->ms_iocb_dma,
355 		    sizeof(ms_iocb_entry_t));
356 		if (rval != QLA_SUCCESS) {
357 			/*EMPTY*/
358 			DEBUG2_3(printk("scsi(%ld): GPN_ID issue IOCB failed "
359 			    "(%d).\n", ha->host_no, rval));
360 		} else if (qla2x00_chk_ms_status(ha, ms_pkt, ct_rsp,
361 		    "GPN_ID") != QLA_SUCCESS) {
362 			rval = QLA_FUNCTION_FAILED;
363 		} else {
364 			/* Save portname */
365 			memcpy(list[i].port_name,
366 			    ct_rsp->rsp.gpn_id.port_name, WWN_SIZE);
367 		}
368 
369 		/* Last device exit. */
370 		if (list[i].d_id.b.rsvd_1 != 0)
371 			break;
372 	}
373 
374 	return (rval);
375 }
376 
377 /**
378  * qla2x00_gnn_id() - SNS Get Node Name (GNN_ID) query.
379  * @ha: HA context
380  * @list: switch info entries to populate
381  *
382  * Returns 0 on success.
383  */
384 int
385 qla2x00_gnn_id(scsi_qla_host_t *ha, sw_info_t *list)
386 {
387 	int		rval;
388 	uint16_t	i;
389 
390 	ms_iocb_entry_t	*ms_pkt;
391 	struct ct_sns_req	*ct_req;
392 	struct ct_sns_rsp	*ct_rsp;
393 
394 	if (IS_QLA2100(ha) || IS_QLA2200(ha)) {
395 		return (qla2x00_sns_gnn_id(ha, list));
396 	}
397 
398 	for (i = 0; i < MAX_FIBRE_DEVICES; i++) {
399 		/* Issue GNN_ID */
400 		/* Prepare common MS IOCB */
401 		ms_pkt = ha->isp_ops.prep_ms_iocb(ha, GNN_ID_REQ_SIZE,
402 		    GNN_ID_RSP_SIZE);
403 
404 		/* Prepare CT request */
405 		ct_req = qla2x00_prep_ct_req(&ha->ct_sns->p.req, GNN_ID_CMD,
406 		    GNN_ID_RSP_SIZE);
407 		ct_rsp = &ha->ct_sns->p.rsp;
408 
409 		/* Prepare CT arguments -- port_id */
410 		ct_req->req.port_id.port_id[0] = list[i].d_id.b.domain;
411 		ct_req->req.port_id.port_id[1] = list[i].d_id.b.area;
412 		ct_req->req.port_id.port_id[2] = list[i].d_id.b.al_pa;
413 
414 		/* Execute MS IOCB */
415 		rval = qla2x00_issue_iocb(ha, ha->ms_iocb, ha->ms_iocb_dma,
416 		    sizeof(ms_iocb_entry_t));
417 		if (rval != QLA_SUCCESS) {
418 			/*EMPTY*/
419 			DEBUG2_3(printk("scsi(%ld): GNN_ID issue IOCB failed "
420 			    "(%d).\n", ha->host_no, rval));
421 		} else if (qla2x00_chk_ms_status(ha, ms_pkt, ct_rsp,
422 		    "GNN_ID") != QLA_SUCCESS) {
423 			rval = QLA_FUNCTION_FAILED;
424 		} else {
425 			/* Save nodename */
426 			memcpy(list[i].node_name,
427 			    ct_rsp->rsp.gnn_id.node_name, WWN_SIZE);
428 
429 			DEBUG2_3(printk("scsi(%ld): GID_PT entry - "
430 			    "nn %02x%02x%02x%02x%02x%02x%02x%02x "
431 			    "pn %02x%02x%02x%02x%02x%02x%02x%02x "
432 			    "portid=%02x%02x%02x.\n",
433 			    ha->host_no,
434 			    list[i].node_name[0], list[i].node_name[1],
435 			    list[i].node_name[2], list[i].node_name[3],
436 			    list[i].node_name[4], list[i].node_name[5],
437 			    list[i].node_name[6], list[i].node_name[7],
438 			    list[i].port_name[0], list[i].port_name[1],
439 			    list[i].port_name[2], list[i].port_name[3],
440 			    list[i].port_name[4], list[i].port_name[5],
441 			    list[i].port_name[6], list[i].port_name[7],
442 			    list[i].d_id.b.domain, list[i].d_id.b.area,
443 			    list[i].d_id.b.al_pa));
444 		}
445 
446 		/* Last device exit. */
447 		if (list[i].d_id.b.rsvd_1 != 0)
448 			break;
449 	}
450 
451 	return (rval);
452 }
453 
454 /**
455  * qla2x00_rft_id() - SNS Register FC-4 TYPEs (RFT_ID) supported by the HBA.
456  * @ha: HA context
457  *
458  * Returns 0 on success.
459  */
460 int
461 qla2x00_rft_id(scsi_qla_host_t *ha)
462 {
463 	int		rval;
464 
465 	ms_iocb_entry_t	*ms_pkt;
466 	struct ct_sns_req	*ct_req;
467 	struct ct_sns_rsp	*ct_rsp;
468 
469 	if (IS_QLA2100(ha) || IS_QLA2200(ha)) {
470 		return (qla2x00_sns_rft_id(ha));
471 	}
472 
473 	/* Issue RFT_ID */
474 	/* Prepare common MS IOCB */
475 	ms_pkt = ha->isp_ops.prep_ms_iocb(ha, RFT_ID_REQ_SIZE, RFT_ID_RSP_SIZE);
476 
477 	/* Prepare CT request */
478 	ct_req = qla2x00_prep_ct_req(&ha->ct_sns->p.req, RFT_ID_CMD,
479 	    RFT_ID_RSP_SIZE);
480 	ct_rsp = &ha->ct_sns->p.rsp;
481 
482 	/* Prepare CT arguments -- port_id, FC-4 types */
483 	ct_req->req.rft_id.port_id[0] = ha->d_id.b.domain;
484 	ct_req->req.rft_id.port_id[1] = ha->d_id.b.area;
485 	ct_req->req.rft_id.port_id[2] = ha->d_id.b.al_pa;
486 
487 	ct_req->req.rft_id.fc4_types[2] = 0x01;		/* FCP-3 */
488 
489 	/* Execute MS IOCB */
490 	rval = qla2x00_issue_iocb(ha, ha->ms_iocb, ha->ms_iocb_dma,
491 	    sizeof(ms_iocb_entry_t));
492 	if (rval != QLA_SUCCESS) {
493 		/*EMPTY*/
494 		DEBUG2_3(printk("scsi(%ld): RFT_ID issue IOCB failed (%d).\n",
495 		    ha->host_no, rval));
496 	} else if (qla2x00_chk_ms_status(ha, ms_pkt, ct_rsp, "RFT_ID") !=
497 	    QLA_SUCCESS) {
498 		rval = QLA_FUNCTION_FAILED;
499 	} else {
500 		DEBUG2(printk("scsi(%ld): RFT_ID exiting normally.\n",
501 		    ha->host_no));
502 	}
503 
504 	return (rval);
505 }
506 
507 /**
508  * qla2x00_rff_id() - SNS Register FC-4 Features (RFF_ID) supported by the HBA.
509  * @ha: HA context
510  *
511  * Returns 0 on success.
512  */
513 int
514 qla2x00_rff_id(scsi_qla_host_t *ha)
515 {
516 	int		rval;
517 
518 	ms_iocb_entry_t	*ms_pkt;
519 	struct ct_sns_req	*ct_req;
520 	struct ct_sns_rsp	*ct_rsp;
521 
522 	if (IS_QLA2100(ha) || IS_QLA2200(ha)) {
523 		DEBUG2(printk("scsi(%ld): RFF_ID call unsupported on "
524 		    "ISP2100/ISP2200.\n", ha->host_no));
525 		return (QLA_SUCCESS);
526 	}
527 
528 	/* Issue RFF_ID */
529 	/* Prepare common MS IOCB */
530 	ms_pkt = ha->isp_ops.prep_ms_iocb(ha, RFF_ID_REQ_SIZE, RFF_ID_RSP_SIZE);
531 
532 	/* Prepare CT request */
533 	ct_req = qla2x00_prep_ct_req(&ha->ct_sns->p.req, RFF_ID_CMD,
534 	    RFF_ID_RSP_SIZE);
535 	ct_rsp = &ha->ct_sns->p.rsp;
536 
537 	/* Prepare CT arguments -- port_id, FC-4 feature, FC-4 type */
538 	ct_req->req.rff_id.port_id[0] = ha->d_id.b.domain;
539 	ct_req->req.rff_id.port_id[1] = ha->d_id.b.area;
540 	ct_req->req.rff_id.port_id[2] = ha->d_id.b.al_pa;
541 
542 	ct_req->req.rff_id.fc4_feature = BIT_1;
543 	ct_req->req.rff_id.fc4_type = 0x08;		/* SCSI - FCP */
544 
545 	/* Execute MS IOCB */
546 	rval = qla2x00_issue_iocb(ha, ha->ms_iocb, ha->ms_iocb_dma,
547 	    sizeof(ms_iocb_entry_t));
548 	if (rval != QLA_SUCCESS) {
549 		/*EMPTY*/
550 		DEBUG2_3(printk("scsi(%ld): RFF_ID issue IOCB failed (%d).\n",
551 		    ha->host_no, rval));
552 	} else if (qla2x00_chk_ms_status(ha, ms_pkt, ct_rsp, "RFF_ID") !=
553 	    QLA_SUCCESS) {
554 		rval = QLA_FUNCTION_FAILED;
555 	} else {
556 		DEBUG2(printk("scsi(%ld): RFF_ID exiting normally.\n",
557 		    ha->host_no));
558 	}
559 
560 	return (rval);
561 }
562 
563 /**
564  * qla2x00_rnn_id() - SNS Register Node Name (RNN_ID) of the HBA.
565  * @ha: HA context
566  *
567  * Returns 0 on success.
568  */
569 int
570 qla2x00_rnn_id(scsi_qla_host_t *ha)
571 {
572 	int		rval;
573 
574 	ms_iocb_entry_t	*ms_pkt;
575 	struct ct_sns_req	*ct_req;
576 	struct ct_sns_rsp	*ct_rsp;
577 
578 	if (IS_QLA2100(ha) || IS_QLA2200(ha)) {
579 		return (qla2x00_sns_rnn_id(ha));
580 	}
581 
582 	/* Issue RNN_ID */
583 	/* Prepare common MS IOCB */
584 	ms_pkt = ha->isp_ops.prep_ms_iocb(ha, RNN_ID_REQ_SIZE, RNN_ID_RSP_SIZE);
585 
586 	/* Prepare CT request */
587 	ct_req = qla2x00_prep_ct_req(&ha->ct_sns->p.req, RNN_ID_CMD,
588 	    RNN_ID_RSP_SIZE);
589 	ct_rsp = &ha->ct_sns->p.rsp;
590 
591 	/* Prepare CT arguments -- port_id, node_name */
592 	ct_req->req.rnn_id.port_id[0] = ha->d_id.b.domain;
593 	ct_req->req.rnn_id.port_id[1] = ha->d_id.b.area;
594 	ct_req->req.rnn_id.port_id[2] = ha->d_id.b.al_pa;
595 
596 	memcpy(ct_req->req.rnn_id.node_name, ha->node_name, WWN_SIZE);
597 
598 	/* Execute MS IOCB */
599 	rval = qla2x00_issue_iocb(ha, ha->ms_iocb, ha->ms_iocb_dma,
600 	    sizeof(ms_iocb_entry_t));
601 	if (rval != QLA_SUCCESS) {
602 		/*EMPTY*/
603 		DEBUG2_3(printk("scsi(%ld): RNN_ID issue IOCB failed (%d).\n",
604 		    ha->host_no, rval));
605 	} else if (qla2x00_chk_ms_status(ha, ms_pkt, ct_rsp, "RNN_ID") !=
606 	    QLA_SUCCESS) {
607 		rval = QLA_FUNCTION_FAILED;
608 	} else {
609 		DEBUG2(printk("scsi(%ld): RNN_ID exiting normally.\n",
610 		    ha->host_no));
611 	}
612 
613 	return (rval);
614 }
615 
616 void
617 qla2x00_get_sym_node_name(scsi_qla_host_t *ha, uint8_t *snn)
618 {
619 	sprintf(snn, "%s FW:v%d.%02d.%02d DVR:v%s",ha->model_number,
620 	    ha->fw_major_version, ha->fw_minor_version,
621 	    ha->fw_subminor_version, qla2x00_version_str);
622 }
623 
624 /**
625  * qla2x00_rsnn_nn() - SNS Register Symbolic Node Name (RSNN_NN) of the HBA.
626  * @ha: HA context
627  *
628  * Returns 0 on success.
629  */
630 int
631 qla2x00_rsnn_nn(scsi_qla_host_t *ha)
632 {
633 	int		rval;
634 	ms_iocb_entry_t	*ms_pkt;
635 	struct ct_sns_req	*ct_req;
636 	struct ct_sns_rsp	*ct_rsp;
637 
638 	if (IS_QLA2100(ha) || IS_QLA2200(ha)) {
639 		DEBUG2(printk("scsi(%ld): RSNN_ID call unsupported on "
640 		    "ISP2100/ISP2200.\n", ha->host_no));
641 		return (QLA_SUCCESS);
642 	}
643 
644 	/* Issue RSNN_NN */
645 	/* Prepare common MS IOCB */
646 	/*   Request size adjusted after CT preparation */
647 	ms_pkt = ha->isp_ops.prep_ms_iocb(ha, 0, RSNN_NN_RSP_SIZE);
648 
649 	/* Prepare CT request */
650 	ct_req = qla2x00_prep_ct_req(&ha->ct_sns->p.req, RSNN_NN_CMD,
651 	    RSNN_NN_RSP_SIZE);
652 	ct_rsp = &ha->ct_sns->p.rsp;
653 
654 	/* Prepare CT arguments -- node_name, symbolic node_name, size */
655 	memcpy(ct_req->req.rsnn_nn.node_name, ha->node_name, WWN_SIZE);
656 
657 	/* Prepare the Symbolic Node Name */
658 	qla2x00_get_sym_node_name(ha, ct_req->req.rsnn_nn.sym_node_name);
659 
660 	/* Calculate SNN length */
661 	ct_req->req.rsnn_nn.name_len =
662 	    (uint8_t)strlen(ct_req->req.rsnn_nn.sym_node_name);
663 
664 	/* Update MS IOCB request */
665 	ms_pkt->req_bytecount =
666 	    cpu_to_le32(24 + 1 + ct_req->req.rsnn_nn.name_len);
667 	ms_pkt->dseg_req_length = ms_pkt->req_bytecount;
668 
669 	/* Execute MS IOCB */
670 	rval = qla2x00_issue_iocb(ha, ha->ms_iocb, ha->ms_iocb_dma,
671 	    sizeof(ms_iocb_entry_t));
672 	if (rval != QLA_SUCCESS) {
673 		/*EMPTY*/
674 		DEBUG2_3(printk("scsi(%ld): RSNN_NN issue IOCB failed (%d).\n",
675 		    ha->host_no, rval));
676 	} else if (qla2x00_chk_ms_status(ha, ms_pkt, ct_rsp, "RSNN_NN") !=
677 	    QLA_SUCCESS) {
678 		rval = QLA_FUNCTION_FAILED;
679 	} else {
680 		DEBUG2(printk("scsi(%ld): RSNN_NN exiting normally.\n",
681 		    ha->host_no));
682 	}
683 
684 	return (rval);
685 }
686 
687 /**
688  * qla2x00_prep_sns_cmd() - Prepare common SNS command request fields for query.
689  * @ha: HA context
690  * @cmd: GS command
691  * @scmd_len: Subcommand length
692  * @data_size: response size in bytes
693  *
694  * Returns a pointer to the @ha's sns_cmd.
695  */
696 static inline struct sns_cmd_pkt *
697 qla2x00_prep_sns_cmd(scsi_qla_host_t *ha, uint16_t cmd, uint16_t scmd_len,
698     uint16_t data_size)
699 {
700 	uint16_t		wc;
701 	struct sns_cmd_pkt	*sns_cmd;
702 
703 	sns_cmd = ha->sns_cmd;
704 	memset(sns_cmd, 0, sizeof(struct sns_cmd_pkt));
705 	wc = data_size / 2;			/* Size in 16bit words. */
706 	sns_cmd->p.cmd.buffer_length = cpu_to_le16(wc);
707 	sns_cmd->p.cmd.buffer_address[0] = cpu_to_le32(LSD(ha->sns_cmd_dma));
708 	sns_cmd->p.cmd.buffer_address[1] = cpu_to_le32(MSD(ha->sns_cmd_dma));
709 	sns_cmd->p.cmd.subcommand_length = cpu_to_le16(scmd_len);
710 	sns_cmd->p.cmd.subcommand = cpu_to_le16(cmd);
711 	wc = (data_size - 16) / 4;		/* Size in 32bit words. */
712 	sns_cmd->p.cmd.size = cpu_to_le16(wc);
713 
714 	return (sns_cmd);
715 }
716 
717 /**
718  * qla2x00_sns_ga_nxt() - SNS scan for fabric devices via GA_NXT command.
719  * @ha: HA context
720  * @fcport: fcport entry to updated
721  *
722  * This command uses the old Exectute SNS Command mailbox routine.
723  *
724  * Returns 0 on success.
725  */
726 static int
727 qla2x00_sns_ga_nxt(scsi_qla_host_t *ha, fc_port_t *fcport)
728 {
729 	int		rval;
730 
731 	struct sns_cmd_pkt	*sns_cmd;
732 
733 	/* Issue GA_NXT. */
734 	/* Prepare SNS command request. */
735 	sns_cmd = qla2x00_prep_sns_cmd(ha, GA_NXT_CMD, GA_NXT_SNS_SCMD_LEN,
736 	    GA_NXT_SNS_DATA_SIZE);
737 
738 	/* Prepare SNS command arguments -- port_id. */
739 	sns_cmd->p.cmd.param[0] = fcport->d_id.b.al_pa;
740 	sns_cmd->p.cmd.param[1] = fcport->d_id.b.area;
741 	sns_cmd->p.cmd.param[2] = fcport->d_id.b.domain;
742 
743 	/* Execute SNS command. */
744 	rval = qla2x00_send_sns(ha, ha->sns_cmd_dma, GA_NXT_SNS_CMD_SIZE / 2,
745 	    sizeof(struct sns_cmd_pkt));
746 	if (rval != QLA_SUCCESS) {
747 		/*EMPTY*/
748 		DEBUG2_3(printk("scsi(%ld): GA_NXT Send SNS failed (%d).\n",
749 		    ha->host_no, rval));
750 	} else if (sns_cmd->p.gan_data[8] != 0x80 ||
751 	    sns_cmd->p.gan_data[9] != 0x02) {
752 		DEBUG2_3(printk("scsi(%ld): GA_NXT failed, rejected request, "
753 		    "ga_nxt_rsp:\n", ha->host_no));
754 		DEBUG2_3(qla2x00_dump_buffer(sns_cmd->p.gan_data, 16));
755 		rval = QLA_FUNCTION_FAILED;
756 	} else {
757 		/* Populate fc_port_t entry. */
758 		fcport->d_id.b.domain = sns_cmd->p.gan_data[17];
759 		fcport->d_id.b.area = sns_cmd->p.gan_data[18];
760 		fcport->d_id.b.al_pa = sns_cmd->p.gan_data[19];
761 
762 		memcpy(fcport->node_name, &sns_cmd->p.gan_data[284], WWN_SIZE);
763 		memcpy(fcport->port_name, &sns_cmd->p.gan_data[20], WWN_SIZE);
764 
765 		if (sns_cmd->p.gan_data[16] != NS_N_PORT_TYPE &&
766 		    sns_cmd->p.gan_data[16] != NS_NL_PORT_TYPE)
767 			fcport->d_id.b.domain = 0xf0;
768 
769 		DEBUG2_3(printk("scsi(%ld): GA_NXT entry - "
770 		    "nn %02x%02x%02x%02x%02x%02x%02x%02x "
771 		    "pn %02x%02x%02x%02x%02x%02x%02x%02x "
772 		    "portid=%02x%02x%02x.\n",
773 		    ha->host_no,
774 		    fcport->node_name[0], fcport->node_name[1],
775 		    fcport->node_name[2], fcport->node_name[3],
776 		    fcport->node_name[4], fcport->node_name[5],
777 		    fcport->node_name[6], fcport->node_name[7],
778 		    fcport->port_name[0], fcport->port_name[1],
779 		    fcport->port_name[2], fcport->port_name[3],
780 		    fcport->port_name[4], fcport->port_name[5],
781 		    fcport->port_name[6], fcport->port_name[7],
782 		    fcport->d_id.b.domain, fcport->d_id.b.area,
783 		    fcport->d_id.b.al_pa));
784 	}
785 
786 	return (rval);
787 }
788 
789 /**
790  * qla2x00_sns_gid_pt() - SNS scan for fabric devices via GID_PT command.
791  * @ha: HA context
792  * @list: switch info entries to populate
793  *
794  * This command uses the old Exectute SNS Command mailbox routine.
795  *
796  * NOTE: Non-Nx_Ports are not requested.
797  *
798  * Returns 0 on success.
799  */
800 static int
801 qla2x00_sns_gid_pt(scsi_qla_host_t *ha, sw_info_t *list)
802 {
803 	int		rval;
804 
805 	uint16_t	i;
806 	uint8_t		*entry;
807 	struct sns_cmd_pkt	*sns_cmd;
808 
809 	/* Issue GID_PT. */
810 	/* Prepare SNS command request. */
811 	sns_cmd = qla2x00_prep_sns_cmd(ha, GID_PT_CMD, GID_PT_SNS_SCMD_LEN,
812 	    GID_PT_SNS_DATA_SIZE);
813 
814 	/* Prepare SNS command arguments -- port_type. */
815 	sns_cmd->p.cmd.param[0] = NS_NX_PORT_TYPE;
816 
817 	/* Execute SNS command. */
818 	rval = qla2x00_send_sns(ha, ha->sns_cmd_dma, GID_PT_SNS_CMD_SIZE / 2,
819 	    sizeof(struct sns_cmd_pkt));
820 	if (rval != QLA_SUCCESS) {
821 		/*EMPTY*/
822 		DEBUG2_3(printk("scsi(%ld): GID_PT Send SNS failed (%d).\n",
823 		    ha->host_no, rval));
824 	} else if (sns_cmd->p.gid_data[8] != 0x80 ||
825 	    sns_cmd->p.gid_data[9] != 0x02) {
826 		DEBUG2_3(printk("scsi(%ld): GID_PT failed, rejected request, "
827 		    "gid_rsp:\n", ha->host_no));
828 		DEBUG2_3(qla2x00_dump_buffer(sns_cmd->p.gid_data, 16));
829 		rval = QLA_FUNCTION_FAILED;
830 	} else {
831 		/* Set port IDs in switch info list. */
832 		for (i = 0; i < MAX_FIBRE_DEVICES; i++) {
833 			entry = &sns_cmd->p.gid_data[(i * 4) + 16];
834 			list[i].d_id.b.domain = entry[1];
835 			list[i].d_id.b.area = entry[2];
836 			list[i].d_id.b.al_pa = entry[3];
837 
838 			/* Last one exit. */
839 			if (entry[0] & BIT_7) {
840 				list[i].d_id.b.rsvd_1 = entry[0];
841 				break;
842 			}
843 		}
844 
845 		/*
846 		 * If we've used all available slots, then the switch is
847 		 * reporting back more devices that we can handle with this
848 		 * single call.  Return a failed status, and let GA_NXT handle
849 		 * the overload.
850 		 */
851 		if (i == MAX_FIBRE_DEVICES)
852 			rval = QLA_FUNCTION_FAILED;
853 	}
854 
855 	return (rval);
856 }
857 
858 /**
859  * qla2x00_sns_gpn_id() - SNS Get Port Name (GPN_ID) query.
860  * @ha: HA context
861  * @list: switch info entries to populate
862  *
863  * This command uses the old Exectute SNS Command mailbox routine.
864  *
865  * Returns 0 on success.
866  */
867 static int
868 qla2x00_sns_gpn_id(scsi_qla_host_t *ha, sw_info_t *list)
869 {
870 	int		rval;
871 
872 	uint16_t	i;
873 	struct sns_cmd_pkt	*sns_cmd;
874 
875 	for (i = 0; i < MAX_FIBRE_DEVICES; i++) {
876 		/* Issue GPN_ID */
877 		/* Prepare SNS command request. */
878 		sns_cmd = qla2x00_prep_sns_cmd(ha, GPN_ID_CMD,
879 		    GPN_ID_SNS_SCMD_LEN, GPN_ID_SNS_DATA_SIZE);
880 
881 		/* Prepare SNS command arguments -- port_id. */
882 		sns_cmd->p.cmd.param[0] = list[i].d_id.b.al_pa;
883 		sns_cmd->p.cmd.param[1] = list[i].d_id.b.area;
884 		sns_cmd->p.cmd.param[2] = list[i].d_id.b.domain;
885 
886 		/* Execute SNS command. */
887 		rval = qla2x00_send_sns(ha, ha->sns_cmd_dma,
888 		    GPN_ID_SNS_CMD_SIZE / 2, sizeof(struct sns_cmd_pkt));
889 		if (rval != QLA_SUCCESS) {
890 			/*EMPTY*/
891 			DEBUG2_3(printk("scsi(%ld): GPN_ID Send SNS failed "
892 			    "(%d).\n", ha->host_no, rval));
893 		} else if (sns_cmd->p.gpn_data[8] != 0x80 ||
894 		    sns_cmd->p.gpn_data[9] != 0x02) {
895 			DEBUG2_3(printk("scsi(%ld): GPN_ID failed, rejected "
896 			    "request, gpn_rsp:\n", ha->host_no));
897 			DEBUG2_3(qla2x00_dump_buffer(sns_cmd->p.gpn_data, 16));
898 			rval = QLA_FUNCTION_FAILED;
899 		} else {
900 			/* Save portname */
901 			memcpy(list[i].port_name, &sns_cmd->p.gpn_data[16],
902 			    WWN_SIZE);
903 		}
904 
905 		/* Last device exit. */
906 		if (list[i].d_id.b.rsvd_1 != 0)
907 			break;
908 	}
909 
910 	return (rval);
911 }
912 
913 /**
914  * qla2x00_sns_gnn_id() - SNS Get Node Name (GNN_ID) query.
915  * @ha: HA context
916  * @list: switch info entries to populate
917  *
918  * This command uses the old Exectute SNS Command mailbox routine.
919  *
920  * Returns 0 on success.
921  */
922 static int
923 qla2x00_sns_gnn_id(scsi_qla_host_t *ha, sw_info_t *list)
924 {
925 	int		rval;
926 
927 	uint16_t	i;
928 	struct sns_cmd_pkt	*sns_cmd;
929 
930 	for (i = 0; i < MAX_FIBRE_DEVICES; i++) {
931 		/* Issue GNN_ID */
932 		/* Prepare SNS command request. */
933 		sns_cmd = qla2x00_prep_sns_cmd(ha, GNN_ID_CMD,
934 		    GNN_ID_SNS_SCMD_LEN, GNN_ID_SNS_DATA_SIZE);
935 
936 		/* Prepare SNS command arguments -- port_id. */
937 		sns_cmd->p.cmd.param[0] = list[i].d_id.b.al_pa;
938 		sns_cmd->p.cmd.param[1] = list[i].d_id.b.area;
939 		sns_cmd->p.cmd.param[2] = list[i].d_id.b.domain;
940 
941 		/* Execute SNS command. */
942 		rval = qla2x00_send_sns(ha, ha->sns_cmd_dma,
943 		    GNN_ID_SNS_CMD_SIZE / 2, sizeof(struct sns_cmd_pkt));
944 		if (rval != QLA_SUCCESS) {
945 			/*EMPTY*/
946 			DEBUG2_3(printk("scsi(%ld): GNN_ID Send SNS failed "
947 			    "(%d).\n", ha->host_no, rval));
948 		} else if (sns_cmd->p.gnn_data[8] != 0x80 ||
949 		    sns_cmd->p.gnn_data[9] != 0x02) {
950 			DEBUG2_3(printk("scsi(%ld): GNN_ID failed, rejected "
951 			    "request, gnn_rsp:\n", ha->host_no));
952 			DEBUG2_3(qla2x00_dump_buffer(sns_cmd->p.gnn_data, 16));
953 			rval = QLA_FUNCTION_FAILED;
954 		} else {
955 			/* Save nodename */
956 			memcpy(list[i].node_name, &sns_cmd->p.gnn_data[16],
957 			    WWN_SIZE);
958 
959 			DEBUG2_3(printk("scsi(%ld): GID_PT entry - "
960 			    "nn %02x%02x%02x%02x%02x%02x%02x%02x "
961 			    "pn %02x%02x%02x%02x%02x%02x%02x%02x "
962 			    "portid=%02x%02x%02x.\n",
963 			    ha->host_no,
964 			    list[i].node_name[0], list[i].node_name[1],
965 			    list[i].node_name[2], list[i].node_name[3],
966 			    list[i].node_name[4], list[i].node_name[5],
967 			    list[i].node_name[6], list[i].node_name[7],
968 			    list[i].port_name[0], list[i].port_name[1],
969 			    list[i].port_name[2], list[i].port_name[3],
970 			    list[i].port_name[4], list[i].port_name[5],
971 			    list[i].port_name[6], list[i].port_name[7],
972 			    list[i].d_id.b.domain, list[i].d_id.b.area,
973 			    list[i].d_id.b.al_pa));
974 		}
975 
976 		/* Last device exit. */
977 		if (list[i].d_id.b.rsvd_1 != 0)
978 			break;
979 	}
980 
981 	return (rval);
982 }
983 
984 /**
985  * qla2x00_snd_rft_id() - SNS Register FC-4 TYPEs (RFT_ID) supported by the HBA.
986  * @ha: HA context
987  *
988  * This command uses the old Exectute SNS Command mailbox routine.
989  *
990  * Returns 0 on success.
991  */
992 static int
993 qla2x00_sns_rft_id(scsi_qla_host_t *ha)
994 {
995 	int		rval;
996 
997 	struct sns_cmd_pkt	*sns_cmd;
998 
999 	/* Issue RFT_ID. */
1000 	/* Prepare SNS command request. */
1001 	sns_cmd = qla2x00_prep_sns_cmd(ha, RFT_ID_CMD, RFT_ID_SNS_SCMD_LEN,
1002 	    RFT_ID_SNS_DATA_SIZE);
1003 
1004 	/* Prepare SNS command arguments -- port_id, FC-4 types */
1005 	sns_cmd->p.cmd.param[0] = ha->d_id.b.al_pa;
1006 	sns_cmd->p.cmd.param[1] = ha->d_id.b.area;
1007 	sns_cmd->p.cmd.param[2] = ha->d_id.b.domain;
1008 
1009 	sns_cmd->p.cmd.param[5] = 0x01;			/* FCP-3 */
1010 
1011 	/* Execute SNS command. */
1012 	rval = qla2x00_send_sns(ha, ha->sns_cmd_dma, RFT_ID_SNS_CMD_SIZE / 2,
1013 	    sizeof(struct sns_cmd_pkt));
1014 	if (rval != QLA_SUCCESS) {
1015 		/*EMPTY*/
1016 		DEBUG2_3(printk("scsi(%ld): RFT_ID Send SNS failed (%d).\n",
1017 		    ha->host_no, rval));
1018 	} else if (sns_cmd->p.rft_data[8] != 0x80 ||
1019 	    sns_cmd->p.rft_data[9] != 0x02) {
1020 		DEBUG2_3(printk("scsi(%ld): RFT_ID failed, rejected request, "
1021 		    "rft_rsp:\n", ha->host_no));
1022 		DEBUG2_3(qla2x00_dump_buffer(sns_cmd->p.rft_data, 16));
1023 		rval = QLA_FUNCTION_FAILED;
1024 	} else {
1025 		DEBUG2(printk("scsi(%ld): RFT_ID exiting normally.\n",
1026 		    ha->host_no));
1027 	}
1028 
1029 	return (rval);
1030 }
1031 
1032 /**
1033  * qla2x00_sns_rnn_id() - SNS Register Node Name (RNN_ID) of the HBA.
1034  * HBA.
1035  * @ha: HA context
1036  *
1037  * This command uses the old Exectute SNS Command mailbox routine.
1038  *
1039  * Returns 0 on success.
1040  */
1041 static int
1042 qla2x00_sns_rnn_id(scsi_qla_host_t *ha)
1043 {
1044 	int		rval;
1045 
1046 	struct sns_cmd_pkt	*sns_cmd;
1047 
1048 	/* Issue RNN_ID. */
1049 	/* Prepare SNS command request. */
1050 	sns_cmd = qla2x00_prep_sns_cmd(ha, RNN_ID_CMD, RNN_ID_SNS_SCMD_LEN,
1051 	    RNN_ID_SNS_DATA_SIZE);
1052 
1053 	/* Prepare SNS command arguments -- port_id, nodename. */
1054 	sns_cmd->p.cmd.param[0] = ha->d_id.b.al_pa;
1055 	sns_cmd->p.cmd.param[1] = ha->d_id.b.area;
1056 	sns_cmd->p.cmd.param[2] = ha->d_id.b.domain;
1057 
1058 	sns_cmd->p.cmd.param[4] = ha->node_name[7];
1059 	sns_cmd->p.cmd.param[5] = ha->node_name[6];
1060 	sns_cmd->p.cmd.param[6] = ha->node_name[5];
1061 	sns_cmd->p.cmd.param[7] = ha->node_name[4];
1062 	sns_cmd->p.cmd.param[8] = ha->node_name[3];
1063 	sns_cmd->p.cmd.param[9] = ha->node_name[2];
1064 	sns_cmd->p.cmd.param[10] = ha->node_name[1];
1065 	sns_cmd->p.cmd.param[11] = ha->node_name[0];
1066 
1067 	/* Execute SNS command. */
1068 	rval = qla2x00_send_sns(ha, ha->sns_cmd_dma, RNN_ID_SNS_CMD_SIZE / 2,
1069 	    sizeof(struct sns_cmd_pkt));
1070 	if (rval != QLA_SUCCESS) {
1071 		/*EMPTY*/
1072 		DEBUG2_3(printk("scsi(%ld): RNN_ID Send SNS failed (%d).\n",
1073 		    ha->host_no, rval));
1074 	} else if (sns_cmd->p.rnn_data[8] != 0x80 ||
1075 	    sns_cmd->p.rnn_data[9] != 0x02) {
1076 		DEBUG2_3(printk("scsi(%ld): RNN_ID failed, rejected request, "
1077 		    "rnn_rsp:\n", ha->host_no));
1078 		DEBUG2_3(qla2x00_dump_buffer(sns_cmd->p.rnn_data, 16));
1079 		rval = QLA_FUNCTION_FAILED;
1080 	} else {
1081 		DEBUG2(printk("scsi(%ld): RNN_ID exiting normally.\n",
1082 		    ha->host_no));
1083 	}
1084 
1085 	return (rval);
1086 }
1087 
1088 /**
1089  * qla2x00_mgmt_svr_login() - Login to fabric Managment Service.
1090  * @ha: HA context
1091  *
1092  * Returns 0 on success.
1093  */
1094 static int
1095 qla2x00_mgmt_svr_login(scsi_qla_host_t *ha)
1096 {
1097 	int ret;
1098 	uint16_t mb[MAILBOX_REGISTER_COUNT];
1099 
1100 	ret = QLA_SUCCESS;
1101 	if (ha->flags.management_server_logged_in)
1102 		return ret;
1103 
1104 	ha->isp_ops.fabric_login(ha, ha->mgmt_svr_loop_id, 0xff, 0xff, 0xfa,
1105 	    mb, BIT_1);
1106 	if (mb[0] != MBS_COMMAND_COMPLETE) {
1107 		DEBUG2_13(printk("%s(%ld): Failed MANAGEMENT_SERVER login: "
1108 		    "loop_id=%x mb[0]=%x mb[1]=%x mb[2]=%x mb[6]=%x mb[7]=%x\n",
1109 		    __func__, ha->host_no, ha->mgmt_svr_loop_id, mb[0], mb[1],
1110 		    mb[2], mb[6], mb[7]));
1111 		ret = QLA_FUNCTION_FAILED;
1112 	} else
1113 		ha->flags.management_server_logged_in = 1;
1114 
1115 	return ret;
1116 }
1117 
1118 /**
1119  * qla2x00_prep_ms_fdmi_iocb() - Prepare common MS IOCB fields for FDMI query.
1120  * @ha: HA context
1121  * @req_size: request size in bytes
1122  * @rsp_size: response size in bytes
1123  *
1124  * Returns a pointer to the @ha's ms_iocb.
1125  */
1126 void *
1127 qla2x00_prep_ms_fdmi_iocb(scsi_qla_host_t *ha, uint32_t req_size,
1128     uint32_t rsp_size)
1129 {
1130 	ms_iocb_entry_t *ms_pkt;
1131 
1132 	ms_pkt = ha->ms_iocb;
1133 	memset(ms_pkt, 0, sizeof(ms_iocb_entry_t));
1134 
1135 	ms_pkt->entry_type = MS_IOCB_TYPE;
1136 	ms_pkt->entry_count = 1;
1137 	SET_TARGET_ID(ha, ms_pkt->loop_id, ha->mgmt_svr_loop_id);
1138 	ms_pkt->control_flags = __constant_cpu_to_le16(CF_READ | CF_HEAD_TAG);
1139 	ms_pkt->timeout = __constant_cpu_to_le16(59);
1140 	ms_pkt->cmd_dsd_count = __constant_cpu_to_le16(1);
1141 	ms_pkt->total_dsd_count = __constant_cpu_to_le16(2);
1142 	ms_pkt->rsp_bytecount = cpu_to_le32(rsp_size);
1143 	ms_pkt->req_bytecount = cpu_to_le32(req_size);
1144 
1145 	ms_pkt->dseg_req_address[0] = cpu_to_le32(LSD(ha->ct_sns_dma));
1146 	ms_pkt->dseg_req_address[1] = cpu_to_le32(MSD(ha->ct_sns_dma));
1147 	ms_pkt->dseg_req_length = ms_pkt->req_bytecount;
1148 
1149 	ms_pkt->dseg_rsp_address[0] = cpu_to_le32(LSD(ha->ct_sns_dma));
1150 	ms_pkt->dseg_rsp_address[1] = cpu_to_le32(MSD(ha->ct_sns_dma));
1151 	ms_pkt->dseg_rsp_length = ms_pkt->rsp_bytecount;
1152 
1153 	return ms_pkt;
1154 }
1155 
1156 /**
1157  * qla24xx_prep_ms_fdmi_iocb() - Prepare common MS IOCB fields for FDMI query.
1158  * @ha: HA context
1159  * @req_size: request size in bytes
1160  * @rsp_size: response size in bytes
1161  *
1162  * Returns a pointer to the @ha's ms_iocb.
1163  */
1164 void *
1165 qla24xx_prep_ms_fdmi_iocb(scsi_qla_host_t *ha, uint32_t req_size,
1166     uint32_t rsp_size)
1167 {
1168 	struct ct_entry_24xx *ct_pkt;
1169 
1170 	ct_pkt = (struct ct_entry_24xx *)ha->ms_iocb;
1171 	memset(ct_pkt, 0, sizeof(struct ct_entry_24xx));
1172 
1173 	ct_pkt->entry_type = CT_IOCB_TYPE;
1174 	ct_pkt->entry_count = 1;
1175 	ct_pkt->nport_handle = cpu_to_le16(ha->mgmt_svr_loop_id);
1176 	ct_pkt->timeout = __constant_cpu_to_le16(59);
1177 	ct_pkt->cmd_dsd_count = __constant_cpu_to_le16(1);
1178 	ct_pkt->rsp_dsd_count = __constant_cpu_to_le16(1);
1179 	ct_pkt->rsp_byte_count = cpu_to_le32(rsp_size);
1180 	ct_pkt->cmd_byte_count = cpu_to_le32(req_size);
1181 
1182 	ct_pkt->dseg_0_address[0] = cpu_to_le32(LSD(ha->ct_sns_dma));
1183 	ct_pkt->dseg_0_address[1] = cpu_to_le32(MSD(ha->ct_sns_dma));
1184 	ct_pkt->dseg_0_len = ct_pkt->cmd_byte_count;
1185 
1186 	ct_pkt->dseg_1_address[0] = cpu_to_le32(LSD(ha->ct_sns_dma));
1187 	ct_pkt->dseg_1_address[1] = cpu_to_le32(MSD(ha->ct_sns_dma));
1188 	ct_pkt->dseg_1_len = ct_pkt->rsp_byte_count;
1189 
1190 	return ct_pkt;
1191 }
1192 
1193 static inline ms_iocb_entry_t *
1194 qla2x00_update_ms_fdmi_iocb(scsi_qla_host_t *ha, uint32_t req_size)
1195 {
1196 	ms_iocb_entry_t *ms_pkt = ha->ms_iocb;
1197 	struct ct_entry_24xx *ct_pkt = (struct ct_entry_24xx *)ha->ms_iocb;
1198 
1199 	if (IS_QLA24XX(ha) || IS_QLA54XX(ha)) {
1200 		ct_pkt->cmd_byte_count = cpu_to_le32(req_size);
1201 		ct_pkt->dseg_0_len = ct_pkt->cmd_byte_count;
1202 	} else {
1203 		ms_pkt->req_bytecount = cpu_to_le32(req_size);
1204 		ms_pkt->dseg_req_length = ms_pkt->req_bytecount;
1205 	}
1206 
1207 	return ms_pkt;
1208 }
1209 
1210 /**
1211  * qla2x00_prep_ct_req() - Prepare common CT request fields for SNS query.
1212  * @ct_req: CT request buffer
1213  * @cmd: GS command
1214  * @rsp_size: response size in bytes
1215  *
1216  * Returns a pointer to the intitialized @ct_req.
1217  */
1218 static inline struct ct_sns_req *
1219 qla2x00_prep_ct_fdmi_req(struct ct_sns_req *ct_req, uint16_t cmd,
1220     uint16_t rsp_size)
1221 {
1222 	memset(ct_req, 0, sizeof(struct ct_sns_pkt));
1223 
1224 	ct_req->header.revision = 0x01;
1225 	ct_req->header.gs_type = 0xFA;
1226 	ct_req->header.gs_subtype = 0x10;
1227 	ct_req->command = cpu_to_be16(cmd);
1228 	ct_req->max_rsp_size = cpu_to_be16((rsp_size - 16) / 4);
1229 
1230 	return ct_req;
1231 }
1232 
1233 /**
1234  * qla2x00_fdmi_rhba() -
1235  * @ha: HA context
1236  *
1237  * Returns 0 on success.
1238  */
1239 static int
1240 qla2x00_fdmi_rhba(scsi_qla_host_t *ha)
1241 {
1242 	int rval, alen;
1243 	uint32_t size, sn;
1244 
1245 	ms_iocb_entry_t *ms_pkt;
1246 	struct ct_sns_req *ct_req;
1247 	struct ct_sns_rsp *ct_rsp;
1248 	uint8_t *entries;
1249 	struct ct_fdmi_hba_attr *eiter;
1250 
1251 	/* Issue RHBA */
1252 	/* Prepare common MS IOCB */
1253 	/*   Request size adjusted after CT preparation */
1254 	ms_pkt = ha->isp_ops.prep_ms_fdmi_iocb(ha, 0, RHBA_RSP_SIZE);
1255 
1256 	/* Prepare CT request */
1257 	ct_req = qla2x00_prep_ct_fdmi_req(&ha->ct_sns->p.req, RHBA_CMD,
1258 	    RHBA_RSP_SIZE);
1259 	ct_rsp = &ha->ct_sns->p.rsp;
1260 
1261 	/* Prepare FDMI command arguments -- attribute block, attributes. */
1262 	memcpy(ct_req->req.rhba.hba_identifier, ha->port_name, WWN_SIZE);
1263 	ct_req->req.rhba.entry_count = __constant_cpu_to_be32(1);
1264 	memcpy(ct_req->req.rhba.port_name, ha->port_name, WWN_SIZE);
1265 	size = 2 * WWN_SIZE + 4 + 4;
1266 
1267 	/* Attributes */
1268 	ct_req->req.rhba.attrs.count =
1269 	    __constant_cpu_to_be32(FDMI_HBA_ATTR_COUNT);
1270 	entries = ct_req->req.rhba.hba_identifier;
1271 
1272 	/* Nodename. */
1273 	eiter = (struct ct_fdmi_hba_attr *) (entries + size);
1274 	eiter->type = __constant_cpu_to_be16(FDMI_HBA_NODE_NAME);
1275 	eiter->len = __constant_cpu_to_be16(4 + WWN_SIZE);
1276 	memcpy(eiter->a.node_name, ha->node_name, WWN_SIZE);
1277 	size += 4 + WWN_SIZE;
1278 
1279 	DEBUG13(printk("%s(%ld): NODENAME=%02x%02x%02x%02x%02x%02x%02x%02x.\n",
1280 	    __func__, ha->host_no,
1281 	    eiter->a.node_name[0], eiter->a.node_name[1], eiter->a.node_name[2],
1282 	    eiter->a.node_name[3], eiter->a.node_name[4], eiter->a.node_name[5],
1283 	    eiter->a.node_name[6], eiter->a.node_name[7]));
1284 
1285 	/* Manufacturer. */
1286 	eiter = (struct ct_fdmi_hba_attr *) (entries + size);
1287 	eiter->type = __constant_cpu_to_be16(FDMI_HBA_MANUFACTURER);
1288 	strcpy(eiter->a.manufacturer, "QLogic Corporation");
1289 	alen = strlen(eiter->a.manufacturer);
1290 	alen += (alen & 3) ? (4 - (alen & 3)) : 4;
1291 	eiter->len = cpu_to_be16(4 + alen);
1292 	size += 4 + alen;
1293 
1294 	DEBUG13(printk("%s(%ld): MANUFACTURER=%s.\n", __func__, ha->host_no,
1295 	    eiter->a.manufacturer));
1296 
1297 	/* Serial number. */
1298 	eiter = (struct ct_fdmi_hba_attr *) (entries + size);
1299 	eiter->type = __constant_cpu_to_be16(FDMI_HBA_SERIAL_NUMBER);
1300 	sn = ((ha->serial0 & 0x1f) << 16) | (ha->serial2 << 8) | ha->serial1;
1301 	sprintf(eiter->a.serial_num, "%c%05d", 'A' + sn / 100000, sn % 100000);
1302 	alen = strlen(eiter->a.serial_num);
1303 	alen += (alen & 3) ? (4 - (alen & 3)) : 4;
1304 	eiter->len = cpu_to_be16(4 + alen);
1305 	size += 4 + alen;
1306 
1307 	DEBUG13(printk("%s(%ld): SERIALNO=%s.\n", __func__, ha->host_no,
1308 	    eiter->a.serial_num));
1309 
1310 	/* Model name. */
1311 	eiter = (struct ct_fdmi_hba_attr *) (entries + size);
1312 	eiter->type = __constant_cpu_to_be16(FDMI_HBA_MODEL);
1313 	strcpy(eiter->a.model, ha->model_number);
1314 	alen = strlen(eiter->a.model);
1315 	alen += (alen & 3) ? (4 - (alen & 3)) : 4;
1316 	eiter->len = cpu_to_be16(4 + alen);
1317 	size += 4 + alen;
1318 
1319 	DEBUG13(printk("%s(%ld): MODEL_NAME=%s.\n", __func__, ha->host_no,
1320 	    eiter->a.model));
1321 
1322 	/* Model description. */
1323 	eiter = (struct ct_fdmi_hba_attr *) (entries + size);
1324 	eiter->type = __constant_cpu_to_be16(FDMI_HBA_MODEL_DESCRIPTION);
1325 	if (ha->model_desc)
1326 		strncpy(eiter->a.model_desc, ha->model_desc, 80);
1327 	alen = strlen(eiter->a.model_desc);
1328 	alen += (alen & 3) ? (4 - (alen & 3)) : 4;
1329 	eiter->len = cpu_to_be16(4 + alen);
1330 	size += 4 + alen;
1331 
1332 	DEBUG13(printk("%s(%ld): MODEL_DESC=%s.\n", __func__, ha->host_no,
1333 	    eiter->a.model_desc));
1334 
1335 	/* Hardware version. */
1336 	eiter = (struct ct_fdmi_hba_attr *) (entries + size);
1337 	eiter->type = __constant_cpu_to_be16(FDMI_HBA_HARDWARE_VERSION);
1338 	strcpy(eiter->a.hw_version, ha->adapter_id);
1339 	alen = strlen(eiter->a.hw_version);
1340 	alen += (alen & 3) ? (4 - (alen & 3)) : 4;
1341 	eiter->len = cpu_to_be16(4 + alen);
1342 	size += 4 + alen;
1343 
1344 	DEBUG13(printk("%s(%ld): HARDWAREVER=%s.\n", __func__, ha->host_no,
1345 	    eiter->a.hw_version));
1346 
1347 	/* Driver version. */
1348 	eiter = (struct ct_fdmi_hba_attr *) (entries + size);
1349 	eiter->type = __constant_cpu_to_be16(FDMI_HBA_DRIVER_VERSION);
1350 	strcpy(eiter->a.driver_version, qla2x00_version_str);
1351 	alen = strlen(eiter->a.driver_version);
1352 	alen += (alen & 3) ? (4 - (alen & 3)) : 4;
1353 	eiter->len = cpu_to_be16(4 + alen);
1354 	size += 4 + alen;
1355 
1356 	DEBUG13(printk("%s(%ld): DRIVERVER=%s.\n", __func__, ha->host_no,
1357 	    eiter->a.driver_version));
1358 
1359 	/* Option ROM version. */
1360 	eiter = (struct ct_fdmi_hba_attr *) (entries + size);
1361 	eiter->type = __constant_cpu_to_be16(FDMI_HBA_OPTION_ROM_VERSION);
1362 	strcpy(eiter->a.orom_version, "0.00");
1363 	alen = strlen(eiter->a.orom_version);
1364 	alen += (alen & 3) ? (4 - (alen & 3)) : 4;
1365 	eiter->len = cpu_to_be16(4 + alen);
1366 	size += 4 + alen;
1367 
1368 	DEBUG13(printk("%s(%ld): OPTROMVER=%s.\n", __func__, ha->host_no,
1369 	    eiter->a.orom_version));
1370 
1371 	/* Firmware version */
1372 	eiter = (struct ct_fdmi_hba_attr *) (entries + size);
1373 	eiter->type = __constant_cpu_to_be16(FDMI_HBA_FIRMWARE_VERSION);
1374 	ha->isp_ops.fw_version_str(ha, eiter->a.fw_version);
1375 	alen = strlen(eiter->a.fw_version);
1376 	alen += (alen & 3) ? (4 - (alen & 3)) : 4;
1377 	eiter->len = cpu_to_be16(4 + alen);
1378 	size += 4 + alen;
1379 
1380 	DEBUG13(printk("%s(%ld): FIRMWAREVER=%s.\n", __func__, ha->host_no,
1381 	    eiter->a.fw_version));
1382 
1383 	/* Update MS request size. */
1384 	qla2x00_update_ms_fdmi_iocb(ha, size + 16);
1385 
1386 	DEBUG13(printk("%s(%ld): RHBA identifier="
1387 	    "%02x%02x%02x%02x%02x%02x%02x%02x size=%d.\n", __func__,
1388 	    ha->host_no, ct_req->req.rhba.hba_identifier[0],
1389 	    ct_req->req.rhba.hba_identifier[1],
1390 	    ct_req->req.rhba.hba_identifier[2],
1391 	    ct_req->req.rhba.hba_identifier[3],
1392 	    ct_req->req.rhba.hba_identifier[4],
1393 	    ct_req->req.rhba.hba_identifier[5],
1394 	    ct_req->req.rhba.hba_identifier[6],
1395 	    ct_req->req.rhba.hba_identifier[7], size));
1396 	DEBUG13(qla2x00_dump_buffer(entries, size));
1397 
1398 	/* Execute MS IOCB */
1399 	rval = qla2x00_issue_iocb(ha, ha->ms_iocb, ha->ms_iocb_dma,
1400 	    sizeof(ms_iocb_entry_t));
1401 	if (rval != QLA_SUCCESS) {
1402 		/*EMPTY*/
1403 		DEBUG2_3(printk("scsi(%ld): RHBA issue IOCB failed (%d).\n",
1404 		    ha->host_no, rval));
1405 	} else if (qla2x00_chk_ms_status(ha, ms_pkt, ct_rsp, "RHBA") !=
1406 	    QLA_SUCCESS) {
1407 		rval = QLA_FUNCTION_FAILED;
1408 		if (ct_rsp->header.reason_code == CT_REASON_CANNOT_PERFORM &&
1409 		    ct_rsp->header.explanation_code ==
1410 		    CT_EXPL_ALREADY_REGISTERED) {
1411 			DEBUG2_13(printk("%s(%ld): HBA already registered.\n",
1412 			    __func__, ha->host_no));
1413 			rval = QLA_ALREADY_REGISTERED;
1414 		}
1415 	} else {
1416 		DEBUG2(printk("scsi(%ld): RHBA exiting normally.\n",
1417 		    ha->host_no));
1418 	}
1419 
1420 	return rval;
1421 }
1422 
1423 /**
1424  * qla2x00_fdmi_dhba() -
1425  * @ha: HA context
1426  *
1427  * Returns 0 on success.
1428  */
1429 static int
1430 qla2x00_fdmi_dhba(scsi_qla_host_t *ha)
1431 {
1432 	int rval;
1433 
1434 	ms_iocb_entry_t *ms_pkt;
1435 	struct ct_sns_req *ct_req;
1436 	struct ct_sns_rsp *ct_rsp;
1437 
1438 	/* Issue RPA */
1439 	/* Prepare common MS IOCB */
1440 	ms_pkt = ha->isp_ops.prep_ms_fdmi_iocb(ha, DHBA_REQ_SIZE,
1441 	    DHBA_RSP_SIZE);
1442 
1443 	/* Prepare CT request */
1444 	ct_req = qla2x00_prep_ct_fdmi_req(&ha->ct_sns->p.req, DHBA_CMD,
1445 	    DHBA_RSP_SIZE);
1446 	ct_rsp = &ha->ct_sns->p.rsp;
1447 
1448 	/* Prepare FDMI command arguments -- portname. */
1449 	memcpy(ct_req->req.dhba.port_name, ha->port_name, WWN_SIZE);
1450 
1451 	DEBUG13(printk("%s(%ld): DHBA portname="
1452 	    "%02x%02x%02x%02x%02x%02x%02x%02x.\n", __func__, ha->host_no,
1453 	    ct_req->req.dhba.port_name[0], ct_req->req.dhba.port_name[1],
1454 	    ct_req->req.dhba.port_name[2], ct_req->req.dhba.port_name[3],
1455 	    ct_req->req.dhba.port_name[4], ct_req->req.dhba.port_name[5],
1456 	    ct_req->req.dhba.port_name[6], ct_req->req.dhba.port_name[7]));
1457 
1458 	/* Execute MS IOCB */
1459 	rval = qla2x00_issue_iocb(ha, ha->ms_iocb, ha->ms_iocb_dma,
1460 	    sizeof(ms_iocb_entry_t));
1461 	if (rval != QLA_SUCCESS) {
1462 		/*EMPTY*/
1463 		DEBUG2_3(printk("scsi(%ld): DHBA issue IOCB failed (%d).\n",
1464 		    ha->host_no, rval));
1465 	} else if (qla2x00_chk_ms_status(ha, ms_pkt, ct_rsp, "DHBA") !=
1466 	    QLA_SUCCESS) {
1467 		rval = QLA_FUNCTION_FAILED;
1468 	} else {
1469 		DEBUG2(printk("scsi(%ld): DHBA exiting normally.\n",
1470 		    ha->host_no));
1471 	}
1472 
1473 	return rval;
1474 }
1475 
1476 /**
1477  * qla2x00_fdmi_rpa() -
1478  * @ha: HA context
1479  *
1480  * Returns 0 on success.
1481  */
1482 static int
1483 qla2x00_fdmi_rpa(scsi_qla_host_t *ha)
1484 {
1485 	int rval, alen;
1486 	uint32_t size, max_frame_size;
1487 
1488 	ms_iocb_entry_t *ms_pkt;
1489 	struct ct_sns_req *ct_req;
1490 	struct ct_sns_rsp *ct_rsp;
1491 	uint8_t *entries;
1492 	struct ct_fdmi_port_attr *eiter;
1493 	struct init_cb_24xx *icb24 = (struct init_cb_24xx *)ha->init_cb;
1494 
1495 	/* Issue RPA */
1496 	/* Prepare common MS IOCB */
1497 	/*   Request size adjusted after CT preparation */
1498 	ms_pkt = ha->isp_ops.prep_ms_fdmi_iocb(ha, 0, RPA_RSP_SIZE);
1499 
1500 	/* Prepare CT request */
1501 	ct_req = qla2x00_prep_ct_fdmi_req(&ha->ct_sns->p.req, RPA_CMD,
1502 	    RPA_RSP_SIZE);
1503 	ct_rsp = &ha->ct_sns->p.rsp;
1504 
1505 	/* Prepare FDMI command arguments -- attribute block, attributes. */
1506 	memcpy(ct_req->req.rpa.port_name, ha->port_name, WWN_SIZE);
1507 	size = WWN_SIZE + 4;
1508 
1509 	/* Attributes */
1510 	ct_req->req.rpa.attrs.count =
1511 	    __constant_cpu_to_be32(FDMI_PORT_ATTR_COUNT);
1512 	entries = ct_req->req.rpa.port_name;
1513 
1514 	/* FC4 types. */
1515 	eiter = (struct ct_fdmi_port_attr *) (entries + size);
1516 	eiter->type = __constant_cpu_to_be16(FDMI_PORT_FC4_TYPES);
1517 	eiter->len = __constant_cpu_to_be16(4 + 32);
1518 	eiter->a.fc4_types[2] = 0x01;
1519 	size += 4 + 32;
1520 
1521 	DEBUG13(printk("%s(%ld): FC4_TYPES=%02x %02x.\n", __func__, ha->host_no,
1522 	    eiter->a.fc4_types[2], eiter->a.fc4_types[1]));
1523 
1524 	/* Supported speed. */
1525 	eiter = (struct ct_fdmi_port_attr *) (entries + size);
1526 	eiter->type = __constant_cpu_to_be16(FDMI_PORT_SUPPORT_SPEED);
1527 	eiter->len = __constant_cpu_to_be16(4 + 4);
1528 	if (IS_QLA24XX(ha) || IS_QLA54XX(ha))
1529 		eiter->a.sup_speed = __constant_cpu_to_be32(4);
1530 	else if (IS_QLA23XX(ha))
1531 		eiter->a.sup_speed = __constant_cpu_to_be32(2);
1532 	else
1533 		eiter->a.sup_speed = __constant_cpu_to_be32(1);
1534 	size += 4 + 4;
1535 
1536 	DEBUG13(printk("%s(%ld): SUPPORTED_SPEED=%x.\n", __func__, ha->host_no,
1537 	    eiter->a.sup_speed));
1538 
1539 	/* Current speed. */
1540 	eiter = (struct ct_fdmi_port_attr *) (entries + size);
1541 	eiter->type = __constant_cpu_to_be16(FDMI_PORT_CURRENT_SPEED);
1542 	eiter->len = __constant_cpu_to_be16(4 + 4);
1543 	switch (ha->link_data_rate) {
1544 	case 0:
1545 		eiter->a.cur_speed = __constant_cpu_to_be32(1);
1546 		break;
1547 	case 1:
1548 		eiter->a.cur_speed = __constant_cpu_to_be32(2);
1549 		break;
1550 	case 3:
1551 		eiter->a.cur_speed = __constant_cpu_to_be32(4);
1552 		break;
1553 	}
1554 	size += 4 + 4;
1555 
1556 	DEBUG13(printk("%s(%ld): CURRENT_SPEED=%x.\n", __func__, ha->host_no,
1557 	    eiter->a.cur_speed));
1558 
1559 	/* Max frame size. */
1560 	eiter = (struct ct_fdmi_port_attr *) (entries + size);
1561 	eiter->type = __constant_cpu_to_be16(FDMI_PORT_MAX_FRAME_SIZE);
1562 	eiter->len = __constant_cpu_to_be16(4 + 4);
1563 	max_frame_size = IS_QLA24XX(ha) || IS_QLA54XX(ha) ?
1564 		(uint32_t) icb24->frame_payload_size:
1565 		(uint32_t) ha->init_cb->frame_payload_size;
1566 	eiter->a.max_frame_size = cpu_to_be32(max_frame_size);
1567 	size += 4 + 4;
1568 
1569 	DEBUG13(printk("%s(%ld): MAX_FRAME_SIZE=%x.\n", __func__, ha->host_no,
1570 	    eiter->a.max_frame_size));
1571 
1572 	/* OS device name. */
1573 	eiter = (struct ct_fdmi_port_attr *) (entries + size);
1574 	eiter->type = __constant_cpu_to_be16(FDMI_PORT_OS_DEVICE_NAME);
1575 	sprintf(eiter->a.os_dev_name, "/proc/scsi/qla2xxx/%ld", ha->host_no);
1576 	alen = strlen(eiter->a.os_dev_name);
1577 	alen += (alen & 3) ? (4 - (alen & 3)) : 4;
1578 	eiter->len = cpu_to_be16(4 + alen);
1579 	size += 4 + alen;
1580 
1581 	DEBUG13(printk("%s(%ld): OS_DEVICE_NAME=%s.\n", __func__, ha->host_no,
1582 	    eiter->a.os_dev_name));
1583 
1584 	/* Hostname. */
1585 	if (strlen(fc_host_system_hostname(ha->host))) {
1586 		eiter = (struct ct_fdmi_port_attr *) (entries + size);
1587 		eiter->type = __constant_cpu_to_be16(FDMI_PORT_HOST_NAME);
1588 		snprintf(eiter->a.host_name, sizeof(eiter->a.host_name),
1589 		    "%s", fc_host_system_hostname(ha->host));
1590 		alen = strlen(eiter->a.host_name);
1591 		alen += (alen & 3) ? (4 - (alen & 3)) : 4;
1592 		eiter->len = cpu_to_be16(4 + alen);
1593 		size += 4 + alen;
1594 
1595 		DEBUG13(printk("%s(%ld): HOSTNAME=%s.\n", __func__,
1596 		    ha->host_no, eiter->a.host_name));
1597 	}
1598 
1599 	/* Update MS request size. */
1600 	qla2x00_update_ms_fdmi_iocb(ha, size + 16);
1601 
1602 	DEBUG13(printk("%s(%ld): RPA portname="
1603 	    "%02x%02x%02x%02x%02x%02x%02x%02x size=%d.\n", __func__,
1604 	    ha->host_no, ct_req->req.rpa.port_name[0],
1605 	    ct_req->req.rpa.port_name[1], ct_req->req.rpa.port_name[2],
1606 	    ct_req->req.rpa.port_name[3], ct_req->req.rpa.port_name[4],
1607 	    ct_req->req.rpa.port_name[5], ct_req->req.rpa.port_name[6],
1608 	    ct_req->req.rpa.port_name[7], size));
1609 	DEBUG13(qla2x00_dump_buffer(entries, size));
1610 
1611 	/* Execute MS IOCB */
1612 	rval = qla2x00_issue_iocb(ha, ha->ms_iocb, ha->ms_iocb_dma,
1613 	    sizeof(ms_iocb_entry_t));
1614 	if (rval != QLA_SUCCESS) {
1615 		/*EMPTY*/
1616 		DEBUG2_3(printk("scsi(%ld): RPA issue IOCB failed (%d).\n",
1617 		    ha->host_no, rval));
1618 	} else if (qla2x00_chk_ms_status(ha, ms_pkt, ct_rsp, "RPA") !=
1619 	    QLA_SUCCESS) {
1620 		rval = QLA_FUNCTION_FAILED;
1621 	} else {
1622 		DEBUG2(printk("scsi(%ld): RPA exiting normally.\n",
1623 		    ha->host_no));
1624 	}
1625 
1626 	return rval;
1627 }
1628 
1629 /**
1630  * qla2x00_fdmi_register() -
1631  * @ha: HA context
1632  *
1633  * Returns 0 on success.
1634  */
1635 int
1636 qla2x00_fdmi_register(scsi_qla_host_t *ha)
1637 {
1638 	int rval;
1639 
1640 	rval = qla2x00_mgmt_svr_login(ha);
1641 	if (rval)
1642 		return rval;
1643 
1644 	rval = qla2x00_fdmi_rhba(ha);
1645 	if (rval) {
1646 		if (rval != QLA_ALREADY_REGISTERED)
1647 			return rval;
1648 
1649 		rval = qla2x00_fdmi_dhba(ha);
1650 		if (rval)
1651 			return rval;
1652 
1653 		rval = qla2x00_fdmi_rhba(ha);
1654 		if (rval)
1655 			return rval;
1656 	}
1657 	rval = qla2x00_fdmi_rpa(ha);
1658 
1659 	return rval;
1660 }
1661 
1662 /**
1663  * qla2x00_gfpn_id() - SNS Get Fabric Port Name (GFPN_ID) query.
1664  * @ha: HA context
1665  * @list: switch info entries to populate
1666  *
1667  * Returns 0 on success.
1668  */
1669 int
1670 qla2x00_gfpn_id(scsi_qla_host_t *ha, sw_info_t *list)
1671 {
1672 	int		rval;
1673 	uint16_t	i;
1674 
1675 	ms_iocb_entry_t	*ms_pkt;
1676 	struct ct_sns_req	*ct_req;
1677 	struct ct_sns_rsp	*ct_rsp;
1678 
1679 	if (!IS_QLA24XX(ha) && !IS_QLA54XX(ha))
1680 		return QLA_FUNCTION_FAILED;
1681 
1682 	for (i = 0; i < MAX_FIBRE_DEVICES; i++) {
1683 		/* Issue GFPN_ID */
1684 		memset(list[i].fabric_port_name, 0, WWN_SIZE);
1685 
1686 		/* Prepare common MS IOCB */
1687 		ms_pkt = ha->isp_ops.prep_ms_iocb(ha, GFPN_ID_REQ_SIZE,
1688 		    GFPN_ID_RSP_SIZE);
1689 
1690 		/* Prepare CT request */
1691 		ct_req = qla2x00_prep_ct_req(&ha->ct_sns->p.req, GFPN_ID_CMD,
1692 		    GFPN_ID_RSP_SIZE);
1693 		ct_rsp = &ha->ct_sns->p.rsp;
1694 
1695 		/* Prepare CT arguments -- port_id */
1696 		ct_req->req.port_id.port_id[0] = list[i].d_id.b.domain;
1697 		ct_req->req.port_id.port_id[1] = list[i].d_id.b.area;
1698 		ct_req->req.port_id.port_id[2] = list[i].d_id.b.al_pa;
1699 
1700 		/* Execute MS IOCB */
1701 		rval = qla2x00_issue_iocb(ha, ha->ms_iocb, ha->ms_iocb_dma,
1702 		    sizeof(ms_iocb_entry_t));
1703 		if (rval != QLA_SUCCESS) {
1704 			/*EMPTY*/
1705 			DEBUG2_3(printk("scsi(%ld): GFPN_ID issue IOCB "
1706 			    "failed (%d).\n", ha->host_no, rval));
1707 		} else if (qla2x00_chk_ms_status(ha, ms_pkt, ct_rsp,
1708 		    "GFPN_ID") != QLA_SUCCESS) {
1709 			rval = QLA_FUNCTION_FAILED;
1710 		} else {
1711 			/* Save fabric portname */
1712 			memcpy(list[i].fabric_port_name,
1713 			    ct_rsp->rsp.gfpn_id.port_name, WWN_SIZE);
1714 		}
1715 
1716 		/* Last device exit. */
1717 		if (list[i].d_id.b.rsvd_1 != 0)
1718 			break;
1719 	}
1720 
1721 	return (rval);
1722 }
1723 
1724 static inline void *
1725 qla24xx_prep_ms_fm_iocb(scsi_qla_host_t *ha, uint32_t req_size,
1726     uint32_t rsp_size)
1727 {
1728 	struct ct_entry_24xx *ct_pkt;
1729 
1730 	ct_pkt = (struct ct_entry_24xx *)ha->ms_iocb;
1731 	memset(ct_pkt, 0, sizeof(struct ct_entry_24xx));
1732 
1733 	ct_pkt->entry_type = CT_IOCB_TYPE;
1734 	ct_pkt->entry_count = 1;
1735 	ct_pkt->nport_handle = cpu_to_le16(ha->mgmt_svr_loop_id);
1736 	ct_pkt->timeout = __constant_cpu_to_le16(59);
1737 	ct_pkt->cmd_dsd_count = __constant_cpu_to_le16(1);
1738 	ct_pkt->rsp_dsd_count = __constant_cpu_to_le16(1);
1739 	ct_pkt->rsp_byte_count = cpu_to_le32(rsp_size);
1740 	ct_pkt->cmd_byte_count = cpu_to_le32(req_size);
1741 
1742 	ct_pkt->dseg_0_address[0] = cpu_to_le32(LSD(ha->ct_sns_dma));
1743 	ct_pkt->dseg_0_address[1] = cpu_to_le32(MSD(ha->ct_sns_dma));
1744 	ct_pkt->dseg_0_len = ct_pkt->cmd_byte_count;
1745 
1746 	ct_pkt->dseg_1_address[0] = cpu_to_le32(LSD(ha->ct_sns_dma));
1747 	ct_pkt->dseg_1_address[1] = cpu_to_le32(MSD(ha->ct_sns_dma));
1748 	ct_pkt->dseg_1_len = ct_pkt->rsp_byte_count;
1749 
1750 	return ct_pkt;
1751 }
1752 
1753 
1754 static inline struct ct_sns_req *
1755 qla24xx_prep_ct_fm_req(struct ct_sns_req *ct_req, uint16_t cmd,
1756     uint16_t rsp_size)
1757 {
1758 	memset(ct_req, 0, sizeof(struct ct_sns_pkt));
1759 
1760 	ct_req->header.revision = 0x01;
1761 	ct_req->header.gs_type = 0xFA;
1762 	ct_req->header.gs_subtype = 0x01;
1763 	ct_req->command = cpu_to_be16(cmd);
1764 	ct_req->max_rsp_size = cpu_to_be16((rsp_size - 16) / 4);
1765 
1766 	return ct_req;
1767 }
1768 
1769 /**
1770  * qla2x00_gpsc() - FCS Get Port Speed Capabilities (GPSC) query.
1771  * @ha: HA context
1772  * @list: switch info entries to populate
1773  *
1774  * Returns 0 on success.
1775  */
1776 int
1777 qla2x00_gpsc(scsi_qla_host_t *ha, sw_info_t *list)
1778 {
1779 	int		rval;
1780 	uint16_t	i;
1781 
1782 	ms_iocb_entry_t	*ms_pkt;
1783 	struct ct_sns_req	*ct_req;
1784 	struct ct_sns_rsp	*ct_rsp;
1785 
1786 	if (!IS_QLA24XX(ha) && !IS_QLA54XX(ha))
1787 		return QLA_FUNCTION_FAILED;
1788 	if (!ha->flags.gpsc_supported)
1789 		return QLA_FUNCTION_FAILED;
1790 
1791 	rval = qla2x00_mgmt_svr_login(ha);
1792 	if (rval)
1793 		return rval;
1794 
1795 	for (i = 0; i < MAX_FIBRE_DEVICES; i++) {
1796 		/* Issue GFPN_ID */
1797 		list[i].fp_speeds = list[i].fp_speed = 0;
1798 
1799 		/* Prepare common MS IOCB */
1800 		ms_pkt = qla24xx_prep_ms_fm_iocb(ha, GPSC_REQ_SIZE,
1801 		    GPSC_RSP_SIZE);
1802 
1803 		/* Prepare CT request */
1804 		ct_req = qla24xx_prep_ct_fm_req(&ha->ct_sns->p.req,
1805 		    GPSC_CMD, GPSC_RSP_SIZE);
1806 		ct_rsp = &ha->ct_sns->p.rsp;
1807 
1808 		/* Prepare CT arguments -- port_name */
1809 		memcpy(ct_req->req.gpsc.port_name, list[i].fabric_port_name,
1810 		    WWN_SIZE);
1811 
1812 		/* Execute MS IOCB */
1813 		rval = qla2x00_issue_iocb(ha, ha->ms_iocb, ha->ms_iocb_dma,
1814 		    sizeof(ms_iocb_entry_t));
1815 		if (rval != QLA_SUCCESS) {
1816 			/*EMPTY*/
1817 			DEBUG2_3(printk("scsi(%ld): GPSC issue IOCB "
1818 			    "failed (%d).\n", ha->host_no, rval));
1819 		} else if ((rval = qla2x00_chk_ms_status(ha, ms_pkt, ct_rsp,
1820 		    "GPSC")) != QLA_SUCCESS) {
1821 			/* FM command unsupported? */
1822 			if (rval == QLA_INVALID_COMMAND &&
1823 			    ct_rsp->header.reason_code ==
1824 			    CT_REASON_INVALID_COMMAND_CODE) {
1825 				DEBUG2(printk("scsi(%ld): GPSC command "
1826 				    "unsupported, disabling query...\n",
1827 				    ha->host_no));
1828 				ha->flags.gpsc_supported = 0;
1829 				rval = QLA_FUNCTION_FAILED;
1830 				break;
1831 			}
1832 			rval = QLA_FUNCTION_FAILED;
1833 		} else {
1834 			/* Save portname */
1835 			list[i].fp_speeds = ct_rsp->rsp.gpsc.speeds;
1836 			list[i].fp_speed = ct_rsp->rsp.gpsc.speed;
1837 
1838 			DEBUG2_3(printk("scsi(%ld): GPSC ext entry - "
1839 			    "fpn %02x%02x%02x%02x%02x%02x%02x%02x speeds=%04x "
1840 			    "speed=%04x.\n", ha->host_no,
1841 			    list[i].fabric_port_name[0],
1842 			    list[i].fabric_port_name[1],
1843 			    list[i].fabric_port_name[2],
1844 			    list[i].fabric_port_name[3],
1845 			    list[i].fabric_port_name[4],
1846 			    list[i].fabric_port_name[5],
1847 			    list[i].fabric_port_name[6],
1848 			    list[i].fabric_port_name[7],
1849 			    be16_to_cpu(list[i].fp_speeds),
1850 			    be16_to_cpu(list[i].fp_speed)));
1851 		}
1852 
1853 		/* Last device exit. */
1854 		if (list[i].d_id.b.rsvd_1 != 0)
1855 			break;
1856 	}
1857 
1858 	return (rval);
1859 }
1860