1 /*
2 * Copyright (c) 2005-2010 Brocade Communications Systems, Inc.
3 * All rights reserved
4 * www.brocade.com
5 *
6 * Linux driver for Brocade Fibre Channel Host Bus Adapter.
7 *
8 * This program is free software; you can redistribute it and/or modify it
9 * under the terms of the GNU General Public License (GPL) Version 2 as
10 * published by the Free Software Foundation
11 *
12 * This program is distributed in the hope that it will be useful, but
13 * WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 * General Public License for more details.
16 */
17 /*
18 * fcbuild.c - FC link service frame building and parsing routines
19 */
20
21 #include "bfad_drv.h"
22 #include "bfa_fcbuild.h"
23
24 /*
25 * static build functions
26 */
27 static void fc_els_rsp_build(struct fchs_s *fchs, u32 d_id, u32 s_id,
28 __be16 ox_id);
29 static void fc_bls_rsp_build(struct fchs_s *fchs, u32 d_id, u32 s_id,
30 __be16 ox_id);
31 static struct fchs_s fc_els_req_tmpl;
32 static struct fchs_s fc_els_rsp_tmpl;
33 static struct fchs_s fc_bls_req_tmpl;
34 static struct fchs_s fc_bls_rsp_tmpl;
35 static struct fc_ba_acc_s ba_acc_tmpl;
36 static struct fc_logi_s plogi_tmpl;
37 static struct fc_prli_s prli_tmpl;
38 static struct fc_rrq_s rrq_tmpl;
39 static struct fchs_s fcp_fchs_tmpl;
40
41 void
fcbuild_init(void)42 fcbuild_init(void)
43 {
44 /*
45 * fc_els_req_tmpl
46 */
47 fc_els_req_tmpl.routing = FC_RTG_EXT_LINK;
48 fc_els_req_tmpl.cat_info = FC_CAT_LD_REQUEST;
49 fc_els_req_tmpl.type = FC_TYPE_ELS;
50 fc_els_req_tmpl.f_ctl =
51 bfa_hton3b(FCTL_SEQ_INI | FCTL_FS_EXCH | FCTL_END_SEQ |
52 FCTL_SI_XFER);
53 fc_els_req_tmpl.rx_id = FC_RXID_ANY;
54
55 /*
56 * fc_els_rsp_tmpl
57 */
58 fc_els_rsp_tmpl.routing = FC_RTG_EXT_LINK;
59 fc_els_rsp_tmpl.cat_info = FC_CAT_LD_REPLY;
60 fc_els_rsp_tmpl.type = FC_TYPE_ELS;
61 fc_els_rsp_tmpl.f_ctl =
62 bfa_hton3b(FCTL_EC_RESP | FCTL_SEQ_INI | FCTL_LS_EXCH |
63 FCTL_END_SEQ | FCTL_SI_XFER);
64 fc_els_rsp_tmpl.rx_id = FC_RXID_ANY;
65
66 /*
67 * fc_bls_req_tmpl
68 */
69 fc_bls_req_tmpl.routing = FC_RTG_BASIC_LINK;
70 fc_bls_req_tmpl.type = FC_TYPE_BLS;
71 fc_bls_req_tmpl.f_ctl = bfa_hton3b(FCTL_END_SEQ | FCTL_SI_XFER);
72 fc_bls_req_tmpl.rx_id = FC_RXID_ANY;
73
74 /*
75 * fc_bls_rsp_tmpl
76 */
77 fc_bls_rsp_tmpl.routing = FC_RTG_BASIC_LINK;
78 fc_bls_rsp_tmpl.cat_info = FC_CAT_BA_ACC;
79 fc_bls_rsp_tmpl.type = FC_TYPE_BLS;
80 fc_bls_rsp_tmpl.f_ctl =
81 bfa_hton3b(FCTL_EC_RESP | FCTL_SEQ_INI | FCTL_LS_EXCH |
82 FCTL_END_SEQ | FCTL_SI_XFER);
83 fc_bls_rsp_tmpl.rx_id = FC_RXID_ANY;
84
85 /*
86 * ba_acc_tmpl
87 */
88 ba_acc_tmpl.seq_id_valid = 0;
89 ba_acc_tmpl.low_seq_cnt = 0;
90 ba_acc_tmpl.high_seq_cnt = 0xFFFF;
91
92 /*
93 * plogi_tmpl
94 */
95 plogi_tmpl.csp.verhi = FC_PH_VER_PH_3;
96 plogi_tmpl.csp.verlo = FC_PH_VER_4_3;
97 plogi_tmpl.csp.bbcred = cpu_to_be16(0x0004);
98 plogi_tmpl.csp.ciro = 0x1;
99 plogi_tmpl.csp.cisc = 0x0;
100 plogi_tmpl.csp.altbbcred = 0x0;
101 plogi_tmpl.csp.conseq = cpu_to_be16(0x00FF);
102 plogi_tmpl.csp.ro_bitmap = cpu_to_be16(0x0002);
103 plogi_tmpl.csp.e_d_tov = cpu_to_be32(2000);
104
105 plogi_tmpl.class3.class_valid = 1;
106 plogi_tmpl.class3.sequential = 1;
107 plogi_tmpl.class3.conseq = 0xFF;
108 plogi_tmpl.class3.ospx = 1;
109
110 /*
111 * prli_tmpl
112 */
113 prli_tmpl.command = FC_ELS_PRLI;
114 prli_tmpl.pglen = 0x10;
115 prli_tmpl.pagebytes = cpu_to_be16(0x0014);
116 prli_tmpl.parampage.type = FC_TYPE_FCP;
117 prli_tmpl.parampage.imagepair = 1;
118 prli_tmpl.parampage.servparams.rxrdisab = 1;
119
120 /*
121 * rrq_tmpl
122 */
123 rrq_tmpl.els_cmd.els_code = FC_ELS_RRQ;
124
125 /*
126 * fcp_struct fchs_s mpl
127 */
128 fcp_fchs_tmpl.routing = FC_RTG_FC4_DEV_DATA;
129 fcp_fchs_tmpl.cat_info = FC_CAT_UNSOLICIT_CMD;
130 fcp_fchs_tmpl.type = FC_TYPE_FCP;
131 fcp_fchs_tmpl.f_ctl =
132 bfa_hton3b(FCTL_FS_EXCH | FCTL_END_SEQ | FCTL_SI_XFER);
133 fcp_fchs_tmpl.seq_id = 1;
134 fcp_fchs_tmpl.rx_id = FC_RXID_ANY;
135 }
136
137 static void
fc_gs_fchdr_build(struct fchs_s * fchs,u32 d_id,u32 s_id,u32 ox_id)138 fc_gs_fchdr_build(struct fchs_s *fchs, u32 d_id, u32 s_id, u32 ox_id)
139 {
140 memset(fchs, 0, sizeof(struct fchs_s));
141
142 fchs->routing = FC_RTG_FC4_DEV_DATA;
143 fchs->cat_info = FC_CAT_UNSOLICIT_CTRL;
144 fchs->type = FC_TYPE_SERVICES;
145 fchs->f_ctl =
146 bfa_hton3b(FCTL_SEQ_INI | FCTL_FS_EXCH | FCTL_END_SEQ |
147 FCTL_SI_XFER);
148 fchs->rx_id = FC_RXID_ANY;
149 fchs->d_id = (d_id);
150 fchs->s_id = (s_id);
151 fchs->ox_id = cpu_to_be16(ox_id);
152
153 /*
154 * @todo no need to set ox_id for request
155 * no need to set rx_id for response
156 */
157 }
158
159 void
fc_els_req_build(struct fchs_s * fchs,u32 d_id,u32 s_id,__be16 ox_id)160 fc_els_req_build(struct fchs_s *fchs, u32 d_id, u32 s_id, __be16 ox_id)
161 {
162 memcpy(fchs, &fc_els_req_tmpl, sizeof(struct fchs_s));
163 fchs->d_id = (d_id);
164 fchs->s_id = (s_id);
165 fchs->ox_id = cpu_to_be16(ox_id);
166 }
167
168 static void
fc_els_rsp_build(struct fchs_s * fchs,u32 d_id,u32 s_id,__be16 ox_id)169 fc_els_rsp_build(struct fchs_s *fchs, u32 d_id, u32 s_id, __be16 ox_id)
170 {
171 memcpy(fchs, &fc_els_rsp_tmpl, sizeof(struct fchs_s));
172 fchs->d_id = d_id;
173 fchs->s_id = s_id;
174 fchs->ox_id = ox_id;
175 }
176
177 enum fc_parse_status
fc_els_rsp_parse(struct fchs_s * fchs,int len)178 fc_els_rsp_parse(struct fchs_s *fchs, int len)
179 {
180 struct fc_els_cmd_s *els_cmd = (struct fc_els_cmd_s *) (fchs + 1);
181 struct fc_ls_rjt_s *ls_rjt = (struct fc_ls_rjt_s *) els_cmd;
182
183 len = len;
184
185 switch (els_cmd->els_code) {
186 case FC_ELS_LS_RJT:
187 if (ls_rjt->reason_code == FC_LS_RJT_RSN_LOGICAL_BUSY)
188 return FC_PARSE_BUSY;
189 else
190 return FC_PARSE_FAILURE;
191
192 case FC_ELS_ACC:
193 return FC_PARSE_OK;
194 }
195 return FC_PARSE_OK;
196 }
197
198 static void
fc_bls_rsp_build(struct fchs_s * fchs,u32 d_id,u32 s_id,__be16 ox_id)199 fc_bls_rsp_build(struct fchs_s *fchs, u32 d_id, u32 s_id, __be16 ox_id)
200 {
201 memcpy(fchs, &fc_bls_rsp_tmpl, sizeof(struct fchs_s));
202 fchs->d_id = d_id;
203 fchs->s_id = s_id;
204 fchs->ox_id = ox_id;
205 }
206
207 static u16
fc_plogi_x_build(struct fchs_s * fchs,void * pld,u32 d_id,u32 s_id,__be16 ox_id,wwn_t port_name,wwn_t node_name,u16 pdu_size,u8 els_code)208 fc_plogi_x_build(struct fchs_s *fchs, void *pld, u32 d_id, u32 s_id,
209 __be16 ox_id, wwn_t port_name, wwn_t node_name,
210 u16 pdu_size, u8 els_code)
211 {
212 struct fc_logi_s *plogi = (struct fc_logi_s *) (pld);
213
214 memcpy(plogi, &plogi_tmpl, sizeof(struct fc_logi_s));
215
216 plogi->els_cmd.els_code = els_code;
217 if (els_code == FC_ELS_PLOGI)
218 fc_els_req_build(fchs, d_id, s_id, ox_id);
219 else
220 fc_els_rsp_build(fchs, d_id, s_id, ox_id);
221
222 plogi->csp.rxsz = plogi->class3.rxsz = cpu_to_be16(pdu_size);
223
224 memcpy(&plogi->port_name, &port_name, sizeof(wwn_t));
225 memcpy(&plogi->node_name, &node_name, sizeof(wwn_t));
226
227 return sizeof(struct fc_logi_s);
228 }
229
230 u16
fc_flogi_build(struct fchs_s * fchs,struct fc_logi_s * flogi,u32 s_id,u16 ox_id,wwn_t port_name,wwn_t node_name,u16 pdu_size,u8 set_npiv,u8 set_auth,u16 local_bb_credits)231 fc_flogi_build(struct fchs_s *fchs, struct fc_logi_s *flogi, u32 s_id,
232 u16 ox_id, wwn_t port_name, wwn_t node_name, u16 pdu_size,
233 u8 set_npiv, u8 set_auth, u16 local_bb_credits)
234 {
235 u32 d_id = bfa_hton3b(FC_FABRIC_PORT);
236 __be32 *vvl_info;
237
238 memcpy(flogi, &plogi_tmpl, sizeof(struct fc_logi_s));
239
240 flogi->els_cmd.els_code = FC_ELS_FLOGI;
241 fc_els_req_build(fchs, d_id, s_id, ox_id);
242
243 flogi->csp.rxsz = flogi->class3.rxsz = cpu_to_be16(pdu_size);
244 flogi->port_name = port_name;
245 flogi->node_name = node_name;
246
247 /*
248 * Set the NPIV Capability Bit ( word 1, bit 31) of Common
249 * Service Parameters.
250 */
251 flogi->csp.ciro = set_npiv;
252
253 /* set AUTH capability */
254 flogi->csp.security = set_auth;
255
256 flogi->csp.bbcred = cpu_to_be16(local_bb_credits);
257
258 /* Set brcd token in VVL */
259 vvl_info = (u32 *)&flogi->vvl[0];
260
261 /* set the flag to indicate the presence of VVL */
262 flogi->csp.npiv_supp = 1; /* @todo. field name is not correct */
263 vvl_info[0] = cpu_to_be32(FLOGI_VVL_BRCD);
264
265 return sizeof(struct fc_logi_s);
266 }
267
268 u16
fc_flogi_acc_build(struct fchs_s * fchs,struct fc_logi_s * flogi,u32 s_id,__be16 ox_id,wwn_t port_name,wwn_t node_name,u16 pdu_size,u16 local_bb_credits)269 fc_flogi_acc_build(struct fchs_s *fchs, struct fc_logi_s *flogi, u32 s_id,
270 __be16 ox_id, wwn_t port_name, wwn_t node_name,
271 u16 pdu_size, u16 local_bb_credits)
272 {
273 u32 d_id = 0;
274
275 memcpy(flogi, &plogi_tmpl, sizeof(struct fc_logi_s));
276 fc_els_rsp_build(fchs, d_id, s_id, ox_id);
277
278 flogi->els_cmd.els_code = FC_ELS_ACC;
279 flogi->csp.rxsz = flogi->class3.rxsz = cpu_to_be16(pdu_size);
280 flogi->port_name = port_name;
281 flogi->node_name = node_name;
282
283 flogi->csp.bbcred = cpu_to_be16(local_bb_credits);
284
285 return sizeof(struct fc_logi_s);
286 }
287
288 u16
fc_fdisc_build(struct fchs_s * fchs,struct fc_logi_s * flogi,u32 s_id,u16 ox_id,wwn_t port_name,wwn_t node_name,u16 pdu_size)289 fc_fdisc_build(struct fchs_s *fchs, struct fc_logi_s *flogi, u32 s_id,
290 u16 ox_id, wwn_t port_name, wwn_t node_name, u16 pdu_size)
291 {
292 u32 d_id = bfa_hton3b(FC_FABRIC_PORT);
293
294 memcpy(flogi, &plogi_tmpl, sizeof(struct fc_logi_s));
295
296 flogi->els_cmd.els_code = FC_ELS_FDISC;
297 fc_els_req_build(fchs, d_id, s_id, ox_id);
298
299 flogi->csp.rxsz = flogi->class3.rxsz = cpu_to_be16(pdu_size);
300 flogi->port_name = port_name;
301 flogi->node_name = node_name;
302
303 return sizeof(struct fc_logi_s);
304 }
305
306 u16
fc_plogi_build(struct fchs_s * fchs,void * pld,u32 d_id,u32 s_id,u16 ox_id,wwn_t port_name,wwn_t node_name,u16 pdu_size)307 fc_plogi_build(struct fchs_s *fchs, void *pld, u32 d_id, u32 s_id,
308 u16 ox_id, wwn_t port_name, wwn_t node_name,
309 u16 pdu_size)
310 {
311 return fc_plogi_x_build(fchs, pld, d_id, s_id, ox_id, port_name,
312 node_name, pdu_size, FC_ELS_PLOGI);
313 }
314
315 u16
fc_plogi_acc_build(struct fchs_s * fchs,void * pld,u32 d_id,u32 s_id,u16 ox_id,wwn_t port_name,wwn_t node_name,u16 pdu_size)316 fc_plogi_acc_build(struct fchs_s *fchs, void *pld, u32 d_id, u32 s_id,
317 u16 ox_id, wwn_t port_name, wwn_t node_name,
318 u16 pdu_size)
319 {
320 return fc_plogi_x_build(fchs, pld, d_id, s_id, ox_id, port_name,
321 node_name, pdu_size, FC_ELS_ACC);
322 }
323
324 enum fc_parse_status
fc_plogi_rsp_parse(struct fchs_s * fchs,int len,wwn_t port_name)325 fc_plogi_rsp_parse(struct fchs_s *fchs, int len, wwn_t port_name)
326 {
327 struct fc_els_cmd_s *els_cmd = (struct fc_els_cmd_s *) (fchs + 1);
328 struct fc_logi_s *plogi;
329 struct fc_ls_rjt_s *ls_rjt;
330
331 switch (els_cmd->els_code) {
332 case FC_ELS_LS_RJT:
333 ls_rjt = (struct fc_ls_rjt_s *) (fchs + 1);
334 if (ls_rjt->reason_code == FC_LS_RJT_RSN_LOGICAL_BUSY)
335 return FC_PARSE_BUSY;
336 else
337 return FC_PARSE_FAILURE;
338 case FC_ELS_ACC:
339 plogi = (struct fc_logi_s *) (fchs + 1);
340 if (len < sizeof(struct fc_logi_s))
341 return FC_PARSE_FAILURE;
342
343 if (!wwn_is_equal(plogi->port_name, port_name))
344 return FC_PARSE_FAILURE;
345
346 if (!plogi->class3.class_valid)
347 return FC_PARSE_FAILURE;
348
349 if (be16_to_cpu(plogi->class3.rxsz) < (FC_MIN_PDUSZ))
350 return FC_PARSE_FAILURE;
351
352 return FC_PARSE_OK;
353 default:
354 return FC_PARSE_FAILURE;
355 }
356 }
357
358 enum fc_parse_status
fc_plogi_parse(struct fchs_s * fchs)359 fc_plogi_parse(struct fchs_s *fchs)
360 {
361 struct fc_logi_s *plogi = (struct fc_logi_s *) (fchs + 1);
362
363 if (plogi->class3.class_valid != 1)
364 return FC_PARSE_FAILURE;
365
366 if ((be16_to_cpu(plogi->class3.rxsz) < FC_MIN_PDUSZ)
367 || (be16_to_cpu(plogi->class3.rxsz) > FC_MAX_PDUSZ)
368 || (plogi->class3.rxsz == 0))
369 return FC_PARSE_FAILURE;
370
371 return FC_PARSE_OK;
372 }
373
374 u16
fc_prli_build(struct fchs_s * fchs,void * pld,u32 d_id,u32 s_id,u16 ox_id)375 fc_prli_build(struct fchs_s *fchs, void *pld, u32 d_id, u32 s_id,
376 u16 ox_id)
377 {
378 struct fc_prli_s *prli = (struct fc_prli_s *) (pld);
379
380 fc_els_req_build(fchs, d_id, s_id, ox_id);
381 memcpy(prli, &prli_tmpl, sizeof(struct fc_prli_s));
382
383 prli->command = FC_ELS_PRLI;
384 prli->parampage.servparams.initiator = 1;
385 prli->parampage.servparams.retry = 1;
386 prli->parampage.servparams.rec_support = 1;
387 prli->parampage.servparams.task_retry_id = 0;
388 prli->parampage.servparams.confirm = 1;
389
390 return sizeof(struct fc_prli_s);
391 }
392
393 u16
fc_prli_acc_build(struct fchs_s * fchs,void * pld,u32 d_id,u32 s_id,__be16 ox_id,enum bfa_lport_role role)394 fc_prli_acc_build(struct fchs_s *fchs, void *pld, u32 d_id, u32 s_id,
395 __be16 ox_id, enum bfa_lport_role role)
396 {
397 struct fc_prli_s *prli = (struct fc_prli_s *) (pld);
398
399 fc_els_rsp_build(fchs, d_id, s_id, ox_id);
400 memcpy(prli, &prli_tmpl, sizeof(struct fc_prli_s));
401
402 prli->command = FC_ELS_ACC;
403
404 prli->parampage.servparams.initiator = 1;
405
406 prli->parampage.rspcode = FC_PRLI_ACC_XQTD;
407
408 return sizeof(struct fc_prli_s);
409 }
410
411 enum fc_parse_status
fc_prli_rsp_parse(struct fc_prli_s * prli,int len)412 fc_prli_rsp_parse(struct fc_prli_s *prli, int len)
413 {
414 if (len < sizeof(struct fc_prli_s))
415 return FC_PARSE_FAILURE;
416
417 if (prli->command != FC_ELS_ACC)
418 return FC_PARSE_FAILURE;
419
420 if ((prli->parampage.rspcode != FC_PRLI_ACC_XQTD)
421 && (prli->parampage.rspcode != FC_PRLI_ACC_PREDEF_IMG))
422 return FC_PARSE_FAILURE;
423
424 if (prli->parampage.servparams.target != 1)
425 return FC_PARSE_FAILURE;
426
427 return FC_PARSE_OK;
428 }
429
430 enum fc_parse_status
fc_prli_parse(struct fc_prli_s * prli)431 fc_prli_parse(struct fc_prli_s *prli)
432 {
433 if (prli->parampage.type != FC_TYPE_FCP)
434 return FC_PARSE_FAILURE;
435
436 if (!prli->parampage.imagepair)
437 return FC_PARSE_FAILURE;
438
439 if (!prli->parampage.servparams.initiator)
440 return FC_PARSE_FAILURE;
441
442 return FC_PARSE_OK;
443 }
444
445 u16
fc_logo_build(struct fchs_s * fchs,struct fc_logo_s * logo,u32 d_id,u32 s_id,u16 ox_id,wwn_t port_name)446 fc_logo_build(struct fchs_s *fchs, struct fc_logo_s *logo, u32 d_id, u32 s_id,
447 u16 ox_id, wwn_t port_name)
448 {
449 fc_els_req_build(fchs, d_id, s_id, ox_id);
450
451 memset(logo, '\0', sizeof(struct fc_logo_s));
452 logo->els_cmd.els_code = FC_ELS_LOGO;
453 logo->nport_id = (s_id);
454 logo->orig_port_name = port_name;
455
456 return sizeof(struct fc_logo_s);
457 }
458
459 static u16
fc_adisc_x_build(struct fchs_s * fchs,struct fc_adisc_s * adisc,u32 d_id,u32 s_id,__be16 ox_id,wwn_t port_name,wwn_t node_name,u8 els_code)460 fc_adisc_x_build(struct fchs_s *fchs, struct fc_adisc_s *adisc, u32 d_id,
461 u32 s_id, __be16 ox_id, wwn_t port_name,
462 wwn_t node_name, u8 els_code)
463 {
464 memset(adisc, '\0', sizeof(struct fc_adisc_s));
465
466 adisc->els_cmd.els_code = els_code;
467
468 if (els_code == FC_ELS_ADISC)
469 fc_els_req_build(fchs, d_id, s_id, ox_id);
470 else
471 fc_els_rsp_build(fchs, d_id, s_id, ox_id);
472
473 adisc->orig_HA = 0;
474 adisc->orig_port_name = port_name;
475 adisc->orig_node_name = node_name;
476 adisc->nport_id = (s_id);
477
478 return sizeof(struct fc_adisc_s);
479 }
480
481 u16
fc_adisc_build(struct fchs_s * fchs,struct fc_adisc_s * adisc,u32 d_id,u32 s_id,__be16 ox_id,wwn_t port_name,wwn_t node_name)482 fc_adisc_build(struct fchs_s *fchs, struct fc_adisc_s *adisc, u32 d_id,
483 u32 s_id, __be16 ox_id, wwn_t port_name, wwn_t node_name)
484 {
485 return fc_adisc_x_build(fchs, adisc, d_id, s_id, ox_id, port_name,
486 node_name, FC_ELS_ADISC);
487 }
488
489 u16
fc_adisc_acc_build(struct fchs_s * fchs,struct fc_adisc_s * adisc,u32 d_id,u32 s_id,__be16 ox_id,wwn_t port_name,wwn_t node_name)490 fc_adisc_acc_build(struct fchs_s *fchs, struct fc_adisc_s *adisc, u32 d_id,
491 u32 s_id, __be16 ox_id, wwn_t port_name,
492 wwn_t node_name)
493 {
494 return fc_adisc_x_build(fchs, adisc, d_id, s_id, ox_id, port_name,
495 node_name, FC_ELS_ACC);
496 }
497
498 enum fc_parse_status
fc_adisc_rsp_parse(struct fc_adisc_s * adisc,int len,wwn_t port_name,wwn_t node_name)499 fc_adisc_rsp_parse(struct fc_adisc_s *adisc, int len, wwn_t port_name,
500 wwn_t node_name)
501 {
502
503 if (len < sizeof(struct fc_adisc_s))
504 return FC_PARSE_FAILURE;
505
506 if (adisc->els_cmd.els_code != FC_ELS_ACC)
507 return FC_PARSE_FAILURE;
508
509 if (!wwn_is_equal(adisc->orig_port_name, port_name))
510 return FC_PARSE_FAILURE;
511
512 return FC_PARSE_OK;
513 }
514
515 enum fc_parse_status
fc_adisc_parse(struct fchs_s * fchs,void * pld,u32 host_dap,wwn_t node_name,wwn_t port_name)516 fc_adisc_parse(struct fchs_s *fchs, void *pld, u32 host_dap, wwn_t node_name,
517 wwn_t port_name)
518 {
519 struct fc_adisc_s *adisc = (struct fc_adisc_s *) pld;
520
521 if (adisc->els_cmd.els_code != FC_ELS_ACC)
522 return FC_PARSE_FAILURE;
523
524 if ((adisc->nport_id == (host_dap))
525 && wwn_is_equal(adisc->orig_port_name, port_name)
526 && wwn_is_equal(adisc->orig_node_name, node_name))
527 return FC_PARSE_OK;
528
529 return FC_PARSE_FAILURE;
530 }
531
532 enum fc_parse_status
fc_pdisc_parse(struct fchs_s * fchs,wwn_t node_name,wwn_t port_name)533 fc_pdisc_parse(struct fchs_s *fchs, wwn_t node_name, wwn_t port_name)
534 {
535 struct fc_logi_s *pdisc = (struct fc_logi_s *) (fchs + 1);
536
537 if (pdisc->class3.class_valid != 1)
538 return FC_PARSE_FAILURE;
539
540 if ((be16_to_cpu(pdisc->class3.rxsz) <
541 (FC_MIN_PDUSZ - sizeof(struct fchs_s)))
542 || (pdisc->class3.rxsz == 0))
543 return FC_PARSE_FAILURE;
544
545 if (!wwn_is_equal(pdisc->port_name, port_name))
546 return FC_PARSE_FAILURE;
547
548 if (!wwn_is_equal(pdisc->node_name, node_name))
549 return FC_PARSE_FAILURE;
550
551 return FC_PARSE_OK;
552 }
553
554 u16
fc_abts_build(struct fchs_s * fchs,u32 d_id,u32 s_id,u16 ox_id)555 fc_abts_build(struct fchs_s *fchs, u32 d_id, u32 s_id, u16 ox_id)
556 {
557 memcpy(fchs, &fc_bls_req_tmpl, sizeof(struct fchs_s));
558 fchs->cat_info = FC_CAT_ABTS;
559 fchs->d_id = (d_id);
560 fchs->s_id = (s_id);
561 fchs->ox_id = cpu_to_be16(ox_id);
562
563 return sizeof(struct fchs_s);
564 }
565
566 enum fc_parse_status
fc_abts_rsp_parse(struct fchs_s * fchs,int len)567 fc_abts_rsp_parse(struct fchs_s *fchs, int len)
568 {
569 if ((fchs->cat_info == FC_CAT_BA_ACC)
570 || (fchs->cat_info == FC_CAT_BA_RJT))
571 return FC_PARSE_OK;
572
573 return FC_PARSE_FAILURE;
574 }
575
576 u16
fc_rrq_build(struct fchs_s * fchs,struct fc_rrq_s * rrq,u32 d_id,u32 s_id,u16 ox_id,u16 rrq_oxid)577 fc_rrq_build(struct fchs_s *fchs, struct fc_rrq_s *rrq, u32 d_id, u32 s_id,
578 u16 ox_id, u16 rrq_oxid)
579 {
580 fc_els_req_build(fchs, d_id, s_id, ox_id);
581
582 /*
583 * build rrq payload
584 */
585 memcpy(rrq, &rrq_tmpl, sizeof(struct fc_rrq_s));
586 rrq->s_id = (s_id);
587 rrq->ox_id = cpu_to_be16(rrq_oxid);
588 rrq->rx_id = FC_RXID_ANY;
589
590 return sizeof(struct fc_rrq_s);
591 }
592
593 u16
fc_logo_acc_build(struct fchs_s * fchs,void * pld,u32 d_id,u32 s_id,__be16 ox_id)594 fc_logo_acc_build(struct fchs_s *fchs, void *pld, u32 d_id, u32 s_id,
595 __be16 ox_id)
596 {
597 struct fc_els_cmd_s *acc = pld;
598
599 fc_els_rsp_build(fchs, d_id, s_id, ox_id);
600
601 memset(acc, 0, sizeof(struct fc_els_cmd_s));
602 acc->els_code = FC_ELS_ACC;
603
604 return sizeof(struct fc_els_cmd_s);
605 }
606
607 u16
fc_ls_rjt_build(struct fchs_s * fchs,struct fc_ls_rjt_s * ls_rjt,u32 d_id,u32 s_id,__be16 ox_id,u8 reason_code,u8 reason_code_expl)608 fc_ls_rjt_build(struct fchs_s *fchs, struct fc_ls_rjt_s *ls_rjt, u32 d_id,
609 u32 s_id, __be16 ox_id, u8 reason_code,
610 u8 reason_code_expl)
611 {
612 fc_els_rsp_build(fchs, d_id, s_id, ox_id);
613 memset(ls_rjt, 0, sizeof(struct fc_ls_rjt_s));
614
615 ls_rjt->els_cmd.els_code = FC_ELS_LS_RJT;
616 ls_rjt->reason_code = reason_code;
617 ls_rjt->reason_code_expl = reason_code_expl;
618 ls_rjt->vendor_unique = 0x00;
619
620 return sizeof(struct fc_ls_rjt_s);
621 }
622
623 u16
fc_ba_acc_build(struct fchs_s * fchs,struct fc_ba_acc_s * ba_acc,u32 d_id,u32 s_id,__be16 ox_id,u16 rx_id)624 fc_ba_acc_build(struct fchs_s *fchs, struct fc_ba_acc_s *ba_acc, u32 d_id,
625 u32 s_id, __be16 ox_id, u16 rx_id)
626 {
627 fc_bls_rsp_build(fchs, d_id, s_id, ox_id);
628
629 memcpy(ba_acc, &ba_acc_tmpl, sizeof(struct fc_ba_acc_s));
630
631 fchs->rx_id = rx_id;
632
633 ba_acc->ox_id = fchs->ox_id;
634 ba_acc->rx_id = fchs->rx_id;
635
636 return sizeof(struct fc_ba_acc_s);
637 }
638
639 u16
fc_ls_acc_build(struct fchs_s * fchs,struct fc_els_cmd_s * els_cmd,u32 d_id,u32 s_id,__be16 ox_id)640 fc_ls_acc_build(struct fchs_s *fchs, struct fc_els_cmd_s *els_cmd, u32 d_id,
641 u32 s_id, __be16 ox_id)
642 {
643 fc_els_rsp_build(fchs, d_id, s_id, ox_id);
644 memset(els_cmd, 0, sizeof(struct fc_els_cmd_s));
645 els_cmd->els_code = FC_ELS_ACC;
646
647 return sizeof(struct fc_els_cmd_s);
648 }
649
650 int
fc_logout_params_pages(struct fchs_s * fc_frame,u8 els_code)651 fc_logout_params_pages(struct fchs_s *fc_frame, u8 els_code)
652 {
653 int num_pages = 0;
654 struct fc_prlo_s *prlo;
655 struct fc_tprlo_s *tprlo;
656
657 if (els_code == FC_ELS_PRLO) {
658 prlo = (struct fc_prlo_s *) (fc_frame + 1);
659 num_pages = (be16_to_cpu(prlo->payload_len) - 4) / 16;
660 } else {
661 tprlo = (struct fc_tprlo_s *) (fc_frame + 1);
662 num_pages = (be16_to_cpu(tprlo->payload_len) - 4) / 16;
663 }
664 return num_pages;
665 }
666
667 u16
fc_tprlo_acc_build(struct fchs_s * fchs,struct fc_tprlo_acc_s * tprlo_acc,u32 d_id,u32 s_id,__be16 ox_id,int num_pages)668 fc_tprlo_acc_build(struct fchs_s *fchs, struct fc_tprlo_acc_s *tprlo_acc,
669 u32 d_id, u32 s_id, __be16 ox_id, int num_pages)
670 {
671 int page;
672
673 fc_els_rsp_build(fchs, d_id, s_id, ox_id);
674
675 memset(tprlo_acc, 0, (num_pages * 16) + 4);
676 tprlo_acc->command = FC_ELS_ACC;
677
678 tprlo_acc->page_len = 0x10;
679 tprlo_acc->payload_len = cpu_to_be16((num_pages * 16) + 4);
680
681 for (page = 0; page < num_pages; page++) {
682 tprlo_acc->tprlo_acc_params[page].opa_valid = 0;
683 tprlo_acc->tprlo_acc_params[page].rpa_valid = 0;
684 tprlo_acc->tprlo_acc_params[page].fc4type_csp = FC_TYPE_FCP;
685 tprlo_acc->tprlo_acc_params[page].orig_process_assc = 0;
686 tprlo_acc->tprlo_acc_params[page].resp_process_assc = 0;
687 }
688 return be16_to_cpu(tprlo_acc->payload_len);
689 }
690
691 u16
fc_prlo_acc_build(struct fchs_s * fchs,struct fc_prlo_acc_s * prlo_acc,u32 d_id,u32 s_id,__be16 ox_id,int num_pages)692 fc_prlo_acc_build(struct fchs_s *fchs, struct fc_prlo_acc_s *prlo_acc, u32 d_id,
693 u32 s_id, __be16 ox_id, int num_pages)
694 {
695 int page;
696
697 fc_els_rsp_build(fchs, d_id, s_id, ox_id);
698
699 memset(prlo_acc, 0, (num_pages * 16) + 4);
700 prlo_acc->command = FC_ELS_ACC;
701 prlo_acc->page_len = 0x10;
702 prlo_acc->payload_len = cpu_to_be16((num_pages * 16) + 4);
703
704 for (page = 0; page < num_pages; page++) {
705 prlo_acc->prlo_acc_params[page].opa_valid = 0;
706 prlo_acc->prlo_acc_params[page].rpa_valid = 0;
707 prlo_acc->prlo_acc_params[page].fc4type_csp = FC_TYPE_FCP;
708 prlo_acc->prlo_acc_params[page].orig_process_assc = 0;
709 prlo_acc->prlo_acc_params[page].resp_process_assc = 0;
710 }
711
712 return be16_to_cpu(prlo_acc->payload_len);
713 }
714
715 u16
fc_rnid_build(struct fchs_s * fchs,struct fc_rnid_cmd_s * rnid,u32 d_id,u32 s_id,u16 ox_id,u32 data_format)716 fc_rnid_build(struct fchs_s *fchs, struct fc_rnid_cmd_s *rnid, u32 d_id,
717 u32 s_id, u16 ox_id, u32 data_format)
718 {
719 fc_els_req_build(fchs, d_id, s_id, ox_id);
720
721 memset(rnid, 0, sizeof(struct fc_rnid_cmd_s));
722
723 rnid->els_cmd.els_code = FC_ELS_RNID;
724 rnid->node_id_data_format = data_format;
725
726 return sizeof(struct fc_rnid_cmd_s);
727 }
728
729 u16
fc_rnid_acc_build(struct fchs_s * fchs,struct fc_rnid_acc_s * rnid_acc,u32 d_id,u32 s_id,__be16 ox_id,u32 data_format,struct fc_rnid_common_id_data_s * common_id_data,struct fc_rnid_general_topology_data_s * gen_topo_data)730 fc_rnid_acc_build(struct fchs_s *fchs, struct fc_rnid_acc_s *rnid_acc, u32 d_id,
731 u32 s_id, __be16 ox_id, u32 data_format,
732 struct fc_rnid_common_id_data_s *common_id_data,
733 struct fc_rnid_general_topology_data_s *gen_topo_data)
734 {
735 memset(rnid_acc, 0, sizeof(struct fc_rnid_acc_s));
736
737 fc_els_rsp_build(fchs, d_id, s_id, ox_id);
738
739 rnid_acc->els_cmd.els_code = FC_ELS_ACC;
740 rnid_acc->node_id_data_format = data_format;
741 rnid_acc->common_id_data_length =
742 sizeof(struct fc_rnid_common_id_data_s);
743 rnid_acc->common_id_data = *common_id_data;
744
745 if (data_format == RNID_NODEID_DATA_FORMAT_DISCOVERY) {
746 rnid_acc->specific_id_data_length =
747 sizeof(struct fc_rnid_general_topology_data_s);
748 rnid_acc->gen_topology_data = *gen_topo_data;
749 return sizeof(struct fc_rnid_acc_s);
750 } else {
751 return sizeof(struct fc_rnid_acc_s) -
752 sizeof(struct fc_rnid_general_topology_data_s);
753 }
754
755 }
756
757 u16
fc_rpsc_build(struct fchs_s * fchs,struct fc_rpsc_cmd_s * rpsc,u32 d_id,u32 s_id,u16 ox_id)758 fc_rpsc_build(struct fchs_s *fchs, struct fc_rpsc_cmd_s *rpsc, u32 d_id,
759 u32 s_id, u16 ox_id)
760 {
761 fc_els_req_build(fchs, d_id, s_id, ox_id);
762
763 memset(rpsc, 0, sizeof(struct fc_rpsc_cmd_s));
764
765 rpsc->els_cmd.els_code = FC_ELS_RPSC;
766 return sizeof(struct fc_rpsc_cmd_s);
767 }
768
769 u16
fc_rpsc2_build(struct fchs_s * fchs,struct fc_rpsc2_cmd_s * rpsc2,u32 d_id,u32 s_id,u32 * pid_list,u16 npids)770 fc_rpsc2_build(struct fchs_s *fchs, struct fc_rpsc2_cmd_s *rpsc2, u32 d_id,
771 u32 s_id, u32 *pid_list, u16 npids)
772 {
773 u32 dctlr_id = FC_DOMAIN_CTRLR(bfa_hton3b(d_id));
774 int i = 0;
775
776 fc_els_req_build(fchs, bfa_hton3b(dctlr_id), s_id, 0);
777
778 memset(rpsc2, 0, sizeof(struct fc_rpsc2_cmd_s));
779
780 rpsc2->els_cmd.els_code = FC_ELS_RPSC;
781 rpsc2->token = cpu_to_be32(FC_BRCD_TOKEN);
782 rpsc2->num_pids = cpu_to_be16(npids);
783 for (i = 0; i < npids; i++)
784 rpsc2->pid_list[i].pid = pid_list[i];
785
786 return sizeof(struct fc_rpsc2_cmd_s) + ((npids - 1) * (sizeof(u32)));
787 }
788
789 u16
fc_rpsc_acc_build(struct fchs_s * fchs,struct fc_rpsc_acc_s * rpsc_acc,u32 d_id,u32 s_id,__be16 ox_id,struct fc_rpsc_speed_info_s * oper_speed)790 fc_rpsc_acc_build(struct fchs_s *fchs, struct fc_rpsc_acc_s *rpsc_acc,
791 u32 d_id, u32 s_id, __be16 ox_id,
792 struct fc_rpsc_speed_info_s *oper_speed)
793 {
794 memset(rpsc_acc, 0, sizeof(struct fc_rpsc_acc_s));
795
796 fc_els_rsp_build(fchs, d_id, s_id, ox_id);
797
798 rpsc_acc->command = FC_ELS_ACC;
799 rpsc_acc->num_entries = cpu_to_be16(1);
800
801 rpsc_acc->speed_info[0].port_speed_cap =
802 cpu_to_be16(oper_speed->port_speed_cap);
803
804 rpsc_acc->speed_info[0].port_op_speed =
805 cpu_to_be16(oper_speed->port_op_speed);
806
807 return sizeof(struct fc_rpsc_acc_s);
808 }
809
810 u16
fc_logo_rsp_parse(struct fchs_s * fchs,int len)811 fc_logo_rsp_parse(struct fchs_s *fchs, int len)
812 {
813 struct fc_els_cmd_s *els_cmd = (struct fc_els_cmd_s *) (fchs + 1);
814
815 len = len;
816 if (els_cmd->els_code != FC_ELS_ACC)
817 return FC_PARSE_FAILURE;
818
819 return FC_PARSE_OK;
820 }
821
822 u16
fc_pdisc_build(struct fchs_s * fchs,u32 d_id,u32 s_id,u16 ox_id,wwn_t port_name,wwn_t node_name,u16 pdu_size)823 fc_pdisc_build(struct fchs_s *fchs, u32 d_id, u32 s_id, u16 ox_id,
824 wwn_t port_name, wwn_t node_name, u16 pdu_size)
825 {
826 struct fc_logi_s *pdisc = (struct fc_logi_s *) (fchs + 1);
827
828 memcpy(pdisc, &plogi_tmpl, sizeof(struct fc_logi_s));
829
830 pdisc->els_cmd.els_code = FC_ELS_PDISC;
831 fc_els_req_build(fchs, d_id, s_id, ox_id);
832
833 pdisc->csp.rxsz = pdisc->class3.rxsz = cpu_to_be16(pdu_size);
834 pdisc->port_name = port_name;
835 pdisc->node_name = node_name;
836
837 return sizeof(struct fc_logi_s);
838 }
839
840 u16
fc_pdisc_rsp_parse(struct fchs_s * fchs,int len,wwn_t port_name)841 fc_pdisc_rsp_parse(struct fchs_s *fchs, int len, wwn_t port_name)
842 {
843 struct fc_logi_s *pdisc = (struct fc_logi_s *) (fchs + 1);
844
845 if (len < sizeof(struct fc_logi_s))
846 return FC_PARSE_LEN_INVAL;
847
848 if (pdisc->els_cmd.els_code != FC_ELS_ACC)
849 return FC_PARSE_ACC_INVAL;
850
851 if (!wwn_is_equal(pdisc->port_name, port_name))
852 return FC_PARSE_PWWN_NOT_EQUAL;
853
854 if (!pdisc->class3.class_valid)
855 return FC_PARSE_NWWN_NOT_EQUAL;
856
857 if (be16_to_cpu(pdisc->class3.rxsz) < (FC_MIN_PDUSZ))
858 return FC_PARSE_RXSZ_INVAL;
859
860 return FC_PARSE_OK;
861 }
862
863 u16
fc_prlo_build(struct fchs_s * fchs,u32 d_id,u32 s_id,u16 ox_id,int num_pages)864 fc_prlo_build(struct fchs_s *fchs, u32 d_id, u32 s_id, u16 ox_id,
865 int num_pages)
866 {
867 struct fc_prlo_s *prlo = (struct fc_prlo_s *) (fchs + 1);
868 int page;
869
870 fc_els_req_build(fchs, d_id, s_id, ox_id);
871 memset(prlo, 0, (num_pages * 16) + 4);
872 prlo->command = FC_ELS_PRLO;
873 prlo->page_len = 0x10;
874 prlo->payload_len = cpu_to_be16((num_pages * 16) + 4);
875
876 for (page = 0; page < num_pages; page++) {
877 prlo->prlo_params[page].type = FC_TYPE_FCP;
878 prlo->prlo_params[page].opa_valid = 0;
879 prlo->prlo_params[page].rpa_valid = 0;
880 prlo->prlo_params[page].orig_process_assc = 0;
881 prlo->prlo_params[page].resp_process_assc = 0;
882 }
883
884 return be16_to_cpu(prlo->payload_len);
885 }
886
887 u16
fc_prlo_rsp_parse(struct fchs_s * fchs,int len)888 fc_prlo_rsp_parse(struct fchs_s *fchs, int len)
889 {
890 struct fc_prlo_acc_s *prlo = (struct fc_prlo_acc_s *) (fchs + 1);
891 int num_pages = 0;
892 int page = 0;
893
894 len = len;
895
896 if (prlo->command != FC_ELS_ACC)
897 return FC_PARSE_FAILURE;
898
899 num_pages = ((be16_to_cpu(prlo->payload_len)) - 4) / 16;
900
901 for (page = 0; page < num_pages; page++) {
902 if (prlo->prlo_acc_params[page].type != FC_TYPE_FCP)
903 return FC_PARSE_FAILURE;
904
905 if (prlo->prlo_acc_params[page].opa_valid != 0)
906 return FC_PARSE_FAILURE;
907
908 if (prlo->prlo_acc_params[page].rpa_valid != 0)
909 return FC_PARSE_FAILURE;
910
911 if (prlo->prlo_acc_params[page].orig_process_assc != 0)
912 return FC_PARSE_FAILURE;
913
914 if (prlo->prlo_acc_params[page].resp_process_assc != 0)
915 return FC_PARSE_FAILURE;
916 }
917 return FC_PARSE_OK;
918
919 }
920
921 u16
fc_tprlo_build(struct fchs_s * fchs,u32 d_id,u32 s_id,u16 ox_id,int num_pages,enum fc_tprlo_type tprlo_type,u32 tpr_id)922 fc_tprlo_build(struct fchs_s *fchs, u32 d_id, u32 s_id, u16 ox_id,
923 int num_pages, enum fc_tprlo_type tprlo_type, u32 tpr_id)
924 {
925 struct fc_tprlo_s *tprlo = (struct fc_tprlo_s *) (fchs + 1);
926 int page;
927
928 fc_els_req_build(fchs, d_id, s_id, ox_id);
929 memset(tprlo, 0, (num_pages * 16) + 4);
930 tprlo->command = FC_ELS_TPRLO;
931 tprlo->page_len = 0x10;
932 tprlo->payload_len = cpu_to_be16((num_pages * 16) + 4);
933
934 for (page = 0; page < num_pages; page++) {
935 tprlo->tprlo_params[page].type = FC_TYPE_FCP;
936 tprlo->tprlo_params[page].opa_valid = 0;
937 tprlo->tprlo_params[page].rpa_valid = 0;
938 tprlo->tprlo_params[page].orig_process_assc = 0;
939 tprlo->tprlo_params[page].resp_process_assc = 0;
940 if (tprlo_type == FC_GLOBAL_LOGO) {
941 tprlo->tprlo_params[page].global_process_logout = 1;
942 } else if (tprlo_type == FC_TPR_LOGO) {
943 tprlo->tprlo_params[page].tpo_nport_valid = 1;
944 tprlo->tprlo_params[page].tpo_nport_id = (tpr_id);
945 }
946 }
947
948 return be16_to_cpu(tprlo->payload_len);
949 }
950
951 u16
fc_tprlo_rsp_parse(struct fchs_s * fchs,int len)952 fc_tprlo_rsp_parse(struct fchs_s *fchs, int len)
953 {
954 struct fc_tprlo_acc_s *tprlo = (struct fc_tprlo_acc_s *) (fchs + 1);
955 int num_pages = 0;
956 int page = 0;
957
958 len = len;
959
960 if (tprlo->command != FC_ELS_ACC)
961 return FC_PARSE_ACC_INVAL;
962
963 num_pages = (be16_to_cpu(tprlo->payload_len) - 4) / 16;
964
965 for (page = 0; page < num_pages; page++) {
966 if (tprlo->tprlo_acc_params[page].type != FC_TYPE_FCP)
967 return FC_PARSE_NOT_FCP;
968 if (tprlo->tprlo_acc_params[page].opa_valid != 0)
969 return FC_PARSE_OPAFLAG_INVAL;
970 if (tprlo->tprlo_acc_params[page].rpa_valid != 0)
971 return FC_PARSE_RPAFLAG_INVAL;
972 if (tprlo->tprlo_acc_params[page].orig_process_assc != 0)
973 return FC_PARSE_OPA_INVAL;
974 if (tprlo->tprlo_acc_params[page].resp_process_assc != 0)
975 return FC_PARSE_RPA_INVAL;
976 }
977 return FC_PARSE_OK;
978 }
979
980 enum fc_parse_status
fc_rrq_rsp_parse(struct fchs_s * fchs,int len)981 fc_rrq_rsp_parse(struct fchs_s *fchs, int len)
982 {
983 struct fc_els_cmd_s *els_cmd = (struct fc_els_cmd_s *) (fchs + 1);
984
985 len = len;
986 if (els_cmd->els_code != FC_ELS_ACC)
987 return FC_PARSE_FAILURE;
988
989 return FC_PARSE_OK;
990 }
991
992 u16
fc_ba_rjt_build(struct fchs_s * fchs,u32 d_id,u32 s_id,__be16 ox_id,u32 reason_code,u32 reason_expl)993 fc_ba_rjt_build(struct fchs_s *fchs, u32 d_id, u32 s_id, __be16 ox_id,
994 u32 reason_code, u32 reason_expl)
995 {
996 struct fc_ba_rjt_s *ba_rjt = (struct fc_ba_rjt_s *) (fchs + 1);
997
998 fc_bls_rsp_build(fchs, d_id, s_id, ox_id);
999
1000 fchs->cat_info = FC_CAT_BA_RJT;
1001 ba_rjt->reason_code = reason_code;
1002 ba_rjt->reason_expl = reason_expl;
1003 return sizeof(struct fc_ba_rjt_s);
1004 }
1005
1006 static void
fc_gs_cthdr_build(struct ct_hdr_s * cthdr,u32 s_id,u16 cmd_code)1007 fc_gs_cthdr_build(struct ct_hdr_s *cthdr, u32 s_id, u16 cmd_code)
1008 {
1009 memset(cthdr, 0, sizeof(struct ct_hdr_s));
1010 cthdr->rev_id = CT_GS3_REVISION;
1011 cthdr->gs_type = CT_GSTYPE_DIRSERVICE;
1012 cthdr->gs_sub_type = CT_GSSUBTYPE_NAMESERVER;
1013 cthdr->cmd_rsp_code = cpu_to_be16(cmd_code);
1014 }
1015
1016 static void
fc_gs_fdmi_cthdr_build(struct ct_hdr_s * cthdr,u32 s_id,u16 cmd_code)1017 fc_gs_fdmi_cthdr_build(struct ct_hdr_s *cthdr, u32 s_id, u16 cmd_code)
1018 {
1019 memset(cthdr, 0, sizeof(struct ct_hdr_s));
1020 cthdr->rev_id = CT_GS3_REVISION;
1021 cthdr->gs_type = CT_GSTYPE_MGMTSERVICE;
1022 cthdr->gs_sub_type = CT_GSSUBTYPE_HBA_MGMTSERVER;
1023 cthdr->cmd_rsp_code = cpu_to_be16(cmd_code);
1024 }
1025
1026 static void
fc_gs_ms_cthdr_build(struct ct_hdr_s * cthdr,u32 s_id,u16 cmd_code,u8 sub_type)1027 fc_gs_ms_cthdr_build(struct ct_hdr_s *cthdr, u32 s_id, u16 cmd_code,
1028 u8 sub_type)
1029 {
1030 memset(cthdr, 0, sizeof(struct ct_hdr_s));
1031 cthdr->rev_id = CT_GS3_REVISION;
1032 cthdr->gs_type = CT_GSTYPE_MGMTSERVICE;
1033 cthdr->gs_sub_type = sub_type;
1034 cthdr->cmd_rsp_code = cpu_to_be16(cmd_code);
1035 }
1036
1037 u16
fc_gidpn_build(struct fchs_s * fchs,void * pyld,u32 s_id,u16 ox_id,wwn_t port_name)1038 fc_gidpn_build(struct fchs_s *fchs, void *pyld, u32 s_id, u16 ox_id,
1039 wwn_t port_name)
1040 {
1041 struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
1042 struct fcgs_gidpn_req_s *gidpn = (struct fcgs_gidpn_req_s *)(cthdr + 1);
1043 u32 d_id = bfa_hton3b(FC_NAME_SERVER);
1044
1045 fc_gs_fchdr_build(fchs, d_id, s_id, ox_id);
1046 fc_gs_cthdr_build(cthdr, s_id, GS_GID_PN);
1047
1048 memset(gidpn, 0, sizeof(struct fcgs_gidpn_req_s));
1049 gidpn->port_name = port_name;
1050 return sizeof(struct fcgs_gidpn_req_s) + sizeof(struct ct_hdr_s);
1051 }
1052
1053 u16
fc_gpnid_build(struct fchs_s * fchs,void * pyld,u32 s_id,u16 ox_id,u32 port_id)1054 fc_gpnid_build(struct fchs_s *fchs, void *pyld, u32 s_id, u16 ox_id,
1055 u32 port_id)
1056 {
1057 struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
1058 fcgs_gpnid_req_t *gpnid = (fcgs_gpnid_req_t *) (cthdr + 1);
1059 u32 d_id = bfa_hton3b(FC_NAME_SERVER);
1060
1061 fc_gs_fchdr_build(fchs, d_id, s_id, ox_id);
1062 fc_gs_cthdr_build(cthdr, s_id, GS_GPN_ID);
1063
1064 memset(gpnid, 0, sizeof(fcgs_gpnid_req_t));
1065 gpnid->dap = port_id;
1066 return sizeof(fcgs_gpnid_req_t) + sizeof(struct ct_hdr_s);
1067 }
1068
1069 u16
fc_gnnid_build(struct fchs_s * fchs,void * pyld,u32 s_id,u16 ox_id,u32 port_id)1070 fc_gnnid_build(struct fchs_s *fchs, void *pyld, u32 s_id, u16 ox_id,
1071 u32 port_id)
1072 {
1073 struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
1074 fcgs_gnnid_req_t *gnnid = (fcgs_gnnid_req_t *) (cthdr + 1);
1075 u32 d_id = bfa_hton3b(FC_NAME_SERVER);
1076
1077 fc_gs_fchdr_build(fchs, d_id, s_id, ox_id);
1078 fc_gs_cthdr_build(cthdr, s_id, GS_GNN_ID);
1079
1080 memset(gnnid, 0, sizeof(fcgs_gnnid_req_t));
1081 gnnid->dap = port_id;
1082 return sizeof(fcgs_gnnid_req_t) + sizeof(struct ct_hdr_s);
1083 }
1084
1085 u16
fc_ct_rsp_parse(struct ct_hdr_s * cthdr)1086 fc_ct_rsp_parse(struct ct_hdr_s *cthdr)
1087 {
1088 if (be16_to_cpu(cthdr->cmd_rsp_code) != CT_RSP_ACCEPT) {
1089 if (cthdr->reason_code == CT_RSN_LOGICAL_BUSY)
1090 return FC_PARSE_BUSY;
1091 else
1092 return FC_PARSE_FAILURE;
1093 }
1094
1095 return FC_PARSE_OK;
1096 }
1097
1098 u16
fc_scr_build(struct fchs_s * fchs,struct fc_scr_s * scr,u8 set_br_reg,u32 s_id,u16 ox_id)1099 fc_scr_build(struct fchs_s *fchs, struct fc_scr_s *scr,
1100 u8 set_br_reg, u32 s_id, u16 ox_id)
1101 {
1102 u32 d_id = bfa_hton3b(FC_FABRIC_CONTROLLER);
1103
1104 fc_els_req_build(fchs, d_id, s_id, ox_id);
1105
1106 memset(scr, 0, sizeof(struct fc_scr_s));
1107 scr->command = FC_ELS_SCR;
1108 scr->reg_func = FC_SCR_REG_FUNC_FULL;
1109 if (set_br_reg)
1110 scr->vu_reg_func = FC_VU_SCR_REG_FUNC_FABRIC_NAME_CHANGE;
1111
1112 return sizeof(struct fc_scr_s);
1113 }
1114
1115 u16
fc_rscn_build(struct fchs_s * fchs,struct fc_rscn_pl_s * rscn,u32 s_id,u16 ox_id)1116 fc_rscn_build(struct fchs_s *fchs, struct fc_rscn_pl_s *rscn,
1117 u32 s_id, u16 ox_id)
1118 {
1119 u32 d_id = bfa_hton3b(FC_FABRIC_CONTROLLER);
1120 u16 payldlen;
1121
1122 fc_els_req_build(fchs, d_id, s_id, ox_id);
1123 rscn->command = FC_ELS_RSCN;
1124 rscn->pagelen = sizeof(rscn->event[0]);
1125
1126 payldlen = sizeof(u32) + rscn->pagelen;
1127 rscn->payldlen = cpu_to_be16(payldlen);
1128
1129 rscn->event[0].format = FC_RSCN_FORMAT_PORTID;
1130 rscn->event[0].portid = s_id;
1131
1132 return sizeof(struct fc_rscn_pl_s);
1133 }
1134
1135 u16
fc_rftid_build(struct fchs_s * fchs,void * pyld,u32 s_id,u16 ox_id,enum bfa_lport_role roles)1136 fc_rftid_build(struct fchs_s *fchs, void *pyld, u32 s_id, u16 ox_id,
1137 enum bfa_lport_role roles)
1138 {
1139 struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
1140 struct fcgs_rftid_req_s *rftid = (struct fcgs_rftid_req_s *)(cthdr + 1);
1141 u32 type_value, d_id = bfa_hton3b(FC_NAME_SERVER);
1142 u8 index;
1143
1144 fc_gs_fchdr_build(fchs, d_id, s_id, ox_id);
1145 fc_gs_cthdr_build(cthdr, s_id, GS_RFT_ID);
1146
1147 memset(rftid, 0, sizeof(struct fcgs_rftid_req_s));
1148
1149 rftid->dap = s_id;
1150
1151 /* By default, FCP FC4 Type is registered */
1152 index = FC_TYPE_FCP >> 5;
1153 type_value = 1 << (FC_TYPE_FCP % 32);
1154 rftid->fc4_type[index] = cpu_to_be32(type_value);
1155
1156 return sizeof(struct fcgs_rftid_req_s) + sizeof(struct ct_hdr_s);
1157 }
1158
1159 u16
fc_rftid_build_sol(struct fchs_s * fchs,void * pyld,u32 s_id,u16 ox_id,u8 * fc4_bitmap,u32 bitmap_size)1160 fc_rftid_build_sol(struct fchs_s *fchs, void *pyld, u32 s_id, u16 ox_id,
1161 u8 *fc4_bitmap, u32 bitmap_size)
1162 {
1163 struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
1164 struct fcgs_rftid_req_s *rftid = (struct fcgs_rftid_req_s *)(cthdr + 1);
1165 u32 d_id = bfa_hton3b(FC_NAME_SERVER);
1166
1167 fc_gs_fchdr_build(fchs, d_id, s_id, ox_id);
1168 fc_gs_cthdr_build(cthdr, s_id, GS_RFT_ID);
1169
1170 memset(rftid, 0, sizeof(struct fcgs_rftid_req_s));
1171
1172 rftid->dap = s_id;
1173 memcpy((void *)rftid->fc4_type, (void *)fc4_bitmap,
1174 (bitmap_size < 32 ? bitmap_size : 32));
1175
1176 return sizeof(struct fcgs_rftid_req_s) + sizeof(struct ct_hdr_s);
1177 }
1178
1179 u16
fc_rffid_build(struct fchs_s * fchs,void * pyld,u32 s_id,u16 ox_id,u8 fc4_type,u8 fc4_ftrs)1180 fc_rffid_build(struct fchs_s *fchs, void *pyld, u32 s_id, u16 ox_id,
1181 u8 fc4_type, u8 fc4_ftrs)
1182 {
1183 struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
1184 struct fcgs_rffid_req_s *rffid = (struct fcgs_rffid_req_s *)(cthdr + 1);
1185 u32 d_id = bfa_hton3b(FC_NAME_SERVER);
1186
1187 fc_gs_fchdr_build(fchs, d_id, s_id, ox_id);
1188 fc_gs_cthdr_build(cthdr, s_id, GS_RFF_ID);
1189
1190 memset(rffid, 0, sizeof(struct fcgs_rffid_req_s));
1191
1192 rffid->dap = s_id;
1193 rffid->fc4ftr_bits = fc4_ftrs;
1194 rffid->fc4_type = fc4_type;
1195
1196 return sizeof(struct fcgs_rffid_req_s) + sizeof(struct ct_hdr_s);
1197 }
1198
1199 u16
fc_rspnid_build(struct fchs_s * fchs,void * pyld,u32 s_id,u16 ox_id,u8 * name)1200 fc_rspnid_build(struct fchs_s *fchs, void *pyld, u32 s_id, u16 ox_id,
1201 u8 *name)
1202 {
1203
1204 struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
1205 struct fcgs_rspnid_req_s *rspnid =
1206 (struct fcgs_rspnid_req_s *)(cthdr + 1);
1207 u32 d_id = bfa_hton3b(FC_NAME_SERVER);
1208
1209 fc_gs_fchdr_build(fchs, d_id, s_id, ox_id);
1210 fc_gs_cthdr_build(cthdr, s_id, GS_RSPN_ID);
1211
1212 memset(rspnid, 0, sizeof(struct fcgs_rspnid_req_s));
1213
1214 rspnid->dap = s_id;
1215 rspnid->spn_len = (u8) strlen((char *)name);
1216 strncpy((char *)rspnid->spn, (char *)name, rspnid->spn_len);
1217
1218 return sizeof(struct fcgs_rspnid_req_s) + sizeof(struct ct_hdr_s);
1219 }
1220
1221 u16
fc_gid_ft_build(struct fchs_s * fchs,void * pyld,u32 s_id,u8 fc4_type)1222 fc_gid_ft_build(struct fchs_s *fchs, void *pyld, u32 s_id, u8 fc4_type)
1223 {
1224
1225 struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
1226 struct fcgs_gidft_req_s *gidft = (struct fcgs_gidft_req_s *)(cthdr + 1);
1227 u32 d_id = bfa_hton3b(FC_NAME_SERVER);
1228
1229 fc_gs_fchdr_build(fchs, d_id, s_id, 0);
1230
1231 fc_gs_cthdr_build(cthdr, s_id, GS_GID_FT);
1232
1233 memset(gidft, 0, sizeof(struct fcgs_gidft_req_s));
1234 gidft->fc4_type = fc4_type;
1235 gidft->domain_id = 0;
1236 gidft->area_id = 0;
1237
1238 return sizeof(struct fcgs_gidft_req_s) + sizeof(struct ct_hdr_s);
1239 }
1240
1241 u16
fc_rpnid_build(struct fchs_s * fchs,void * pyld,u32 s_id,u32 port_id,wwn_t port_name)1242 fc_rpnid_build(struct fchs_s *fchs, void *pyld, u32 s_id, u32 port_id,
1243 wwn_t port_name)
1244 {
1245 struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
1246 struct fcgs_rpnid_req_s *rpnid = (struct fcgs_rpnid_req_s *)(cthdr + 1);
1247 u32 d_id = bfa_hton3b(FC_NAME_SERVER);
1248
1249 fc_gs_fchdr_build(fchs, d_id, s_id, 0);
1250 fc_gs_cthdr_build(cthdr, s_id, GS_RPN_ID);
1251
1252 memset(rpnid, 0, sizeof(struct fcgs_rpnid_req_s));
1253 rpnid->port_id = port_id;
1254 rpnid->port_name = port_name;
1255
1256 return sizeof(struct fcgs_rpnid_req_s) + sizeof(struct ct_hdr_s);
1257 }
1258
1259 u16
fc_rnnid_build(struct fchs_s * fchs,void * pyld,u32 s_id,u32 port_id,wwn_t node_name)1260 fc_rnnid_build(struct fchs_s *fchs, void *pyld, u32 s_id, u32 port_id,
1261 wwn_t node_name)
1262 {
1263 struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
1264 struct fcgs_rnnid_req_s *rnnid = (struct fcgs_rnnid_req_s *)(cthdr + 1);
1265 u32 d_id = bfa_hton3b(FC_NAME_SERVER);
1266
1267 fc_gs_fchdr_build(fchs, d_id, s_id, 0);
1268 fc_gs_cthdr_build(cthdr, s_id, GS_RNN_ID);
1269
1270 memset(rnnid, 0, sizeof(struct fcgs_rnnid_req_s));
1271 rnnid->port_id = port_id;
1272 rnnid->node_name = node_name;
1273
1274 return sizeof(struct fcgs_rnnid_req_s) + sizeof(struct ct_hdr_s);
1275 }
1276
1277 u16
fc_rcsid_build(struct fchs_s * fchs,void * pyld,u32 s_id,u32 port_id,u32 cos)1278 fc_rcsid_build(struct fchs_s *fchs, void *pyld, u32 s_id, u32 port_id,
1279 u32 cos)
1280 {
1281 struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
1282 struct fcgs_rcsid_req_s *rcsid =
1283 (struct fcgs_rcsid_req_s *) (cthdr + 1);
1284 u32 d_id = bfa_hton3b(FC_NAME_SERVER);
1285
1286 fc_gs_fchdr_build(fchs, d_id, s_id, 0);
1287 fc_gs_cthdr_build(cthdr, s_id, GS_RCS_ID);
1288
1289 memset(rcsid, 0, sizeof(struct fcgs_rcsid_req_s));
1290 rcsid->port_id = port_id;
1291 rcsid->cos = cos;
1292
1293 return sizeof(struct fcgs_rcsid_req_s) + sizeof(struct ct_hdr_s);
1294 }
1295
1296 u16
fc_rptid_build(struct fchs_s * fchs,void * pyld,u32 s_id,u32 port_id,u8 port_type)1297 fc_rptid_build(struct fchs_s *fchs, void *pyld, u32 s_id, u32 port_id,
1298 u8 port_type)
1299 {
1300 struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
1301 struct fcgs_rptid_req_s *rptid = (struct fcgs_rptid_req_s *)(cthdr + 1);
1302 u32 d_id = bfa_hton3b(FC_NAME_SERVER);
1303
1304 fc_gs_fchdr_build(fchs, d_id, s_id, 0);
1305 fc_gs_cthdr_build(cthdr, s_id, GS_RPT_ID);
1306
1307 memset(rptid, 0, sizeof(struct fcgs_rptid_req_s));
1308 rptid->port_id = port_id;
1309 rptid->port_type = port_type;
1310
1311 return sizeof(struct fcgs_rptid_req_s) + sizeof(struct ct_hdr_s);
1312 }
1313
1314 u16
fc_ganxt_build(struct fchs_s * fchs,void * pyld,u32 s_id,u32 port_id)1315 fc_ganxt_build(struct fchs_s *fchs, void *pyld, u32 s_id, u32 port_id)
1316 {
1317 struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
1318 struct fcgs_ganxt_req_s *ganxt = (struct fcgs_ganxt_req_s *)(cthdr + 1);
1319 u32 d_id = bfa_hton3b(FC_NAME_SERVER);
1320
1321 fc_gs_fchdr_build(fchs, d_id, s_id, 0);
1322 fc_gs_cthdr_build(cthdr, s_id, GS_GA_NXT);
1323
1324 memset(ganxt, 0, sizeof(struct fcgs_ganxt_req_s));
1325 ganxt->port_id = port_id;
1326
1327 return sizeof(struct ct_hdr_s) + sizeof(struct fcgs_ganxt_req_s);
1328 }
1329
1330 /*
1331 * Builds fc hdr and ct hdr for FDMI requests.
1332 */
1333 u16
fc_fdmi_reqhdr_build(struct fchs_s * fchs,void * pyld,u32 s_id,u16 cmd_code)1334 fc_fdmi_reqhdr_build(struct fchs_s *fchs, void *pyld, u32 s_id,
1335 u16 cmd_code)
1336 {
1337
1338 struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
1339 u32 d_id = bfa_hton3b(FC_MGMT_SERVER);
1340
1341 fc_gs_fchdr_build(fchs, d_id, s_id, 0);
1342 fc_gs_fdmi_cthdr_build(cthdr, s_id, cmd_code);
1343
1344 return sizeof(struct ct_hdr_s);
1345 }
1346
1347 /*
1348 * Given a FC4 Type, this function returns a fc4 type bitmask
1349 */
1350 void
fc_get_fc4type_bitmask(u8 fc4_type,u8 * bit_mask)1351 fc_get_fc4type_bitmask(u8 fc4_type, u8 *bit_mask)
1352 {
1353 u8 index;
1354 __be32 *ptr = (__be32 *) bit_mask;
1355 u32 type_value;
1356
1357 /*
1358 * @todo : Check for bitmask size
1359 */
1360
1361 index = fc4_type >> 5;
1362 type_value = 1 << (fc4_type % 32);
1363 ptr[index] = cpu_to_be32(type_value);
1364
1365 }
1366
1367 /*
1368 * GMAL Request
1369 */
1370 u16
fc_gmal_req_build(struct fchs_s * fchs,void * pyld,u32 s_id,wwn_t wwn)1371 fc_gmal_req_build(struct fchs_s *fchs, void *pyld, u32 s_id, wwn_t wwn)
1372 {
1373 struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
1374 fcgs_gmal_req_t *gmal = (fcgs_gmal_req_t *) (cthdr + 1);
1375 u32 d_id = bfa_hton3b(FC_MGMT_SERVER);
1376
1377 fc_gs_fchdr_build(fchs, d_id, s_id, 0);
1378 fc_gs_ms_cthdr_build(cthdr, s_id, GS_FC_GMAL_CMD,
1379 CT_GSSUBTYPE_CFGSERVER);
1380
1381 memset(gmal, 0, sizeof(fcgs_gmal_req_t));
1382 gmal->wwn = wwn;
1383
1384 return sizeof(struct ct_hdr_s) + sizeof(fcgs_gmal_req_t);
1385 }
1386
1387 /*
1388 * GFN (Get Fabric Name) Request
1389 */
1390 u16
fc_gfn_req_build(struct fchs_s * fchs,void * pyld,u32 s_id,wwn_t wwn)1391 fc_gfn_req_build(struct fchs_s *fchs, void *pyld, u32 s_id, wwn_t wwn)
1392 {
1393 struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
1394 fcgs_gfn_req_t *gfn = (fcgs_gfn_req_t *) (cthdr + 1);
1395 u32 d_id = bfa_hton3b(FC_MGMT_SERVER);
1396
1397 fc_gs_fchdr_build(fchs, d_id, s_id, 0);
1398 fc_gs_ms_cthdr_build(cthdr, s_id, GS_FC_GFN_CMD,
1399 CT_GSSUBTYPE_CFGSERVER);
1400
1401 memset(gfn, 0, sizeof(fcgs_gfn_req_t));
1402 gfn->wwn = wwn;
1403
1404 return sizeof(struct ct_hdr_s) + sizeof(fcgs_gfn_req_t);
1405 }
1406