|  | /* | 
|  | * This file is part of the Chelsio FCoE driver for Linux. | 
|  | * | 
|  | * Copyright (c) 2008-2012 Chelsio Communications, Inc. All rights reserved. | 
|  | * | 
|  | * This software is available to you under a choice of one of two | 
|  | * licenses.  You may choose to be licensed under the terms of the GNU | 
|  | * General Public License (GPL) Version 2, available from the file | 
|  | * COPYING in the main directory of this source tree, or the | 
|  | * OpenIB.org BSD license below: | 
|  | * | 
|  | *     Redistribution and use in source and binary forms, with or | 
|  | *     without modification, are permitted provided that the following | 
|  | *     conditions are met: | 
|  | * | 
|  | *      - Redistributions of source code must retain the above | 
|  | *        copyright notice, this list of conditions and the following | 
|  | *        disclaimer. | 
|  | * | 
|  | *      - Redistributions in binary form must reproduce the above | 
|  | *        copyright notice, this list of conditions and the following | 
|  | *        disclaimer in the documentation and/or other materials | 
|  | *        provided with the distribution. | 
|  | * | 
|  | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, | 
|  | * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF | 
|  | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND | 
|  | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS | 
|  | * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN | 
|  | * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN | 
|  | * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE | 
|  | * SOFTWARE. | 
|  | */ | 
|  |  | 
|  | #include <linux/kernel.h> | 
|  | #include <linux/delay.h> | 
|  | #include <linux/slab.h> | 
|  | #include <linux/utsname.h> | 
|  | #include <scsi/scsi_device.h> | 
|  | #include <scsi/scsi_transport_fc.h> | 
|  | #include <asm/unaligned.h> | 
|  | #include <scsi/fc/fc_els.h> | 
|  | #include <scsi/fc/fc_fs.h> | 
|  | #include <scsi/fc/fc_gs.h> | 
|  | #include <scsi/fc/fc_ms.h> | 
|  |  | 
|  | #include "csio_hw.h" | 
|  | #include "csio_mb.h" | 
|  | #include "csio_lnode.h" | 
|  | #include "csio_rnode.h" | 
|  |  | 
|  | int csio_fcoe_rnodes = 1024; | 
|  | int csio_fdmi_enable = 1; | 
|  |  | 
|  | #define PORT_ID_PTR(_x)         ((uint8_t *)(&_x) + 1) | 
|  |  | 
|  | /* Lnode SM declarations */ | 
|  | static void csio_lns_uninit(struct csio_lnode *, enum csio_ln_ev); | 
|  | static void csio_lns_online(struct csio_lnode *, enum csio_ln_ev); | 
|  | static void csio_lns_ready(struct csio_lnode *, enum csio_ln_ev); | 
|  | static void csio_lns_offline(struct csio_lnode *, enum csio_ln_ev); | 
|  |  | 
|  | static int csio_ln_mgmt_submit_req(struct csio_ioreq *, | 
|  | void (*io_cbfn) (struct csio_hw *, struct csio_ioreq *), | 
|  | enum fcoe_cmn_type, struct csio_dma_buf *, uint32_t); | 
|  |  | 
|  | /* LN event mapping */ | 
|  | static enum csio_ln_ev fwevt_to_lnevt[] = { | 
|  | CSIO_LNE_NONE,		/* None */ | 
|  | CSIO_LNE_NONE,		/* PLOGI_ACC_RCVD  */ | 
|  | CSIO_LNE_NONE,		/* PLOGI_RJT_RCVD  */ | 
|  | CSIO_LNE_NONE,		/* PLOGI_RCVD	   */ | 
|  | CSIO_LNE_NONE,		/* PLOGO_RCVD	   */ | 
|  | CSIO_LNE_NONE,		/* PRLI_ACC_RCVD   */ | 
|  | CSIO_LNE_NONE,		/* PRLI_RJT_RCVD   */ | 
|  | CSIO_LNE_NONE,		/* PRLI_RCVD	   */ | 
|  | CSIO_LNE_NONE,		/* PRLO_RCVD	   */ | 
|  | CSIO_LNE_NONE,		/* NPORT_ID_CHGD   */ | 
|  | CSIO_LNE_LOGO,		/* FLOGO_RCVD	   */ | 
|  | CSIO_LNE_LOGO,		/* CLR_VIRT_LNK_RCVD */ | 
|  | CSIO_LNE_FAB_INIT_DONE,/* FLOGI_ACC_RCVD   */ | 
|  | CSIO_LNE_NONE,		/* FLOGI_RJT_RCVD   */ | 
|  | CSIO_LNE_FAB_INIT_DONE,/* FDISC_ACC_RCVD   */ | 
|  | CSIO_LNE_NONE,		/* FDISC_RJT_RCVD   */ | 
|  | CSIO_LNE_NONE,		/* FLOGI_TMO_MAX_RETRY */ | 
|  | CSIO_LNE_NONE,		/* IMPL_LOGO_ADISC_ACC */ | 
|  | CSIO_LNE_NONE,		/* IMPL_LOGO_ADISC_RJT */ | 
|  | CSIO_LNE_NONE,		/* IMPL_LOGO_ADISC_CNFLT */ | 
|  | CSIO_LNE_NONE,		/* PRLI_TMO		*/ | 
|  | CSIO_LNE_NONE,		/* ADISC_TMO		*/ | 
|  | CSIO_LNE_NONE,		/* RSCN_DEV_LOST */ | 
|  | CSIO_LNE_NONE,		/* SCR_ACC_RCVD */ | 
|  | CSIO_LNE_NONE,		/* ADISC_RJT_RCVD */ | 
|  | CSIO_LNE_NONE,		/* LOGO_SNT */ | 
|  | CSIO_LNE_NONE,		/* PROTO_ERR_IMPL_LOGO */ | 
|  | }; | 
|  |  | 
|  | #define CSIO_FWE_TO_LNE(_evt)	((_evt > PROTO_ERR_IMPL_LOGO) ?		\ | 
|  | CSIO_LNE_NONE :	\ | 
|  | fwevt_to_lnevt[_evt]) | 
|  |  | 
|  | #define csio_ct_rsp(cp)		(((struct fc_ct_hdr *)cp)->ct_cmd) | 
|  | #define csio_ct_reason(cp)	(((struct fc_ct_hdr *)cp)->ct_reason) | 
|  | #define csio_ct_expl(cp)	(((struct fc_ct_hdr *)cp)->ct_explan) | 
|  | #define csio_ct_get_pld(cp)	((void *)(((uint8_t *)cp) + FC_CT_HDR_LEN)) | 
|  |  | 
|  | /* | 
|  | * csio_ln_match_by_portid - lookup lnode using given portid. | 
|  | * @hw: HW module | 
|  | * @portid: port-id. | 
|  | * | 
|  | * If found, returns lnode matching given portid otherwise returns NULL. | 
|  | */ | 
|  | static struct csio_lnode * | 
|  | csio_ln_lookup_by_portid(struct csio_hw *hw, uint8_t portid) | 
|  | { | 
|  | struct csio_lnode *ln; | 
|  | struct list_head *tmp; | 
|  |  | 
|  | /* Match siblings lnode with portid */ | 
|  | list_for_each(tmp, &hw->sln_head) { | 
|  | ln = (struct csio_lnode *) tmp; | 
|  | if (ln->portid == portid) | 
|  | return ln; | 
|  | } | 
|  |  | 
|  | return NULL; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_ln_lookup_by_vnpi - Lookup lnode using given vnp id. | 
|  | * @hw - HW module | 
|  | * @vnpi - vnp index. | 
|  | * Returns - If found, returns lnode matching given vnp id | 
|  | * otherwise returns NULL. | 
|  | */ | 
|  | static struct csio_lnode * | 
|  | csio_ln_lookup_by_vnpi(struct csio_hw *hw, uint32_t vnp_id) | 
|  | { | 
|  | struct list_head *tmp1, *tmp2; | 
|  | struct csio_lnode *sln = NULL, *cln = NULL; | 
|  |  | 
|  | if (list_empty(&hw->sln_head)) { | 
|  | CSIO_INC_STATS(hw, n_lnlkup_miss); | 
|  | return NULL; | 
|  | } | 
|  | /* Traverse sibling lnodes */ | 
|  | list_for_each(tmp1, &hw->sln_head) { | 
|  | sln = (struct csio_lnode *) tmp1; | 
|  |  | 
|  | /* Match sibling lnode */ | 
|  | if (sln->vnp_flowid == vnp_id) | 
|  | return sln; | 
|  |  | 
|  | if (list_empty(&sln->cln_head)) | 
|  | continue; | 
|  |  | 
|  | /* Traverse children lnodes */ | 
|  | list_for_each(tmp2, &sln->cln_head) { | 
|  | cln = (struct csio_lnode *) tmp2; | 
|  |  | 
|  | if (cln->vnp_flowid == vnp_id) | 
|  | return cln; | 
|  | } | 
|  | } | 
|  | CSIO_INC_STATS(hw, n_lnlkup_miss); | 
|  | return NULL; | 
|  | } | 
|  |  | 
|  | /** | 
|  | * csio_lnode_lookup_by_wwpn - Lookup lnode using given wwpn. | 
|  | * @hw:		HW module. | 
|  | * @wwpn:	WWPN. | 
|  | * | 
|  | * If found, returns lnode matching given wwpn, returns NULL otherwise. | 
|  | */ | 
|  | struct csio_lnode * | 
|  | csio_lnode_lookup_by_wwpn(struct csio_hw *hw, uint8_t *wwpn) | 
|  | { | 
|  | struct list_head *tmp1, *tmp2; | 
|  | struct csio_lnode *sln = NULL, *cln = NULL; | 
|  |  | 
|  | if (list_empty(&hw->sln_head)) { | 
|  | CSIO_INC_STATS(hw, n_lnlkup_miss); | 
|  | return NULL; | 
|  | } | 
|  | /* Traverse sibling lnodes */ | 
|  | list_for_each(tmp1, &hw->sln_head) { | 
|  | sln = (struct csio_lnode *) tmp1; | 
|  |  | 
|  | /* Match sibling lnode */ | 
|  | if (!memcmp(csio_ln_wwpn(sln), wwpn, 8)) | 
|  | return sln; | 
|  |  | 
|  | if (list_empty(&sln->cln_head)) | 
|  | continue; | 
|  |  | 
|  | /* Traverse children lnodes */ | 
|  | list_for_each(tmp2, &sln->cln_head) { | 
|  | cln = (struct csio_lnode *) tmp2; | 
|  |  | 
|  | if (!memcmp(csio_ln_wwpn(cln), wwpn, 8)) | 
|  | return cln; | 
|  | } | 
|  | } | 
|  | return NULL; | 
|  | } | 
|  |  | 
|  | /* FDMI */ | 
|  | static void | 
|  | csio_fill_ct_iu(void *buf, uint8_t type, uint8_t sub_type, uint16_t op) | 
|  | { | 
|  | struct fc_ct_hdr *cmd = (struct fc_ct_hdr *)buf; | 
|  | cmd->ct_rev = FC_CT_REV; | 
|  | cmd->ct_fs_type = type; | 
|  | cmd->ct_fs_subtype = sub_type; | 
|  | cmd->ct_cmd = htons(op); | 
|  | } | 
|  |  | 
|  | static int | 
|  | csio_hostname(uint8_t *buf, size_t buf_len) | 
|  | { | 
|  | if (snprintf(buf, buf_len, "%s", init_utsname()->nodename) > 0) | 
|  | return 0; | 
|  | return -1; | 
|  | } | 
|  |  | 
|  | static int | 
|  | csio_osname(uint8_t *buf, size_t buf_len) | 
|  | { | 
|  | if (snprintf(buf, buf_len, "%s %s %s", | 
|  | init_utsname()->sysname, | 
|  | init_utsname()->release, | 
|  | init_utsname()->version) > 0) | 
|  | return 0; | 
|  |  | 
|  | return -1; | 
|  | } | 
|  |  | 
|  | static inline void | 
|  | csio_append_attrib(uint8_t **ptr, uint16_t type, void *val, size_t val_len) | 
|  | { | 
|  | uint16_t len; | 
|  | struct fc_fdmi_attr_entry *ae = (struct fc_fdmi_attr_entry *)*ptr; | 
|  |  | 
|  | if (WARN_ON(val_len > U16_MAX)) | 
|  | return; | 
|  |  | 
|  | len = val_len; | 
|  |  | 
|  | ae->type = htons(type); | 
|  | len += 4;		/* includes attribute type and length */ | 
|  | len = (len + 3) & ~3;	/* should be multiple of 4 bytes */ | 
|  | ae->len = htons(len); | 
|  | memcpy(ae->value, val, val_len); | 
|  | if (len > val_len) | 
|  | memset(ae->value + val_len, 0, len - val_len); | 
|  | *ptr += len; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_ln_fdmi_done - FDMI registeration completion | 
|  | * @hw: HW context | 
|  | * @fdmi_req: fdmi request | 
|  | */ | 
|  | static void | 
|  | csio_ln_fdmi_done(struct csio_hw *hw, struct csio_ioreq *fdmi_req) | 
|  | { | 
|  | void *cmd; | 
|  | struct csio_lnode *ln = fdmi_req->lnode; | 
|  |  | 
|  | if (fdmi_req->wr_status != FW_SUCCESS) { | 
|  | csio_ln_dbg(ln, "WR error:%x in processing fdmi rpa cmd\n", | 
|  | fdmi_req->wr_status); | 
|  | CSIO_INC_STATS(ln, n_fdmi_err); | 
|  | } | 
|  |  | 
|  | cmd = fdmi_req->dma_buf.vaddr; | 
|  | if (ntohs(csio_ct_rsp(cmd)) != FC_FS_ACC) { | 
|  | csio_ln_dbg(ln, "fdmi rpa cmd rejected reason %x expl %x\n", | 
|  | csio_ct_reason(cmd), csio_ct_expl(cmd)); | 
|  | } | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_ln_fdmi_rhba_cbfn - RHBA completion | 
|  | * @hw: HW context | 
|  | * @fdmi_req: fdmi request | 
|  | */ | 
|  | static void | 
|  | csio_ln_fdmi_rhba_cbfn(struct csio_hw *hw, struct csio_ioreq *fdmi_req) | 
|  | { | 
|  | void *cmd; | 
|  | uint8_t *pld; | 
|  | uint32_t len = 0; | 
|  | __be32 val; | 
|  | __be16 mfs; | 
|  | uint32_t numattrs = 0; | 
|  | struct csio_lnode *ln = fdmi_req->lnode; | 
|  | struct fs_fdmi_attrs *attrib_blk; | 
|  | struct fc_fdmi_port_name *port_name; | 
|  | uint8_t buf[64]; | 
|  | uint8_t *fc4_type; | 
|  |  | 
|  | if (fdmi_req->wr_status != FW_SUCCESS) { | 
|  | csio_ln_dbg(ln, "WR error:%x in processing fdmi rhba cmd\n", | 
|  | fdmi_req->wr_status); | 
|  | CSIO_INC_STATS(ln, n_fdmi_err); | 
|  | } | 
|  |  | 
|  | cmd = fdmi_req->dma_buf.vaddr; | 
|  | if (ntohs(csio_ct_rsp(cmd)) != FC_FS_ACC) { | 
|  | csio_ln_dbg(ln, "fdmi rhba cmd rejected reason %x expl %x\n", | 
|  | csio_ct_reason(cmd), csio_ct_expl(cmd)); | 
|  | } | 
|  |  | 
|  | if (!csio_is_rnode_ready(fdmi_req->rnode)) { | 
|  | CSIO_INC_STATS(ln, n_fdmi_err); | 
|  | return; | 
|  | } | 
|  |  | 
|  | /* Prepare CT hdr for RPA cmd */ | 
|  | memset(cmd, 0, FC_CT_HDR_LEN); | 
|  | csio_fill_ct_iu(cmd, FC_FST_MGMT, FC_FDMI_SUBTYPE, FC_FDMI_RPA); | 
|  |  | 
|  | /* Prepare RPA payload */ | 
|  | pld = (uint8_t *)csio_ct_get_pld(cmd); | 
|  | port_name = (struct fc_fdmi_port_name *)pld; | 
|  | memcpy(&port_name->portname, csio_ln_wwpn(ln), 8); | 
|  | pld += sizeof(*port_name); | 
|  |  | 
|  | /* Start appending Port attributes */ | 
|  | attrib_blk = (struct fs_fdmi_attrs *)pld; | 
|  | attrib_blk->numattrs = 0; | 
|  | len += sizeof(attrib_blk->numattrs); | 
|  | pld += sizeof(attrib_blk->numattrs); | 
|  |  | 
|  | fc4_type = &buf[0]; | 
|  | memset(fc4_type, 0, FC_FDMI_PORT_ATTR_FC4TYPES_LEN); | 
|  | fc4_type[2] = 1; | 
|  | fc4_type[7] = 1; | 
|  | csio_append_attrib(&pld, FC_FDMI_PORT_ATTR_FC4TYPES, | 
|  | fc4_type, FC_FDMI_PORT_ATTR_FC4TYPES_LEN); | 
|  | numattrs++; | 
|  | val = htonl(FC_PORTSPEED_1GBIT | FC_PORTSPEED_10GBIT); | 
|  | csio_append_attrib(&pld, FC_FDMI_PORT_ATTR_SUPPORTEDSPEED, | 
|  | &val, | 
|  | FC_FDMI_PORT_ATTR_SUPPORTEDSPEED_LEN); | 
|  | numattrs++; | 
|  |  | 
|  | if (hw->pport[ln->portid].link_speed == FW_PORT_CAP_SPEED_1G) | 
|  | val = htonl(FC_PORTSPEED_1GBIT); | 
|  | else if (hw->pport[ln->portid].link_speed == FW_PORT_CAP_SPEED_10G) | 
|  | val = htonl(FC_PORTSPEED_10GBIT); | 
|  | else if (hw->pport[ln->portid].link_speed == FW_PORT_CAP32_SPEED_25G) | 
|  | val = htonl(FC_PORTSPEED_25GBIT); | 
|  | else if (hw->pport[ln->portid].link_speed == FW_PORT_CAP32_SPEED_40G) | 
|  | val = htonl(FC_PORTSPEED_40GBIT); | 
|  | else if (hw->pport[ln->portid].link_speed == FW_PORT_CAP32_SPEED_50G) | 
|  | val = htonl(FC_PORTSPEED_50GBIT); | 
|  | else if (hw->pport[ln->portid].link_speed == FW_PORT_CAP32_SPEED_100G) | 
|  | val = htonl(FC_PORTSPEED_100GBIT); | 
|  | else | 
|  | val = htonl(CSIO_HBA_PORTSPEED_UNKNOWN); | 
|  | csio_append_attrib(&pld, FC_FDMI_PORT_ATTR_CURRENTPORTSPEED, | 
|  | &val, FC_FDMI_PORT_ATTR_CURRENTPORTSPEED_LEN); | 
|  | numattrs++; | 
|  |  | 
|  | mfs = ln->ln_sparm.csp.sp_bb_data; | 
|  | csio_append_attrib(&pld, FC_FDMI_PORT_ATTR_MAXFRAMESIZE, | 
|  | &mfs, sizeof(mfs)); | 
|  | numattrs++; | 
|  |  | 
|  | strcpy(buf, "csiostor"); | 
|  | csio_append_attrib(&pld, FC_FDMI_PORT_ATTR_OSDEVICENAME, buf, | 
|  | strlen(buf)); | 
|  | numattrs++; | 
|  |  | 
|  | if (!csio_hostname(buf, sizeof(buf))) { | 
|  | csio_append_attrib(&pld, FC_FDMI_PORT_ATTR_HOSTNAME, | 
|  | buf, strlen(buf)); | 
|  | numattrs++; | 
|  | } | 
|  | attrib_blk->numattrs = htonl(numattrs); | 
|  | len = (uint32_t)(pld - (uint8_t *)cmd); | 
|  |  | 
|  | /* Submit FDMI RPA request */ | 
|  | spin_lock_irq(&hw->lock); | 
|  | if (csio_ln_mgmt_submit_req(fdmi_req, csio_ln_fdmi_done, | 
|  | FCOE_CT, &fdmi_req->dma_buf, len)) { | 
|  | CSIO_INC_STATS(ln, n_fdmi_err); | 
|  | csio_ln_dbg(ln, "Failed to issue fdmi rpa req\n"); | 
|  | } | 
|  | spin_unlock_irq(&hw->lock); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_ln_fdmi_dprt_cbfn - DPRT completion | 
|  | * @hw: HW context | 
|  | * @fdmi_req: fdmi request | 
|  | */ | 
|  | static void | 
|  | csio_ln_fdmi_dprt_cbfn(struct csio_hw *hw, struct csio_ioreq *fdmi_req) | 
|  | { | 
|  | void *cmd; | 
|  | uint8_t *pld; | 
|  | uint32_t len = 0; | 
|  | uint32_t numattrs = 0; | 
|  | __be32  maxpayload = htonl(65536); | 
|  | struct fc_fdmi_hba_identifier *hbaid; | 
|  | struct csio_lnode *ln = fdmi_req->lnode; | 
|  | struct fc_fdmi_rpl *reg_pl; | 
|  | struct fs_fdmi_attrs *attrib_blk; | 
|  | uint8_t buf[64]; | 
|  |  | 
|  | if (fdmi_req->wr_status != FW_SUCCESS) { | 
|  | csio_ln_dbg(ln, "WR error:%x in processing fdmi dprt cmd\n", | 
|  | fdmi_req->wr_status); | 
|  | CSIO_INC_STATS(ln, n_fdmi_err); | 
|  | } | 
|  |  | 
|  | if (!csio_is_rnode_ready(fdmi_req->rnode)) { | 
|  | CSIO_INC_STATS(ln, n_fdmi_err); | 
|  | return; | 
|  | } | 
|  | cmd = fdmi_req->dma_buf.vaddr; | 
|  | if (ntohs(csio_ct_rsp(cmd)) != FC_FS_ACC) { | 
|  | csio_ln_dbg(ln, "fdmi dprt cmd rejected reason %x expl %x\n", | 
|  | csio_ct_reason(cmd), csio_ct_expl(cmd)); | 
|  | } | 
|  |  | 
|  | /* Prepare CT hdr for RHBA cmd */ | 
|  | memset(cmd, 0, FC_CT_HDR_LEN); | 
|  | csio_fill_ct_iu(cmd, FC_FST_MGMT, FC_FDMI_SUBTYPE, FC_FDMI_RHBA); | 
|  | len = FC_CT_HDR_LEN; | 
|  |  | 
|  | /* Prepare RHBA payload */ | 
|  | pld = (uint8_t *)csio_ct_get_pld(cmd); | 
|  | hbaid = (struct fc_fdmi_hba_identifier *)pld; | 
|  | memcpy(&hbaid->id, csio_ln_wwpn(ln), 8); /* HBA identifer */ | 
|  | pld += sizeof(*hbaid); | 
|  |  | 
|  | /* Register one port per hba */ | 
|  | reg_pl = (struct fc_fdmi_rpl *)pld; | 
|  | reg_pl->numport = htonl(1); | 
|  | memcpy(®_pl->port[0].portname, csio_ln_wwpn(ln), 8); | 
|  | pld += sizeof(*reg_pl); | 
|  |  | 
|  | /* Start appending HBA attributes hba */ | 
|  | attrib_blk = (struct fs_fdmi_attrs *)pld; | 
|  | attrib_blk->numattrs = 0; | 
|  | len += sizeof(attrib_blk->numattrs); | 
|  | pld += sizeof(attrib_blk->numattrs); | 
|  |  | 
|  | csio_append_attrib(&pld, FC_FDMI_HBA_ATTR_NODENAME, csio_ln_wwnn(ln), | 
|  | FC_FDMI_HBA_ATTR_NODENAME_LEN); | 
|  | numattrs++; | 
|  |  | 
|  | memset(buf, 0, sizeof(buf)); | 
|  |  | 
|  | strcpy(buf, "Chelsio Communications"); | 
|  | csio_append_attrib(&pld, FC_FDMI_HBA_ATTR_MANUFACTURER, buf, | 
|  | strlen(buf)); | 
|  | numattrs++; | 
|  | csio_append_attrib(&pld, FC_FDMI_HBA_ATTR_SERIALNUMBER, | 
|  | hw->vpd.sn, sizeof(hw->vpd.sn)); | 
|  | numattrs++; | 
|  | csio_append_attrib(&pld, FC_FDMI_HBA_ATTR_MODEL, hw->vpd.id, | 
|  | sizeof(hw->vpd.id)); | 
|  | numattrs++; | 
|  | csio_append_attrib(&pld, FC_FDMI_HBA_ATTR_MODELDESCRIPTION, | 
|  | hw->model_desc, strlen(hw->model_desc)); | 
|  | numattrs++; | 
|  | csio_append_attrib(&pld, FC_FDMI_HBA_ATTR_HARDWAREVERSION, | 
|  | hw->hw_ver, sizeof(hw->hw_ver)); | 
|  | numattrs++; | 
|  | csio_append_attrib(&pld, FC_FDMI_HBA_ATTR_FIRMWAREVERSION, | 
|  | hw->fwrev_str, strlen(hw->fwrev_str)); | 
|  | numattrs++; | 
|  |  | 
|  | if (!csio_osname(buf, sizeof(buf))) { | 
|  | csio_append_attrib(&pld, FC_FDMI_HBA_ATTR_OSNAMEVERSION, | 
|  | buf, strlen(buf)); | 
|  | numattrs++; | 
|  | } | 
|  |  | 
|  | csio_append_attrib(&pld, FC_FDMI_HBA_ATTR_MAXCTPAYLOAD, | 
|  | &maxpayload, FC_FDMI_HBA_ATTR_MAXCTPAYLOAD_LEN); | 
|  | len = (uint32_t)(pld - (uint8_t *)cmd); | 
|  | numattrs++; | 
|  | attrib_blk->numattrs = htonl(numattrs); | 
|  |  | 
|  | /* Submit FDMI RHBA request */ | 
|  | spin_lock_irq(&hw->lock); | 
|  | if (csio_ln_mgmt_submit_req(fdmi_req, csio_ln_fdmi_rhba_cbfn, | 
|  | FCOE_CT, &fdmi_req->dma_buf, len)) { | 
|  | CSIO_INC_STATS(ln, n_fdmi_err); | 
|  | csio_ln_dbg(ln, "Failed to issue fdmi rhba req\n"); | 
|  | } | 
|  | spin_unlock_irq(&hw->lock); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_ln_fdmi_dhba_cbfn - DHBA completion | 
|  | * @hw: HW context | 
|  | * @fdmi_req: fdmi request | 
|  | */ | 
|  | static void | 
|  | csio_ln_fdmi_dhba_cbfn(struct csio_hw *hw, struct csio_ioreq *fdmi_req) | 
|  | { | 
|  | struct csio_lnode *ln = fdmi_req->lnode; | 
|  | void *cmd; | 
|  | struct fc_fdmi_port_name *port_name; | 
|  | uint32_t len; | 
|  |  | 
|  | if (fdmi_req->wr_status != FW_SUCCESS) { | 
|  | csio_ln_dbg(ln, "WR error:%x in processing fdmi dhba cmd\n", | 
|  | fdmi_req->wr_status); | 
|  | CSIO_INC_STATS(ln, n_fdmi_err); | 
|  | } | 
|  |  | 
|  | if (!csio_is_rnode_ready(fdmi_req->rnode)) { | 
|  | CSIO_INC_STATS(ln, n_fdmi_err); | 
|  | return; | 
|  | } | 
|  | cmd = fdmi_req->dma_buf.vaddr; | 
|  | if (ntohs(csio_ct_rsp(cmd)) != FC_FS_ACC) { | 
|  | csio_ln_dbg(ln, "fdmi dhba cmd rejected reason %x expl %x\n", | 
|  | csio_ct_reason(cmd), csio_ct_expl(cmd)); | 
|  | } | 
|  |  | 
|  | /* Send FDMI cmd to de-register any Port attributes if registered | 
|  | * before | 
|  | */ | 
|  |  | 
|  | /* Prepare FDMI DPRT cmd */ | 
|  | memset(cmd, 0, FC_CT_HDR_LEN); | 
|  | csio_fill_ct_iu(cmd, FC_FST_MGMT, FC_FDMI_SUBTYPE, FC_FDMI_DPRT); | 
|  | len = FC_CT_HDR_LEN; | 
|  | port_name = (struct fc_fdmi_port_name *)csio_ct_get_pld(cmd); | 
|  | memcpy(&port_name->portname, csio_ln_wwpn(ln), 8); | 
|  | len += sizeof(*port_name); | 
|  |  | 
|  | /* Submit FDMI request */ | 
|  | spin_lock_irq(&hw->lock); | 
|  | if (csio_ln_mgmt_submit_req(fdmi_req, csio_ln_fdmi_dprt_cbfn, | 
|  | FCOE_CT, &fdmi_req->dma_buf, len)) { | 
|  | CSIO_INC_STATS(ln, n_fdmi_err); | 
|  | csio_ln_dbg(ln, "Failed to issue fdmi dprt req\n"); | 
|  | } | 
|  | spin_unlock_irq(&hw->lock); | 
|  | } | 
|  |  | 
|  | /** | 
|  | * csio_ln_fdmi_start - Start an FDMI request. | 
|  | * @ln:		lnode | 
|  | * @context:	session context | 
|  | * | 
|  | * Issued with lock held. | 
|  | */ | 
|  | int | 
|  | csio_ln_fdmi_start(struct csio_lnode *ln, void *context) | 
|  | { | 
|  | struct csio_ioreq *fdmi_req; | 
|  | struct csio_rnode *fdmi_rn = (struct csio_rnode *)context; | 
|  | void *cmd; | 
|  | struct fc_fdmi_hba_identifier *hbaid; | 
|  | uint32_t len; | 
|  |  | 
|  | if (!(ln->flags & CSIO_LNF_FDMI_ENABLE)) | 
|  | return -EPROTONOSUPPORT; | 
|  |  | 
|  | if (!csio_is_rnode_ready(fdmi_rn)) | 
|  | CSIO_INC_STATS(ln, n_fdmi_err); | 
|  |  | 
|  | /* Send FDMI cmd to de-register any HBA attributes if registered | 
|  | * before | 
|  | */ | 
|  |  | 
|  | fdmi_req = ln->mgmt_req; | 
|  | fdmi_req->lnode = ln; | 
|  | fdmi_req->rnode = fdmi_rn; | 
|  |  | 
|  | /* Prepare FDMI DHBA cmd */ | 
|  | cmd = fdmi_req->dma_buf.vaddr; | 
|  | memset(cmd, 0, FC_CT_HDR_LEN); | 
|  | csio_fill_ct_iu(cmd, FC_FST_MGMT, FC_FDMI_SUBTYPE, FC_FDMI_DHBA); | 
|  | len = FC_CT_HDR_LEN; | 
|  |  | 
|  | hbaid = (struct fc_fdmi_hba_identifier *)csio_ct_get_pld(cmd); | 
|  | memcpy(&hbaid->id, csio_ln_wwpn(ln), 8); | 
|  | len += sizeof(*hbaid); | 
|  |  | 
|  | /* Submit FDMI request */ | 
|  | if (csio_ln_mgmt_submit_req(fdmi_req, csio_ln_fdmi_dhba_cbfn, | 
|  | FCOE_CT, &fdmi_req->dma_buf, len)) { | 
|  | CSIO_INC_STATS(ln, n_fdmi_err); | 
|  | csio_ln_dbg(ln, "Failed to issue fdmi dhba req\n"); | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_ln_vnp_read_cbfn - vnp read completion handler. | 
|  | * @hw: HW lnode | 
|  | * @cbfn: Completion handler. | 
|  | * | 
|  | * Reads vnp response and updates ln parameters. | 
|  | */ | 
|  | static void | 
|  | csio_ln_vnp_read_cbfn(struct csio_hw *hw, struct csio_mb *mbp) | 
|  | { | 
|  | struct csio_lnode *ln = ((struct csio_lnode *)mbp->priv); | 
|  | struct fw_fcoe_vnp_cmd *rsp = (struct fw_fcoe_vnp_cmd *)(mbp->mb); | 
|  | struct fc_els_csp *csp; | 
|  | struct fc_els_cssp *clsp; | 
|  | enum fw_retval retval; | 
|  | __be32 nport_id; | 
|  |  | 
|  | retval = FW_CMD_RETVAL_G(ntohl(rsp->alloc_to_len16)); | 
|  | if (retval != FW_SUCCESS) { | 
|  | csio_err(hw, "FCOE VNP read cmd returned error:0x%x\n", retval); | 
|  | mempool_free(mbp, hw->mb_mempool); | 
|  | return; | 
|  | } | 
|  |  | 
|  | spin_lock_irq(&hw->lock); | 
|  |  | 
|  | memcpy(ln->mac, rsp->vnport_mac, sizeof(ln->mac)); | 
|  | memcpy(&nport_id, &rsp->vnport_mac[3], sizeof(uint8_t)*3); | 
|  | ln->nport_id = ntohl(nport_id); | 
|  | ln->nport_id = ln->nport_id >> 8; | 
|  |  | 
|  | /* Update WWNs */ | 
|  | /* | 
|  | * This may look like a duplication of what csio_fcoe_enable_link() | 
|  | * does, but is absolutely necessary if the vnpi changes between | 
|  | * a FCOE LINK UP and FCOE LINK DOWN. | 
|  | */ | 
|  | memcpy(csio_ln_wwnn(ln), rsp->vnport_wwnn, 8); | 
|  | memcpy(csio_ln_wwpn(ln), rsp->vnport_wwpn, 8); | 
|  |  | 
|  | /* Copy common sparam */ | 
|  | csp = (struct fc_els_csp *)rsp->cmn_srv_parms; | 
|  | ln->ln_sparm.csp.sp_hi_ver = csp->sp_hi_ver; | 
|  | ln->ln_sparm.csp.sp_lo_ver = csp->sp_lo_ver; | 
|  | ln->ln_sparm.csp.sp_bb_cred = csp->sp_bb_cred; | 
|  | ln->ln_sparm.csp.sp_features = csp->sp_features; | 
|  | ln->ln_sparm.csp.sp_bb_data = csp->sp_bb_data; | 
|  | ln->ln_sparm.csp.sp_r_a_tov = csp->sp_r_a_tov; | 
|  | ln->ln_sparm.csp.sp_e_d_tov = csp->sp_e_d_tov; | 
|  |  | 
|  | /* Copy word 0 & word 1 of class sparam */ | 
|  | clsp = (struct fc_els_cssp *)rsp->clsp_word_0_1; | 
|  | ln->ln_sparm.clsp[2].cp_class = clsp->cp_class; | 
|  | ln->ln_sparm.clsp[2].cp_init = clsp->cp_init; | 
|  | ln->ln_sparm.clsp[2].cp_recip = clsp->cp_recip; | 
|  | ln->ln_sparm.clsp[2].cp_rdfs = clsp->cp_rdfs; | 
|  |  | 
|  | spin_unlock_irq(&hw->lock); | 
|  |  | 
|  | mempool_free(mbp, hw->mb_mempool); | 
|  |  | 
|  | /* Send an event to update local attribs */ | 
|  | csio_lnode_async_event(ln, CSIO_LN_FC_ATTRIB_UPDATE); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_ln_vnp_read - Read vnp params. | 
|  | * @ln: lnode | 
|  | * @cbfn: Completion handler. | 
|  | * | 
|  | * Issued with lock held. | 
|  | */ | 
|  | static int | 
|  | csio_ln_vnp_read(struct csio_lnode *ln, | 
|  | void (*cbfn) (struct csio_hw *, struct csio_mb *)) | 
|  | { | 
|  | struct csio_hw *hw = ln->hwp; | 
|  | struct csio_mb  *mbp; | 
|  |  | 
|  | /* Allocate Mbox request */ | 
|  | mbp = mempool_alloc(hw->mb_mempool, GFP_ATOMIC); | 
|  | if (!mbp) { | 
|  | CSIO_INC_STATS(hw, n_err_nomem); | 
|  | return -ENOMEM; | 
|  | } | 
|  |  | 
|  | /* Prepare VNP Command */ | 
|  | csio_fcoe_vnp_read_init_mb(ln, mbp, | 
|  | CSIO_MB_DEFAULT_TMO, | 
|  | ln->fcf_flowid, | 
|  | ln->vnp_flowid, | 
|  | cbfn); | 
|  |  | 
|  | /* Issue MBOX cmd */ | 
|  | if (csio_mb_issue(hw, mbp)) { | 
|  | csio_err(hw, "Failed to issue mbox FCoE VNP command\n"); | 
|  | mempool_free(mbp, hw->mb_mempool); | 
|  | return -EINVAL; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_fcoe_enable_link - Enable fcoe link. | 
|  | * @ln: lnode | 
|  | * @enable: enable/disable | 
|  | * Issued with lock held. | 
|  | * Issues mbox cmd to bring up FCOE link on port associated with given ln. | 
|  | */ | 
|  | static int | 
|  | csio_fcoe_enable_link(struct csio_lnode *ln, bool enable) | 
|  | { | 
|  | struct csio_hw *hw = ln->hwp; | 
|  | struct csio_mb  *mbp; | 
|  | enum fw_retval retval; | 
|  | uint8_t portid; | 
|  | uint8_t sub_op; | 
|  | struct fw_fcoe_link_cmd *lcmd; | 
|  | int i; | 
|  |  | 
|  | mbp = mempool_alloc(hw->mb_mempool, GFP_ATOMIC); | 
|  | if (!mbp) { | 
|  | CSIO_INC_STATS(hw, n_err_nomem); | 
|  | return -ENOMEM; | 
|  | } | 
|  |  | 
|  | portid = ln->portid; | 
|  | sub_op = enable ? FCOE_LINK_UP : FCOE_LINK_DOWN; | 
|  |  | 
|  | csio_dbg(hw, "bringing FCOE LINK %s on Port:%d\n", | 
|  | sub_op ? "UP" : "DOWN", portid); | 
|  |  | 
|  | csio_write_fcoe_link_cond_init_mb(ln, mbp, CSIO_MB_DEFAULT_TMO, | 
|  | portid, sub_op, 0, 0, 0, NULL); | 
|  |  | 
|  | if (csio_mb_issue(hw, mbp)) { | 
|  | csio_err(hw, "failed to issue FCOE LINK cmd on port[%d]\n", | 
|  | portid); | 
|  | mempool_free(mbp, hw->mb_mempool); | 
|  | return -EINVAL; | 
|  | } | 
|  |  | 
|  | retval = csio_mb_fw_retval(mbp); | 
|  | if (retval != FW_SUCCESS) { | 
|  | csio_err(hw, | 
|  | "FCOE LINK %s cmd on port[%d] failed with " | 
|  | "ret:x%x\n", sub_op ? "UP" : "DOWN", portid, retval); | 
|  | mempool_free(mbp, hw->mb_mempool); | 
|  | return -EINVAL; | 
|  | } | 
|  |  | 
|  | if (!enable) | 
|  | goto out; | 
|  |  | 
|  | lcmd = (struct fw_fcoe_link_cmd *)mbp->mb; | 
|  |  | 
|  | memcpy(csio_ln_wwnn(ln), lcmd->vnport_wwnn, 8); | 
|  | memcpy(csio_ln_wwpn(ln), lcmd->vnport_wwpn, 8); | 
|  |  | 
|  | for (i = 0; i < CSIO_MAX_PPORTS; i++) | 
|  | if (hw->pport[i].portid == portid) | 
|  | memcpy(hw->pport[i].mac, lcmd->phy_mac, 6); | 
|  |  | 
|  | out: | 
|  | mempool_free(mbp, hw->mb_mempool); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_ln_read_fcf_cbfn - Read fcf parameters | 
|  | * @ln: lnode | 
|  | * | 
|  | * read fcf response and Update ln fcf information. | 
|  | */ | 
|  | static void | 
|  | csio_ln_read_fcf_cbfn(struct csio_hw *hw, struct csio_mb *mbp) | 
|  | { | 
|  | struct csio_lnode *ln = (struct csio_lnode *)mbp->priv; | 
|  | struct csio_fcf_info	*fcf_info; | 
|  | struct fw_fcoe_fcf_cmd *rsp = | 
|  | (struct fw_fcoe_fcf_cmd *)(mbp->mb); | 
|  | enum fw_retval retval; | 
|  |  | 
|  | retval = FW_CMD_RETVAL_G(ntohl(rsp->retval_len16)); | 
|  | if (retval != FW_SUCCESS) { | 
|  | csio_ln_err(ln, "FCOE FCF cmd failed with ret x%x\n", | 
|  | retval); | 
|  | mempool_free(mbp, hw->mb_mempool); | 
|  | return; | 
|  | } | 
|  |  | 
|  | spin_lock_irq(&hw->lock); | 
|  | fcf_info = ln->fcfinfo; | 
|  | fcf_info->priority = FW_FCOE_FCF_CMD_PRIORITY_GET( | 
|  | ntohs(rsp->priority_pkd)); | 
|  | fcf_info->vf_id = ntohs(rsp->vf_id); | 
|  | fcf_info->vlan_id = rsp->vlan_id; | 
|  | fcf_info->max_fcoe_size = ntohs(rsp->max_fcoe_size); | 
|  | fcf_info->fka_adv = be32_to_cpu(rsp->fka_adv); | 
|  | fcf_info->fcfi = FW_FCOE_FCF_CMD_FCFI_GET(ntohl(rsp->op_to_fcfi)); | 
|  | fcf_info->fpma = FW_FCOE_FCF_CMD_FPMA_GET(rsp->fpma_to_portid); | 
|  | fcf_info->spma = FW_FCOE_FCF_CMD_SPMA_GET(rsp->fpma_to_portid); | 
|  | fcf_info->login = FW_FCOE_FCF_CMD_LOGIN_GET(rsp->fpma_to_portid); | 
|  | fcf_info->portid = FW_FCOE_FCF_CMD_PORTID_GET(rsp->fpma_to_portid); | 
|  | memcpy(fcf_info->fc_map, rsp->fc_map, sizeof(fcf_info->fc_map)); | 
|  | memcpy(fcf_info->mac, rsp->mac, sizeof(fcf_info->mac)); | 
|  | memcpy(fcf_info->name_id, rsp->name_id, sizeof(fcf_info->name_id)); | 
|  | memcpy(fcf_info->fabric, rsp->fabric, sizeof(fcf_info->fabric)); | 
|  | memcpy(fcf_info->spma_mac, rsp->spma_mac, sizeof(fcf_info->spma_mac)); | 
|  |  | 
|  | spin_unlock_irq(&hw->lock); | 
|  |  | 
|  | mempool_free(mbp, hw->mb_mempool); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_ln_read_fcf_entry - Read fcf entry. | 
|  | * @ln: lnode | 
|  | * @cbfn: Completion handler. | 
|  | * | 
|  | * Issued with lock held. | 
|  | */ | 
|  | static int | 
|  | csio_ln_read_fcf_entry(struct csio_lnode *ln, | 
|  | void (*cbfn) (struct csio_hw *, struct csio_mb *)) | 
|  | { | 
|  | struct csio_hw *hw = ln->hwp; | 
|  | struct csio_mb  *mbp; | 
|  |  | 
|  | mbp = mempool_alloc(hw->mb_mempool, GFP_ATOMIC); | 
|  | if (!mbp) { | 
|  | CSIO_INC_STATS(hw, n_err_nomem); | 
|  | return -ENOMEM; | 
|  | } | 
|  |  | 
|  | /* Get FCoE FCF information */ | 
|  | csio_fcoe_read_fcf_init_mb(ln, mbp, CSIO_MB_DEFAULT_TMO, | 
|  | ln->portid, ln->fcf_flowid, cbfn); | 
|  |  | 
|  | if (csio_mb_issue(hw, mbp)) { | 
|  | csio_err(hw, "failed to issue FCOE FCF cmd\n"); | 
|  | mempool_free(mbp, hw->mb_mempool); | 
|  | return -EINVAL; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_handle_link_up - Logical Linkup event. | 
|  | * @hw - HW module. | 
|  | * @portid - Physical port number | 
|  | * @fcfi - FCF index. | 
|  | * @vnpi - VNP index. | 
|  | * Returns - none. | 
|  | * | 
|  | * This event is received from FW, when virtual link is established between | 
|  | * Physical port[ENode] and FCF. If its new vnpi, then local node object is | 
|  | * created on this FCF and set to [ONLINE] state. | 
|  | * Lnode waits for FW_RDEV_CMD event to be received indicating that | 
|  | * Fabric login is completed and lnode moves to [READY] state. | 
|  | * | 
|  | * This called with hw lock held | 
|  | */ | 
|  | static void | 
|  | csio_handle_link_up(struct csio_hw *hw, uint8_t portid, uint32_t fcfi, | 
|  | uint32_t vnpi) | 
|  | { | 
|  | struct csio_lnode *ln = NULL; | 
|  |  | 
|  | /* Lookup lnode based on vnpi */ | 
|  | ln = csio_ln_lookup_by_vnpi(hw, vnpi); | 
|  | if (!ln) { | 
|  | /* Pick lnode based on portid */ | 
|  | ln = csio_ln_lookup_by_portid(hw, portid); | 
|  | if (!ln) { | 
|  | csio_err(hw, "failed to lookup fcoe lnode on port:%d\n", | 
|  | portid); | 
|  | CSIO_DB_ASSERT(0); | 
|  | return; | 
|  | } | 
|  |  | 
|  | /* Check if lnode has valid vnp flowid */ | 
|  | if (ln->vnp_flowid != CSIO_INVALID_IDX) { | 
|  | /* New VN-Port */ | 
|  | spin_unlock_irq(&hw->lock); | 
|  | csio_lnode_alloc(hw); | 
|  | spin_lock_irq(&hw->lock); | 
|  | if (!ln) { | 
|  | csio_err(hw, | 
|  | "failed to allocate fcoe lnode" | 
|  | "for port:%d vnpi:x%x\n", | 
|  | portid, vnpi); | 
|  | CSIO_DB_ASSERT(0); | 
|  | return; | 
|  | } | 
|  | ln->portid = portid; | 
|  | } | 
|  | ln->vnp_flowid = vnpi; | 
|  | ln->dev_num &= ~0xFFFF; | 
|  | ln->dev_num |= vnpi; | 
|  | } | 
|  |  | 
|  | /*Initialize fcfi */ | 
|  | ln->fcf_flowid = fcfi; | 
|  |  | 
|  | csio_info(hw, "Port:%d - FCOE LINK UP\n", portid); | 
|  |  | 
|  | CSIO_INC_STATS(ln, n_link_up); | 
|  |  | 
|  | /* Send LINKUP event to SM */ | 
|  | csio_post_event(&ln->sm, CSIO_LNE_LINKUP); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_post_event_rns | 
|  | * @ln - FCOE lnode | 
|  | * @evt - Given rnode event | 
|  | * Returns - none | 
|  | * | 
|  | * Posts given rnode event to all FCOE rnodes connected with given Lnode. | 
|  | * This routine is invoked when lnode receives LINK_DOWN/DOWN_LINK/CLOSE | 
|  | * event. | 
|  | * | 
|  | * This called with hw lock held | 
|  | */ | 
|  | static void | 
|  | csio_post_event_rns(struct csio_lnode *ln, enum csio_rn_ev evt) | 
|  | { | 
|  | struct csio_rnode *rnhead = (struct csio_rnode *) &ln->rnhead; | 
|  | struct list_head *tmp, *next; | 
|  | struct csio_rnode *rn; | 
|  |  | 
|  | list_for_each_safe(tmp, next, &rnhead->sm.sm_list) { | 
|  | rn = (struct csio_rnode *) tmp; | 
|  | csio_post_event(&rn->sm, evt); | 
|  | } | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_cleanup_rns | 
|  | * @ln - FCOE lnode | 
|  | * Returns - none | 
|  | * | 
|  | * Frees all FCOE rnodes connected with given Lnode. | 
|  | * | 
|  | * This called with hw lock held | 
|  | */ | 
|  | static void | 
|  | csio_cleanup_rns(struct csio_lnode *ln) | 
|  | { | 
|  | struct csio_rnode *rnhead = (struct csio_rnode *) &ln->rnhead; | 
|  | struct list_head *tmp, *next_rn; | 
|  | struct csio_rnode *rn; | 
|  |  | 
|  | list_for_each_safe(tmp, next_rn, &rnhead->sm.sm_list) { | 
|  | rn = (struct csio_rnode *) tmp; | 
|  | csio_put_rnode(ln, rn); | 
|  | } | 
|  |  | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_post_event_lns | 
|  | * @ln - FCOE lnode | 
|  | * @evt - Given lnode event | 
|  | * Returns - none | 
|  | * | 
|  | * Posts given lnode event to all FCOE lnodes connected with given Lnode. | 
|  | * This routine is invoked when lnode receives LINK_DOWN/DOWN_LINK/CLOSE | 
|  | * event. | 
|  | * | 
|  | * This called with hw lock held | 
|  | */ | 
|  | static void | 
|  | csio_post_event_lns(struct csio_lnode *ln, enum csio_ln_ev evt) | 
|  | { | 
|  | struct list_head *tmp; | 
|  | struct csio_lnode *cln, *sln; | 
|  |  | 
|  | /* If NPIV lnode, send evt only to that and return */ | 
|  | if (csio_is_npiv_ln(ln)) { | 
|  | csio_post_event(&ln->sm, evt); | 
|  | return; | 
|  | } | 
|  |  | 
|  | sln = ln; | 
|  | /* Traverse children lnodes list and send evt */ | 
|  | list_for_each(tmp, &sln->cln_head) { | 
|  | cln = (struct csio_lnode *) tmp; | 
|  | csio_post_event(&cln->sm, evt); | 
|  | } | 
|  |  | 
|  | /* Send evt to parent lnode */ | 
|  | csio_post_event(&ln->sm, evt); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_ln_down - Lcoal nport is down | 
|  | * @ln - FCOE Lnode | 
|  | * Returns - none | 
|  | * | 
|  | * Sends LINK_DOWN events to Lnode and its associated NPIVs lnodes. | 
|  | * | 
|  | * This called with hw lock held | 
|  | */ | 
|  | static void | 
|  | csio_ln_down(struct csio_lnode *ln) | 
|  | { | 
|  | csio_post_event_lns(ln, CSIO_LNE_LINK_DOWN); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_handle_link_down - Logical Linkdown event. | 
|  | * @hw - HW module. | 
|  | * @portid - Physical port number | 
|  | * @fcfi - FCF index. | 
|  | * @vnpi - VNP index. | 
|  | * Returns - none | 
|  | * | 
|  | * This event is received from FW, when virtual link goes down between | 
|  | * Physical port[ENode] and FCF. Lnode and its associated NPIVs lnode hosted on | 
|  | * this vnpi[VN-Port] will be de-instantiated. | 
|  | * | 
|  | * This called with hw lock held | 
|  | */ | 
|  | static void | 
|  | csio_handle_link_down(struct csio_hw *hw, uint8_t portid, uint32_t fcfi, | 
|  | uint32_t vnpi) | 
|  | { | 
|  | struct csio_fcf_info *fp; | 
|  | struct csio_lnode *ln; | 
|  |  | 
|  | /* Lookup lnode based on vnpi */ | 
|  | ln = csio_ln_lookup_by_vnpi(hw, vnpi); | 
|  | if (ln) { | 
|  | fp = ln->fcfinfo; | 
|  | CSIO_INC_STATS(ln, n_link_down); | 
|  |  | 
|  | /*Warn if linkdown received if lnode is not in ready state */ | 
|  | if (!csio_is_lnode_ready(ln)) { | 
|  | csio_ln_warn(ln, | 
|  | "warn: FCOE link is already in offline " | 
|  | "Ignoring Fcoe linkdown event on portid %d\n", | 
|  | portid); | 
|  | CSIO_INC_STATS(ln, n_evt_drop); | 
|  | return; | 
|  | } | 
|  |  | 
|  | /* Verify portid */ | 
|  | if (fp->portid != portid) { | 
|  | csio_ln_warn(ln, | 
|  | "warn: FCOE linkdown recv with " | 
|  | "invalid port %d\n", portid); | 
|  | CSIO_INC_STATS(ln, n_evt_drop); | 
|  | return; | 
|  | } | 
|  |  | 
|  | /* verify fcfi */ | 
|  | if (ln->fcf_flowid != fcfi) { | 
|  | csio_ln_warn(ln, | 
|  | "warn: FCOE linkdown recv with " | 
|  | "invalid fcfi x%x\n", fcfi); | 
|  | CSIO_INC_STATS(ln, n_evt_drop); | 
|  | return; | 
|  | } | 
|  |  | 
|  | csio_info(hw, "Port:%d - FCOE LINK DOWN\n", portid); | 
|  |  | 
|  | /* Send LINK_DOWN event to lnode s/m */ | 
|  | csio_ln_down(ln); | 
|  |  | 
|  | return; | 
|  | } else { | 
|  | csio_warn(hw, | 
|  | "warn: FCOE linkdown recv with invalid vnpi x%x\n", | 
|  | vnpi); | 
|  | CSIO_INC_STATS(hw, n_evt_drop); | 
|  | } | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_is_lnode_ready - Checks FCOE lnode is in ready state. | 
|  | * @ln: Lnode module | 
|  | * | 
|  | * Returns True if FCOE lnode is in ready state. | 
|  | */ | 
|  | int | 
|  | csio_is_lnode_ready(struct csio_lnode *ln) | 
|  | { | 
|  | return (csio_get_state(ln) == ((csio_sm_state_t)csio_lns_ready)); | 
|  | } | 
|  |  | 
|  | /*****************************************************************************/ | 
|  | /* START: Lnode SM                                                           */ | 
|  | /*****************************************************************************/ | 
|  | /* | 
|  | * csio_lns_uninit - The request in uninit state. | 
|  | * @ln - FCOE lnode. | 
|  | * @evt - Event to be processed. | 
|  | * | 
|  | * Process the given lnode event which is currently in "uninit" state. | 
|  | * Invoked with HW lock held. | 
|  | * Return - none. | 
|  | */ | 
|  | static void | 
|  | csio_lns_uninit(struct csio_lnode *ln, enum csio_ln_ev evt) | 
|  | { | 
|  | struct csio_hw *hw = csio_lnode_to_hw(ln); | 
|  | struct csio_lnode *rln = hw->rln; | 
|  | int rv; | 
|  |  | 
|  | CSIO_INC_STATS(ln, n_evt_sm[evt]); | 
|  | switch (evt) { | 
|  | case CSIO_LNE_LINKUP: | 
|  | csio_set_state(&ln->sm, csio_lns_online); | 
|  | /* Read FCF only for physical lnode */ | 
|  | if (csio_is_phys_ln(ln)) { | 
|  | rv = csio_ln_read_fcf_entry(ln, | 
|  | csio_ln_read_fcf_cbfn); | 
|  | if (rv != 0) { | 
|  | /* TODO: Send HW RESET event */ | 
|  | CSIO_INC_STATS(ln, n_err); | 
|  | break; | 
|  | } | 
|  |  | 
|  | /* Add FCF record */ | 
|  | list_add_tail(&ln->fcfinfo->list, &rln->fcf_lsthead); | 
|  | } | 
|  |  | 
|  | rv = csio_ln_vnp_read(ln, csio_ln_vnp_read_cbfn); | 
|  | if (rv != 0) { | 
|  | /* TODO: Send HW RESET event */ | 
|  | CSIO_INC_STATS(ln, n_err); | 
|  | } | 
|  | break; | 
|  |  | 
|  | case CSIO_LNE_DOWN_LINK: | 
|  | break; | 
|  |  | 
|  | default: | 
|  | csio_ln_dbg(ln, | 
|  | "unexp ln event %d recv from did:x%x in " | 
|  | "ln state[uninit].\n", evt, ln->nport_id); | 
|  | CSIO_INC_STATS(ln, n_evt_unexp); | 
|  | break; | 
|  | } /* switch event */ | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_lns_online - The request in online state. | 
|  | * @ln - FCOE lnode. | 
|  | * @evt - Event to be processed. | 
|  | * | 
|  | * Process the given lnode event which is currently in "online" state. | 
|  | * Invoked with HW lock held. | 
|  | * Return - none. | 
|  | */ | 
|  | static void | 
|  | csio_lns_online(struct csio_lnode *ln, enum csio_ln_ev evt) | 
|  | { | 
|  | struct csio_hw *hw = csio_lnode_to_hw(ln); | 
|  |  | 
|  | CSIO_INC_STATS(ln, n_evt_sm[evt]); | 
|  | switch (evt) { | 
|  | case CSIO_LNE_LINKUP: | 
|  | csio_ln_warn(ln, | 
|  | "warn: FCOE link is up already " | 
|  | "Ignoring linkup on port:%d\n", ln->portid); | 
|  | CSIO_INC_STATS(ln, n_evt_drop); | 
|  | break; | 
|  |  | 
|  | case CSIO_LNE_FAB_INIT_DONE: | 
|  | csio_set_state(&ln->sm, csio_lns_ready); | 
|  |  | 
|  | spin_unlock_irq(&hw->lock); | 
|  | csio_lnode_async_event(ln, CSIO_LN_FC_LINKUP); | 
|  | spin_lock_irq(&hw->lock); | 
|  |  | 
|  | break; | 
|  |  | 
|  | case CSIO_LNE_LINK_DOWN: | 
|  | /* Fall through */ | 
|  | case CSIO_LNE_DOWN_LINK: | 
|  | csio_set_state(&ln->sm, csio_lns_uninit); | 
|  | if (csio_is_phys_ln(ln)) { | 
|  | /* Remove FCF entry */ | 
|  | list_del_init(&ln->fcfinfo->list); | 
|  | } | 
|  | break; | 
|  |  | 
|  | default: | 
|  | csio_ln_dbg(ln, | 
|  | "unexp ln event %d recv from did:x%x in " | 
|  | "ln state[uninit].\n", evt, ln->nport_id); | 
|  | CSIO_INC_STATS(ln, n_evt_unexp); | 
|  |  | 
|  | break; | 
|  | } /* switch event */ | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_lns_ready - The request in ready state. | 
|  | * @ln - FCOE lnode. | 
|  | * @evt - Event to be processed. | 
|  | * | 
|  | * Process the given lnode event which is currently in "ready" state. | 
|  | * Invoked with HW lock held. | 
|  | * Return - none. | 
|  | */ | 
|  | static void | 
|  | csio_lns_ready(struct csio_lnode *ln, enum csio_ln_ev evt) | 
|  | { | 
|  | struct csio_hw *hw = csio_lnode_to_hw(ln); | 
|  |  | 
|  | CSIO_INC_STATS(ln, n_evt_sm[evt]); | 
|  | switch (evt) { | 
|  | case CSIO_LNE_FAB_INIT_DONE: | 
|  | csio_ln_dbg(ln, | 
|  | "ignoring event %d recv from did x%x" | 
|  | "in ln state[ready].\n", evt, ln->nport_id); | 
|  | CSIO_INC_STATS(ln, n_evt_drop); | 
|  | break; | 
|  |  | 
|  | case CSIO_LNE_LINK_DOWN: | 
|  | csio_set_state(&ln->sm, csio_lns_offline); | 
|  | csio_post_event_rns(ln, CSIO_RNFE_DOWN); | 
|  |  | 
|  | spin_unlock_irq(&hw->lock); | 
|  | csio_lnode_async_event(ln, CSIO_LN_FC_LINKDOWN); | 
|  | spin_lock_irq(&hw->lock); | 
|  |  | 
|  | if (csio_is_phys_ln(ln)) { | 
|  | /* Remove FCF entry */ | 
|  | list_del_init(&ln->fcfinfo->list); | 
|  | } | 
|  | break; | 
|  |  | 
|  | case CSIO_LNE_DOWN_LINK: | 
|  | csio_set_state(&ln->sm, csio_lns_offline); | 
|  | csio_post_event_rns(ln, CSIO_RNFE_DOWN); | 
|  |  | 
|  | /* Host need to issue aborts in case if FW has not returned | 
|  | * WRs with status "ABORTED" | 
|  | */ | 
|  | spin_unlock_irq(&hw->lock); | 
|  | csio_lnode_async_event(ln, CSIO_LN_FC_LINKDOWN); | 
|  | spin_lock_irq(&hw->lock); | 
|  |  | 
|  | if (csio_is_phys_ln(ln)) { | 
|  | /* Remove FCF entry */ | 
|  | list_del_init(&ln->fcfinfo->list); | 
|  | } | 
|  | break; | 
|  |  | 
|  | case CSIO_LNE_CLOSE: | 
|  | csio_set_state(&ln->sm, csio_lns_uninit); | 
|  | csio_post_event_rns(ln, CSIO_RNFE_CLOSE); | 
|  | break; | 
|  |  | 
|  | case CSIO_LNE_LOGO: | 
|  | csio_set_state(&ln->sm, csio_lns_offline); | 
|  | csio_post_event_rns(ln, CSIO_RNFE_DOWN); | 
|  | break; | 
|  |  | 
|  | default: | 
|  | csio_ln_dbg(ln, | 
|  | "unexp ln event %d recv from did:x%x in " | 
|  | "ln state[uninit].\n", evt, ln->nport_id); | 
|  | CSIO_INC_STATS(ln, n_evt_unexp); | 
|  | CSIO_DB_ASSERT(0); | 
|  | break; | 
|  | } /* switch event */ | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_lns_offline - The request in offline state. | 
|  | * @ln - FCOE lnode. | 
|  | * @evt - Event to be processed. | 
|  | * | 
|  | * Process the given lnode event which is currently in "offline" state. | 
|  | * Invoked with HW lock held. | 
|  | * Return - none. | 
|  | */ | 
|  | static void | 
|  | csio_lns_offline(struct csio_lnode *ln, enum csio_ln_ev evt) | 
|  | { | 
|  | struct csio_hw *hw = csio_lnode_to_hw(ln); | 
|  | struct csio_lnode *rln = hw->rln; | 
|  | int rv; | 
|  |  | 
|  | CSIO_INC_STATS(ln, n_evt_sm[evt]); | 
|  | switch (evt) { | 
|  | case CSIO_LNE_LINKUP: | 
|  | csio_set_state(&ln->sm, csio_lns_online); | 
|  | /* Read FCF only for physical lnode */ | 
|  | if (csio_is_phys_ln(ln)) { | 
|  | rv = csio_ln_read_fcf_entry(ln, | 
|  | csio_ln_read_fcf_cbfn); | 
|  | if (rv != 0) { | 
|  | /* TODO: Send HW RESET event */ | 
|  | CSIO_INC_STATS(ln, n_err); | 
|  | break; | 
|  | } | 
|  |  | 
|  | /* Add FCF record */ | 
|  | list_add_tail(&ln->fcfinfo->list, &rln->fcf_lsthead); | 
|  | } | 
|  |  | 
|  | rv = csio_ln_vnp_read(ln, csio_ln_vnp_read_cbfn); | 
|  | if (rv != 0) { | 
|  | /* TODO: Send HW RESET event */ | 
|  | CSIO_INC_STATS(ln, n_err); | 
|  | } | 
|  | break; | 
|  |  | 
|  | case CSIO_LNE_LINK_DOWN: | 
|  | case CSIO_LNE_DOWN_LINK: | 
|  | case CSIO_LNE_LOGO: | 
|  | csio_ln_dbg(ln, | 
|  | "ignoring event %d recv from did x%x" | 
|  | "in ln state[offline].\n", evt, ln->nport_id); | 
|  | CSIO_INC_STATS(ln, n_evt_drop); | 
|  | break; | 
|  |  | 
|  | case CSIO_LNE_CLOSE: | 
|  | csio_set_state(&ln->sm, csio_lns_uninit); | 
|  | csio_post_event_rns(ln, CSIO_RNFE_CLOSE); | 
|  | break; | 
|  |  | 
|  | default: | 
|  | csio_ln_dbg(ln, | 
|  | "unexp ln event %d recv from did:x%x in " | 
|  | "ln state[offline]\n", evt, ln->nport_id); | 
|  | CSIO_INC_STATS(ln, n_evt_unexp); | 
|  | CSIO_DB_ASSERT(0); | 
|  | break; | 
|  | } /* switch event */ | 
|  | } | 
|  |  | 
|  | /*****************************************************************************/ | 
|  | /* END: Lnode SM                                                             */ | 
|  | /*****************************************************************************/ | 
|  |  | 
|  | static void | 
|  | csio_free_fcfinfo(struct kref *kref) | 
|  | { | 
|  | struct csio_fcf_info *fcfinfo = container_of(kref, | 
|  | struct csio_fcf_info, kref); | 
|  | kfree(fcfinfo); | 
|  | } | 
|  |  | 
|  | /* Helper routines for attributes  */ | 
|  | /* | 
|  | * csio_lnode_state_to_str - Get current state of FCOE lnode. | 
|  | * @ln - lnode | 
|  | * @str - state of lnode. | 
|  | * | 
|  | */ | 
|  | void | 
|  | csio_lnode_state_to_str(struct csio_lnode *ln, int8_t *str) | 
|  | { | 
|  | if (csio_get_state(ln) == ((csio_sm_state_t)csio_lns_uninit)) { | 
|  | strcpy(str, "UNINIT"); | 
|  | return; | 
|  | } | 
|  | if (csio_get_state(ln) == ((csio_sm_state_t)csio_lns_ready)) { | 
|  | strcpy(str, "READY"); | 
|  | return; | 
|  | } | 
|  | if (csio_get_state(ln) == ((csio_sm_state_t)csio_lns_offline)) { | 
|  | strcpy(str, "OFFLINE"); | 
|  | return; | 
|  | } | 
|  | strcpy(str, "UNKNOWN"); | 
|  | } /* csio_lnode_state_to_str */ | 
|  |  | 
|  |  | 
|  | int | 
|  | csio_get_phy_port_stats(struct csio_hw *hw, uint8_t portid, | 
|  | struct fw_fcoe_port_stats *port_stats) | 
|  | { | 
|  | struct csio_mb  *mbp; | 
|  | struct fw_fcoe_port_cmd_params portparams; | 
|  | enum fw_retval retval; | 
|  | int idx; | 
|  |  | 
|  | mbp = mempool_alloc(hw->mb_mempool, GFP_ATOMIC); | 
|  | if (!mbp) { | 
|  | csio_err(hw, "FCoE FCF PARAMS command out of memory!\n"); | 
|  | return -EINVAL; | 
|  | } | 
|  | portparams.portid = portid; | 
|  |  | 
|  | for (idx = 1; idx <= 3; idx++) { | 
|  | portparams.idx = (idx-1)*6 + 1; | 
|  | portparams.nstats = 6; | 
|  | if (idx == 3) | 
|  | portparams.nstats = 4; | 
|  | csio_fcoe_read_portparams_init_mb(hw, mbp, CSIO_MB_DEFAULT_TMO, | 
|  | &portparams, NULL); | 
|  | if (csio_mb_issue(hw, mbp)) { | 
|  | csio_err(hw, "Issue of FCoE port params failed!\n"); | 
|  | mempool_free(mbp, hw->mb_mempool); | 
|  | return -EINVAL; | 
|  | } | 
|  | csio_mb_process_portparams_rsp(hw, mbp, &retval, | 
|  | &portparams, port_stats); | 
|  | } | 
|  |  | 
|  | mempool_free(mbp, hw->mb_mempool); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_ln_mgmt_wr_handler -Mgmt Work Request handler. | 
|  | * @wr - WR. | 
|  | * @len - WR len. | 
|  | * This handler is invoked when an outstanding mgmt WR is completed. | 
|  | * Its invoked in the context of FW event worker thread for every | 
|  | * mgmt event received. | 
|  | * Return - none. | 
|  | */ | 
|  |  | 
|  | static void | 
|  | csio_ln_mgmt_wr_handler(struct csio_hw *hw, void *wr, uint32_t len) | 
|  | { | 
|  | struct csio_mgmtm *mgmtm = csio_hw_to_mgmtm(hw); | 
|  | struct csio_ioreq *io_req = NULL; | 
|  | struct fw_fcoe_els_ct_wr *wr_cmd; | 
|  |  | 
|  |  | 
|  | wr_cmd = (struct fw_fcoe_els_ct_wr *) wr; | 
|  |  | 
|  | if (len < sizeof(struct fw_fcoe_els_ct_wr)) { | 
|  | csio_err(mgmtm->hw, | 
|  | "Invalid ELS CT WR length recvd, len:%x\n", len); | 
|  | mgmtm->stats.n_err++; | 
|  | return; | 
|  | } | 
|  |  | 
|  | io_req = (struct csio_ioreq *) ((uintptr_t) wr_cmd->cookie); | 
|  | io_req->wr_status = csio_wr_status(wr_cmd); | 
|  |  | 
|  | /* lookup ioreq exists in our active Q */ | 
|  | spin_lock_irq(&hw->lock); | 
|  | if (csio_mgmt_req_lookup(mgmtm, io_req) != 0) { | 
|  | csio_err(mgmtm->hw, | 
|  | "Error- Invalid IO handle recv in WR. handle: %p\n", | 
|  | io_req); | 
|  | mgmtm->stats.n_err++; | 
|  | spin_unlock_irq(&hw->lock); | 
|  | return; | 
|  | } | 
|  |  | 
|  | mgmtm = csio_hw_to_mgmtm(hw); | 
|  |  | 
|  | /* Dequeue from active queue */ | 
|  | list_del_init(&io_req->sm.sm_list); | 
|  | mgmtm->stats.n_active--; | 
|  | spin_unlock_irq(&hw->lock); | 
|  |  | 
|  | /* io_req will be freed by completion handler */ | 
|  | if (io_req->io_cbfn) | 
|  | io_req->io_cbfn(hw, io_req); | 
|  | } | 
|  |  | 
|  | /** | 
|  | * csio_fcoe_fwevt_handler - Event handler for Firmware FCoE events. | 
|  | * @hw:		HW module | 
|  | * @cpl_op:	CPL opcode | 
|  | * @cmd:	FW cmd/WR. | 
|  | * | 
|  | * Process received FCoE cmd/WR event from FW. | 
|  | */ | 
|  | void | 
|  | csio_fcoe_fwevt_handler(struct csio_hw *hw, __u8 cpl_op, __be64 *cmd) | 
|  | { | 
|  | struct csio_lnode *ln; | 
|  | struct csio_rnode *rn; | 
|  | uint8_t portid, opcode = *(uint8_t *)cmd; | 
|  | struct fw_fcoe_link_cmd *lcmd; | 
|  | struct fw_wr_hdr *wr; | 
|  | struct fw_rdev_wr *rdev_wr; | 
|  | enum fw_fcoe_link_status lstatus; | 
|  | uint32_t fcfi, rdev_flowid, vnpi; | 
|  | enum csio_ln_ev evt; | 
|  |  | 
|  | if (cpl_op == CPL_FW6_MSG && opcode == FW_FCOE_LINK_CMD) { | 
|  |  | 
|  | lcmd = (struct fw_fcoe_link_cmd *)cmd; | 
|  | lstatus = lcmd->lstatus; | 
|  | portid = FW_FCOE_LINK_CMD_PORTID_GET( | 
|  | ntohl(lcmd->op_to_portid)); | 
|  | fcfi = FW_FCOE_LINK_CMD_FCFI_GET(ntohl(lcmd->sub_opcode_fcfi)); | 
|  | vnpi = FW_FCOE_LINK_CMD_VNPI_GET(ntohl(lcmd->vnpi_pkd)); | 
|  |  | 
|  | if (lstatus == FCOE_LINKUP) { | 
|  |  | 
|  | /* HW lock here */ | 
|  | spin_lock_irq(&hw->lock); | 
|  | csio_handle_link_up(hw, portid, fcfi, vnpi); | 
|  | spin_unlock_irq(&hw->lock); | 
|  | /* HW un lock here */ | 
|  |  | 
|  | } else if (lstatus == FCOE_LINKDOWN) { | 
|  |  | 
|  | /* HW lock here */ | 
|  | spin_lock_irq(&hw->lock); | 
|  | csio_handle_link_down(hw, portid, fcfi, vnpi); | 
|  | spin_unlock_irq(&hw->lock); | 
|  | /* HW un lock here */ | 
|  | } else { | 
|  | csio_warn(hw, "Unexpected FCOE LINK status:0x%x\n", | 
|  | lcmd->lstatus); | 
|  | CSIO_INC_STATS(hw, n_cpl_unexp); | 
|  | } | 
|  | } else if (cpl_op == CPL_FW6_PLD) { | 
|  | wr = (struct fw_wr_hdr *) (cmd + 4); | 
|  | if (FW_WR_OP_G(be32_to_cpu(wr->hi)) | 
|  | == FW_RDEV_WR) { | 
|  |  | 
|  | rdev_wr = (struct fw_rdev_wr *) (cmd + 4); | 
|  |  | 
|  | rdev_flowid = FW_RDEV_WR_FLOWID_GET( | 
|  | ntohl(rdev_wr->alloc_to_len16)); | 
|  | vnpi = FW_RDEV_WR_ASSOC_FLOWID_GET( | 
|  | ntohl(rdev_wr->flags_to_assoc_flowid)); | 
|  |  | 
|  | csio_dbg(hw, | 
|  | "FW_RDEV_WR: flowid:x%x ev_cause:x%x " | 
|  | "vnpi:0x%x\n", rdev_flowid, | 
|  | rdev_wr->event_cause, vnpi); | 
|  |  | 
|  | if (rdev_wr->protocol != PROT_FCOE) { | 
|  | csio_err(hw, | 
|  | "FW_RDEV_WR: invalid proto:x%x " | 
|  | "received with flowid:x%x\n", | 
|  | rdev_wr->protocol, | 
|  | rdev_flowid); | 
|  | CSIO_INC_STATS(hw, n_evt_drop); | 
|  | return; | 
|  | } | 
|  |  | 
|  | /* HW lock here */ | 
|  | spin_lock_irq(&hw->lock); | 
|  | ln = csio_ln_lookup_by_vnpi(hw, vnpi); | 
|  | if (!ln) { | 
|  | csio_err(hw, | 
|  | "FW_DEV_WR: invalid vnpi:x%x received " | 
|  | "with flowid:x%x\n", vnpi, rdev_flowid); | 
|  | CSIO_INC_STATS(hw, n_evt_drop); | 
|  | goto out_pld; | 
|  | } | 
|  |  | 
|  | rn = csio_confirm_rnode(ln, rdev_flowid, | 
|  | &rdev_wr->u.fcoe_rdev); | 
|  | if (!rn) { | 
|  | csio_ln_dbg(ln, | 
|  | "Failed to confirm rnode " | 
|  | "for flowid:x%x\n", rdev_flowid); | 
|  | CSIO_INC_STATS(hw, n_evt_drop); | 
|  | goto out_pld; | 
|  | } | 
|  |  | 
|  | /* save previous event for debugging */ | 
|  | ln->prev_evt = ln->cur_evt; | 
|  | ln->cur_evt = rdev_wr->event_cause; | 
|  | CSIO_INC_STATS(ln, n_evt_fw[rdev_wr->event_cause]); | 
|  |  | 
|  | /* Translate all the fabric events to lnode SM events */ | 
|  | evt = CSIO_FWE_TO_LNE(rdev_wr->event_cause); | 
|  | if (evt) { | 
|  | csio_ln_dbg(ln, | 
|  | "Posting event to lnode event:%d " | 
|  | "cause:%d flowid:x%x\n", evt, | 
|  | rdev_wr->event_cause, rdev_flowid); | 
|  | csio_post_event(&ln->sm, evt); | 
|  | } | 
|  |  | 
|  | /* Handover event to rn SM here. */ | 
|  | csio_rnode_fwevt_handler(rn, rdev_wr->event_cause); | 
|  | out_pld: | 
|  | spin_unlock_irq(&hw->lock); | 
|  | return; | 
|  | } else { | 
|  | csio_warn(hw, "unexpected WR op(0x%x) recv\n", | 
|  | FW_WR_OP_G(be32_to_cpu((wr->hi)))); | 
|  | CSIO_INC_STATS(hw, n_cpl_unexp); | 
|  | } | 
|  | } else if (cpl_op == CPL_FW6_MSG) { | 
|  | wr = (struct fw_wr_hdr *) (cmd); | 
|  | if (FW_WR_OP_G(be32_to_cpu(wr->hi)) == FW_FCOE_ELS_CT_WR) { | 
|  | csio_ln_mgmt_wr_handler(hw, wr, | 
|  | sizeof(struct fw_fcoe_els_ct_wr)); | 
|  | } else { | 
|  | csio_warn(hw, "unexpected WR op(0x%x) recv\n", | 
|  | FW_WR_OP_G(be32_to_cpu((wr->hi)))); | 
|  | CSIO_INC_STATS(hw, n_cpl_unexp); | 
|  | } | 
|  | } else { | 
|  | csio_warn(hw, "unexpected CPL op(0x%x) recv\n", opcode); | 
|  | CSIO_INC_STATS(hw, n_cpl_unexp); | 
|  | } | 
|  | } | 
|  |  | 
|  | /** | 
|  | * csio_lnode_start - Kickstart lnode discovery. | 
|  | * @ln:		lnode | 
|  | * | 
|  | * This routine kickstarts the discovery by issuing an FCOE_LINK (up) command. | 
|  | */ | 
|  | int | 
|  | csio_lnode_start(struct csio_lnode *ln) | 
|  | { | 
|  | int rv = 0; | 
|  | if (csio_is_phys_ln(ln) && !(ln->flags & CSIO_LNF_LINK_ENABLE)) { | 
|  | rv = csio_fcoe_enable_link(ln, 1); | 
|  | ln->flags |= CSIO_LNF_LINK_ENABLE; | 
|  | } | 
|  |  | 
|  | return rv; | 
|  | } | 
|  |  | 
|  | /** | 
|  | * csio_lnode_stop - Stop the lnode. | 
|  | * @ln:		lnode | 
|  | * | 
|  | * This routine is invoked by HW module to stop lnode and its associated NPIV | 
|  | * lnodes. | 
|  | */ | 
|  | void | 
|  | csio_lnode_stop(struct csio_lnode *ln) | 
|  | { | 
|  | csio_post_event_lns(ln, CSIO_LNE_DOWN_LINK); | 
|  | if (csio_is_phys_ln(ln) && (ln->flags & CSIO_LNF_LINK_ENABLE)) { | 
|  | csio_fcoe_enable_link(ln, 0); | 
|  | ln->flags &= ~CSIO_LNF_LINK_ENABLE; | 
|  | } | 
|  | csio_ln_dbg(ln, "stopping ln :%p\n", ln); | 
|  | } | 
|  |  | 
|  | /** | 
|  | * csio_lnode_close - Close an lnode. | 
|  | * @ln:		lnode | 
|  | * | 
|  | * This routine is invoked by HW module to close an lnode and its | 
|  | * associated NPIV lnodes. Lnode and its associated NPIV lnodes are | 
|  | * set to uninitialized state. | 
|  | */ | 
|  | void | 
|  | csio_lnode_close(struct csio_lnode *ln) | 
|  | { | 
|  | csio_post_event_lns(ln, CSIO_LNE_CLOSE); | 
|  | if (csio_is_phys_ln(ln)) | 
|  | ln->vnp_flowid = CSIO_INVALID_IDX; | 
|  |  | 
|  | csio_ln_dbg(ln, "closed ln :%p\n", ln); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_ln_prep_ecwr - Prepare ELS/CT WR. | 
|  | * @io_req - IO request. | 
|  | * @wr_len - WR len | 
|  | * @immd_len - WR immediate data | 
|  | * @sub_op - Sub opcode | 
|  | * @sid - source portid. | 
|  | * @did - destination portid | 
|  | * @flow_id - flowid | 
|  | * @fw_wr - ELS/CT WR to be prepared. | 
|  | * Returns: 0 - on success | 
|  | */ | 
|  | static int | 
|  | csio_ln_prep_ecwr(struct csio_ioreq *io_req, uint32_t wr_len, | 
|  | uint32_t immd_len, uint8_t sub_op, uint32_t sid, | 
|  | uint32_t did, uint32_t flow_id, uint8_t *fw_wr) | 
|  | { | 
|  | struct fw_fcoe_els_ct_wr *wr; | 
|  | __be32 port_id; | 
|  |  | 
|  | wr  = (struct fw_fcoe_els_ct_wr *)fw_wr; | 
|  | wr->op_immdlen = cpu_to_be32(FW_WR_OP_V(FW_FCOE_ELS_CT_WR) | | 
|  | FW_FCOE_ELS_CT_WR_IMMDLEN(immd_len)); | 
|  |  | 
|  | wr_len =  DIV_ROUND_UP(wr_len, 16); | 
|  | wr->flowid_len16 = cpu_to_be32(FW_WR_FLOWID_V(flow_id) | | 
|  | FW_WR_LEN16_V(wr_len)); | 
|  | wr->els_ct_type = sub_op; | 
|  | wr->ctl_pri = 0; | 
|  | wr->cp_en_class = 0; | 
|  | wr->cookie = io_req->fw_handle; | 
|  | wr->iqid = cpu_to_be16(csio_q_physiqid( | 
|  | io_req->lnode->hwp, io_req->iq_idx)); | 
|  | wr->fl_to_sp =  FW_FCOE_ELS_CT_WR_SP(1); | 
|  | wr->tmo_val = (uint8_t) io_req->tmo; | 
|  | port_id = htonl(sid); | 
|  | memcpy(wr->l_id, PORT_ID_PTR(port_id), 3); | 
|  | port_id = htonl(did); | 
|  | memcpy(wr->r_id, PORT_ID_PTR(port_id), 3); | 
|  |  | 
|  | /* Prepare RSP SGL */ | 
|  | wr->rsp_dmalen = cpu_to_be32(io_req->dma_buf.len); | 
|  | wr->rsp_dmaaddr = cpu_to_be64(io_req->dma_buf.paddr); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_ln_mgmt_submit_wr - Post elsct work request. | 
|  | * @mgmtm - mgmtm | 
|  | * @io_req - io request. | 
|  | * @sub_op - ELS or CT request type | 
|  | * @pld - Dma Payload buffer | 
|  | * @pld_len - Payload len | 
|  | * Prepares ELSCT Work request and sents it to FW. | 
|  | * Returns: 0 - on success | 
|  | */ | 
|  | static int | 
|  | csio_ln_mgmt_submit_wr(struct csio_mgmtm *mgmtm, struct csio_ioreq *io_req, | 
|  | uint8_t sub_op, struct csio_dma_buf *pld, | 
|  | uint32_t pld_len) | 
|  | { | 
|  | struct csio_wr_pair wrp; | 
|  | struct csio_lnode *ln = io_req->lnode; | 
|  | struct csio_rnode *rn = io_req->rnode; | 
|  | struct	csio_hw	*hw = mgmtm->hw; | 
|  | uint8_t fw_wr[64]; | 
|  | struct ulptx_sgl dsgl; | 
|  | uint32_t wr_size = 0; | 
|  | uint8_t im_len = 0; | 
|  | uint32_t wr_off = 0; | 
|  |  | 
|  | int ret = 0; | 
|  |  | 
|  | /* Calculate WR Size for this ELS REQ */ | 
|  | wr_size = sizeof(struct fw_fcoe_els_ct_wr); | 
|  |  | 
|  | /* Send as immediate data if pld < 256 */ | 
|  | if (pld_len < 256) { | 
|  | wr_size += ALIGN(pld_len, 8); | 
|  | im_len = (uint8_t)pld_len; | 
|  | } else | 
|  | wr_size += sizeof(struct ulptx_sgl); | 
|  |  | 
|  | /* Roundup WR size in units of 16 bytes */ | 
|  | wr_size = ALIGN(wr_size, 16); | 
|  |  | 
|  | /* Get WR to send ELS REQ */ | 
|  | ret = csio_wr_get(hw, mgmtm->eq_idx, wr_size, &wrp); | 
|  | if (ret != 0) { | 
|  | csio_err(hw, "Failed to get WR for ec_req %p ret:%d\n", | 
|  | io_req, ret); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | /* Prepare Generic WR used by all ELS/CT cmd */ | 
|  | csio_ln_prep_ecwr(io_req, wr_size, im_len, sub_op, | 
|  | ln->nport_id, rn->nport_id, | 
|  | csio_rn_flowid(rn), | 
|  | &fw_wr[0]); | 
|  |  | 
|  | /* Copy ELS/CT WR CMD */ | 
|  | csio_wr_copy_to_wrp(&fw_wr[0], &wrp, wr_off, | 
|  | sizeof(struct fw_fcoe_els_ct_wr)); | 
|  | wr_off += sizeof(struct fw_fcoe_els_ct_wr); | 
|  |  | 
|  | /* Copy payload to Immediate section of WR */ | 
|  | if (im_len) | 
|  | csio_wr_copy_to_wrp(pld->vaddr, &wrp, wr_off, im_len); | 
|  | else { | 
|  | /* Program DSGL to dma payload */ | 
|  | dsgl.cmd_nsge = htonl(ULPTX_CMD_V(ULP_TX_SC_DSGL) | | 
|  | ULPTX_MORE_F | ULPTX_NSGE_V(1)); | 
|  | dsgl.len0 = cpu_to_be32(pld_len); | 
|  | dsgl.addr0 = cpu_to_be64(pld->paddr); | 
|  | csio_wr_copy_to_wrp(&dsgl, &wrp, ALIGN(wr_off, 8), | 
|  | sizeof(struct ulptx_sgl)); | 
|  | } | 
|  |  | 
|  | /* Issue work request to xmit ELS/CT req to FW */ | 
|  | csio_wr_issue(mgmtm->hw, mgmtm->eq_idx, false); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_ln_mgmt_submit_req - Submit FCOE Mgmt request. | 
|  | * @io_req - IO Request | 
|  | * @io_cbfn - Completion handler. | 
|  | * @req_type - ELS or CT request type | 
|  | * @pld - Dma Payload buffer | 
|  | * @pld_len - Payload len | 
|  | * | 
|  | * | 
|  | * This API used submit managment ELS/CT request. | 
|  | * This called with hw lock held | 
|  | * Returns: 0 - on success | 
|  | *	    -ENOMEM	- on error. | 
|  | */ | 
|  | static int | 
|  | csio_ln_mgmt_submit_req(struct csio_ioreq *io_req, | 
|  | void (*io_cbfn) (struct csio_hw *, struct csio_ioreq *), | 
|  | enum fcoe_cmn_type req_type, struct csio_dma_buf *pld, | 
|  | uint32_t pld_len) | 
|  | { | 
|  | struct csio_hw *hw = csio_lnode_to_hw(io_req->lnode); | 
|  | struct csio_mgmtm *mgmtm = csio_hw_to_mgmtm(hw); | 
|  | int rv; | 
|  |  | 
|  | BUG_ON(pld_len > pld->len); | 
|  |  | 
|  | io_req->io_cbfn = io_cbfn;	/* Upper layer callback handler */ | 
|  | io_req->fw_handle = (uintptr_t) (io_req); | 
|  | io_req->eq_idx = mgmtm->eq_idx; | 
|  | io_req->iq_idx = mgmtm->iq_idx; | 
|  |  | 
|  | rv = csio_ln_mgmt_submit_wr(mgmtm, io_req, req_type, pld, pld_len); | 
|  | if (rv == 0) { | 
|  | list_add_tail(&io_req->sm.sm_list, &mgmtm->active_q); | 
|  | mgmtm->stats.n_active++; | 
|  | } | 
|  | return rv; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_ln_fdmi_init - FDMI Init entry point. | 
|  | * @ln: lnode | 
|  | */ | 
|  | static int | 
|  | csio_ln_fdmi_init(struct csio_lnode *ln) | 
|  | { | 
|  | struct csio_hw *hw = csio_lnode_to_hw(ln); | 
|  | struct csio_dma_buf	*dma_buf; | 
|  |  | 
|  | /* Allocate MGMT request required for FDMI */ | 
|  | ln->mgmt_req = kzalloc(sizeof(struct csio_ioreq), GFP_KERNEL); | 
|  | if (!ln->mgmt_req) { | 
|  | csio_ln_err(ln, "Failed to alloc ioreq for FDMI\n"); | 
|  | CSIO_INC_STATS(hw, n_err_nomem); | 
|  | return -ENOMEM; | 
|  | } | 
|  |  | 
|  | /* Allocate Dma buffers for FDMI response Payload */ | 
|  | dma_buf = &ln->mgmt_req->dma_buf; | 
|  | dma_buf->len = 2048; | 
|  | dma_buf->vaddr = dma_alloc_coherent(&hw->pdev->dev, dma_buf->len, | 
|  | &dma_buf->paddr, GFP_KERNEL); | 
|  | if (!dma_buf->vaddr) { | 
|  | csio_err(hw, "Failed to alloc DMA buffer for FDMI!\n"); | 
|  | kfree(ln->mgmt_req); | 
|  | ln->mgmt_req = NULL; | 
|  | return -ENOMEM; | 
|  | } | 
|  |  | 
|  | ln->flags |= CSIO_LNF_FDMI_ENABLE; | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_ln_fdmi_exit - FDMI exit entry point. | 
|  | * @ln: lnode | 
|  | */ | 
|  | static int | 
|  | csio_ln_fdmi_exit(struct csio_lnode *ln) | 
|  | { | 
|  | struct csio_dma_buf *dma_buf; | 
|  | struct csio_hw *hw = csio_lnode_to_hw(ln); | 
|  |  | 
|  | if (!ln->mgmt_req) | 
|  | return 0; | 
|  |  | 
|  | dma_buf = &ln->mgmt_req->dma_buf; | 
|  | if (dma_buf->vaddr) | 
|  | dma_free_coherent(&hw->pdev->dev, dma_buf->len, dma_buf->vaddr, | 
|  | dma_buf->paddr); | 
|  |  | 
|  | kfree(ln->mgmt_req); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | int | 
|  | csio_scan_done(struct csio_lnode *ln, unsigned long ticks, | 
|  | unsigned long time, unsigned long max_scan_ticks, | 
|  | unsigned long delta_scan_ticks) | 
|  | { | 
|  | int rv = 0; | 
|  |  | 
|  | if (time >= max_scan_ticks) | 
|  | return 1; | 
|  |  | 
|  | if (!ln->tgt_scan_tick) | 
|  | ln->tgt_scan_tick = ticks; | 
|  |  | 
|  | if (((ticks - ln->tgt_scan_tick) >= delta_scan_ticks)) { | 
|  | if (!ln->last_scan_ntgts) | 
|  | ln->last_scan_ntgts = ln->n_scsi_tgts; | 
|  | else { | 
|  | if (ln->last_scan_ntgts == ln->n_scsi_tgts) | 
|  | return 1; | 
|  |  | 
|  | ln->last_scan_ntgts = ln->n_scsi_tgts; | 
|  | } | 
|  | ln->tgt_scan_tick = ticks; | 
|  | } | 
|  | return rv; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_notify_lnodes: | 
|  | * @hw: HW module | 
|  | * @note: Notification | 
|  | * | 
|  | * Called from the HW SM to fan out notifications to the | 
|  | * Lnode SM. Since the HW SM is entered with lock held, | 
|  | * there is no need to hold locks here. | 
|  | * | 
|  | */ | 
|  | void | 
|  | csio_notify_lnodes(struct csio_hw *hw, enum csio_ln_notify note) | 
|  | { | 
|  | struct list_head *tmp; | 
|  | struct csio_lnode *ln; | 
|  |  | 
|  | csio_dbg(hw, "Notifying all nodes of event %d\n", note); | 
|  |  | 
|  | /* Traverse children lnodes list and send evt */ | 
|  | list_for_each(tmp, &hw->sln_head) { | 
|  | ln = (struct csio_lnode *) tmp; | 
|  |  | 
|  | switch (note) { | 
|  | case CSIO_LN_NOTIFY_HWREADY: | 
|  | csio_lnode_start(ln); | 
|  | break; | 
|  |  | 
|  | case CSIO_LN_NOTIFY_HWRESET: | 
|  | case CSIO_LN_NOTIFY_HWREMOVE: | 
|  | csio_lnode_close(ln); | 
|  | break; | 
|  |  | 
|  | case CSIO_LN_NOTIFY_HWSTOP: | 
|  | csio_lnode_stop(ln); | 
|  | break; | 
|  |  | 
|  | default: | 
|  | break; | 
|  |  | 
|  | } | 
|  | } | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_disable_lnodes: | 
|  | * @hw: HW module | 
|  | * @portid:port id | 
|  | * @disable: disable/enable flag. | 
|  | * If disable=1, disables all lnode hosted on given physical port. | 
|  | * otherwise enables all the lnodes on given phsysical port. | 
|  | * This routine need to called with hw lock held. | 
|  | */ | 
|  | void | 
|  | csio_disable_lnodes(struct csio_hw *hw, uint8_t portid, bool disable) | 
|  | { | 
|  | struct list_head *tmp; | 
|  | struct csio_lnode *ln; | 
|  |  | 
|  | csio_dbg(hw, "Notifying event to all nodes of port:%d\n", portid); | 
|  |  | 
|  | /* Traverse sibling lnodes list and send evt */ | 
|  | list_for_each(tmp, &hw->sln_head) { | 
|  | ln = (struct csio_lnode *) tmp; | 
|  | if (ln->portid != portid) | 
|  | continue; | 
|  |  | 
|  | if (disable) | 
|  | csio_lnode_stop(ln); | 
|  | else | 
|  | csio_lnode_start(ln); | 
|  | } | 
|  | } | 
|  |  | 
|  | /* | 
|  | * csio_ln_init - Initialize an lnode. | 
|  | * @ln:		lnode | 
|  | * | 
|  | */ | 
|  | static int | 
|  | csio_ln_init(struct csio_lnode *ln) | 
|  | { | 
|  | int rv = -EINVAL; | 
|  | struct csio_lnode *rln, *pln; | 
|  | struct csio_hw *hw = csio_lnode_to_hw(ln); | 
|  |  | 
|  | csio_init_state(&ln->sm, csio_lns_uninit); | 
|  | ln->vnp_flowid = CSIO_INVALID_IDX; | 
|  | ln->fcf_flowid = CSIO_INVALID_IDX; | 
|  |  | 
|  | if (csio_is_root_ln(ln)) { | 
|  |  | 
|  | /* This is the lnode used during initialization */ | 
|  |  | 
|  | ln->fcfinfo = kzalloc(sizeof(struct csio_fcf_info), GFP_KERNEL); | 
|  | if (!ln->fcfinfo) { | 
|  | csio_ln_err(ln, "Failed to alloc FCF record\n"); | 
|  | CSIO_INC_STATS(hw, n_err_nomem); | 
|  | goto err; | 
|  | } | 
|  |  | 
|  | INIT_LIST_HEAD(&ln->fcf_lsthead); | 
|  | kref_init(&ln->fcfinfo->kref); | 
|  |  | 
|  | if (csio_fdmi_enable && csio_ln_fdmi_init(ln)) | 
|  | goto err; | 
|  |  | 
|  | } else { /* Either a non-root physical or a virtual lnode */ | 
|  |  | 
|  | /* | 
|  | * THe rest is common for non-root physical and NPIV lnodes. | 
|  | * Just get references to all other modules | 
|  | */ | 
|  | rln = csio_root_lnode(ln); | 
|  |  | 
|  | if (csio_is_npiv_ln(ln)) { | 
|  | /* NPIV */ | 
|  | pln = csio_parent_lnode(ln); | 
|  | kref_get(&pln->fcfinfo->kref); | 
|  | ln->fcfinfo = pln->fcfinfo; | 
|  | } else { | 
|  | /* Another non-root physical lnode (FCF) */ | 
|  | ln->fcfinfo = kzalloc(sizeof(struct csio_fcf_info), | 
|  | GFP_KERNEL); | 
|  | if (!ln->fcfinfo) { | 
|  | csio_ln_err(ln, "Failed to alloc FCF info\n"); | 
|  | CSIO_INC_STATS(hw, n_err_nomem); | 
|  | goto err; | 
|  | } | 
|  |  | 
|  | kref_init(&ln->fcfinfo->kref); | 
|  |  | 
|  | if (csio_fdmi_enable && csio_ln_fdmi_init(ln)) | 
|  | goto err; | 
|  | } | 
|  |  | 
|  | } /* if (!csio_is_root_ln(ln)) */ | 
|  |  | 
|  | return 0; | 
|  | err: | 
|  | return rv; | 
|  | } | 
|  |  | 
|  | static void | 
|  | csio_ln_exit(struct csio_lnode *ln) | 
|  | { | 
|  | struct csio_lnode *pln; | 
|  |  | 
|  | csio_cleanup_rns(ln); | 
|  | if (csio_is_npiv_ln(ln)) { | 
|  | pln = csio_parent_lnode(ln); | 
|  | kref_put(&pln->fcfinfo->kref, csio_free_fcfinfo); | 
|  | } else { | 
|  | kref_put(&ln->fcfinfo->kref, csio_free_fcfinfo); | 
|  | if (csio_fdmi_enable) | 
|  | csio_ln_fdmi_exit(ln); | 
|  | } | 
|  | ln->fcfinfo = NULL; | 
|  | } | 
|  |  | 
|  | /** | 
|  | * csio_lnode_init - Initialize the members of an lnode. | 
|  | * @ln:		lnode | 
|  | * | 
|  | */ | 
|  | int | 
|  | csio_lnode_init(struct csio_lnode *ln, struct csio_hw *hw, | 
|  | struct csio_lnode *pln) | 
|  | { | 
|  | int rv = -EINVAL; | 
|  |  | 
|  | /* Link this lnode to hw */ | 
|  | csio_lnode_to_hw(ln)	= hw; | 
|  |  | 
|  | /* Link child to parent if child lnode */ | 
|  | if (pln) | 
|  | ln->pln = pln; | 
|  | else | 
|  | ln->pln = NULL; | 
|  |  | 
|  | /* Initialize scsi_tgt and timers to zero */ | 
|  | ln->n_scsi_tgts = 0; | 
|  | ln->last_scan_ntgts = 0; | 
|  | ln->tgt_scan_tick = 0; | 
|  |  | 
|  | /* Initialize rnode list */ | 
|  | INIT_LIST_HEAD(&ln->rnhead); | 
|  | INIT_LIST_HEAD(&ln->cln_head); | 
|  |  | 
|  | /* Initialize log level for debug */ | 
|  | ln->params.log_level	= hw->params.log_level; | 
|  |  | 
|  | if (csio_ln_init(ln)) | 
|  | goto err; | 
|  |  | 
|  | /* Add lnode to list of sibling or children lnodes */ | 
|  | spin_lock_irq(&hw->lock); | 
|  | list_add_tail(&ln->sm.sm_list, pln ? &pln->cln_head : &hw->sln_head); | 
|  | if (pln) | 
|  | pln->num_vports++; | 
|  | spin_unlock_irq(&hw->lock); | 
|  |  | 
|  | hw->num_lns++; | 
|  |  | 
|  | return 0; | 
|  | err: | 
|  | csio_lnode_to_hw(ln) = NULL; | 
|  | return rv; | 
|  | } | 
|  |  | 
|  | /** | 
|  | * csio_lnode_exit - De-instantiate an lnode. | 
|  | * @ln:		lnode | 
|  | * | 
|  | */ | 
|  | void | 
|  | csio_lnode_exit(struct csio_lnode *ln) | 
|  | { | 
|  | struct csio_hw *hw = csio_lnode_to_hw(ln); | 
|  |  | 
|  | csio_ln_exit(ln); | 
|  |  | 
|  | /* Remove this lnode from hw->sln_head */ | 
|  | spin_lock_irq(&hw->lock); | 
|  |  | 
|  | list_del_init(&ln->sm.sm_list); | 
|  |  | 
|  | /* If it is children lnode, decrement the | 
|  | * counter in its parent lnode | 
|  | */ | 
|  | if (ln->pln) | 
|  | ln->pln->num_vports--; | 
|  |  | 
|  | /* Update root lnode pointer */ | 
|  | if (list_empty(&hw->sln_head)) | 
|  | hw->rln = NULL; | 
|  | else | 
|  | hw->rln = (struct csio_lnode *)csio_list_next(&hw->sln_head); | 
|  |  | 
|  | spin_unlock_irq(&hw->lock); | 
|  |  | 
|  | csio_lnode_to_hw(ln)	= NULL; | 
|  | hw->num_lns--; | 
|  | } |