bfa_fcbuild.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (c) 2005-2014 Brocade Communications Systems, Inc.
  4. * Copyright (c) 2014- QLogic Corporation.
  5. * All rights reserved
  6. * www.qlogic.com
  7. *
  8. * Linux driver for QLogic BR-series Fibre Channel Host Bus Adapter.
  9. */
  10. /*
  11. * fcbuild.c - FC link service frame building and parsing routines
  12. */
  13. #include "bfad_drv.h"
  14. #include "bfa_fcbuild.h"
  15. /*
  16. * static build functions
  17. */
  18. static void fc_els_rsp_build(struct fchs_s *fchs, u32 d_id, u32 s_id,
  19. __be16 ox_id);
  20. static void fc_bls_rsp_build(struct fchs_s *fchs, u32 d_id, u32 s_id,
  21. __be16 ox_id);
  22. static struct fchs_s fc_els_req_tmpl;
  23. static struct fchs_s fc_els_rsp_tmpl;
  24. static struct fchs_s fc_bls_req_tmpl;
  25. static struct fchs_s fc_bls_rsp_tmpl;
  26. static struct fc_ba_acc_s ba_acc_tmpl;
  27. static struct fc_logi_s plogi_tmpl;
  28. static struct fc_prli_s prli_tmpl;
  29. static struct fc_rrq_s rrq_tmpl;
  30. static struct fchs_s fcp_fchs_tmpl;
  31. void
  32. fcbuild_init(void)
  33. {
  34. /*
  35. * fc_els_req_tmpl
  36. */
  37. fc_els_req_tmpl.routing = FC_RTG_EXT_LINK;
  38. fc_els_req_tmpl.cat_info = FC_CAT_LD_REQUEST;
  39. fc_els_req_tmpl.type = FC_TYPE_ELS;
  40. fc_els_req_tmpl.f_ctl =
  41. bfa_hton3b(FCTL_SEQ_INI | FCTL_FS_EXCH | FCTL_END_SEQ |
  42. FCTL_SI_XFER);
  43. fc_els_req_tmpl.rx_id = FC_RXID_ANY;
  44. /*
  45. * fc_els_rsp_tmpl
  46. */
  47. fc_els_rsp_tmpl.routing = FC_RTG_EXT_LINK;
  48. fc_els_rsp_tmpl.cat_info = FC_CAT_LD_REPLY;
  49. fc_els_rsp_tmpl.type = FC_TYPE_ELS;
  50. fc_els_rsp_tmpl.f_ctl =
  51. bfa_hton3b(FCTL_EC_RESP | FCTL_SEQ_INI | FCTL_LS_EXCH |
  52. FCTL_END_SEQ | FCTL_SI_XFER);
  53. fc_els_rsp_tmpl.rx_id = FC_RXID_ANY;
  54. /*
  55. * fc_bls_req_tmpl
  56. */
  57. fc_bls_req_tmpl.routing = FC_RTG_BASIC_LINK;
  58. fc_bls_req_tmpl.type = FC_TYPE_BLS;
  59. fc_bls_req_tmpl.f_ctl = bfa_hton3b(FCTL_END_SEQ | FCTL_SI_XFER);
  60. fc_bls_req_tmpl.rx_id = FC_RXID_ANY;
  61. /*
  62. * fc_bls_rsp_tmpl
  63. */
  64. fc_bls_rsp_tmpl.routing = FC_RTG_BASIC_LINK;
  65. fc_bls_rsp_tmpl.cat_info = FC_CAT_BA_ACC;
  66. fc_bls_rsp_tmpl.type = FC_TYPE_BLS;
  67. fc_bls_rsp_tmpl.f_ctl =
  68. bfa_hton3b(FCTL_EC_RESP | FCTL_SEQ_INI | FCTL_LS_EXCH |
  69. FCTL_END_SEQ | FCTL_SI_XFER);
  70. fc_bls_rsp_tmpl.rx_id = FC_RXID_ANY;
  71. /*
  72. * ba_acc_tmpl
  73. */
  74. ba_acc_tmpl.seq_id_valid = 0;
  75. ba_acc_tmpl.low_seq_cnt = 0;
  76. ba_acc_tmpl.high_seq_cnt = 0xFFFF;
  77. /*
  78. * plogi_tmpl
  79. */
  80. plogi_tmpl.csp.verhi = FC_PH_VER_PH_3;
  81. plogi_tmpl.csp.verlo = FC_PH_VER_4_3;
  82. plogi_tmpl.csp.ciro = 0x1;
  83. plogi_tmpl.csp.cisc = 0x0;
  84. plogi_tmpl.csp.altbbcred = 0x0;
  85. plogi_tmpl.csp.conseq = cpu_to_be16(0x00FF);
  86. plogi_tmpl.csp.ro_bitmap = cpu_to_be16(0x0002);
  87. plogi_tmpl.csp.e_d_tov = cpu_to_be32(2000);
  88. plogi_tmpl.class3.class_valid = 1;
  89. plogi_tmpl.class3.sequential = 1;
  90. plogi_tmpl.class3.conseq = 0xFF;
  91. plogi_tmpl.class3.ospx = 1;
  92. /*
  93. * prli_tmpl
  94. */
  95. prli_tmpl.command = FC_ELS_PRLI;
  96. prli_tmpl.pglen = 0x10;
  97. prli_tmpl.pagebytes = cpu_to_be16(0x0014);
  98. prli_tmpl.parampage.type = FC_TYPE_FCP;
  99. prli_tmpl.parampage.imagepair = 1;
  100. prli_tmpl.parampage.servparams.rxrdisab = 1;
  101. /*
  102. * rrq_tmpl
  103. */
  104. rrq_tmpl.els_cmd.els_code = FC_ELS_RRQ;
  105. /*
  106. * fcp_struct fchs_s mpl
  107. */
  108. fcp_fchs_tmpl.routing = FC_RTG_FC4_DEV_DATA;
  109. fcp_fchs_tmpl.cat_info = FC_CAT_UNSOLICIT_CMD;
  110. fcp_fchs_tmpl.type = FC_TYPE_FCP;
  111. fcp_fchs_tmpl.f_ctl =
  112. bfa_hton3b(FCTL_FS_EXCH | FCTL_END_SEQ | FCTL_SI_XFER);
  113. fcp_fchs_tmpl.seq_id = 1;
  114. fcp_fchs_tmpl.rx_id = FC_RXID_ANY;
  115. }
  116. static void
  117. fc_gs_fchdr_build(struct fchs_s *fchs, u32 d_id, u32 s_id, u32 ox_id)
  118. {
  119. memset(fchs, 0, sizeof(struct fchs_s));
  120. fchs->routing = FC_RTG_FC4_DEV_DATA;
  121. fchs->cat_info = FC_CAT_UNSOLICIT_CTRL;
  122. fchs->type = FC_TYPE_SERVICES;
  123. fchs->f_ctl =
  124. bfa_hton3b(FCTL_SEQ_INI | FCTL_FS_EXCH | FCTL_END_SEQ |
  125. FCTL_SI_XFER);
  126. fchs->rx_id = FC_RXID_ANY;
  127. fchs->d_id = (d_id);
  128. fchs->s_id = (s_id);
  129. fchs->ox_id = cpu_to_be16(ox_id);
  130. /*
  131. * @todo no need to set ox_id for request
  132. * no need to set rx_id for response
  133. */
  134. }
  135. static void
  136. fc_gsresp_fchdr_build(struct fchs_s *fchs, u32 d_id, u32 s_id, u16 ox_id)
  137. {
  138. memset(fchs, 0, sizeof(struct fchs_s));
  139. fchs->routing = FC_RTG_FC4_DEV_DATA;
  140. fchs->cat_info = FC_CAT_SOLICIT_CTRL;
  141. fchs->type = FC_TYPE_SERVICES;
  142. fchs->f_ctl =
  143. bfa_hton3b(FCTL_EC_RESP | FCTL_SEQ_INI | FCTL_LS_EXCH |
  144. FCTL_END_SEQ | FCTL_SI_XFER);
  145. fchs->d_id = d_id;
  146. fchs->s_id = s_id;
  147. fchs->ox_id = ox_id;
  148. }
  149. void
  150. fc_els_req_build(struct fchs_s *fchs, u32 d_id, u32 s_id, __be16 ox_id)
  151. {
  152. memcpy(fchs, &fc_els_req_tmpl, sizeof(struct fchs_s));
  153. fchs->d_id = (d_id);
  154. fchs->s_id = (s_id);
  155. fchs->ox_id = cpu_to_be16(ox_id);
  156. }
  157. static void
  158. fc_els_rsp_build(struct fchs_s *fchs, u32 d_id, u32 s_id, __be16 ox_id)
  159. {
  160. memcpy(fchs, &fc_els_rsp_tmpl, sizeof(struct fchs_s));
  161. fchs->d_id = d_id;
  162. fchs->s_id = s_id;
  163. fchs->ox_id = ox_id;
  164. }
  165. static void
  166. fc_bls_rsp_build(struct fchs_s *fchs, u32 d_id, u32 s_id, __be16 ox_id)
  167. {
  168. memcpy(fchs, &fc_bls_rsp_tmpl, sizeof(struct fchs_s));
  169. fchs->d_id = d_id;
  170. fchs->s_id = s_id;
  171. fchs->ox_id = ox_id;
  172. }
  173. static u16
  174. fc_plogi_x_build(struct fchs_s *fchs, void *pld, u32 d_id, u32 s_id,
  175. __be16 ox_id, wwn_t port_name, wwn_t node_name,
  176. u16 pdu_size, u16 bb_cr, u8 els_code)
  177. {
  178. struct fc_logi_s *plogi = (struct fc_logi_s *) (pld);
  179. memcpy(plogi, &plogi_tmpl, sizeof(struct fc_logi_s));
  180. /* For FC AL bb_cr is 0 and altbbcred is 1 */
  181. if (!bb_cr)
  182. plogi->csp.altbbcred = 1;
  183. plogi->els_cmd.els_code = els_code;
  184. if (els_code == FC_ELS_PLOGI)
  185. fc_els_req_build(fchs, d_id, s_id, ox_id);
  186. else
  187. fc_els_rsp_build(fchs, d_id, s_id, ox_id);
  188. plogi->csp.rxsz = plogi->class3.rxsz = cpu_to_be16(pdu_size);
  189. plogi->csp.bbcred = cpu_to_be16(bb_cr);
  190. memcpy(&plogi->port_name, &port_name, sizeof(wwn_t));
  191. memcpy(&plogi->node_name, &node_name, sizeof(wwn_t));
  192. return sizeof(struct fc_logi_s);
  193. }
  194. u16
  195. fc_flogi_acc_build(struct fchs_s *fchs, struct fc_logi_s *flogi, u32 s_id,
  196. __be16 ox_id, wwn_t port_name, wwn_t node_name,
  197. u16 pdu_size, u16 local_bb_credits, u8 bb_scn)
  198. {
  199. u32 d_id = 0;
  200. u16 bbscn_rxsz = (bb_scn << 12) | pdu_size;
  201. memcpy(flogi, &plogi_tmpl, sizeof(struct fc_logi_s));
  202. fc_els_rsp_build(fchs, d_id, s_id, ox_id);
  203. flogi->els_cmd.els_code = FC_ELS_ACC;
  204. flogi->class3.rxsz = cpu_to_be16(pdu_size);
  205. flogi->csp.rxsz = cpu_to_be16(bbscn_rxsz); /* bb_scn/rxsz */
  206. flogi->port_name = port_name;
  207. flogi->node_name = node_name;
  208. flogi->csp.bbcred = cpu_to_be16(local_bb_credits);
  209. return sizeof(struct fc_logi_s);
  210. }
  211. u16
  212. fc_plogi_build(struct fchs_s *fchs, void *pld, u32 d_id, u32 s_id,
  213. u16 ox_id, wwn_t port_name, wwn_t node_name,
  214. u16 pdu_size, u16 bb_cr)
  215. {
  216. return fc_plogi_x_build(fchs, pld, d_id, s_id, ox_id, port_name,
  217. node_name, pdu_size, bb_cr, FC_ELS_PLOGI);
  218. }
  219. u16
  220. fc_plogi_acc_build(struct fchs_s *fchs, void *pld, u32 d_id, u32 s_id,
  221. u16 ox_id, wwn_t port_name, wwn_t node_name,
  222. u16 pdu_size, u16 bb_cr)
  223. {
  224. return fc_plogi_x_build(fchs, pld, d_id, s_id, ox_id, port_name,
  225. node_name, pdu_size, bb_cr, FC_ELS_ACC);
  226. }
  227. enum fc_parse_status
  228. fc_plogi_parse(struct fchs_s *fchs)
  229. {
  230. struct fc_logi_s *plogi = (struct fc_logi_s *) (fchs + 1);
  231. if (plogi->class3.class_valid != 1)
  232. return FC_PARSE_FAILURE;
  233. if ((be16_to_cpu(plogi->class3.rxsz) < FC_MIN_PDUSZ)
  234. || (be16_to_cpu(plogi->class3.rxsz) > FC_MAX_PDUSZ)
  235. || (plogi->class3.rxsz == 0))
  236. return FC_PARSE_FAILURE;
  237. return FC_PARSE_OK;
  238. }
  239. u16
  240. fc_prli_build(struct fchs_s *fchs, void *pld, u32 d_id, u32 s_id,
  241. u16 ox_id)
  242. {
  243. struct fc_prli_s *prli = (struct fc_prli_s *) (pld);
  244. fc_els_req_build(fchs, d_id, s_id, ox_id);
  245. memcpy(prli, &prli_tmpl, sizeof(struct fc_prli_s));
  246. prli->command = FC_ELS_PRLI;
  247. prli->parampage.servparams.initiator = 1;
  248. prli->parampage.servparams.retry = 1;
  249. prli->parampage.servparams.rec_support = 1;
  250. prli->parampage.servparams.task_retry_id = 0;
  251. prli->parampage.servparams.confirm = 1;
  252. return sizeof(struct fc_prli_s);
  253. }
  254. u16
  255. fc_prli_acc_build(struct fchs_s *fchs, void *pld, u32 d_id, u32 s_id,
  256. __be16 ox_id, enum bfa_lport_role role)
  257. {
  258. struct fc_prli_s *prli = (struct fc_prli_s *) (pld);
  259. fc_els_rsp_build(fchs, d_id, s_id, ox_id);
  260. memcpy(prli, &prli_tmpl, sizeof(struct fc_prli_s));
  261. prli->command = FC_ELS_ACC;
  262. prli->parampage.servparams.initiator = 1;
  263. prli->parampage.rspcode = FC_PRLI_ACC_XQTD;
  264. return sizeof(struct fc_prli_s);
  265. }
  266. enum fc_parse_status
  267. fc_prli_rsp_parse(struct fc_prli_s *prli, int len)
  268. {
  269. if (len < sizeof(struct fc_prli_s))
  270. return FC_PARSE_FAILURE;
  271. if (prli->command != FC_ELS_ACC)
  272. return FC_PARSE_FAILURE;
  273. if ((prli->parampage.rspcode != FC_PRLI_ACC_XQTD)
  274. && (prli->parampage.rspcode != FC_PRLI_ACC_PREDEF_IMG))
  275. return FC_PARSE_FAILURE;
  276. if (prli->parampage.servparams.target != 1)
  277. return FC_PARSE_FAILURE;
  278. return FC_PARSE_OK;
  279. }
  280. u16
  281. fc_logo_build(struct fchs_s *fchs, struct fc_logo_s *logo, u32 d_id, u32 s_id,
  282. u16 ox_id, wwn_t port_name)
  283. {
  284. fc_els_req_build(fchs, d_id, s_id, ox_id);
  285. memset(logo, '\0', sizeof(struct fc_logo_s));
  286. logo->els_cmd.els_code = FC_ELS_LOGO;
  287. logo->nport_id = (s_id);
  288. logo->orig_port_name = port_name;
  289. return sizeof(struct fc_logo_s);
  290. }
  291. static u16
  292. fc_adisc_x_build(struct fchs_s *fchs, struct fc_adisc_s *adisc, u32 d_id,
  293. u32 s_id, __be16 ox_id, wwn_t port_name,
  294. wwn_t node_name, u8 els_code)
  295. {
  296. memset(adisc, '\0', sizeof(struct fc_adisc_s));
  297. adisc->els_cmd.els_code = els_code;
  298. if (els_code == FC_ELS_ADISC)
  299. fc_els_req_build(fchs, d_id, s_id, ox_id);
  300. else
  301. fc_els_rsp_build(fchs, d_id, s_id, ox_id);
  302. adisc->orig_HA = 0;
  303. adisc->orig_port_name = port_name;
  304. adisc->orig_node_name = node_name;
  305. adisc->nport_id = (s_id);
  306. return sizeof(struct fc_adisc_s);
  307. }
  308. u16
  309. fc_adisc_build(struct fchs_s *fchs, struct fc_adisc_s *adisc, u32 d_id,
  310. u32 s_id, __be16 ox_id, wwn_t port_name, wwn_t node_name)
  311. {
  312. return fc_adisc_x_build(fchs, adisc, d_id, s_id, ox_id, port_name,
  313. node_name, FC_ELS_ADISC);
  314. }
  315. u16
  316. fc_adisc_acc_build(struct fchs_s *fchs, struct fc_adisc_s *adisc, u32 d_id,
  317. u32 s_id, __be16 ox_id, wwn_t port_name,
  318. wwn_t node_name)
  319. {
  320. return fc_adisc_x_build(fchs, adisc, d_id, s_id, ox_id, port_name,
  321. node_name, FC_ELS_ACC);
  322. }
  323. enum fc_parse_status
  324. fc_adisc_rsp_parse(struct fc_adisc_s *adisc, int len, wwn_t port_name,
  325. wwn_t node_name)
  326. {
  327. if (len < sizeof(struct fc_adisc_s))
  328. return FC_PARSE_FAILURE;
  329. if (adisc->els_cmd.els_code != FC_ELS_ACC)
  330. return FC_PARSE_FAILURE;
  331. if (!wwn_is_equal(adisc->orig_port_name, port_name))
  332. return FC_PARSE_FAILURE;
  333. return FC_PARSE_OK;
  334. }
  335. u16
  336. fc_logo_acc_build(struct fchs_s *fchs, void *pld, u32 d_id, u32 s_id,
  337. __be16 ox_id)
  338. {
  339. struct fc_els_cmd_s *acc = pld;
  340. fc_els_rsp_build(fchs, d_id, s_id, ox_id);
  341. memset(acc, 0, sizeof(struct fc_els_cmd_s));
  342. acc->els_code = FC_ELS_ACC;
  343. return sizeof(struct fc_els_cmd_s);
  344. }
  345. u16
  346. fc_ls_rjt_build(struct fchs_s *fchs, struct fc_ls_rjt_s *ls_rjt, u32 d_id,
  347. u32 s_id, __be16 ox_id, u8 reason_code,
  348. u8 reason_code_expl)
  349. {
  350. fc_els_rsp_build(fchs, d_id, s_id, ox_id);
  351. memset(ls_rjt, 0, sizeof(struct fc_ls_rjt_s));
  352. ls_rjt->els_cmd.els_code = FC_ELS_LS_RJT;
  353. ls_rjt->reason_code = reason_code;
  354. ls_rjt->reason_code_expl = reason_code_expl;
  355. ls_rjt->vendor_unique = 0x00;
  356. return sizeof(struct fc_ls_rjt_s);
  357. }
  358. u16
  359. fc_ba_acc_build(struct fchs_s *fchs, struct fc_ba_acc_s *ba_acc, u32 d_id,
  360. u32 s_id, __be16 ox_id, u16 rx_id)
  361. {
  362. fc_bls_rsp_build(fchs, d_id, s_id, ox_id);
  363. memcpy(ba_acc, &ba_acc_tmpl, sizeof(struct fc_ba_acc_s));
  364. fchs->rx_id = rx_id;
  365. ba_acc->ox_id = fchs->ox_id;
  366. ba_acc->rx_id = fchs->rx_id;
  367. return sizeof(struct fc_ba_acc_s);
  368. }
  369. u16
  370. fc_ls_acc_build(struct fchs_s *fchs, struct fc_els_cmd_s *els_cmd, u32 d_id,
  371. u32 s_id, __be16 ox_id)
  372. {
  373. fc_els_rsp_build(fchs, d_id, s_id, ox_id);
  374. memset(els_cmd, 0, sizeof(struct fc_els_cmd_s));
  375. els_cmd->els_code = FC_ELS_ACC;
  376. return sizeof(struct fc_els_cmd_s);
  377. }
  378. int
  379. fc_logout_params_pages(struct fchs_s *fc_frame, u8 els_code)
  380. {
  381. int num_pages = 0;
  382. struct fc_prlo_s *prlo;
  383. struct fc_tprlo_s *tprlo;
  384. if (els_code == FC_ELS_PRLO) {
  385. prlo = (struct fc_prlo_s *) (fc_frame + 1);
  386. num_pages = (be16_to_cpu(prlo->payload_len) - 4) / 16;
  387. } else {
  388. tprlo = (struct fc_tprlo_s *) (fc_frame + 1);
  389. num_pages = (be16_to_cpu(tprlo->payload_len) - 4) / 16;
  390. }
  391. return num_pages;
  392. }
  393. u16
  394. fc_prlo_acc_build(struct fchs_s *fchs, struct fc_prlo_acc_s *prlo_acc, u32 d_id,
  395. u32 s_id, __be16 ox_id, int num_pages)
  396. {
  397. int page;
  398. fc_els_rsp_build(fchs, d_id, s_id, ox_id);
  399. memset(prlo_acc, 0, (num_pages * 16) + 4);
  400. prlo_acc->command = FC_ELS_ACC;
  401. prlo_acc->page_len = 0x10;
  402. prlo_acc->payload_len = cpu_to_be16((num_pages * 16) + 4);
  403. for (page = 0; page < num_pages; page++) {
  404. prlo_acc->prlo_acc_params[page].opa_valid = 0;
  405. prlo_acc->prlo_acc_params[page].rpa_valid = 0;
  406. prlo_acc->prlo_acc_params[page].fc4type_csp = FC_TYPE_FCP;
  407. prlo_acc->prlo_acc_params[page].orig_process_assc = 0;
  408. prlo_acc->prlo_acc_params[page].resp_process_assc = 0;
  409. }
  410. return be16_to_cpu(prlo_acc->payload_len);
  411. }
  412. u16
  413. fc_rnid_acc_build(struct fchs_s *fchs, struct fc_rnid_acc_s *rnid_acc, u32 d_id,
  414. u32 s_id, __be16 ox_id, u32 data_format,
  415. struct fc_rnid_common_id_data_s *common_id_data,
  416. struct fc_rnid_general_topology_data_s *gen_topo_data)
  417. {
  418. memset(rnid_acc, 0, sizeof(struct fc_rnid_acc_s));
  419. fc_els_rsp_build(fchs, d_id, s_id, ox_id);
  420. rnid_acc->els_cmd.els_code = FC_ELS_ACC;
  421. rnid_acc->node_id_data_format = data_format;
  422. rnid_acc->common_id_data_length =
  423. sizeof(struct fc_rnid_common_id_data_s);
  424. rnid_acc->common_id_data = *common_id_data;
  425. if (data_format == RNID_NODEID_DATA_FORMAT_DISCOVERY) {
  426. rnid_acc->specific_id_data_length =
  427. sizeof(struct fc_rnid_general_topology_data_s);
  428. rnid_acc->gen_topology_data = *gen_topo_data;
  429. return sizeof(struct fc_rnid_acc_s);
  430. } else {
  431. return sizeof(struct fc_rnid_acc_s) -
  432. sizeof(struct fc_rnid_general_topology_data_s);
  433. }
  434. }
  435. u16
  436. fc_rpsc2_build(struct fchs_s *fchs, struct fc_rpsc2_cmd_s *rpsc2, u32 d_id,
  437. u32 s_id, u32 *pid_list, u16 npids)
  438. {
  439. u32 dctlr_id = FC_DOMAIN_CTRLR(bfa_hton3b(d_id));
  440. int i = 0;
  441. fc_els_req_build(fchs, bfa_hton3b(dctlr_id), s_id, 0);
  442. memset(rpsc2, 0, sizeof(struct fc_rpsc2_cmd_s));
  443. rpsc2->els_cmd.els_code = FC_ELS_RPSC;
  444. rpsc2->token = cpu_to_be32(FC_BRCD_TOKEN);
  445. rpsc2->num_pids = cpu_to_be16(npids);
  446. for (i = 0; i < npids; i++)
  447. rpsc2->pid_list[i].pid = pid_list[i];
  448. return sizeof(struct fc_rpsc2_cmd_s) + ((npids - 1) * (sizeof(u32)));
  449. }
  450. u16
  451. fc_rpsc_acc_build(struct fchs_s *fchs, struct fc_rpsc_acc_s *rpsc_acc,
  452. u32 d_id, u32 s_id, __be16 ox_id,
  453. struct fc_rpsc_speed_info_s *oper_speed)
  454. {
  455. memset(rpsc_acc, 0, sizeof(struct fc_rpsc_acc_s));
  456. fc_els_rsp_build(fchs, d_id, s_id, ox_id);
  457. rpsc_acc->command = FC_ELS_ACC;
  458. rpsc_acc->num_entries = cpu_to_be16(1);
  459. rpsc_acc->speed_info[0].port_speed_cap =
  460. cpu_to_be16(oper_speed->port_speed_cap);
  461. rpsc_acc->speed_info[0].port_op_speed =
  462. cpu_to_be16(oper_speed->port_op_speed);
  463. return sizeof(struct fc_rpsc_acc_s);
  464. }
  465. static void
  466. fc_gs_cthdr_build(struct ct_hdr_s *cthdr, u32 s_id, u16 cmd_code)
  467. {
  468. memset(cthdr, 0, sizeof(struct ct_hdr_s));
  469. cthdr->rev_id = CT_GS3_REVISION;
  470. cthdr->gs_type = CT_GSTYPE_DIRSERVICE;
  471. cthdr->gs_sub_type = CT_GSSUBTYPE_NAMESERVER;
  472. cthdr->cmd_rsp_code = cpu_to_be16(cmd_code);
  473. }
  474. static void
  475. fc_gs_fdmi_cthdr_build(struct ct_hdr_s *cthdr, u32 s_id, u16 cmd_code)
  476. {
  477. memset(cthdr, 0, sizeof(struct ct_hdr_s));
  478. cthdr->rev_id = CT_GS3_REVISION;
  479. cthdr->gs_type = CT_GSTYPE_MGMTSERVICE;
  480. cthdr->gs_sub_type = CT_GSSUBTYPE_HBA_MGMTSERVER;
  481. cthdr->cmd_rsp_code = cpu_to_be16(cmd_code);
  482. }
  483. static void
  484. fc_gs_ms_cthdr_build(struct ct_hdr_s *cthdr, u32 s_id, u16 cmd_code,
  485. u8 sub_type)
  486. {
  487. memset(cthdr, 0, sizeof(struct ct_hdr_s));
  488. cthdr->rev_id = CT_GS3_REVISION;
  489. cthdr->gs_type = CT_GSTYPE_MGMTSERVICE;
  490. cthdr->gs_sub_type = sub_type;
  491. cthdr->cmd_rsp_code = cpu_to_be16(cmd_code);
  492. }
  493. u16
  494. fc_gidpn_build(struct fchs_s *fchs, void *pyld, u32 s_id, u16 ox_id,
  495. wwn_t port_name)
  496. {
  497. struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
  498. struct fcgs_gidpn_req_s *gidpn = (struct fcgs_gidpn_req_s *)(cthdr + 1);
  499. u32 d_id = bfa_hton3b(FC_NAME_SERVER);
  500. fc_gs_fchdr_build(fchs, d_id, s_id, ox_id);
  501. fc_gs_cthdr_build(cthdr, s_id, GS_GID_PN);
  502. memset(gidpn, 0, sizeof(struct fcgs_gidpn_req_s));
  503. gidpn->port_name = port_name;
  504. return sizeof(struct fcgs_gidpn_req_s) + sizeof(struct ct_hdr_s);
  505. }
  506. u16
  507. fc_gpnid_build(struct fchs_s *fchs, void *pyld, u32 s_id, u16 ox_id,
  508. u32 port_id)
  509. {
  510. struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
  511. fcgs_gpnid_req_t *gpnid = (fcgs_gpnid_req_t *) (cthdr + 1);
  512. u32 d_id = bfa_hton3b(FC_NAME_SERVER);
  513. fc_gs_fchdr_build(fchs, d_id, s_id, ox_id);
  514. fc_gs_cthdr_build(cthdr, s_id, GS_GPN_ID);
  515. memset(gpnid, 0, sizeof(fcgs_gpnid_req_t));
  516. gpnid->dap = port_id;
  517. return sizeof(fcgs_gpnid_req_t) + sizeof(struct ct_hdr_s);
  518. }
  519. u16
  520. fc_gs_rjt_build(struct fchs_s *fchs, struct ct_hdr_s *cthdr,
  521. u32 d_id, u32 s_id, u16 ox_id, u8 reason_code,
  522. u8 reason_code_expl)
  523. {
  524. fc_gsresp_fchdr_build(fchs, d_id, s_id, ox_id);
  525. cthdr->cmd_rsp_code = cpu_to_be16(CT_RSP_REJECT);
  526. cthdr->rev_id = CT_GS3_REVISION;
  527. cthdr->reason_code = reason_code;
  528. cthdr->exp_code = reason_code_expl;
  529. return sizeof(struct ct_hdr_s);
  530. }
  531. u16
  532. fc_scr_build(struct fchs_s *fchs, struct fc_scr_s *scr,
  533. u8 set_br_reg, u32 s_id, u16 ox_id)
  534. {
  535. u32 d_id = bfa_hton3b(FC_FABRIC_CONTROLLER);
  536. fc_els_req_build(fchs, d_id, s_id, ox_id);
  537. memset(scr, 0, sizeof(struct fc_scr_s));
  538. scr->command = FC_ELS_SCR;
  539. scr->reg_func = FC_SCR_REG_FUNC_FULL;
  540. if (set_br_reg)
  541. scr->vu_reg_func = FC_VU_SCR_REG_FUNC_FABRIC_NAME_CHANGE;
  542. return sizeof(struct fc_scr_s);
  543. }
  544. u16
  545. fc_rftid_build(struct fchs_s *fchs, void *pyld, u32 s_id, u16 ox_id,
  546. enum bfa_lport_role roles)
  547. {
  548. struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
  549. struct fcgs_rftid_req_s *rftid = (struct fcgs_rftid_req_s *)(cthdr + 1);
  550. u32 type_value, d_id = bfa_hton3b(FC_NAME_SERVER);
  551. u8 index;
  552. fc_gs_fchdr_build(fchs, d_id, s_id, ox_id);
  553. fc_gs_cthdr_build(cthdr, s_id, GS_RFT_ID);
  554. memset(rftid, 0, sizeof(struct fcgs_rftid_req_s));
  555. rftid->dap = s_id;
  556. /* By default, FCP FC4 Type is registered */
  557. index = FC_TYPE_FCP >> 5;
  558. type_value = 1 << (FC_TYPE_FCP % 32);
  559. rftid->fc4_type[index] = cpu_to_be32(type_value);
  560. return sizeof(struct fcgs_rftid_req_s) + sizeof(struct ct_hdr_s);
  561. }
  562. u16
  563. fc_rffid_build(struct fchs_s *fchs, void *pyld, u32 s_id, u16 ox_id,
  564. u8 fc4_type, u8 fc4_ftrs)
  565. {
  566. struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
  567. struct fcgs_rffid_req_s *rffid = (struct fcgs_rffid_req_s *)(cthdr + 1);
  568. u32 d_id = bfa_hton3b(FC_NAME_SERVER);
  569. fc_gs_fchdr_build(fchs, d_id, s_id, ox_id);
  570. fc_gs_cthdr_build(cthdr, s_id, GS_RFF_ID);
  571. memset(rffid, 0, sizeof(struct fcgs_rffid_req_s));
  572. rffid->dap = s_id;
  573. rffid->fc4ftr_bits = fc4_ftrs;
  574. rffid->fc4_type = fc4_type;
  575. return sizeof(struct fcgs_rffid_req_s) + sizeof(struct ct_hdr_s);
  576. }
  577. u16
  578. fc_rspnid_build(struct fchs_s *fchs, void *pyld, u32 s_id, u16 ox_id,
  579. u8 *name)
  580. {
  581. struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
  582. struct fcgs_rspnid_req_s *rspnid =
  583. (struct fcgs_rspnid_req_s *)(cthdr + 1);
  584. u32 d_id = bfa_hton3b(FC_NAME_SERVER);
  585. fc_gs_fchdr_build(fchs, d_id, s_id, ox_id);
  586. fc_gs_cthdr_build(cthdr, s_id, GS_RSPN_ID);
  587. memset(rspnid, 0, sizeof(struct fcgs_rspnid_req_s));
  588. rspnid->dap = s_id;
  589. strscpy(rspnid->spn, name, sizeof(rspnid->spn));
  590. rspnid->spn_len = (u8) strlen(rspnid->spn);
  591. return sizeof(struct fcgs_rspnid_req_s) + sizeof(struct ct_hdr_s);
  592. }
  593. u16
  594. fc_rsnn_nn_build(struct fchs_s *fchs, void *pyld, u32 s_id,
  595. wwn_t node_name, u8 *name)
  596. {
  597. struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
  598. struct fcgs_rsnn_nn_req_s *rsnn_nn =
  599. (struct fcgs_rsnn_nn_req_s *) (cthdr + 1);
  600. u32 d_id = bfa_hton3b(FC_NAME_SERVER);
  601. fc_gs_fchdr_build(fchs, d_id, s_id, 0);
  602. fc_gs_cthdr_build(cthdr, s_id, GS_RSNN_NN);
  603. memset(rsnn_nn, 0, sizeof(struct fcgs_rsnn_nn_req_s));
  604. rsnn_nn->node_name = node_name;
  605. strscpy(rsnn_nn->snn, name, sizeof(rsnn_nn->snn));
  606. rsnn_nn->snn_len = (u8) strlen(rsnn_nn->snn);
  607. return sizeof(struct fcgs_rsnn_nn_req_s) + sizeof(struct ct_hdr_s);
  608. }
  609. u16
  610. fc_gid_ft_build(struct fchs_s *fchs, void *pyld, u32 s_id, u8 fc4_type)
  611. {
  612. struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
  613. struct fcgs_gidft_req_s *gidft = (struct fcgs_gidft_req_s *)(cthdr + 1);
  614. u32 d_id = bfa_hton3b(FC_NAME_SERVER);
  615. fc_gs_fchdr_build(fchs, d_id, s_id, 0);
  616. fc_gs_cthdr_build(cthdr, s_id, GS_GID_FT);
  617. memset(gidft, 0, sizeof(struct fcgs_gidft_req_s));
  618. gidft->fc4_type = fc4_type;
  619. gidft->domain_id = 0;
  620. gidft->area_id = 0;
  621. return sizeof(struct fcgs_gidft_req_s) + sizeof(struct ct_hdr_s);
  622. }
  623. u16
  624. fc_rnnid_build(struct fchs_s *fchs, void *pyld, u32 s_id, u32 port_id,
  625. wwn_t node_name)
  626. {
  627. struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
  628. struct fcgs_rnnid_req_s *rnnid = (struct fcgs_rnnid_req_s *)(cthdr + 1);
  629. u32 d_id = bfa_hton3b(FC_NAME_SERVER);
  630. fc_gs_fchdr_build(fchs, d_id, s_id, 0);
  631. fc_gs_cthdr_build(cthdr, s_id, GS_RNN_ID);
  632. memset(rnnid, 0, sizeof(struct fcgs_rnnid_req_s));
  633. rnnid->port_id = port_id;
  634. rnnid->node_name = node_name;
  635. return sizeof(struct fcgs_rnnid_req_s) + sizeof(struct ct_hdr_s);
  636. }
  637. /*
  638. * Builds fc hdr and ct hdr for FDMI requests.
  639. */
  640. u16
  641. fc_fdmi_reqhdr_build(struct fchs_s *fchs, void *pyld, u32 s_id,
  642. u16 cmd_code)
  643. {
  644. struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
  645. u32 d_id = bfa_hton3b(FC_MGMT_SERVER);
  646. fc_gs_fchdr_build(fchs, d_id, s_id, 0);
  647. fc_gs_fdmi_cthdr_build(cthdr, s_id, cmd_code);
  648. return sizeof(struct ct_hdr_s);
  649. }
  650. /*
  651. * Given a FC4 Type, this function returns a fc4 type bitmask
  652. */
  653. void
  654. fc_get_fc4type_bitmask(u8 fc4_type, u8 *bit_mask)
  655. {
  656. u8 index;
  657. __be32 *ptr = (__be32 *) bit_mask;
  658. u32 type_value;
  659. /*
  660. * @todo : Check for bitmask size
  661. */
  662. index = fc4_type >> 5;
  663. type_value = 1 << (fc4_type % 32);
  664. ptr[index] = cpu_to_be32(type_value);
  665. }
  666. /*
  667. * GMAL Request
  668. */
  669. u16
  670. fc_gmal_req_build(struct fchs_s *fchs, void *pyld, u32 s_id, wwn_t wwn)
  671. {
  672. struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
  673. fcgs_gmal_req_t *gmal = (fcgs_gmal_req_t *) (cthdr + 1);
  674. u32 d_id = bfa_hton3b(FC_MGMT_SERVER);
  675. fc_gs_fchdr_build(fchs, d_id, s_id, 0);
  676. fc_gs_ms_cthdr_build(cthdr, s_id, GS_FC_GMAL_CMD,
  677. CT_GSSUBTYPE_CFGSERVER);
  678. memset(gmal, 0, sizeof(fcgs_gmal_req_t));
  679. gmal->wwn = wwn;
  680. return sizeof(struct ct_hdr_s) + sizeof(fcgs_gmal_req_t);
  681. }
  682. /*
  683. * GFN (Get Fabric Name) Request
  684. */
  685. u16
  686. fc_gfn_req_build(struct fchs_s *fchs, void *pyld, u32 s_id, wwn_t wwn)
  687. {
  688. struct ct_hdr_s *cthdr = (struct ct_hdr_s *) pyld;
  689. fcgs_gfn_req_t *gfn = (fcgs_gfn_req_t *) (cthdr + 1);
  690. u32 d_id = bfa_hton3b(FC_MGMT_SERVER);
  691. fc_gs_fchdr_build(fchs, d_id, s_id, 0);
  692. fc_gs_ms_cthdr_build(cthdr, s_id, GS_FC_GFN_CMD,
  693. CT_GSSUBTYPE_CFGSERVER);
  694. memset(gfn, 0, sizeof(fcgs_gfn_req_t));
  695. gfn->wwn = wwn;
  696. return sizeof(struct ct_hdr_s) + sizeof(fcgs_gfn_req_t);
  697. }