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