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