Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 1 | /* |
| 2 | * This file is part of the Chelsio FCoE driver for Linux. |
| 3 | * |
| 4 | * Copyright (c) 2008-2012 Chelsio Communications, Inc. All rights reserved. |
| 5 | * |
| 6 | * This software is available to you under a choice of one of two |
| 7 | * licenses. You may choose to be licensed under the terms of the GNU |
| 8 | * General Public License (GPL) Version 2, available from the file |
| 9 | * COPYING in the main directory of this source tree, or the |
| 10 | * OpenIB.org BSD license below: |
| 11 | * |
| 12 | * Redistribution and use in source and binary forms, with or |
| 13 | * without modification, are permitted provided that the following |
| 14 | * conditions are met: |
| 15 | * |
| 16 | * - Redistributions of source code must retain the above |
| 17 | * copyright notice, this list of conditions and the following |
| 18 | * disclaimer. |
| 19 | * |
| 20 | * - Redistributions in binary form must reproduce the above |
| 21 | * copyright notice, this list of conditions and the following |
| 22 | * disclaimer in the documentation and/or other materials |
| 23 | * provided with the distribution. |
| 24 | * |
| 25 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, |
| 26 | * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF |
| 27 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND |
| 28 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS |
| 29 | * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN |
| 30 | * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN |
| 31 | * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE |
| 32 | * SOFTWARE. |
| 33 | */ |
| 34 | |
| 35 | #include <linux/kernel.h> |
| 36 | #include <linux/delay.h> |
| 37 | #include <linux/slab.h> |
| 38 | #include <linux/utsname.h> |
| 39 | #include <scsi/scsi_device.h> |
| 40 | #include <scsi/scsi_transport_fc.h> |
| 41 | #include <asm/unaligned.h> |
| 42 | #include <scsi/fc/fc_els.h> |
| 43 | #include <scsi/fc/fc_fs.h> |
| 44 | #include <scsi/fc/fc_gs.h> |
| 45 | #include <scsi/fc/fc_ms.h> |
| 46 | |
| 47 | #include "csio_hw.h" |
| 48 | #include "csio_mb.h" |
| 49 | #include "csio_lnode.h" |
| 50 | #include "csio_rnode.h" |
| 51 | |
| 52 | int csio_fcoe_rnodes = 1024; |
| 53 | int csio_fdmi_enable = 1; |
| 54 | |
| 55 | #define PORT_ID_PTR(_x) ((uint8_t *)(&_x) + 1) |
| 56 | |
| 57 | /* Lnode SM declarations */ |
| 58 | static void csio_lns_uninit(struct csio_lnode *, enum csio_ln_ev); |
| 59 | static void csio_lns_online(struct csio_lnode *, enum csio_ln_ev); |
| 60 | static void csio_lns_ready(struct csio_lnode *, enum csio_ln_ev); |
| 61 | static void csio_lns_offline(struct csio_lnode *, enum csio_ln_ev); |
| 62 | |
| 63 | static int csio_ln_mgmt_submit_req(struct csio_ioreq *, |
| 64 | void (*io_cbfn) (struct csio_hw *, struct csio_ioreq *), |
| 65 | enum fcoe_cmn_type, struct csio_dma_buf *, uint32_t); |
| 66 | |
| 67 | /* LN event mapping */ |
| 68 | static enum csio_ln_ev fwevt_to_lnevt[] = { |
| 69 | CSIO_LNE_NONE, /* None */ |
| 70 | CSIO_LNE_NONE, /* PLOGI_ACC_RCVD */ |
| 71 | CSIO_LNE_NONE, /* PLOGI_RJT_RCVD */ |
| 72 | CSIO_LNE_NONE, /* PLOGI_RCVD */ |
| 73 | CSIO_LNE_NONE, /* PLOGO_RCVD */ |
| 74 | CSIO_LNE_NONE, /* PRLI_ACC_RCVD */ |
| 75 | CSIO_LNE_NONE, /* PRLI_RJT_RCVD */ |
| 76 | CSIO_LNE_NONE, /* PRLI_RCVD */ |
| 77 | CSIO_LNE_NONE, /* PRLO_RCVD */ |
| 78 | CSIO_LNE_NONE, /* NPORT_ID_CHGD */ |
| 79 | CSIO_LNE_LOGO, /* FLOGO_RCVD */ |
| 80 | CSIO_LNE_LOGO, /* CLR_VIRT_LNK_RCVD */ |
| 81 | CSIO_LNE_FAB_INIT_DONE,/* FLOGI_ACC_RCVD */ |
| 82 | CSIO_LNE_NONE, /* FLOGI_RJT_RCVD */ |
| 83 | CSIO_LNE_FAB_INIT_DONE,/* FDISC_ACC_RCVD */ |
| 84 | CSIO_LNE_NONE, /* FDISC_RJT_RCVD */ |
| 85 | CSIO_LNE_NONE, /* FLOGI_TMO_MAX_RETRY */ |
| 86 | CSIO_LNE_NONE, /* IMPL_LOGO_ADISC_ACC */ |
| 87 | CSIO_LNE_NONE, /* IMPL_LOGO_ADISC_RJT */ |
| 88 | CSIO_LNE_NONE, /* IMPL_LOGO_ADISC_CNFLT */ |
| 89 | CSIO_LNE_NONE, /* PRLI_TMO */ |
| 90 | CSIO_LNE_NONE, /* ADISC_TMO */ |
| 91 | CSIO_LNE_NONE, /* RSCN_DEV_LOST */ |
| 92 | CSIO_LNE_NONE, /* SCR_ACC_RCVD */ |
| 93 | CSIO_LNE_NONE, /* ADISC_RJT_RCVD */ |
| 94 | CSIO_LNE_NONE, /* LOGO_SNT */ |
| 95 | CSIO_LNE_NONE, /* PROTO_ERR_IMPL_LOGO */ |
| 96 | }; |
| 97 | |
| 98 | #define CSIO_FWE_TO_LNE(_evt) ((_evt > PROTO_ERR_IMPL_LOGO) ? \ |
| 99 | CSIO_LNE_NONE : \ |
| 100 | fwevt_to_lnevt[_evt]) |
| 101 | |
| 102 | #define csio_ct_rsp(cp) (((struct fc_ct_hdr *)cp)->ct_cmd) |
| 103 | #define csio_ct_reason(cp) (((struct fc_ct_hdr *)cp)->ct_reason) |
| 104 | #define csio_ct_expl(cp) (((struct fc_ct_hdr *)cp)->ct_explan) |
| 105 | #define csio_ct_get_pld(cp) ((void *)(((uint8_t *)cp) + FC_CT_HDR_LEN)) |
| 106 | |
| 107 | /* |
| 108 | * csio_ln_match_by_portid - lookup lnode using given portid. |
| 109 | * @hw: HW module |
| 110 | * @portid: port-id. |
| 111 | * |
| 112 | * If found, returns lnode matching given portid otherwise returns NULL. |
| 113 | */ |
| 114 | static struct csio_lnode * |
| 115 | csio_ln_lookup_by_portid(struct csio_hw *hw, uint8_t portid) |
| 116 | { |
Colin Ian King | 52797a1 | 2018-01-24 14:58:01 +0000 | [diff] [blame] | 117 | struct csio_lnode *ln; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 118 | struct list_head *tmp; |
| 119 | |
| 120 | /* Match siblings lnode with portid */ |
| 121 | list_for_each(tmp, &hw->sln_head) { |
| 122 | ln = (struct csio_lnode *) tmp; |
| 123 | if (ln->portid == portid) |
| 124 | return ln; |
| 125 | } |
| 126 | |
| 127 | return NULL; |
| 128 | } |
| 129 | |
| 130 | /* |
| 131 | * csio_ln_lookup_by_vnpi - Lookup lnode using given vnp id. |
| 132 | * @hw - HW module |
| 133 | * @vnpi - vnp index. |
| 134 | * Returns - If found, returns lnode matching given vnp id |
| 135 | * otherwise returns NULL. |
| 136 | */ |
| 137 | static struct csio_lnode * |
| 138 | csio_ln_lookup_by_vnpi(struct csio_hw *hw, uint32_t vnp_id) |
| 139 | { |
| 140 | struct list_head *tmp1, *tmp2; |
| 141 | struct csio_lnode *sln = NULL, *cln = NULL; |
| 142 | |
| 143 | if (list_empty(&hw->sln_head)) { |
| 144 | CSIO_INC_STATS(hw, n_lnlkup_miss); |
| 145 | return NULL; |
| 146 | } |
| 147 | /* Traverse sibling lnodes */ |
| 148 | list_for_each(tmp1, &hw->sln_head) { |
| 149 | sln = (struct csio_lnode *) tmp1; |
| 150 | |
| 151 | /* Match sibling lnode */ |
| 152 | if (sln->vnp_flowid == vnp_id) |
| 153 | return sln; |
| 154 | |
| 155 | if (list_empty(&sln->cln_head)) |
| 156 | continue; |
| 157 | |
| 158 | /* Traverse children lnodes */ |
| 159 | list_for_each(tmp2, &sln->cln_head) { |
| 160 | cln = (struct csio_lnode *) tmp2; |
| 161 | |
| 162 | if (cln->vnp_flowid == vnp_id) |
| 163 | return cln; |
| 164 | } |
| 165 | } |
| 166 | CSIO_INC_STATS(hw, n_lnlkup_miss); |
| 167 | return NULL; |
| 168 | } |
| 169 | |
| 170 | /** |
| 171 | * csio_lnode_lookup_by_wwpn - Lookup lnode using given wwpn. |
| 172 | * @hw: HW module. |
| 173 | * @wwpn: WWPN. |
| 174 | * |
| 175 | * If found, returns lnode matching given wwpn, returns NULL otherwise. |
| 176 | */ |
| 177 | struct csio_lnode * |
| 178 | csio_lnode_lookup_by_wwpn(struct csio_hw *hw, uint8_t *wwpn) |
| 179 | { |
| 180 | struct list_head *tmp1, *tmp2; |
| 181 | struct csio_lnode *sln = NULL, *cln = NULL; |
| 182 | |
| 183 | if (list_empty(&hw->sln_head)) { |
| 184 | CSIO_INC_STATS(hw, n_lnlkup_miss); |
| 185 | return NULL; |
| 186 | } |
| 187 | /* Traverse sibling lnodes */ |
| 188 | list_for_each(tmp1, &hw->sln_head) { |
| 189 | sln = (struct csio_lnode *) tmp1; |
| 190 | |
| 191 | /* Match sibling lnode */ |
| 192 | if (!memcmp(csio_ln_wwpn(sln), wwpn, 8)) |
| 193 | return sln; |
| 194 | |
| 195 | if (list_empty(&sln->cln_head)) |
| 196 | continue; |
| 197 | |
| 198 | /* Traverse children lnodes */ |
| 199 | list_for_each(tmp2, &sln->cln_head) { |
| 200 | cln = (struct csio_lnode *) tmp2; |
| 201 | |
| 202 | if (!memcmp(csio_ln_wwpn(cln), wwpn, 8)) |
| 203 | return cln; |
| 204 | } |
| 205 | } |
| 206 | return NULL; |
| 207 | } |
| 208 | |
| 209 | /* FDMI */ |
| 210 | static void |
| 211 | csio_fill_ct_iu(void *buf, uint8_t type, uint8_t sub_type, uint16_t op) |
| 212 | { |
| 213 | struct fc_ct_hdr *cmd = (struct fc_ct_hdr *)buf; |
| 214 | cmd->ct_rev = FC_CT_REV; |
| 215 | cmd->ct_fs_type = type; |
| 216 | cmd->ct_fs_subtype = sub_type; |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 217 | cmd->ct_cmd = htons(op); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 218 | } |
| 219 | |
| 220 | static int |
| 221 | csio_hostname(uint8_t *buf, size_t buf_len) |
| 222 | { |
| 223 | if (snprintf(buf, buf_len, "%s", init_utsname()->nodename) > 0) |
| 224 | return 0; |
| 225 | return -1; |
| 226 | } |
| 227 | |
| 228 | static int |
| 229 | csio_osname(uint8_t *buf, size_t buf_len) |
| 230 | { |
| 231 | if (snprintf(buf, buf_len, "%s %s %s", |
| 232 | init_utsname()->sysname, |
| 233 | init_utsname()->release, |
| 234 | init_utsname()->version) > 0) |
| 235 | return 0; |
| 236 | |
| 237 | return -1; |
| 238 | } |
| 239 | |
| 240 | static inline void |
Kees Cook | 42c335f | 2017-05-09 15:34:44 -0700 | [diff] [blame] | 241 | csio_append_attrib(uint8_t **ptr, uint16_t type, void *val, size_t val_len) |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 242 | { |
Kees Cook | 42c335f | 2017-05-09 15:34:44 -0700 | [diff] [blame] | 243 | uint16_t len; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 244 | struct fc_fdmi_attr_entry *ae = (struct fc_fdmi_attr_entry *)*ptr; |
Kees Cook | 42c335f | 2017-05-09 15:34:44 -0700 | [diff] [blame] | 245 | |
| 246 | if (WARN_ON(val_len > U16_MAX)) |
| 247 | return; |
| 248 | |
| 249 | len = val_len; |
| 250 | |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 251 | ae->type = htons(type); |
| 252 | len += 4; /* includes attribute type and length */ |
| 253 | len = (len + 3) & ~3; /* should be multiple of 4 bytes */ |
| 254 | ae->len = htons(len); |
Kees Cook | 42c335f | 2017-05-09 15:34:44 -0700 | [diff] [blame] | 255 | memcpy(ae->value, val, val_len); |
| 256 | if (len > val_len) |
| 257 | memset(ae->value + val_len, 0, len - val_len); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 258 | *ptr += len; |
| 259 | } |
| 260 | |
| 261 | /* |
| 262 | * csio_ln_fdmi_done - FDMI registeration completion |
| 263 | * @hw: HW context |
| 264 | * @fdmi_req: fdmi request |
| 265 | */ |
| 266 | static void |
| 267 | csio_ln_fdmi_done(struct csio_hw *hw, struct csio_ioreq *fdmi_req) |
| 268 | { |
| 269 | void *cmd; |
| 270 | struct csio_lnode *ln = fdmi_req->lnode; |
| 271 | |
| 272 | if (fdmi_req->wr_status != FW_SUCCESS) { |
| 273 | csio_ln_dbg(ln, "WR error:%x in processing fdmi rpa cmd\n", |
| 274 | fdmi_req->wr_status); |
| 275 | CSIO_INC_STATS(ln, n_fdmi_err); |
| 276 | } |
| 277 | |
| 278 | cmd = fdmi_req->dma_buf.vaddr; |
| 279 | if (ntohs(csio_ct_rsp(cmd)) != FC_FS_ACC) { |
| 280 | csio_ln_dbg(ln, "fdmi rpa cmd rejected reason %x expl %x\n", |
| 281 | csio_ct_reason(cmd), csio_ct_expl(cmd)); |
| 282 | } |
| 283 | } |
| 284 | |
| 285 | /* |
| 286 | * csio_ln_fdmi_rhba_cbfn - RHBA completion |
| 287 | * @hw: HW context |
| 288 | * @fdmi_req: fdmi request |
| 289 | */ |
| 290 | static void |
| 291 | csio_ln_fdmi_rhba_cbfn(struct csio_hw *hw, struct csio_ioreq *fdmi_req) |
| 292 | { |
| 293 | void *cmd; |
| 294 | uint8_t *pld; |
| 295 | uint32_t len = 0; |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 296 | __be32 val; |
| 297 | __be16 mfs; |
| 298 | uint32_t numattrs = 0; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 299 | struct csio_lnode *ln = fdmi_req->lnode; |
| 300 | struct fs_fdmi_attrs *attrib_blk; |
| 301 | struct fc_fdmi_port_name *port_name; |
| 302 | uint8_t buf[64]; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 303 | uint8_t *fc4_type; |
Dan Carpenter | d6c9b31 | 2019-10-19 11:59:13 +0300 | [diff] [blame] | 304 | unsigned long flags; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 305 | |
| 306 | if (fdmi_req->wr_status != FW_SUCCESS) { |
| 307 | csio_ln_dbg(ln, "WR error:%x in processing fdmi rhba cmd\n", |
| 308 | fdmi_req->wr_status); |
| 309 | CSIO_INC_STATS(ln, n_fdmi_err); |
| 310 | } |
| 311 | |
| 312 | cmd = fdmi_req->dma_buf.vaddr; |
| 313 | if (ntohs(csio_ct_rsp(cmd)) != FC_FS_ACC) { |
| 314 | csio_ln_dbg(ln, "fdmi rhba cmd rejected reason %x expl %x\n", |
| 315 | csio_ct_reason(cmd), csio_ct_expl(cmd)); |
| 316 | } |
| 317 | |
| 318 | if (!csio_is_rnode_ready(fdmi_req->rnode)) { |
| 319 | CSIO_INC_STATS(ln, n_fdmi_err); |
| 320 | return; |
| 321 | } |
| 322 | |
| 323 | /* Prepare CT hdr for RPA cmd */ |
| 324 | memset(cmd, 0, FC_CT_HDR_LEN); |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 325 | csio_fill_ct_iu(cmd, FC_FST_MGMT, FC_FDMI_SUBTYPE, FC_FDMI_RPA); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 326 | |
| 327 | /* Prepare RPA payload */ |
| 328 | pld = (uint8_t *)csio_ct_get_pld(cmd); |
| 329 | port_name = (struct fc_fdmi_port_name *)pld; |
| 330 | memcpy(&port_name->portname, csio_ln_wwpn(ln), 8); |
| 331 | pld += sizeof(*port_name); |
| 332 | |
| 333 | /* Start appending Port attributes */ |
| 334 | attrib_blk = (struct fs_fdmi_attrs *)pld; |
| 335 | attrib_blk->numattrs = 0; |
| 336 | len += sizeof(attrib_blk->numattrs); |
| 337 | pld += sizeof(attrib_blk->numattrs); |
| 338 | |
| 339 | fc4_type = &buf[0]; |
| 340 | memset(fc4_type, 0, FC_FDMI_PORT_ATTR_FC4TYPES_LEN); |
| 341 | fc4_type[2] = 1; |
| 342 | fc4_type[7] = 1; |
| 343 | csio_append_attrib(&pld, FC_FDMI_PORT_ATTR_FC4TYPES, |
| 344 | fc4_type, FC_FDMI_PORT_ATTR_FC4TYPES_LEN); |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 345 | numattrs++; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 346 | val = htonl(FC_PORTSPEED_1GBIT | FC_PORTSPEED_10GBIT); |
| 347 | csio_append_attrib(&pld, FC_FDMI_PORT_ATTR_SUPPORTEDSPEED, |
Kees Cook | 42c335f | 2017-05-09 15:34:44 -0700 | [diff] [blame] | 348 | &val, |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 349 | FC_FDMI_PORT_ATTR_SUPPORTEDSPEED_LEN); |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 350 | numattrs++; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 351 | |
| 352 | if (hw->pport[ln->portid].link_speed == FW_PORT_CAP_SPEED_1G) |
| 353 | val = htonl(FC_PORTSPEED_1GBIT); |
| 354 | else if (hw->pport[ln->portid].link_speed == FW_PORT_CAP_SPEED_10G) |
| 355 | val = htonl(FC_PORTSPEED_10GBIT); |
Varun Prakash | e1735d9 | 2018-03-11 18:02:13 +0530 | [diff] [blame] | 356 | else if (hw->pport[ln->portid].link_speed == FW_PORT_CAP32_SPEED_25G) |
| 357 | val = htonl(FC_PORTSPEED_25GBIT); |
| 358 | else if (hw->pport[ln->portid].link_speed == FW_PORT_CAP32_SPEED_40G) |
| 359 | val = htonl(FC_PORTSPEED_40GBIT); |
| 360 | else if (hw->pport[ln->portid].link_speed == FW_PORT_CAP32_SPEED_50G) |
| 361 | val = htonl(FC_PORTSPEED_50GBIT); |
| 362 | else if (hw->pport[ln->portid].link_speed == FW_PORT_CAP32_SPEED_100G) |
| 363 | val = htonl(FC_PORTSPEED_100GBIT); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 364 | else |
| 365 | val = htonl(CSIO_HBA_PORTSPEED_UNKNOWN); |
| 366 | csio_append_attrib(&pld, FC_FDMI_PORT_ATTR_CURRENTPORTSPEED, |
Kees Cook | 42c335f | 2017-05-09 15:34:44 -0700 | [diff] [blame] | 367 | &val, FC_FDMI_PORT_ATTR_CURRENTPORTSPEED_LEN); |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 368 | numattrs++; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 369 | |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 370 | mfs = ln->ln_sparm.csp.sp_bb_data; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 371 | csio_append_attrib(&pld, FC_FDMI_PORT_ATTR_MAXFRAMESIZE, |
Kees Cook | 42c335f | 2017-05-09 15:34:44 -0700 | [diff] [blame] | 372 | &mfs, sizeof(mfs)); |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 373 | numattrs++; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 374 | |
| 375 | strcpy(buf, "csiostor"); |
| 376 | csio_append_attrib(&pld, FC_FDMI_PORT_ATTR_OSDEVICENAME, buf, |
Kees Cook | 42c335f | 2017-05-09 15:34:44 -0700 | [diff] [blame] | 377 | strlen(buf)); |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 378 | numattrs++; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 379 | |
| 380 | if (!csio_hostname(buf, sizeof(buf))) { |
| 381 | csio_append_attrib(&pld, FC_FDMI_PORT_ATTR_HOSTNAME, |
Kees Cook | 42c335f | 2017-05-09 15:34:44 -0700 | [diff] [blame] | 382 | buf, strlen(buf)); |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 383 | numattrs++; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 384 | } |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 385 | attrib_blk->numattrs = htonl(numattrs); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 386 | len = (uint32_t)(pld - (uint8_t *)cmd); |
| 387 | |
| 388 | /* Submit FDMI RPA request */ |
Dan Carpenter | d6c9b31 | 2019-10-19 11:59:13 +0300 | [diff] [blame] | 389 | spin_lock_irqsave(&hw->lock, flags); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 390 | if (csio_ln_mgmt_submit_req(fdmi_req, csio_ln_fdmi_done, |
| 391 | FCOE_CT, &fdmi_req->dma_buf, len)) { |
| 392 | CSIO_INC_STATS(ln, n_fdmi_err); |
| 393 | csio_ln_dbg(ln, "Failed to issue fdmi rpa req\n"); |
| 394 | } |
Dan Carpenter | d6c9b31 | 2019-10-19 11:59:13 +0300 | [diff] [blame] | 395 | spin_unlock_irqrestore(&hw->lock, flags); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 396 | } |
| 397 | |
| 398 | /* |
| 399 | * csio_ln_fdmi_dprt_cbfn - DPRT completion |
| 400 | * @hw: HW context |
| 401 | * @fdmi_req: fdmi request |
| 402 | */ |
| 403 | static void |
| 404 | csio_ln_fdmi_dprt_cbfn(struct csio_hw *hw, struct csio_ioreq *fdmi_req) |
| 405 | { |
| 406 | void *cmd; |
| 407 | uint8_t *pld; |
| 408 | uint32_t len = 0; |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 409 | uint32_t numattrs = 0; |
| 410 | __be32 maxpayload = htonl(65536); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 411 | struct fc_fdmi_hba_identifier *hbaid; |
| 412 | struct csio_lnode *ln = fdmi_req->lnode; |
| 413 | struct fc_fdmi_rpl *reg_pl; |
| 414 | struct fs_fdmi_attrs *attrib_blk; |
| 415 | uint8_t buf[64]; |
Dan Carpenter | d6c9b31 | 2019-10-19 11:59:13 +0300 | [diff] [blame] | 416 | unsigned long flags; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 417 | |
| 418 | if (fdmi_req->wr_status != FW_SUCCESS) { |
| 419 | csio_ln_dbg(ln, "WR error:%x in processing fdmi dprt cmd\n", |
| 420 | fdmi_req->wr_status); |
| 421 | CSIO_INC_STATS(ln, n_fdmi_err); |
| 422 | } |
| 423 | |
| 424 | if (!csio_is_rnode_ready(fdmi_req->rnode)) { |
| 425 | CSIO_INC_STATS(ln, n_fdmi_err); |
| 426 | return; |
| 427 | } |
| 428 | cmd = fdmi_req->dma_buf.vaddr; |
| 429 | if (ntohs(csio_ct_rsp(cmd)) != FC_FS_ACC) { |
| 430 | csio_ln_dbg(ln, "fdmi dprt cmd rejected reason %x expl %x\n", |
| 431 | csio_ct_reason(cmd), csio_ct_expl(cmd)); |
| 432 | } |
| 433 | |
| 434 | /* Prepare CT hdr for RHBA cmd */ |
| 435 | memset(cmd, 0, FC_CT_HDR_LEN); |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 436 | csio_fill_ct_iu(cmd, FC_FST_MGMT, FC_FDMI_SUBTYPE, FC_FDMI_RHBA); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 437 | len = FC_CT_HDR_LEN; |
| 438 | |
| 439 | /* Prepare RHBA payload */ |
| 440 | pld = (uint8_t *)csio_ct_get_pld(cmd); |
| 441 | hbaid = (struct fc_fdmi_hba_identifier *)pld; |
| 442 | memcpy(&hbaid->id, csio_ln_wwpn(ln), 8); /* HBA identifer */ |
| 443 | pld += sizeof(*hbaid); |
| 444 | |
| 445 | /* Register one port per hba */ |
| 446 | reg_pl = (struct fc_fdmi_rpl *)pld; |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 447 | reg_pl->numport = htonl(1); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 448 | memcpy(®_pl->port[0].portname, csio_ln_wwpn(ln), 8); |
| 449 | pld += sizeof(*reg_pl); |
| 450 | |
| 451 | /* Start appending HBA attributes hba */ |
| 452 | attrib_blk = (struct fs_fdmi_attrs *)pld; |
| 453 | attrib_blk->numattrs = 0; |
| 454 | len += sizeof(attrib_blk->numattrs); |
| 455 | pld += sizeof(attrib_blk->numattrs); |
| 456 | |
| 457 | csio_append_attrib(&pld, FC_FDMI_HBA_ATTR_NODENAME, csio_ln_wwnn(ln), |
| 458 | FC_FDMI_HBA_ATTR_NODENAME_LEN); |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 459 | numattrs++; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 460 | |
| 461 | memset(buf, 0, sizeof(buf)); |
| 462 | |
| 463 | strcpy(buf, "Chelsio Communications"); |
| 464 | csio_append_attrib(&pld, FC_FDMI_HBA_ATTR_MANUFACTURER, buf, |
Kees Cook | 42c335f | 2017-05-09 15:34:44 -0700 | [diff] [blame] | 465 | strlen(buf)); |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 466 | numattrs++; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 467 | csio_append_attrib(&pld, FC_FDMI_HBA_ATTR_SERIALNUMBER, |
Kees Cook | 42c335f | 2017-05-09 15:34:44 -0700 | [diff] [blame] | 468 | hw->vpd.sn, sizeof(hw->vpd.sn)); |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 469 | numattrs++; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 470 | csio_append_attrib(&pld, FC_FDMI_HBA_ATTR_MODEL, hw->vpd.id, |
Kees Cook | 42c335f | 2017-05-09 15:34:44 -0700 | [diff] [blame] | 471 | sizeof(hw->vpd.id)); |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 472 | numattrs++; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 473 | csio_append_attrib(&pld, FC_FDMI_HBA_ATTR_MODELDESCRIPTION, |
Kees Cook | 42c335f | 2017-05-09 15:34:44 -0700 | [diff] [blame] | 474 | hw->model_desc, strlen(hw->model_desc)); |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 475 | numattrs++; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 476 | csio_append_attrib(&pld, FC_FDMI_HBA_ATTR_HARDWAREVERSION, |
Kees Cook | 42c335f | 2017-05-09 15:34:44 -0700 | [diff] [blame] | 477 | hw->hw_ver, sizeof(hw->hw_ver)); |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 478 | numattrs++; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 479 | csio_append_attrib(&pld, FC_FDMI_HBA_ATTR_FIRMWAREVERSION, |
Kees Cook | 42c335f | 2017-05-09 15:34:44 -0700 | [diff] [blame] | 480 | hw->fwrev_str, strlen(hw->fwrev_str)); |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 481 | numattrs++; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 482 | |
| 483 | if (!csio_osname(buf, sizeof(buf))) { |
| 484 | csio_append_attrib(&pld, FC_FDMI_HBA_ATTR_OSNAMEVERSION, |
Kees Cook | 42c335f | 2017-05-09 15:34:44 -0700 | [diff] [blame] | 485 | buf, strlen(buf)); |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 486 | numattrs++; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 487 | } |
| 488 | |
| 489 | csio_append_attrib(&pld, FC_FDMI_HBA_ATTR_MAXCTPAYLOAD, |
Kees Cook | 42c335f | 2017-05-09 15:34:44 -0700 | [diff] [blame] | 490 | &maxpayload, FC_FDMI_HBA_ATTR_MAXCTPAYLOAD_LEN); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 491 | len = (uint32_t)(pld - (uint8_t *)cmd); |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 492 | numattrs++; |
| 493 | attrib_blk->numattrs = htonl(numattrs); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 494 | |
| 495 | /* Submit FDMI RHBA request */ |
Dan Carpenter | d6c9b31 | 2019-10-19 11:59:13 +0300 | [diff] [blame] | 496 | spin_lock_irqsave(&hw->lock, flags); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 497 | if (csio_ln_mgmt_submit_req(fdmi_req, csio_ln_fdmi_rhba_cbfn, |
| 498 | FCOE_CT, &fdmi_req->dma_buf, len)) { |
| 499 | CSIO_INC_STATS(ln, n_fdmi_err); |
| 500 | csio_ln_dbg(ln, "Failed to issue fdmi rhba req\n"); |
| 501 | } |
Dan Carpenter | d6c9b31 | 2019-10-19 11:59:13 +0300 | [diff] [blame] | 502 | spin_unlock_irqrestore(&hw->lock, flags); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 503 | } |
| 504 | |
| 505 | /* |
| 506 | * csio_ln_fdmi_dhba_cbfn - DHBA completion |
| 507 | * @hw: HW context |
| 508 | * @fdmi_req: fdmi request |
| 509 | */ |
| 510 | static void |
| 511 | csio_ln_fdmi_dhba_cbfn(struct csio_hw *hw, struct csio_ioreq *fdmi_req) |
| 512 | { |
| 513 | struct csio_lnode *ln = fdmi_req->lnode; |
| 514 | void *cmd; |
| 515 | struct fc_fdmi_port_name *port_name; |
| 516 | uint32_t len; |
Dan Carpenter | d6c9b31 | 2019-10-19 11:59:13 +0300 | [diff] [blame] | 517 | unsigned long flags; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 518 | |
| 519 | if (fdmi_req->wr_status != FW_SUCCESS) { |
| 520 | csio_ln_dbg(ln, "WR error:%x in processing fdmi dhba cmd\n", |
| 521 | fdmi_req->wr_status); |
| 522 | CSIO_INC_STATS(ln, n_fdmi_err); |
| 523 | } |
| 524 | |
| 525 | if (!csio_is_rnode_ready(fdmi_req->rnode)) { |
| 526 | CSIO_INC_STATS(ln, n_fdmi_err); |
| 527 | return; |
| 528 | } |
| 529 | cmd = fdmi_req->dma_buf.vaddr; |
| 530 | if (ntohs(csio_ct_rsp(cmd)) != FC_FS_ACC) { |
| 531 | csio_ln_dbg(ln, "fdmi dhba cmd rejected reason %x expl %x\n", |
| 532 | csio_ct_reason(cmd), csio_ct_expl(cmd)); |
| 533 | } |
| 534 | |
| 535 | /* Send FDMI cmd to de-register any Port attributes if registered |
| 536 | * before |
| 537 | */ |
| 538 | |
| 539 | /* Prepare FDMI DPRT cmd */ |
| 540 | memset(cmd, 0, FC_CT_HDR_LEN); |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 541 | csio_fill_ct_iu(cmd, FC_FST_MGMT, FC_FDMI_SUBTYPE, FC_FDMI_DPRT); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 542 | len = FC_CT_HDR_LEN; |
| 543 | port_name = (struct fc_fdmi_port_name *)csio_ct_get_pld(cmd); |
| 544 | memcpy(&port_name->portname, csio_ln_wwpn(ln), 8); |
| 545 | len += sizeof(*port_name); |
| 546 | |
| 547 | /* Submit FDMI request */ |
Dan Carpenter | d6c9b31 | 2019-10-19 11:59:13 +0300 | [diff] [blame] | 548 | spin_lock_irqsave(&hw->lock, flags); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 549 | if (csio_ln_mgmt_submit_req(fdmi_req, csio_ln_fdmi_dprt_cbfn, |
| 550 | FCOE_CT, &fdmi_req->dma_buf, len)) { |
| 551 | CSIO_INC_STATS(ln, n_fdmi_err); |
| 552 | csio_ln_dbg(ln, "Failed to issue fdmi dprt req\n"); |
| 553 | } |
Dan Carpenter | d6c9b31 | 2019-10-19 11:59:13 +0300 | [diff] [blame] | 554 | spin_unlock_irqrestore(&hw->lock, flags); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 555 | } |
| 556 | |
| 557 | /** |
| 558 | * csio_ln_fdmi_start - Start an FDMI request. |
| 559 | * @ln: lnode |
| 560 | * @context: session context |
| 561 | * |
| 562 | * Issued with lock held. |
| 563 | */ |
| 564 | int |
| 565 | csio_ln_fdmi_start(struct csio_lnode *ln, void *context) |
| 566 | { |
| 567 | struct csio_ioreq *fdmi_req; |
| 568 | struct csio_rnode *fdmi_rn = (struct csio_rnode *)context; |
| 569 | void *cmd; |
| 570 | struct fc_fdmi_hba_identifier *hbaid; |
| 571 | uint32_t len; |
| 572 | |
| 573 | if (!(ln->flags & CSIO_LNF_FDMI_ENABLE)) |
| 574 | return -EPROTONOSUPPORT; |
| 575 | |
| 576 | if (!csio_is_rnode_ready(fdmi_rn)) |
| 577 | CSIO_INC_STATS(ln, n_fdmi_err); |
| 578 | |
| 579 | /* Send FDMI cmd to de-register any HBA attributes if registered |
| 580 | * before |
| 581 | */ |
| 582 | |
| 583 | fdmi_req = ln->mgmt_req; |
| 584 | fdmi_req->lnode = ln; |
| 585 | fdmi_req->rnode = fdmi_rn; |
| 586 | |
| 587 | /* Prepare FDMI DHBA cmd */ |
| 588 | cmd = fdmi_req->dma_buf.vaddr; |
| 589 | memset(cmd, 0, FC_CT_HDR_LEN); |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 590 | csio_fill_ct_iu(cmd, FC_FST_MGMT, FC_FDMI_SUBTYPE, FC_FDMI_DHBA); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 591 | len = FC_CT_HDR_LEN; |
| 592 | |
| 593 | hbaid = (struct fc_fdmi_hba_identifier *)csio_ct_get_pld(cmd); |
| 594 | memcpy(&hbaid->id, csio_ln_wwpn(ln), 8); |
| 595 | len += sizeof(*hbaid); |
| 596 | |
| 597 | /* Submit FDMI request */ |
| 598 | if (csio_ln_mgmt_submit_req(fdmi_req, csio_ln_fdmi_dhba_cbfn, |
| 599 | FCOE_CT, &fdmi_req->dma_buf, len)) { |
| 600 | CSIO_INC_STATS(ln, n_fdmi_err); |
| 601 | csio_ln_dbg(ln, "Failed to issue fdmi dhba req\n"); |
| 602 | } |
| 603 | |
| 604 | return 0; |
| 605 | } |
| 606 | |
| 607 | /* |
| 608 | * csio_ln_vnp_read_cbfn - vnp read completion handler. |
| 609 | * @hw: HW lnode |
| 610 | * @cbfn: Completion handler. |
| 611 | * |
| 612 | * Reads vnp response and updates ln parameters. |
| 613 | */ |
| 614 | static void |
| 615 | csio_ln_vnp_read_cbfn(struct csio_hw *hw, struct csio_mb *mbp) |
| 616 | { |
| 617 | struct csio_lnode *ln = ((struct csio_lnode *)mbp->priv); |
| 618 | struct fw_fcoe_vnp_cmd *rsp = (struct fw_fcoe_vnp_cmd *)(mbp->mb); |
| 619 | struct fc_els_csp *csp; |
| 620 | struct fc_els_cssp *clsp; |
| 621 | enum fw_retval retval; |
Dan Carpenter | f4875d5 | 2021-10-06 10:32:43 +0300 | [diff] [blame] | 622 | __be32 nport_id = 0; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 623 | |
Hariprasad Shenai | e2ac962 | 2014-11-07 09:35:25 +0530 | [diff] [blame] | 624 | retval = FW_CMD_RETVAL_G(ntohl(rsp->alloc_to_len16)); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 625 | if (retval != FW_SUCCESS) { |
| 626 | csio_err(hw, "FCOE VNP read cmd returned error:0x%x\n", retval); |
| 627 | mempool_free(mbp, hw->mb_mempool); |
| 628 | return; |
| 629 | } |
| 630 | |
| 631 | spin_lock_irq(&hw->lock); |
| 632 | |
| 633 | memcpy(ln->mac, rsp->vnport_mac, sizeof(ln->mac)); |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 634 | memcpy(&nport_id, &rsp->vnport_mac[3], sizeof(uint8_t)*3); |
| 635 | ln->nport_id = ntohl(nport_id); |
| 636 | ln->nport_id = ln->nport_id >> 8; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 637 | |
| 638 | /* Update WWNs */ |
| 639 | /* |
| 640 | * This may look like a duplication of what csio_fcoe_enable_link() |
| 641 | * does, but is absolutely necessary if the vnpi changes between |
| 642 | * a FCOE LINK UP and FCOE LINK DOWN. |
| 643 | */ |
| 644 | memcpy(csio_ln_wwnn(ln), rsp->vnport_wwnn, 8); |
| 645 | memcpy(csio_ln_wwpn(ln), rsp->vnport_wwpn, 8); |
| 646 | |
| 647 | /* Copy common sparam */ |
| 648 | csp = (struct fc_els_csp *)rsp->cmn_srv_parms; |
| 649 | ln->ln_sparm.csp.sp_hi_ver = csp->sp_hi_ver; |
| 650 | ln->ln_sparm.csp.sp_lo_ver = csp->sp_lo_ver; |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 651 | ln->ln_sparm.csp.sp_bb_cred = csp->sp_bb_cred; |
| 652 | ln->ln_sparm.csp.sp_features = csp->sp_features; |
| 653 | ln->ln_sparm.csp.sp_bb_data = csp->sp_bb_data; |
| 654 | ln->ln_sparm.csp.sp_r_a_tov = csp->sp_r_a_tov; |
| 655 | ln->ln_sparm.csp.sp_e_d_tov = csp->sp_e_d_tov; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 656 | |
| 657 | /* Copy word 0 & word 1 of class sparam */ |
| 658 | clsp = (struct fc_els_cssp *)rsp->clsp_word_0_1; |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 659 | ln->ln_sparm.clsp[2].cp_class = clsp->cp_class; |
| 660 | ln->ln_sparm.clsp[2].cp_init = clsp->cp_init; |
| 661 | ln->ln_sparm.clsp[2].cp_recip = clsp->cp_recip; |
| 662 | ln->ln_sparm.clsp[2].cp_rdfs = clsp->cp_rdfs; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 663 | |
| 664 | spin_unlock_irq(&hw->lock); |
| 665 | |
| 666 | mempool_free(mbp, hw->mb_mempool); |
| 667 | |
| 668 | /* Send an event to update local attribs */ |
| 669 | csio_lnode_async_event(ln, CSIO_LN_FC_ATTRIB_UPDATE); |
| 670 | } |
| 671 | |
| 672 | /* |
| 673 | * csio_ln_vnp_read - Read vnp params. |
| 674 | * @ln: lnode |
| 675 | * @cbfn: Completion handler. |
| 676 | * |
| 677 | * Issued with lock held. |
| 678 | */ |
| 679 | static int |
| 680 | csio_ln_vnp_read(struct csio_lnode *ln, |
| 681 | void (*cbfn) (struct csio_hw *, struct csio_mb *)) |
| 682 | { |
| 683 | struct csio_hw *hw = ln->hwp; |
| 684 | struct csio_mb *mbp; |
| 685 | |
| 686 | /* Allocate Mbox request */ |
| 687 | mbp = mempool_alloc(hw->mb_mempool, GFP_ATOMIC); |
| 688 | if (!mbp) { |
| 689 | CSIO_INC_STATS(hw, n_err_nomem); |
| 690 | return -ENOMEM; |
| 691 | } |
| 692 | |
| 693 | /* Prepare VNP Command */ |
| 694 | csio_fcoe_vnp_read_init_mb(ln, mbp, |
| 695 | CSIO_MB_DEFAULT_TMO, |
| 696 | ln->fcf_flowid, |
| 697 | ln->vnp_flowid, |
| 698 | cbfn); |
| 699 | |
| 700 | /* Issue MBOX cmd */ |
| 701 | if (csio_mb_issue(hw, mbp)) { |
| 702 | csio_err(hw, "Failed to issue mbox FCoE VNP command\n"); |
| 703 | mempool_free(mbp, hw->mb_mempool); |
| 704 | return -EINVAL; |
| 705 | } |
| 706 | |
| 707 | return 0; |
| 708 | } |
| 709 | |
| 710 | /* |
| 711 | * csio_fcoe_enable_link - Enable fcoe link. |
| 712 | * @ln: lnode |
| 713 | * @enable: enable/disable |
| 714 | * Issued with lock held. |
| 715 | * Issues mbox cmd to bring up FCOE link on port associated with given ln. |
| 716 | */ |
| 717 | static int |
| 718 | csio_fcoe_enable_link(struct csio_lnode *ln, bool enable) |
| 719 | { |
| 720 | struct csio_hw *hw = ln->hwp; |
| 721 | struct csio_mb *mbp; |
| 722 | enum fw_retval retval; |
| 723 | uint8_t portid; |
| 724 | uint8_t sub_op; |
| 725 | struct fw_fcoe_link_cmd *lcmd; |
| 726 | int i; |
| 727 | |
| 728 | mbp = mempool_alloc(hw->mb_mempool, GFP_ATOMIC); |
| 729 | if (!mbp) { |
| 730 | CSIO_INC_STATS(hw, n_err_nomem); |
| 731 | return -ENOMEM; |
| 732 | } |
| 733 | |
| 734 | portid = ln->portid; |
| 735 | sub_op = enable ? FCOE_LINK_UP : FCOE_LINK_DOWN; |
| 736 | |
| 737 | csio_dbg(hw, "bringing FCOE LINK %s on Port:%d\n", |
| 738 | sub_op ? "UP" : "DOWN", portid); |
| 739 | |
| 740 | csio_write_fcoe_link_cond_init_mb(ln, mbp, CSIO_MB_DEFAULT_TMO, |
| 741 | portid, sub_op, 0, 0, 0, NULL); |
| 742 | |
| 743 | if (csio_mb_issue(hw, mbp)) { |
| 744 | csio_err(hw, "failed to issue FCOE LINK cmd on port[%d]\n", |
| 745 | portid); |
| 746 | mempool_free(mbp, hw->mb_mempool); |
| 747 | return -EINVAL; |
| 748 | } |
| 749 | |
| 750 | retval = csio_mb_fw_retval(mbp); |
| 751 | if (retval != FW_SUCCESS) { |
| 752 | csio_err(hw, |
| 753 | "FCOE LINK %s cmd on port[%d] failed with " |
| 754 | "ret:x%x\n", sub_op ? "UP" : "DOWN", portid, retval); |
| 755 | mempool_free(mbp, hw->mb_mempool); |
| 756 | return -EINVAL; |
| 757 | } |
| 758 | |
| 759 | if (!enable) |
| 760 | goto out; |
| 761 | |
| 762 | lcmd = (struct fw_fcoe_link_cmd *)mbp->mb; |
| 763 | |
| 764 | memcpy(csio_ln_wwnn(ln), lcmd->vnport_wwnn, 8); |
| 765 | memcpy(csio_ln_wwpn(ln), lcmd->vnport_wwpn, 8); |
| 766 | |
| 767 | for (i = 0; i < CSIO_MAX_PPORTS; i++) |
| 768 | if (hw->pport[i].portid == portid) |
| 769 | memcpy(hw->pport[i].mac, lcmd->phy_mac, 6); |
| 770 | |
| 771 | out: |
| 772 | mempool_free(mbp, hw->mb_mempool); |
| 773 | return 0; |
| 774 | } |
| 775 | |
| 776 | /* |
| 777 | * csio_ln_read_fcf_cbfn - Read fcf parameters |
| 778 | * @ln: lnode |
| 779 | * |
| 780 | * read fcf response and Update ln fcf information. |
| 781 | */ |
| 782 | static void |
| 783 | csio_ln_read_fcf_cbfn(struct csio_hw *hw, struct csio_mb *mbp) |
| 784 | { |
| 785 | struct csio_lnode *ln = (struct csio_lnode *)mbp->priv; |
| 786 | struct csio_fcf_info *fcf_info; |
| 787 | struct fw_fcoe_fcf_cmd *rsp = |
| 788 | (struct fw_fcoe_fcf_cmd *)(mbp->mb); |
| 789 | enum fw_retval retval; |
| 790 | |
Hariprasad Shenai | e2ac962 | 2014-11-07 09:35:25 +0530 | [diff] [blame] | 791 | retval = FW_CMD_RETVAL_G(ntohl(rsp->retval_len16)); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 792 | if (retval != FW_SUCCESS) { |
| 793 | csio_ln_err(ln, "FCOE FCF cmd failed with ret x%x\n", |
| 794 | retval); |
| 795 | mempool_free(mbp, hw->mb_mempool); |
| 796 | return; |
| 797 | } |
| 798 | |
| 799 | spin_lock_irq(&hw->lock); |
| 800 | fcf_info = ln->fcfinfo; |
| 801 | fcf_info->priority = FW_FCOE_FCF_CMD_PRIORITY_GET( |
| 802 | ntohs(rsp->priority_pkd)); |
| 803 | fcf_info->vf_id = ntohs(rsp->vf_id); |
| 804 | fcf_info->vlan_id = rsp->vlan_id; |
| 805 | fcf_info->max_fcoe_size = ntohs(rsp->max_fcoe_size); |
| 806 | fcf_info->fka_adv = be32_to_cpu(rsp->fka_adv); |
| 807 | fcf_info->fcfi = FW_FCOE_FCF_CMD_FCFI_GET(ntohl(rsp->op_to_fcfi)); |
| 808 | fcf_info->fpma = FW_FCOE_FCF_CMD_FPMA_GET(rsp->fpma_to_portid); |
| 809 | fcf_info->spma = FW_FCOE_FCF_CMD_SPMA_GET(rsp->fpma_to_portid); |
| 810 | fcf_info->login = FW_FCOE_FCF_CMD_LOGIN_GET(rsp->fpma_to_portid); |
| 811 | fcf_info->portid = FW_FCOE_FCF_CMD_PORTID_GET(rsp->fpma_to_portid); |
| 812 | memcpy(fcf_info->fc_map, rsp->fc_map, sizeof(fcf_info->fc_map)); |
| 813 | memcpy(fcf_info->mac, rsp->mac, sizeof(fcf_info->mac)); |
| 814 | memcpy(fcf_info->name_id, rsp->name_id, sizeof(fcf_info->name_id)); |
| 815 | memcpy(fcf_info->fabric, rsp->fabric, sizeof(fcf_info->fabric)); |
| 816 | memcpy(fcf_info->spma_mac, rsp->spma_mac, sizeof(fcf_info->spma_mac)); |
| 817 | |
| 818 | spin_unlock_irq(&hw->lock); |
| 819 | |
| 820 | mempool_free(mbp, hw->mb_mempool); |
| 821 | } |
| 822 | |
| 823 | /* |
| 824 | * csio_ln_read_fcf_entry - Read fcf entry. |
| 825 | * @ln: lnode |
| 826 | * @cbfn: Completion handler. |
| 827 | * |
| 828 | * Issued with lock held. |
| 829 | */ |
| 830 | static int |
| 831 | csio_ln_read_fcf_entry(struct csio_lnode *ln, |
| 832 | void (*cbfn) (struct csio_hw *, struct csio_mb *)) |
| 833 | { |
| 834 | struct csio_hw *hw = ln->hwp; |
| 835 | struct csio_mb *mbp; |
| 836 | |
| 837 | mbp = mempool_alloc(hw->mb_mempool, GFP_ATOMIC); |
| 838 | if (!mbp) { |
| 839 | CSIO_INC_STATS(hw, n_err_nomem); |
| 840 | return -ENOMEM; |
| 841 | } |
| 842 | |
| 843 | /* Get FCoE FCF information */ |
| 844 | csio_fcoe_read_fcf_init_mb(ln, mbp, CSIO_MB_DEFAULT_TMO, |
| 845 | ln->portid, ln->fcf_flowid, cbfn); |
| 846 | |
| 847 | if (csio_mb_issue(hw, mbp)) { |
| 848 | csio_err(hw, "failed to issue FCOE FCF cmd\n"); |
| 849 | mempool_free(mbp, hw->mb_mempool); |
| 850 | return -EINVAL; |
| 851 | } |
| 852 | |
| 853 | return 0; |
| 854 | } |
| 855 | |
| 856 | /* |
| 857 | * csio_handle_link_up - Logical Linkup event. |
| 858 | * @hw - HW module. |
| 859 | * @portid - Physical port number |
| 860 | * @fcfi - FCF index. |
| 861 | * @vnpi - VNP index. |
| 862 | * Returns - none. |
| 863 | * |
| 864 | * This event is received from FW, when virtual link is established between |
| 865 | * Physical port[ENode] and FCF. If its new vnpi, then local node object is |
| 866 | * created on this FCF and set to [ONLINE] state. |
| 867 | * Lnode waits for FW_RDEV_CMD event to be received indicating that |
| 868 | * Fabric login is completed and lnode moves to [READY] state. |
| 869 | * |
| 870 | * This called with hw lock held |
| 871 | */ |
| 872 | static void |
| 873 | csio_handle_link_up(struct csio_hw *hw, uint8_t portid, uint32_t fcfi, |
| 874 | uint32_t vnpi) |
| 875 | { |
| 876 | struct csio_lnode *ln = NULL; |
| 877 | |
| 878 | /* Lookup lnode based on vnpi */ |
| 879 | ln = csio_ln_lookup_by_vnpi(hw, vnpi); |
| 880 | if (!ln) { |
| 881 | /* Pick lnode based on portid */ |
| 882 | ln = csio_ln_lookup_by_portid(hw, portid); |
| 883 | if (!ln) { |
| 884 | csio_err(hw, "failed to lookup fcoe lnode on port:%d\n", |
| 885 | portid); |
| 886 | CSIO_DB_ASSERT(0); |
| 887 | return; |
| 888 | } |
| 889 | |
| 890 | /* Check if lnode has valid vnp flowid */ |
| 891 | if (ln->vnp_flowid != CSIO_INVALID_IDX) { |
| 892 | /* New VN-Port */ |
| 893 | spin_unlock_irq(&hw->lock); |
| 894 | csio_lnode_alloc(hw); |
| 895 | spin_lock_irq(&hw->lock); |
| 896 | if (!ln) { |
| 897 | csio_err(hw, |
| 898 | "failed to allocate fcoe lnode" |
| 899 | "for port:%d vnpi:x%x\n", |
| 900 | portid, vnpi); |
| 901 | CSIO_DB_ASSERT(0); |
| 902 | return; |
| 903 | } |
| 904 | ln->portid = portid; |
| 905 | } |
| 906 | ln->vnp_flowid = vnpi; |
| 907 | ln->dev_num &= ~0xFFFF; |
| 908 | ln->dev_num |= vnpi; |
| 909 | } |
| 910 | |
| 911 | /*Initialize fcfi */ |
| 912 | ln->fcf_flowid = fcfi; |
| 913 | |
| 914 | csio_info(hw, "Port:%d - FCOE LINK UP\n", portid); |
| 915 | |
| 916 | CSIO_INC_STATS(ln, n_link_up); |
| 917 | |
| 918 | /* Send LINKUP event to SM */ |
| 919 | csio_post_event(&ln->sm, CSIO_LNE_LINKUP); |
| 920 | } |
| 921 | |
| 922 | /* |
| 923 | * csio_post_event_rns |
| 924 | * @ln - FCOE lnode |
| 925 | * @evt - Given rnode event |
| 926 | * Returns - none |
| 927 | * |
| 928 | * Posts given rnode event to all FCOE rnodes connected with given Lnode. |
| 929 | * This routine is invoked when lnode receives LINK_DOWN/DOWN_LINK/CLOSE |
| 930 | * event. |
| 931 | * |
| 932 | * This called with hw lock held |
| 933 | */ |
| 934 | static void |
| 935 | csio_post_event_rns(struct csio_lnode *ln, enum csio_rn_ev evt) |
| 936 | { |
| 937 | struct csio_rnode *rnhead = (struct csio_rnode *) &ln->rnhead; |
| 938 | struct list_head *tmp, *next; |
| 939 | struct csio_rnode *rn; |
| 940 | |
| 941 | list_for_each_safe(tmp, next, &rnhead->sm.sm_list) { |
| 942 | rn = (struct csio_rnode *) tmp; |
| 943 | csio_post_event(&rn->sm, evt); |
| 944 | } |
| 945 | } |
| 946 | |
| 947 | /* |
| 948 | * csio_cleanup_rns |
| 949 | * @ln - FCOE lnode |
| 950 | * Returns - none |
| 951 | * |
| 952 | * Frees all FCOE rnodes connected with given Lnode. |
| 953 | * |
| 954 | * This called with hw lock held |
| 955 | */ |
| 956 | static void |
| 957 | csio_cleanup_rns(struct csio_lnode *ln) |
| 958 | { |
| 959 | struct csio_rnode *rnhead = (struct csio_rnode *) &ln->rnhead; |
| 960 | struct list_head *tmp, *next_rn; |
| 961 | struct csio_rnode *rn; |
| 962 | |
| 963 | list_for_each_safe(tmp, next_rn, &rnhead->sm.sm_list) { |
| 964 | rn = (struct csio_rnode *) tmp; |
| 965 | csio_put_rnode(ln, rn); |
| 966 | } |
| 967 | |
| 968 | } |
| 969 | |
| 970 | /* |
| 971 | * csio_post_event_lns |
| 972 | * @ln - FCOE lnode |
| 973 | * @evt - Given lnode event |
| 974 | * Returns - none |
| 975 | * |
| 976 | * Posts given lnode event to all FCOE lnodes connected with given Lnode. |
| 977 | * This routine is invoked when lnode receives LINK_DOWN/DOWN_LINK/CLOSE |
| 978 | * event. |
| 979 | * |
| 980 | * This called with hw lock held |
| 981 | */ |
| 982 | static void |
| 983 | csio_post_event_lns(struct csio_lnode *ln, enum csio_ln_ev evt) |
| 984 | { |
| 985 | struct list_head *tmp; |
| 986 | struct csio_lnode *cln, *sln; |
| 987 | |
| 988 | /* If NPIV lnode, send evt only to that and return */ |
| 989 | if (csio_is_npiv_ln(ln)) { |
| 990 | csio_post_event(&ln->sm, evt); |
| 991 | return; |
| 992 | } |
| 993 | |
| 994 | sln = ln; |
| 995 | /* Traverse children lnodes list and send evt */ |
| 996 | list_for_each(tmp, &sln->cln_head) { |
| 997 | cln = (struct csio_lnode *) tmp; |
| 998 | csio_post_event(&cln->sm, evt); |
| 999 | } |
| 1000 | |
| 1001 | /* Send evt to parent lnode */ |
| 1002 | csio_post_event(&ln->sm, evt); |
| 1003 | } |
| 1004 | |
| 1005 | /* |
| 1006 | * csio_ln_down - Lcoal nport is down |
| 1007 | * @ln - FCOE Lnode |
| 1008 | * Returns - none |
| 1009 | * |
| 1010 | * Sends LINK_DOWN events to Lnode and its associated NPIVs lnodes. |
| 1011 | * |
| 1012 | * This called with hw lock held |
| 1013 | */ |
| 1014 | static void |
| 1015 | csio_ln_down(struct csio_lnode *ln) |
| 1016 | { |
| 1017 | csio_post_event_lns(ln, CSIO_LNE_LINK_DOWN); |
| 1018 | } |
| 1019 | |
| 1020 | /* |
| 1021 | * csio_handle_link_down - Logical Linkdown event. |
| 1022 | * @hw - HW module. |
| 1023 | * @portid - Physical port number |
| 1024 | * @fcfi - FCF index. |
| 1025 | * @vnpi - VNP index. |
| 1026 | * Returns - none |
| 1027 | * |
| 1028 | * This event is received from FW, when virtual link goes down between |
| 1029 | * Physical port[ENode] and FCF. Lnode and its associated NPIVs lnode hosted on |
| 1030 | * this vnpi[VN-Port] will be de-instantiated. |
| 1031 | * |
| 1032 | * This called with hw lock held |
| 1033 | */ |
| 1034 | static void |
| 1035 | csio_handle_link_down(struct csio_hw *hw, uint8_t portid, uint32_t fcfi, |
| 1036 | uint32_t vnpi) |
| 1037 | { |
| 1038 | struct csio_fcf_info *fp; |
| 1039 | struct csio_lnode *ln; |
| 1040 | |
| 1041 | /* Lookup lnode based on vnpi */ |
| 1042 | ln = csio_ln_lookup_by_vnpi(hw, vnpi); |
| 1043 | if (ln) { |
| 1044 | fp = ln->fcfinfo; |
| 1045 | CSIO_INC_STATS(ln, n_link_down); |
| 1046 | |
| 1047 | /*Warn if linkdown received if lnode is not in ready state */ |
| 1048 | if (!csio_is_lnode_ready(ln)) { |
| 1049 | csio_ln_warn(ln, |
| 1050 | "warn: FCOE link is already in offline " |
| 1051 | "Ignoring Fcoe linkdown event on portid %d\n", |
| 1052 | portid); |
| 1053 | CSIO_INC_STATS(ln, n_evt_drop); |
| 1054 | return; |
| 1055 | } |
| 1056 | |
| 1057 | /* Verify portid */ |
| 1058 | if (fp->portid != portid) { |
| 1059 | csio_ln_warn(ln, |
| 1060 | "warn: FCOE linkdown recv with " |
| 1061 | "invalid port %d\n", portid); |
| 1062 | CSIO_INC_STATS(ln, n_evt_drop); |
| 1063 | return; |
| 1064 | } |
| 1065 | |
| 1066 | /* verify fcfi */ |
| 1067 | if (ln->fcf_flowid != fcfi) { |
| 1068 | csio_ln_warn(ln, |
| 1069 | "warn: FCOE linkdown recv with " |
| 1070 | "invalid fcfi x%x\n", fcfi); |
| 1071 | CSIO_INC_STATS(ln, n_evt_drop); |
| 1072 | return; |
| 1073 | } |
| 1074 | |
| 1075 | csio_info(hw, "Port:%d - FCOE LINK DOWN\n", portid); |
| 1076 | |
| 1077 | /* Send LINK_DOWN event to lnode s/m */ |
| 1078 | csio_ln_down(ln); |
| 1079 | |
| 1080 | return; |
| 1081 | } else { |
| 1082 | csio_warn(hw, |
| 1083 | "warn: FCOE linkdown recv with invalid vnpi x%x\n", |
| 1084 | vnpi); |
| 1085 | CSIO_INC_STATS(hw, n_evt_drop); |
| 1086 | } |
| 1087 | } |
| 1088 | |
| 1089 | /* |
| 1090 | * csio_is_lnode_ready - Checks FCOE lnode is in ready state. |
| 1091 | * @ln: Lnode module |
| 1092 | * |
| 1093 | * Returns True if FCOE lnode is in ready state. |
| 1094 | */ |
| 1095 | int |
| 1096 | csio_is_lnode_ready(struct csio_lnode *ln) |
| 1097 | { |
| 1098 | return (csio_get_state(ln) == ((csio_sm_state_t)csio_lns_ready)); |
| 1099 | } |
| 1100 | |
| 1101 | /*****************************************************************************/ |
| 1102 | /* START: Lnode SM */ |
| 1103 | /*****************************************************************************/ |
| 1104 | /* |
| 1105 | * csio_lns_uninit - The request in uninit state. |
| 1106 | * @ln - FCOE lnode. |
| 1107 | * @evt - Event to be processed. |
| 1108 | * |
| 1109 | * Process the given lnode event which is currently in "uninit" state. |
| 1110 | * Invoked with HW lock held. |
| 1111 | * Return - none. |
| 1112 | */ |
| 1113 | static void |
| 1114 | csio_lns_uninit(struct csio_lnode *ln, enum csio_ln_ev evt) |
| 1115 | { |
| 1116 | struct csio_hw *hw = csio_lnode_to_hw(ln); |
| 1117 | struct csio_lnode *rln = hw->rln; |
| 1118 | int rv; |
| 1119 | |
| 1120 | CSIO_INC_STATS(ln, n_evt_sm[evt]); |
| 1121 | switch (evt) { |
| 1122 | case CSIO_LNE_LINKUP: |
| 1123 | csio_set_state(&ln->sm, csio_lns_online); |
| 1124 | /* Read FCF only for physical lnode */ |
| 1125 | if (csio_is_phys_ln(ln)) { |
| 1126 | rv = csio_ln_read_fcf_entry(ln, |
| 1127 | csio_ln_read_fcf_cbfn); |
| 1128 | if (rv != 0) { |
| 1129 | /* TODO: Send HW RESET event */ |
| 1130 | CSIO_INC_STATS(ln, n_err); |
| 1131 | break; |
| 1132 | } |
| 1133 | |
| 1134 | /* Add FCF record */ |
| 1135 | list_add_tail(&ln->fcfinfo->list, &rln->fcf_lsthead); |
| 1136 | } |
| 1137 | |
| 1138 | rv = csio_ln_vnp_read(ln, csio_ln_vnp_read_cbfn); |
| 1139 | if (rv != 0) { |
| 1140 | /* TODO: Send HW RESET event */ |
| 1141 | CSIO_INC_STATS(ln, n_err); |
| 1142 | } |
| 1143 | break; |
| 1144 | |
| 1145 | case CSIO_LNE_DOWN_LINK: |
| 1146 | break; |
| 1147 | |
| 1148 | default: |
| 1149 | csio_ln_dbg(ln, |
| 1150 | "unexp ln event %d recv from did:x%x in " |
| 1151 | "ln state[uninit].\n", evt, ln->nport_id); |
| 1152 | CSIO_INC_STATS(ln, n_evt_unexp); |
| 1153 | break; |
| 1154 | } /* switch event */ |
| 1155 | } |
| 1156 | |
| 1157 | /* |
| 1158 | * csio_lns_online - The request in online state. |
| 1159 | * @ln - FCOE lnode. |
| 1160 | * @evt - Event to be processed. |
| 1161 | * |
| 1162 | * Process the given lnode event which is currently in "online" state. |
| 1163 | * Invoked with HW lock held. |
| 1164 | * Return - none. |
| 1165 | */ |
| 1166 | static void |
| 1167 | csio_lns_online(struct csio_lnode *ln, enum csio_ln_ev evt) |
| 1168 | { |
| 1169 | struct csio_hw *hw = csio_lnode_to_hw(ln); |
| 1170 | |
| 1171 | CSIO_INC_STATS(ln, n_evt_sm[evt]); |
| 1172 | switch (evt) { |
| 1173 | case CSIO_LNE_LINKUP: |
| 1174 | csio_ln_warn(ln, |
| 1175 | "warn: FCOE link is up already " |
| 1176 | "Ignoring linkup on port:%d\n", ln->portid); |
| 1177 | CSIO_INC_STATS(ln, n_evt_drop); |
| 1178 | break; |
| 1179 | |
| 1180 | case CSIO_LNE_FAB_INIT_DONE: |
| 1181 | csio_set_state(&ln->sm, csio_lns_ready); |
| 1182 | |
| 1183 | spin_unlock_irq(&hw->lock); |
| 1184 | csio_lnode_async_event(ln, CSIO_LN_FC_LINKUP); |
| 1185 | spin_lock_irq(&hw->lock); |
| 1186 | |
| 1187 | break; |
| 1188 | |
| 1189 | case CSIO_LNE_LINK_DOWN: |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 1190 | case CSIO_LNE_DOWN_LINK: |
| 1191 | csio_set_state(&ln->sm, csio_lns_uninit); |
| 1192 | if (csio_is_phys_ln(ln)) { |
| 1193 | /* Remove FCF entry */ |
| 1194 | list_del_init(&ln->fcfinfo->list); |
| 1195 | } |
| 1196 | break; |
| 1197 | |
| 1198 | default: |
| 1199 | csio_ln_dbg(ln, |
| 1200 | "unexp ln event %d recv from did:x%x in " |
| 1201 | "ln state[uninit].\n", evt, ln->nport_id); |
| 1202 | CSIO_INC_STATS(ln, n_evt_unexp); |
| 1203 | |
| 1204 | break; |
| 1205 | } /* switch event */ |
| 1206 | } |
| 1207 | |
| 1208 | /* |
| 1209 | * csio_lns_ready - The request in ready state. |
| 1210 | * @ln - FCOE lnode. |
| 1211 | * @evt - Event to be processed. |
| 1212 | * |
| 1213 | * Process the given lnode event which is currently in "ready" state. |
| 1214 | * Invoked with HW lock held. |
| 1215 | * Return - none. |
| 1216 | */ |
| 1217 | static void |
| 1218 | csio_lns_ready(struct csio_lnode *ln, enum csio_ln_ev evt) |
| 1219 | { |
| 1220 | struct csio_hw *hw = csio_lnode_to_hw(ln); |
| 1221 | |
| 1222 | CSIO_INC_STATS(ln, n_evt_sm[evt]); |
| 1223 | switch (evt) { |
| 1224 | case CSIO_LNE_FAB_INIT_DONE: |
| 1225 | csio_ln_dbg(ln, |
| 1226 | "ignoring event %d recv from did x%x" |
| 1227 | "in ln state[ready].\n", evt, ln->nport_id); |
| 1228 | CSIO_INC_STATS(ln, n_evt_drop); |
| 1229 | break; |
| 1230 | |
| 1231 | case CSIO_LNE_LINK_DOWN: |
| 1232 | csio_set_state(&ln->sm, csio_lns_offline); |
| 1233 | csio_post_event_rns(ln, CSIO_RNFE_DOWN); |
| 1234 | |
| 1235 | spin_unlock_irq(&hw->lock); |
| 1236 | csio_lnode_async_event(ln, CSIO_LN_FC_LINKDOWN); |
| 1237 | spin_lock_irq(&hw->lock); |
| 1238 | |
| 1239 | if (csio_is_phys_ln(ln)) { |
| 1240 | /* Remove FCF entry */ |
| 1241 | list_del_init(&ln->fcfinfo->list); |
| 1242 | } |
| 1243 | break; |
| 1244 | |
| 1245 | case CSIO_LNE_DOWN_LINK: |
| 1246 | csio_set_state(&ln->sm, csio_lns_offline); |
| 1247 | csio_post_event_rns(ln, CSIO_RNFE_DOWN); |
| 1248 | |
| 1249 | /* Host need to issue aborts in case if FW has not returned |
| 1250 | * WRs with status "ABORTED" |
| 1251 | */ |
| 1252 | spin_unlock_irq(&hw->lock); |
| 1253 | csio_lnode_async_event(ln, CSIO_LN_FC_LINKDOWN); |
| 1254 | spin_lock_irq(&hw->lock); |
| 1255 | |
| 1256 | if (csio_is_phys_ln(ln)) { |
| 1257 | /* Remove FCF entry */ |
| 1258 | list_del_init(&ln->fcfinfo->list); |
| 1259 | } |
| 1260 | break; |
| 1261 | |
| 1262 | case CSIO_LNE_CLOSE: |
| 1263 | csio_set_state(&ln->sm, csio_lns_uninit); |
| 1264 | csio_post_event_rns(ln, CSIO_RNFE_CLOSE); |
| 1265 | break; |
| 1266 | |
| 1267 | case CSIO_LNE_LOGO: |
| 1268 | csio_set_state(&ln->sm, csio_lns_offline); |
| 1269 | csio_post_event_rns(ln, CSIO_RNFE_DOWN); |
| 1270 | break; |
| 1271 | |
| 1272 | default: |
| 1273 | csio_ln_dbg(ln, |
| 1274 | "unexp ln event %d recv from did:x%x in " |
| 1275 | "ln state[uninit].\n", evt, ln->nport_id); |
| 1276 | CSIO_INC_STATS(ln, n_evt_unexp); |
| 1277 | CSIO_DB_ASSERT(0); |
| 1278 | break; |
| 1279 | } /* switch event */ |
| 1280 | } |
| 1281 | |
| 1282 | /* |
| 1283 | * csio_lns_offline - The request in offline state. |
| 1284 | * @ln - FCOE lnode. |
| 1285 | * @evt - Event to be processed. |
| 1286 | * |
| 1287 | * Process the given lnode event which is currently in "offline" state. |
| 1288 | * Invoked with HW lock held. |
| 1289 | * Return - none. |
| 1290 | */ |
| 1291 | static void |
| 1292 | csio_lns_offline(struct csio_lnode *ln, enum csio_ln_ev evt) |
| 1293 | { |
| 1294 | struct csio_hw *hw = csio_lnode_to_hw(ln); |
| 1295 | struct csio_lnode *rln = hw->rln; |
| 1296 | int rv; |
| 1297 | |
| 1298 | CSIO_INC_STATS(ln, n_evt_sm[evt]); |
| 1299 | switch (evt) { |
| 1300 | case CSIO_LNE_LINKUP: |
| 1301 | csio_set_state(&ln->sm, csio_lns_online); |
| 1302 | /* Read FCF only for physical lnode */ |
| 1303 | if (csio_is_phys_ln(ln)) { |
| 1304 | rv = csio_ln_read_fcf_entry(ln, |
| 1305 | csio_ln_read_fcf_cbfn); |
| 1306 | if (rv != 0) { |
| 1307 | /* TODO: Send HW RESET event */ |
| 1308 | CSIO_INC_STATS(ln, n_err); |
| 1309 | break; |
| 1310 | } |
| 1311 | |
| 1312 | /* Add FCF record */ |
| 1313 | list_add_tail(&ln->fcfinfo->list, &rln->fcf_lsthead); |
| 1314 | } |
| 1315 | |
| 1316 | rv = csio_ln_vnp_read(ln, csio_ln_vnp_read_cbfn); |
| 1317 | if (rv != 0) { |
| 1318 | /* TODO: Send HW RESET event */ |
| 1319 | CSIO_INC_STATS(ln, n_err); |
| 1320 | } |
| 1321 | break; |
| 1322 | |
| 1323 | case CSIO_LNE_LINK_DOWN: |
| 1324 | case CSIO_LNE_DOWN_LINK: |
| 1325 | case CSIO_LNE_LOGO: |
| 1326 | csio_ln_dbg(ln, |
| 1327 | "ignoring event %d recv from did x%x" |
| 1328 | "in ln state[offline].\n", evt, ln->nport_id); |
| 1329 | CSIO_INC_STATS(ln, n_evt_drop); |
| 1330 | break; |
| 1331 | |
| 1332 | case CSIO_LNE_CLOSE: |
| 1333 | csio_set_state(&ln->sm, csio_lns_uninit); |
| 1334 | csio_post_event_rns(ln, CSIO_RNFE_CLOSE); |
| 1335 | break; |
| 1336 | |
| 1337 | default: |
| 1338 | csio_ln_dbg(ln, |
| 1339 | "unexp ln event %d recv from did:x%x in " |
| 1340 | "ln state[offline]\n", evt, ln->nport_id); |
| 1341 | CSIO_INC_STATS(ln, n_evt_unexp); |
| 1342 | CSIO_DB_ASSERT(0); |
| 1343 | break; |
| 1344 | } /* switch event */ |
| 1345 | } |
| 1346 | |
| 1347 | /*****************************************************************************/ |
| 1348 | /* END: Lnode SM */ |
| 1349 | /*****************************************************************************/ |
| 1350 | |
| 1351 | static void |
| 1352 | csio_free_fcfinfo(struct kref *kref) |
| 1353 | { |
| 1354 | struct csio_fcf_info *fcfinfo = container_of(kref, |
| 1355 | struct csio_fcf_info, kref); |
| 1356 | kfree(fcfinfo); |
| 1357 | } |
| 1358 | |
| 1359 | /* Helper routines for attributes */ |
| 1360 | /* |
| 1361 | * csio_lnode_state_to_str - Get current state of FCOE lnode. |
| 1362 | * @ln - lnode |
| 1363 | * @str - state of lnode. |
| 1364 | * |
| 1365 | */ |
| 1366 | void |
| 1367 | csio_lnode_state_to_str(struct csio_lnode *ln, int8_t *str) |
| 1368 | { |
| 1369 | if (csio_get_state(ln) == ((csio_sm_state_t)csio_lns_uninit)) { |
| 1370 | strcpy(str, "UNINIT"); |
| 1371 | return; |
| 1372 | } |
| 1373 | if (csio_get_state(ln) == ((csio_sm_state_t)csio_lns_ready)) { |
| 1374 | strcpy(str, "READY"); |
| 1375 | return; |
| 1376 | } |
| 1377 | if (csio_get_state(ln) == ((csio_sm_state_t)csio_lns_offline)) { |
| 1378 | strcpy(str, "OFFLINE"); |
| 1379 | return; |
| 1380 | } |
| 1381 | strcpy(str, "UNKNOWN"); |
| 1382 | } /* csio_lnode_state_to_str */ |
| 1383 | |
| 1384 | |
| 1385 | int |
| 1386 | csio_get_phy_port_stats(struct csio_hw *hw, uint8_t portid, |
| 1387 | struct fw_fcoe_port_stats *port_stats) |
| 1388 | { |
| 1389 | struct csio_mb *mbp; |
| 1390 | struct fw_fcoe_port_cmd_params portparams; |
| 1391 | enum fw_retval retval; |
| 1392 | int idx; |
| 1393 | |
| 1394 | mbp = mempool_alloc(hw->mb_mempool, GFP_ATOMIC); |
| 1395 | if (!mbp) { |
| 1396 | csio_err(hw, "FCoE FCF PARAMS command out of memory!\n"); |
| 1397 | return -EINVAL; |
| 1398 | } |
| 1399 | portparams.portid = portid; |
| 1400 | |
| 1401 | for (idx = 1; idx <= 3; idx++) { |
| 1402 | portparams.idx = (idx-1)*6 + 1; |
| 1403 | portparams.nstats = 6; |
| 1404 | if (idx == 3) |
| 1405 | portparams.nstats = 4; |
| 1406 | csio_fcoe_read_portparams_init_mb(hw, mbp, CSIO_MB_DEFAULT_TMO, |
| 1407 | &portparams, NULL); |
| 1408 | if (csio_mb_issue(hw, mbp)) { |
| 1409 | csio_err(hw, "Issue of FCoE port params failed!\n"); |
| 1410 | mempool_free(mbp, hw->mb_mempool); |
| 1411 | return -EINVAL; |
| 1412 | } |
| 1413 | csio_mb_process_portparams_rsp(hw, mbp, &retval, |
| 1414 | &portparams, port_stats); |
| 1415 | } |
| 1416 | |
| 1417 | mempool_free(mbp, hw->mb_mempool); |
| 1418 | return 0; |
| 1419 | } |
| 1420 | |
| 1421 | /* |
| 1422 | * csio_ln_mgmt_wr_handler -Mgmt Work Request handler. |
| 1423 | * @wr - WR. |
| 1424 | * @len - WR len. |
| 1425 | * This handler is invoked when an outstanding mgmt WR is completed. |
| 1426 | * Its invoked in the context of FW event worker thread for every |
| 1427 | * mgmt event received. |
| 1428 | * Return - none. |
| 1429 | */ |
| 1430 | |
| 1431 | static void |
| 1432 | csio_ln_mgmt_wr_handler(struct csio_hw *hw, void *wr, uint32_t len) |
| 1433 | { |
| 1434 | struct csio_mgmtm *mgmtm = csio_hw_to_mgmtm(hw); |
| 1435 | struct csio_ioreq *io_req = NULL; |
| 1436 | struct fw_fcoe_els_ct_wr *wr_cmd; |
| 1437 | |
| 1438 | |
| 1439 | wr_cmd = (struct fw_fcoe_els_ct_wr *) wr; |
| 1440 | |
| 1441 | if (len < sizeof(struct fw_fcoe_els_ct_wr)) { |
| 1442 | csio_err(mgmtm->hw, |
| 1443 | "Invalid ELS CT WR length recvd, len:%x\n", len); |
| 1444 | mgmtm->stats.n_err++; |
| 1445 | return; |
| 1446 | } |
| 1447 | |
| 1448 | io_req = (struct csio_ioreq *) ((uintptr_t) wr_cmd->cookie); |
| 1449 | io_req->wr_status = csio_wr_status(wr_cmd); |
| 1450 | |
| 1451 | /* lookup ioreq exists in our active Q */ |
| 1452 | spin_lock_irq(&hw->lock); |
| 1453 | if (csio_mgmt_req_lookup(mgmtm, io_req) != 0) { |
| 1454 | csio_err(mgmtm->hw, |
| 1455 | "Error- Invalid IO handle recv in WR. handle: %p\n", |
| 1456 | io_req); |
| 1457 | mgmtm->stats.n_err++; |
| 1458 | spin_unlock_irq(&hw->lock); |
| 1459 | return; |
| 1460 | } |
| 1461 | |
| 1462 | mgmtm = csio_hw_to_mgmtm(hw); |
| 1463 | |
| 1464 | /* Dequeue from active queue */ |
| 1465 | list_del_init(&io_req->sm.sm_list); |
| 1466 | mgmtm->stats.n_active--; |
| 1467 | spin_unlock_irq(&hw->lock); |
| 1468 | |
| 1469 | /* io_req will be freed by completion handler */ |
| 1470 | if (io_req->io_cbfn) |
| 1471 | io_req->io_cbfn(hw, io_req); |
| 1472 | } |
| 1473 | |
| 1474 | /** |
| 1475 | * csio_fcoe_fwevt_handler - Event handler for Firmware FCoE events. |
| 1476 | * @hw: HW module |
| 1477 | * @cpl_op: CPL opcode |
| 1478 | * @cmd: FW cmd/WR. |
| 1479 | * |
| 1480 | * Process received FCoE cmd/WR event from FW. |
| 1481 | */ |
| 1482 | void |
| 1483 | csio_fcoe_fwevt_handler(struct csio_hw *hw, __u8 cpl_op, __be64 *cmd) |
| 1484 | { |
| 1485 | struct csio_lnode *ln; |
| 1486 | struct csio_rnode *rn; |
| 1487 | uint8_t portid, opcode = *(uint8_t *)cmd; |
| 1488 | struct fw_fcoe_link_cmd *lcmd; |
| 1489 | struct fw_wr_hdr *wr; |
| 1490 | struct fw_rdev_wr *rdev_wr; |
| 1491 | enum fw_fcoe_link_status lstatus; |
| 1492 | uint32_t fcfi, rdev_flowid, vnpi; |
| 1493 | enum csio_ln_ev evt; |
| 1494 | |
| 1495 | if (cpl_op == CPL_FW6_MSG && opcode == FW_FCOE_LINK_CMD) { |
| 1496 | |
| 1497 | lcmd = (struct fw_fcoe_link_cmd *)cmd; |
| 1498 | lstatus = lcmd->lstatus; |
| 1499 | portid = FW_FCOE_LINK_CMD_PORTID_GET( |
| 1500 | ntohl(lcmd->op_to_portid)); |
| 1501 | fcfi = FW_FCOE_LINK_CMD_FCFI_GET(ntohl(lcmd->sub_opcode_fcfi)); |
| 1502 | vnpi = FW_FCOE_LINK_CMD_VNPI_GET(ntohl(lcmd->vnpi_pkd)); |
| 1503 | |
| 1504 | if (lstatus == FCOE_LINKUP) { |
| 1505 | |
| 1506 | /* HW lock here */ |
| 1507 | spin_lock_irq(&hw->lock); |
| 1508 | csio_handle_link_up(hw, portid, fcfi, vnpi); |
| 1509 | spin_unlock_irq(&hw->lock); |
| 1510 | /* HW un lock here */ |
| 1511 | |
| 1512 | } else if (lstatus == FCOE_LINKDOWN) { |
| 1513 | |
| 1514 | /* HW lock here */ |
| 1515 | spin_lock_irq(&hw->lock); |
| 1516 | csio_handle_link_down(hw, portid, fcfi, vnpi); |
| 1517 | spin_unlock_irq(&hw->lock); |
| 1518 | /* HW un lock here */ |
| 1519 | } else { |
| 1520 | csio_warn(hw, "Unexpected FCOE LINK status:0x%x\n", |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 1521 | lcmd->lstatus); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 1522 | CSIO_INC_STATS(hw, n_cpl_unexp); |
| 1523 | } |
| 1524 | } else if (cpl_op == CPL_FW6_PLD) { |
| 1525 | wr = (struct fw_wr_hdr *) (cmd + 4); |
Hariprasad Shenai | e2ac962 | 2014-11-07 09:35:25 +0530 | [diff] [blame] | 1526 | if (FW_WR_OP_G(be32_to_cpu(wr->hi)) |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 1527 | == FW_RDEV_WR) { |
| 1528 | |
| 1529 | rdev_wr = (struct fw_rdev_wr *) (cmd + 4); |
| 1530 | |
| 1531 | rdev_flowid = FW_RDEV_WR_FLOWID_GET( |
| 1532 | ntohl(rdev_wr->alloc_to_len16)); |
| 1533 | vnpi = FW_RDEV_WR_ASSOC_FLOWID_GET( |
| 1534 | ntohl(rdev_wr->flags_to_assoc_flowid)); |
| 1535 | |
| 1536 | csio_dbg(hw, |
| 1537 | "FW_RDEV_WR: flowid:x%x ev_cause:x%x " |
| 1538 | "vnpi:0x%x\n", rdev_flowid, |
| 1539 | rdev_wr->event_cause, vnpi); |
| 1540 | |
| 1541 | if (rdev_wr->protocol != PROT_FCOE) { |
| 1542 | csio_err(hw, |
| 1543 | "FW_RDEV_WR: invalid proto:x%x " |
| 1544 | "received with flowid:x%x\n", |
| 1545 | rdev_wr->protocol, |
| 1546 | rdev_flowid); |
| 1547 | CSIO_INC_STATS(hw, n_evt_drop); |
| 1548 | return; |
| 1549 | } |
| 1550 | |
| 1551 | /* HW lock here */ |
| 1552 | spin_lock_irq(&hw->lock); |
| 1553 | ln = csio_ln_lookup_by_vnpi(hw, vnpi); |
| 1554 | if (!ln) { |
| 1555 | csio_err(hw, |
| 1556 | "FW_DEV_WR: invalid vnpi:x%x received " |
| 1557 | "with flowid:x%x\n", vnpi, rdev_flowid); |
| 1558 | CSIO_INC_STATS(hw, n_evt_drop); |
| 1559 | goto out_pld; |
| 1560 | } |
| 1561 | |
| 1562 | rn = csio_confirm_rnode(ln, rdev_flowid, |
| 1563 | &rdev_wr->u.fcoe_rdev); |
| 1564 | if (!rn) { |
| 1565 | csio_ln_dbg(ln, |
| 1566 | "Failed to confirm rnode " |
| 1567 | "for flowid:x%x\n", rdev_flowid); |
| 1568 | CSIO_INC_STATS(hw, n_evt_drop); |
| 1569 | goto out_pld; |
| 1570 | } |
| 1571 | |
| 1572 | /* save previous event for debugging */ |
| 1573 | ln->prev_evt = ln->cur_evt; |
| 1574 | ln->cur_evt = rdev_wr->event_cause; |
| 1575 | CSIO_INC_STATS(ln, n_evt_fw[rdev_wr->event_cause]); |
| 1576 | |
| 1577 | /* Translate all the fabric events to lnode SM events */ |
| 1578 | evt = CSIO_FWE_TO_LNE(rdev_wr->event_cause); |
| 1579 | if (evt) { |
| 1580 | csio_ln_dbg(ln, |
| 1581 | "Posting event to lnode event:%d " |
| 1582 | "cause:%d flowid:x%x\n", evt, |
| 1583 | rdev_wr->event_cause, rdev_flowid); |
| 1584 | csio_post_event(&ln->sm, evt); |
| 1585 | } |
| 1586 | |
| 1587 | /* Handover event to rn SM here. */ |
| 1588 | csio_rnode_fwevt_handler(rn, rdev_wr->event_cause); |
| 1589 | out_pld: |
| 1590 | spin_unlock_irq(&hw->lock); |
| 1591 | return; |
| 1592 | } else { |
| 1593 | csio_warn(hw, "unexpected WR op(0x%x) recv\n", |
Hariprasad Shenai | e2ac962 | 2014-11-07 09:35:25 +0530 | [diff] [blame] | 1594 | FW_WR_OP_G(be32_to_cpu((wr->hi)))); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 1595 | CSIO_INC_STATS(hw, n_cpl_unexp); |
| 1596 | } |
| 1597 | } else if (cpl_op == CPL_FW6_MSG) { |
| 1598 | wr = (struct fw_wr_hdr *) (cmd); |
Hariprasad Shenai | e2ac962 | 2014-11-07 09:35:25 +0530 | [diff] [blame] | 1599 | if (FW_WR_OP_G(be32_to_cpu(wr->hi)) == FW_FCOE_ELS_CT_WR) { |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 1600 | csio_ln_mgmt_wr_handler(hw, wr, |
| 1601 | sizeof(struct fw_fcoe_els_ct_wr)); |
| 1602 | } else { |
| 1603 | csio_warn(hw, "unexpected WR op(0x%x) recv\n", |
Hariprasad Shenai | e2ac962 | 2014-11-07 09:35:25 +0530 | [diff] [blame] | 1604 | FW_WR_OP_G(be32_to_cpu((wr->hi)))); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 1605 | CSIO_INC_STATS(hw, n_cpl_unexp); |
| 1606 | } |
| 1607 | } else { |
| 1608 | csio_warn(hw, "unexpected CPL op(0x%x) recv\n", opcode); |
| 1609 | CSIO_INC_STATS(hw, n_cpl_unexp); |
| 1610 | } |
| 1611 | } |
| 1612 | |
| 1613 | /** |
| 1614 | * csio_lnode_start - Kickstart lnode discovery. |
| 1615 | * @ln: lnode |
| 1616 | * |
| 1617 | * This routine kickstarts the discovery by issuing an FCOE_LINK (up) command. |
| 1618 | */ |
| 1619 | int |
| 1620 | csio_lnode_start(struct csio_lnode *ln) |
| 1621 | { |
| 1622 | int rv = 0; |
| 1623 | if (csio_is_phys_ln(ln) && !(ln->flags & CSIO_LNF_LINK_ENABLE)) { |
| 1624 | rv = csio_fcoe_enable_link(ln, 1); |
| 1625 | ln->flags |= CSIO_LNF_LINK_ENABLE; |
| 1626 | } |
| 1627 | |
| 1628 | return rv; |
| 1629 | } |
| 1630 | |
| 1631 | /** |
| 1632 | * csio_lnode_stop - Stop the lnode. |
| 1633 | * @ln: lnode |
| 1634 | * |
| 1635 | * This routine is invoked by HW module to stop lnode and its associated NPIV |
| 1636 | * lnodes. |
| 1637 | */ |
| 1638 | void |
| 1639 | csio_lnode_stop(struct csio_lnode *ln) |
| 1640 | { |
| 1641 | csio_post_event_lns(ln, CSIO_LNE_DOWN_LINK); |
| 1642 | if (csio_is_phys_ln(ln) && (ln->flags & CSIO_LNF_LINK_ENABLE)) { |
| 1643 | csio_fcoe_enable_link(ln, 0); |
| 1644 | ln->flags &= ~CSIO_LNF_LINK_ENABLE; |
| 1645 | } |
| 1646 | csio_ln_dbg(ln, "stopping ln :%p\n", ln); |
| 1647 | } |
| 1648 | |
| 1649 | /** |
| 1650 | * csio_lnode_close - Close an lnode. |
| 1651 | * @ln: lnode |
| 1652 | * |
| 1653 | * This routine is invoked by HW module to close an lnode and its |
| 1654 | * associated NPIV lnodes. Lnode and its associated NPIV lnodes are |
| 1655 | * set to uninitialized state. |
| 1656 | */ |
| 1657 | void |
| 1658 | csio_lnode_close(struct csio_lnode *ln) |
| 1659 | { |
| 1660 | csio_post_event_lns(ln, CSIO_LNE_CLOSE); |
| 1661 | if (csio_is_phys_ln(ln)) |
| 1662 | ln->vnp_flowid = CSIO_INVALID_IDX; |
| 1663 | |
| 1664 | csio_ln_dbg(ln, "closed ln :%p\n", ln); |
| 1665 | } |
| 1666 | |
| 1667 | /* |
| 1668 | * csio_ln_prep_ecwr - Prepare ELS/CT WR. |
| 1669 | * @io_req - IO request. |
| 1670 | * @wr_len - WR len |
| 1671 | * @immd_len - WR immediate data |
| 1672 | * @sub_op - Sub opcode |
| 1673 | * @sid - source portid. |
| 1674 | * @did - destination portid |
| 1675 | * @flow_id - flowid |
| 1676 | * @fw_wr - ELS/CT WR to be prepared. |
| 1677 | * Returns: 0 - on success |
| 1678 | */ |
| 1679 | static int |
| 1680 | csio_ln_prep_ecwr(struct csio_ioreq *io_req, uint32_t wr_len, |
| 1681 | uint32_t immd_len, uint8_t sub_op, uint32_t sid, |
| 1682 | uint32_t did, uint32_t flow_id, uint8_t *fw_wr) |
| 1683 | { |
| 1684 | struct fw_fcoe_els_ct_wr *wr; |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 1685 | __be32 port_id; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 1686 | |
| 1687 | wr = (struct fw_fcoe_els_ct_wr *)fw_wr; |
Hariprasad Shenai | e2ac962 | 2014-11-07 09:35:25 +0530 | [diff] [blame] | 1688 | wr->op_immdlen = cpu_to_be32(FW_WR_OP_V(FW_FCOE_ELS_CT_WR) | |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 1689 | FW_FCOE_ELS_CT_WR_IMMDLEN(immd_len)); |
| 1690 | |
| 1691 | wr_len = DIV_ROUND_UP(wr_len, 16); |
Hariprasad Shenai | e2ac962 | 2014-11-07 09:35:25 +0530 | [diff] [blame] | 1692 | wr->flowid_len16 = cpu_to_be32(FW_WR_FLOWID_V(flow_id) | |
| 1693 | FW_WR_LEN16_V(wr_len)); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 1694 | wr->els_ct_type = sub_op; |
| 1695 | wr->ctl_pri = 0; |
| 1696 | wr->cp_en_class = 0; |
| 1697 | wr->cookie = io_req->fw_handle; |
Naresh Kumar Inna | 5036f0a | 2012-11-20 18:15:40 +0530 | [diff] [blame] | 1698 | wr->iqid = cpu_to_be16(csio_q_physiqid( |
| 1699 | io_req->lnode->hwp, io_req->iq_idx)); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 1700 | wr->fl_to_sp = FW_FCOE_ELS_CT_WR_SP(1); |
| 1701 | wr->tmo_val = (uint8_t) io_req->tmo; |
| 1702 | port_id = htonl(sid); |
| 1703 | memcpy(wr->l_id, PORT_ID_PTR(port_id), 3); |
| 1704 | port_id = htonl(did); |
| 1705 | memcpy(wr->r_id, PORT_ID_PTR(port_id), 3); |
| 1706 | |
| 1707 | /* Prepare RSP SGL */ |
| 1708 | wr->rsp_dmalen = cpu_to_be32(io_req->dma_buf.len); |
| 1709 | wr->rsp_dmaaddr = cpu_to_be64(io_req->dma_buf.paddr); |
| 1710 | return 0; |
| 1711 | } |
| 1712 | |
| 1713 | /* |
| 1714 | * csio_ln_mgmt_submit_wr - Post elsct work request. |
| 1715 | * @mgmtm - mgmtm |
| 1716 | * @io_req - io request. |
| 1717 | * @sub_op - ELS or CT request type |
| 1718 | * @pld - Dma Payload buffer |
| 1719 | * @pld_len - Payload len |
| 1720 | * Prepares ELSCT Work request and sents it to FW. |
| 1721 | * Returns: 0 - on success |
| 1722 | */ |
| 1723 | static int |
| 1724 | csio_ln_mgmt_submit_wr(struct csio_mgmtm *mgmtm, struct csio_ioreq *io_req, |
| 1725 | uint8_t sub_op, struct csio_dma_buf *pld, |
| 1726 | uint32_t pld_len) |
| 1727 | { |
| 1728 | struct csio_wr_pair wrp; |
| 1729 | struct csio_lnode *ln = io_req->lnode; |
| 1730 | struct csio_rnode *rn = io_req->rnode; |
| 1731 | struct csio_hw *hw = mgmtm->hw; |
| 1732 | uint8_t fw_wr[64]; |
| 1733 | struct ulptx_sgl dsgl; |
| 1734 | uint32_t wr_size = 0; |
| 1735 | uint8_t im_len = 0; |
| 1736 | uint32_t wr_off = 0; |
| 1737 | |
| 1738 | int ret = 0; |
| 1739 | |
| 1740 | /* Calculate WR Size for this ELS REQ */ |
| 1741 | wr_size = sizeof(struct fw_fcoe_els_ct_wr); |
| 1742 | |
| 1743 | /* Send as immediate data if pld < 256 */ |
| 1744 | if (pld_len < 256) { |
| 1745 | wr_size += ALIGN(pld_len, 8); |
| 1746 | im_len = (uint8_t)pld_len; |
| 1747 | } else |
| 1748 | wr_size += sizeof(struct ulptx_sgl); |
| 1749 | |
| 1750 | /* Roundup WR size in units of 16 bytes */ |
| 1751 | wr_size = ALIGN(wr_size, 16); |
| 1752 | |
| 1753 | /* Get WR to send ELS REQ */ |
| 1754 | ret = csio_wr_get(hw, mgmtm->eq_idx, wr_size, &wrp); |
| 1755 | if (ret != 0) { |
| 1756 | csio_err(hw, "Failed to get WR for ec_req %p ret:%d\n", |
| 1757 | io_req, ret); |
| 1758 | return ret; |
| 1759 | } |
| 1760 | |
| 1761 | /* Prepare Generic WR used by all ELS/CT cmd */ |
| 1762 | csio_ln_prep_ecwr(io_req, wr_size, im_len, sub_op, |
| 1763 | ln->nport_id, rn->nport_id, |
| 1764 | csio_rn_flowid(rn), |
| 1765 | &fw_wr[0]); |
| 1766 | |
| 1767 | /* Copy ELS/CT WR CMD */ |
| 1768 | csio_wr_copy_to_wrp(&fw_wr[0], &wrp, wr_off, |
| 1769 | sizeof(struct fw_fcoe_els_ct_wr)); |
| 1770 | wr_off += sizeof(struct fw_fcoe_els_ct_wr); |
| 1771 | |
| 1772 | /* Copy payload to Immediate section of WR */ |
| 1773 | if (im_len) |
| 1774 | csio_wr_copy_to_wrp(pld->vaddr, &wrp, wr_off, im_len); |
| 1775 | else { |
| 1776 | /* Program DSGL to dma payload */ |
Anish Bhatt | d7990b0 | 2014-11-12 17:15:57 -0800 | [diff] [blame] | 1777 | dsgl.cmd_nsge = htonl(ULPTX_CMD_V(ULP_TX_SC_DSGL) | |
Hariprasad Shenai | bdc590b | 2015-01-08 21:38:16 -0800 | [diff] [blame] | 1778 | ULPTX_MORE_F | ULPTX_NSGE_V(1)); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 1779 | dsgl.len0 = cpu_to_be32(pld_len); |
| 1780 | dsgl.addr0 = cpu_to_be64(pld->paddr); |
| 1781 | csio_wr_copy_to_wrp(&dsgl, &wrp, ALIGN(wr_off, 8), |
| 1782 | sizeof(struct ulptx_sgl)); |
| 1783 | } |
| 1784 | |
| 1785 | /* Issue work request to xmit ELS/CT req to FW */ |
| 1786 | csio_wr_issue(mgmtm->hw, mgmtm->eq_idx, false); |
| 1787 | return ret; |
| 1788 | } |
| 1789 | |
| 1790 | /* |
| 1791 | * csio_ln_mgmt_submit_req - Submit FCOE Mgmt request. |
| 1792 | * @io_req - IO Request |
| 1793 | * @io_cbfn - Completion handler. |
| 1794 | * @req_type - ELS or CT request type |
| 1795 | * @pld - Dma Payload buffer |
| 1796 | * @pld_len - Payload len |
| 1797 | * |
| 1798 | * |
| 1799 | * This API used submit managment ELS/CT request. |
| 1800 | * This called with hw lock held |
| 1801 | * Returns: 0 - on success |
| 1802 | * -ENOMEM - on error. |
| 1803 | */ |
| 1804 | static int |
| 1805 | csio_ln_mgmt_submit_req(struct csio_ioreq *io_req, |
| 1806 | void (*io_cbfn) (struct csio_hw *, struct csio_ioreq *), |
| 1807 | enum fcoe_cmn_type req_type, struct csio_dma_buf *pld, |
| 1808 | uint32_t pld_len) |
| 1809 | { |
| 1810 | struct csio_hw *hw = csio_lnode_to_hw(io_req->lnode); |
| 1811 | struct csio_mgmtm *mgmtm = csio_hw_to_mgmtm(hw); |
| 1812 | int rv; |
| 1813 | |
Kees Cook | 42c335f | 2017-05-09 15:34:44 -0700 | [diff] [blame] | 1814 | BUG_ON(pld_len > pld->len); |
| 1815 | |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 1816 | io_req->io_cbfn = io_cbfn; /* Upper layer callback handler */ |
| 1817 | io_req->fw_handle = (uintptr_t) (io_req); |
| 1818 | io_req->eq_idx = mgmtm->eq_idx; |
| 1819 | io_req->iq_idx = mgmtm->iq_idx; |
| 1820 | |
| 1821 | rv = csio_ln_mgmt_submit_wr(mgmtm, io_req, req_type, pld, pld_len); |
| 1822 | if (rv == 0) { |
| 1823 | list_add_tail(&io_req->sm.sm_list, &mgmtm->active_q); |
| 1824 | mgmtm->stats.n_active++; |
| 1825 | } |
| 1826 | return rv; |
| 1827 | } |
| 1828 | |
| 1829 | /* |
| 1830 | * csio_ln_fdmi_init - FDMI Init entry point. |
| 1831 | * @ln: lnode |
| 1832 | */ |
| 1833 | static int |
| 1834 | csio_ln_fdmi_init(struct csio_lnode *ln) |
| 1835 | { |
| 1836 | struct csio_hw *hw = csio_lnode_to_hw(ln); |
| 1837 | struct csio_dma_buf *dma_buf; |
| 1838 | |
| 1839 | /* Allocate MGMT request required for FDMI */ |
| 1840 | ln->mgmt_req = kzalloc(sizeof(struct csio_ioreq), GFP_KERNEL); |
| 1841 | if (!ln->mgmt_req) { |
| 1842 | csio_ln_err(ln, "Failed to alloc ioreq for FDMI\n"); |
| 1843 | CSIO_INC_STATS(hw, n_err_nomem); |
| 1844 | return -ENOMEM; |
| 1845 | } |
| 1846 | |
| 1847 | /* Allocate Dma buffers for FDMI response Payload */ |
| 1848 | dma_buf = &ln->mgmt_req->dma_buf; |
| 1849 | dma_buf->len = 2048; |
Christoph Hellwig | c22b332 | 2018-10-10 18:34:51 +0200 | [diff] [blame] | 1850 | dma_buf->vaddr = dma_alloc_coherent(&hw->pdev->dev, dma_buf->len, |
| 1851 | &dma_buf->paddr, GFP_KERNEL); |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 1852 | if (!dma_buf->vaddr) { |
| 1853 | csio_err(hw, "Failed to alloc DMA buffer for FDMI!\n"); |
| 1854 | kfree(ln->mgmt_req); |
| 1855 | ln->mgmt_req = NULL; |
| 1856 | return -ENOMEM; |
| 1857 | } |
| 1858 | |
| 1859 | ln->flags |= CSIO_LNF_FDMI_ENABLE; |
| 1860 | return 0; |
| 1861 | } |
| 1862 | |
| 1863 | /* |
| 1864 | * csio_ln_fdmi_exit - FDMI exit entry point. |
| 1865 | * @ln: lnode |
| 1866 | */ |
| 1867 | static int |
| 1868 | csio_ln_fdmi_exit(struct csio_lnode *ln) |
| 1869 | { |
| 1870 | struct csio_dma_buf *dma_buf; |
| 1871 | struct csio_hw *hw = csio_lnode_to_hw(ln); |
| 1872 | |
| 1873 | if (!ln->mgmt_req) |
| 1874 | return 0; |
| 1875 | |
| 1876 | dma_buf = &ln->mgmt_req->dma_buf; |
| 1877 | if (dma_buf->vaddr) |
Christoph Hellwig | c22b332 | 2018-10-10 18:34:51 +0200 | [diff] [blame] | 1878 | dma_free_coherent(&hw->pdev->dev, dma_buf->len, dma_buf->vaddr, |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 1879 | dma_buf->paddr); |
| 1880 | |
| 1881 | kfree(ln->mgmt_req); |
| 1882 | return 0; |
| 1883 | } |
| 1884 | |
| 1885 | int |
| 1886 | csio_scan_done(struct csio_lnode *ln, unsigned long ticks, |
| 1887 | unsigned long time, unsigned long max_scan_ticks, |
| 1888 | unsigned long delta_scan_ticks) |
| 1889 | { |
| 1890 | int rv = 0; |
| 1891 | |
| 1892 | if (time >= max_scan_ticks) |
| 1893 | return 1; |
| 1894 | |
| 1895 | if (!ln->tgt_scan_tick) |
| 1896 | ln->tgt_scan_tick = ticks; |
| 1897 | |
| 1898 | if (((ticks - ln->tgt_scan_tick) >= delta_scan_ticks)) { |
| 1899 | if (!ln->last_scan_ntgts) |
| 1900 | ln->last_scan_ntgts = ln->n_scsi_tgts; |
| 1901 | else { |
| 1902 | if (ln->last_scan_ntgts == ln->n_scsi_tgts) |
| 1903 | return 1; |
| 1904 | |
| 1905 | ln->last_scan_ntgts = ln->n_scsi_tgts; |
| 1906 | } |
| 1907 | ln->tgt_scan_tick = ticks; |
| 1908 | } |
| 1909 | return rv; |
| 1910 | } |
| 1911 | |
| 1912 | /* |
| 1913 | * csio_notify_lnodes: |
| 1914 | * @hw: HW module |
| 1915 | * @note: Notification |
| 1916 | * |
| 1917 | * Called from the HW SM to fan out notifications to the |
| 1918 | * Lnode SM. Since the HW SM is entered with lock held, |
| 1919 | * there is no need to hold locks here. |
| 1920 | * |
| 1921 | */ |
| 1922 | void |
| 1923 | csio_notify_lnodes(struct csio_hw *hw, enum csio_ln_notify note) |
| 1924 | { |
| 1925 | struct list_head *tmp; |
| 1926 | struct csio_lnode *ln; |
| 1927 | |
| 1928 | csio_dbg(hw, "Notifying all nodes of event %d\n", note); |
| 1929 | |
| 1930 | /* Traverse children lnodes list and send evt */ |
| 1931 | list_for_each(tmp, &hw->sln_head) { |
| 1932 | ln = (struct csio_lnode *) tmp; |
| 1933 | |
| 1934 | switch (note) { |
| 1935 | case CSIO_LN_NOTIFY_HWREADY: |
| 1936 | csio_lnode_start(ln); |
| 1937 | break; |
| 1938 | |
| 1939 | case CSIO_LN_NOTIFY_HWRESET: |
| 1940 | case CSIO_LN_NOTIFY_HWREMOVE: |
| 1941 | csio_lnode_close(ln); |
| 1942 | break; |
| 1943 | |
| 1944 | case CSIO_LN_NOTIFY_HWSTOP: |
| 1945 | csio_lnode_stop(ln); |
| 1946 | break; |
| 1947 | |
| 1948 | default: |
| 1949 | break; |
| 1950 | |
| 1951 | } |
| 1952 | } |
| 1953 | } |
| 1954 | |
| 1955 | /* |
| 1956 | * csio_disable_lnodes: |
| 1957 | * @hw: HW module |
| 1958 | * @portid:port id |
| 1959 | * @disable: disable/enable flag. |
| 1960 | * If disable=1, disables all lnode hosted on given physical port. |
| 1961 | * otherwise enables all the lnodes on given phsysical port. |
| 1962 | * This routine need to called with hw lock held. |
| 1963 | */ |
| 1964 | void |
| 1965 | csio_disable_lnodes(struct csio_hw *hw, uint8_t portid, bool disable) |
| 1966 | { |
| 1967 | struct list_head *tmp; |
| 1968 | struct csio_lnode *ln; |
| 1969 | |
| 1970 | csio_dbg(hw, "Notifying event to all nodes of port:%d\n", portid); |
| 1971 | |
| 1972 | /* Traverse sibling lnodes list and send evt */ |
| 1973 | list_for_each(tmp, &hw->sln_head) { |
| 1974 | ln = (struct csio_lnode *) tmp; |
| 1975 | if (ln->portid != portid) |
| 1976 | continue; |
| 1977 | |
| 1978 | if (disable) |
| 1979 | csio_lnode_stop(ln); |
| 1980 | else |
| 1981 | csio_lnode_start(ln); |
| 1982 | } |
| 1983 | } |
| 1984 | |
| 1985 | /* |
| 1986 | * csio_ln_init - Initialize an lnode. |
| 1987 | * @ln: lnode |
| 1988 | * |
| 1989 | */ |
| 1990 | static int |
| 1991 | csio_ln_init(struct csio_lnode *ln) |
| 1992 | { |
| 1993 | int rv = -EINVAL; |
YueHaibing | 63f565a | 2019-10-29 06:15:30 +0000 | [diff] [blame] | 1994 | struct csio_lnode *pln; |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 1995 | struct csio_hw *hw = csio_lnode_to_hw(ln); |
| 1996 | |
| 1997 | csio_init_state(&ln->sm, csio_lns_uninit); |
| 1998 | ln->vnp_flowid = CSIO_INVALID_IDX; |
| 1999 | ln->fcf_flowid = CSIO_INVALID_IDX; |
| 2000 | |
| 2001 | if (csio_is_root_ln(ln)) { |
| 2002 | |
| 2003 | /* This is the lnode used during initialization */ |
| 2004 | |
| 2005 | ln->fcfinfo = kzalloc(sizeof(struct csio_fcf_info), GFP_KERNEL); |
| 2006 | if (!ln->fcfinfo) { |
| 2007 | csio_ln_err(ln, "Failed to alloc FCF record\n"); |
| 2008 | CSIO_INC_STATS(hw, n_err_nomem); |
| 2009 | goto err; |
| 2010 | } |
| 2011 | |
| 2012 | INIT_LIST_HEAD(&ln->fcf_lsthead); |
| 2013 | kref_init(&ln->fcfinfo->kref); |
| 2014 | |
| 2015 | if (csio_fdmi_enable && csio_ln_fdmi_init(ln)) |
| 2016 | goto err; |
| 2017 | |
| 2018 | } else { /* Either a non-root physical or a virtual lnode */ |
| 2019 | |
| 2020 | /* |
| 2021 | * THe rest is common for non-root physical and NPIV lnodes. |
| 2022 | * Just get references to all other modules |
| 2023 | */ |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 2024 | |
| 2025 | if (csio_is_npiv_ln(ln)) { |
| 2026 | /* NPIV */ |
| 2027 | pln = csio_parent_lnode(ln); |
| 2028 | kref_get(&pln->fcfinfo->kref); |
| 2029 | ln->fcfinfo = pln->fcfinfo; |
| 2030 | } else { |
| 2031 | /* Another non-root physical lnode (FCF) */ |
| 2032 | ln->fcfinfo = kzalloc(sizeof(struct csio_fcf_info), |
| 2033 | GFP_KERNEL); |
| 2034 | if (!ln->fcfinfo) { |
| 2035 | csio_ln_err(ln, "Failed to alloc FCF info\n"); |
| 2036 | CSIO_INC_STATS(hw, n_err_nomem); |
| 2037 | goto err; |
| 2038 | } |
| 2039 | |
| 2040 | kref_init(&ln->fcfinfo->kref); |
| 2041 | |
| 2042 | if (csio_fdmi_enable && csio_ln_fdmi_init(ln)) |
| 2043 | goto err; |
| 2044 | } |
| 2045 | |
| 2046 | } /* if (!csio_is_root_ln(ln)) */ |
| 2047 | |
| 2048 | return 0; |
| 2049 | err: |
| 2050 | return rv; |
| 2051 | } |
| 2052 | |
| 2053 | static void |
| 2054 | csio_ln_exit(struct csio_lnode *ln) |
| 2055 | { |
| 2056 | struct csio_lnode *pln; |
| 2057 | |
| 2058 | csio_cleanup_rns(ln); |
| 2059 | if (csio_is_npiv_ln(ln)) { |
| 2060 | pln = csio_parent_lnode(ln); |
| 2061 | kref_put(&pln->fcfinfo->kref, csio_free_fcfinfo); |
| 2062 | } else { |
| 2063 | kref_put(&ln->fcfinfo->kref, csio_free_fcfinfo); |
| 2064 | if (csio_fdmi_enable) |
| 2065 | csio_ln_fdmi_exit(ln); |
| 2066 | } |
| 2067 | ln->fcfinfo = NULL; |
| 2068 | } |
| 2069 | |
Lee Jones | fd4cdf6 | 2020-07-21 17:41:42 +0100 | [diff] [blame] | 2070 | /* |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 2071 | * csio_lnode_init - Initialize the members of an lnode. |
| 2072 | * @ln: lnode |
Naresh Kumar Inna | a3667aa | 2012-11-15 22:41:18 +0530 | [diff] [blame] | 2073 | */ |
| 2074 | int |
| 2075 | csio_lnode_init(struct csio_lnode *ln, struct csio_hw *hw, |
| 2076 | struct csio_lnode *pln) |
| 2077 | { |
| 2078 | int rv = -EINVAL; |
| 2079 | |
| 2080 | /* Link this lnode to hw */ |
| 2081 | csio_lnode_to_hw(ln) = hw; |
| 2082 | |
| 2083 | /* Link child to parent if child lnode */ |
| 2084 | if (pln) |
| 2085 | ln->pln = pln; |
| 2086 | else |
| 2087 | ln->pln = NULL; |
| 2088 | |
| 2089 | /* Initialize scsi_tgt and timers to zero */ |
| 2090 | ln->n_scsi_tgts = 0; |
| 2091 | ln->last_scan_ntgts = 0; |
| 2092 | ln->tgt_scan_tick = 0; |
| 2093 | |
| 2094 | /* Initialize rnode list */ |
| 2095 | INIT_LIST_HEAD(&ln->rnhead); |
| 2096 | INIT_LIST_HEAD(&ln->cln_head); |
| 2097 | |
| 2098 | /* Initialize log level for debug */ |
| 2099 | ln->params.log_level = hw->params.log_level; |
| 2100 | |
| 2101 | if (csio_ln_init(ln)) |
| 2102 | goto err; |
| 2103 | |
| 2104 | /* Add lnode to list of sibling or children lnodes */ |
| 2105 | spin_lock_irq(&hw->lock); |
| 2106 | list_add_tail(&ln->sm.sm_list, pln ? &pln->cln_head : &hw->sln_head); |
| 2107 | if (pln) |
| 2108 | pln->num_vports++; |
| 2109 | spin_unlock_irq(&hw->lock); |
| 2110 | |
| 2111 | hw->num_lns++; |
| 2112 | |
| 2113 | return 0; |
| 2114 | err: |
| 2115 | csio_lnode_to_hw(ln) = NULL; |
| 2116 | return rv; |
| 2117 | } |
| 2118 | |
| 2119 | /** |
| 2120 | * csio_lnode_exit - De-instantiate an lnode. |
| 2121 | * @ln: lnode |
| 2122 | * |
| 2123 | */ |
| 2124 | void |
| 2125 | csio_lnode_exit(struct csio_lnode *ln) |
| 2126 | { |
| 2127 | struct csio_hw *hw = csio_lnode_to_hw(ln); |
| 2128 | |
| 2129 | csio_ln_exit(ln); |
| 2130 | |
| 2131 | /* Remove this lnode from hw->sln_head */ |
| 2132 | spin_lock_irq(&hw->lock); |
| 2133 | |
| 2134 | list_del_init(&ln->sm.sm_list); |
| 2135 | |
| 2136 | /* If it is children lnode, decrement the |
| 2137 | * counter in its parent lnode |
| 2138 | */ |
| 2139 | if (ln->pln) |
| 2140 | ln->pln->num_vports--; |
| 2141 | |
| 2142 | /* Update root lnode pointer */ |
| 2143 | if (list_empty(&hw->sln_head)) |
| 2144 | hw->rln = NULL; |
| 2145 | else |
| 2146 | hw->rln = (struct csio_lnode *)csio_list_next(&hw->sln_head); |
| 2147 | |
| 2148 | spin_unlock_irq(&hw->lock); |
| 2149 | |
| 2150 | csio_lnode_to_hw(ln) = NULL; |
| 2151 | hw->num_lns--; |
| 2152 | } |