| // SPDX-License-Identifier: GPL-2.0-only |
| /* |
| * Copyright (c) 2008-2009 Cisco Systems, Inc. All rights reserved. |
| * Copyright (c) 2009 Intel Corporation. All rights reserved. |
| * |
| * Maintained at www.Open-FCoE.org |
| */ |
| |
| #include <linux/types.h> |
| #include <linux/module.h> |
| #include <linux/kernel.h> |
| #include <linux/list.h> |
| #include <linux/spinlock.h> |
| #include <linux/timer.h> |
| #include <linux/netdevice.h> |
| #include <linux/etherdevice.h> |
| #include <linux/ethtool.h> |
| #include <linux/if_ether.h> |
| #include <linux/if_vlan.h> |
| #include <linux/errno.h> |
| #include <linux/bitops.h> |
| #include <linux/slab.h> |
| #include <net/rtnetlink.h> |
| |
| #include <scsi/fc/fc_els.h> |
| #include <scsi/fc/fc_fs.h> |
| #include <scsi/fc/fc_fip.h> |
| #include <scsi/fc/fc_encaps.h> |
| #include <scsi/fc/fc_fcoe.h> |
| #include <scsi/fc/fc_fcp.h> |
| |
| #include <scsi/libfc.h> |
| #include <scsi/libfcoe.h> |
| |
| #include "libfcoe.h" |
| |
| #define FCOE_CTLR_MIN_FKA 500 /* min keep alive (mS) */ |
| #define FCOE_CTLR_DEF_FKA FIP_DEF_FKA /* default keep alive (mS) */ |
| |
| static void fcoe_ctlr_timeout(struct timer_list *); |
| static void fcoe_ctlr_timer_work(struct work_struct *); |
| static void fcoe_ctlr_recv_work(struct work_struct *); |
| static int fcoe_ctlr_flogi_retry(struct fcoe_ctlr *); |
| |
| static void fcoe_ctlr_vn_start(struct fcoe_ctlr *); |
| static int fcoe_ctlr_vn_recv(struct fcoe_ctlr *, struct sk_buff *); |
| static void fcoe_ctlr_vn_timeout(struct fcoe_ctlr *); |
| static int fcoe_ctlr_vn_lookup(struct fcoe_ctlr *, u32, u8 *); |
| |
| static int fcoe_ctlr_vlan_recv(struct fcoe_ctlr *, struct sk_buff *); |
| |
| static u8 fcoe_all_fcfs[ETH_ALEN] = FIP_ALL_FCF_MACS; |
| static u8 fcoe_all_enode[ETH_ALEN] = FIP_ALL_ENODE_MACS; |
| static u8 fcoe_all_vn2vn[ETH_ALEN] = FIP_ALL_VN2VN_MACS; |
| static u8 fcoe_all_p2p[ETH_ALEN] = FIP_ALL_P2P_MACS; |
| |
| static const char * const fcoe_ctlr_states[] = { |
| [FIP_ST_DISABLED] = "DISABLED", |
| [FIP_ST_LINK_WAIT] = "LINK_WAIT", |
| [FIP_ST_AUTO] = "AUTO", |
| [FIP_ST_NON_FIP] = "NON_FIP", |
| [FIP_ST_ENABLED] = "ENABLED", |
| [FIP_ST_VNMP_START] = "VNMP_START", |
| [FIP_ST_VNMP_PROBE1] = "VNMP_PROBE1", |
| [FIP_ST_VNMP_PROBE2] = "VNMP_PROBE2", |
| [FIP_ST_VNMP_CLAIM] = "VNMP_CLAIM", |
| [FIP_ST_VNMP_UP] = "VNMP_UP", |
| }; |
| |
| static const char *fcoe_ctlr_state(enum fip_state state) |
| { |
| const char *cp = "unknown"; |
| |
| if (state < ARRAY_SIZE(fcoe_ctlr_states)) |
| cp = fcoe_ctlr_states[state]; |
| if (!cp) |
| cp = "unknown"; |
| return cp; |
| } |
| |
| /** |
| * fcoe_ctlr_set_state() - Set and do debug printing for the new FIP state. |
| * @fip: The FCoE controller |
| * @state: The new state |
| */ |
| static void fcoe_ctlr_set_state(struct fcoe_ctlr *fip, enum fip_state state) |
| { |
| if (state == fip->state) |
| return; |
| if (fip->lp) |
| LIBFCOE_FIP_DBG(fip, "state %s -> %s\n", |
| fcoe_ctlr_state(fip->state), fcoe_ctlr_state(state)); |
| fip->state = state; |
| } |
| |
| /** |
| * fcoe_ctlr_mtu_valid() - Check if a FCF's MTU is valid |
| * @fcf: The FCF to check |
| * |
| * Return non-zero if FCF fcoe_size has been validated. |
| */ |
| static inline int fcoe_ctlr_mtu_valid(const struct fcoe_fcf *fcf) |
| { |
| return (fcf->flags & FIP_FL_SOL) != 0; |
| } |
| |
| /** |
| * fcoe_ctlr_fcf_usable() - Check if a FCF is usable |
| * @fcf: The FCF to check |
| * |
| * Return non-zero if the FCF is usable. |
| */ |
| static inline int fcoe_ctlr_fcf_usable(struct fcoe_fcf *fcf) |
| { |
| u16 flags = FIP_FL_SOL | FIP_FL_AVAIL; |
| |
| return (fcf->flags & flags) == flags; |
| } |
| |
| /** |
| * fcoe_ctlr_map_dest() - Set flag and OUI for mapping destination addresses |
| * @fip: The FCoE controller |
| */ |
| static void fcoe_ctlr_map_dest(struct fcoe_ctlr *fip) |
| { |
| if (fip->mode == FIP_MODE_VN2VN) |
| hton24(fip->dest_addr, FIP_VN_FC_MAP); |
| else |
| hton24(fip->dest_addr, FIP_DEF_FC_MAP); |
| hton24(fip->dest_addr + 3, 0); |
| fip->map_dest = 1; |
| } |
| |
| /** |
| * fcoe_ctlr_init() - Initialize the FCoE Controller instance |
| * @fip: The FCoE controller to initialize |
| * @mode: FIP mode to set |
| */ |
| void fcoe_ctlr_init(struct fcoe_ctlr *fip, enum fip_mode mode) |
| { |
| fcoe_ctlr_set_state(fip, FIP_ST_LINK_WAIT); |
| fip->mode = mode; |
| fip->fip_resp = false; |
| INIT_LIST_HEAD(&fip->fcfs); |
| mutex_init(&fip->ctlr_mutex); |
| spin_lock_init(&fip->ctlr_lock); |
| fip->flogi_oxid = FC_XID_UNKNOWN; |
| timer_setup(&fip->timer, fcoe_ctlr_timeout, 0); |
| INIT_WORK(&fip->timer_work, fcoe_ctlr_timer_work); |
| INIT_WORK(&fip->recv_work, fcoe_ctlr_recv_work); |
| skb_queue_head_init(&fip->fip_recv_list); |
| } |
| EXPORT_SYMBOL(fcoe_ctlr_init); |
| |
| /** |
| * fcoe_sysfs_fcf_add() - Add a fcoe_fcf{,_device} to a fcoe_ctlr{,_device} |
| * @new: The newly discovered FCF |
| * |
| * Called with fip->ctlr_mutex held |
| */ |
| static int fcoe_sysfs_fcf_add(struct fcoe_fcf *new) |
| { |
| struct fcoe_ctlr *fip = new->fip; |
| struct fcoe_ctlr_device *ctlr_dev; |
| struct fcoe_fcf_device *temp, *fcf_dev; |
| int rc = -ENOMEM; |
| |
| LIBFCOE_FIP_DBG(fip, "New FCF fab %16.16llx mac %pM\n", |
| new->fabric_name, new->fcf_mac); |
| |
| temp = kzalloc(sizeof(*temp), GFP_KERNEL); |
| if (!temp) |
| goto out; |
| |
| temp->fabric_name = new->fabric_name; |
| temp->switch_name = new->switch_name; |
| temp->fc_map = new->fc_map; |
| temp->vfid = new->vfid; |
| memcpy(temp->mac, new->fcf_mac, ETH_ALEN); |
| temp->priority = new->pri; |
| temp->fka_period = new->fka_period; |
| temp->selected = 0; /* default to unselected */ |
| |
| /* |
| * If ctlr_dev doesn't exist then it means we're a libfcoe user |
| * who doesn't use fcoe_syfs and didn't allocate a fcoe_ctlr_device. |
| * fnic would be an example of a driver with this behavior. In this |
| * case we want to add the fcoe_fcf to the fcoe_ctlr list, but we |
| * don't want to make sysfs changes. |
| */ |
| |
| ctlr_dev = fcoe_ctlr_to_ctlr_dev(fip); |
| if (ctlr_dev) { |
| mutex_lock(&ctlr_dev->lock); |
| fcf_dev = fcoe_fcf_device_add(ctlr_dev, temp); |
| if (unlikely(!fcf_dev)) { |
| rc = -ENOMEM; |
| mutex_unlock(&ctlr_dev->lock); |
| goto out; |
| } |
| |
| /* |
| * The fcoe_sysfs layer can return a CONNECTED fcf that |
| * has a priv (fcf was never deleted) or a CONNECTED fcf |
| * that doesn't have a priv (fcf was deleted). However, |
| * libfcoe will always delete FCFs before trying to add |
| * them. This is ensured because both recv_adv and |
| * age_fcfs are protected by the the fcoe_ctlr's mutex. |
| * This means that we should never get a FCF with a |
| * non-NULL priv pointer. |
| */ |
| BUG_ON(fcf_dev->priv); |
| |
| fcf_dev->priv = new; |
| new->fcf_dev = fcf_dev; |
| mutex_unlock(&ctlr_dev->lock); |
| } |
| |
| list_add(&new->list, &fip->fcfs); |
| fip->fcf_count++; |
| rc = 0; |
| |
| out: |
| kfree(temp); |
| return rc; |
| } |
| |
| /** |
| * fcoe_sysfs_fcf_del() - Remove a fcoe_fcf{,_device} to a fcoe_ctlr{,_device} |
| * @new: The FCF to be removed |
| * |
| * Called with fip->ctlr_mutex held |
| */ |
| static void fcoe_sysfs_fcf_del(struct fcoe_fcf *new) |
| { |
| struct fcoe_ctlr *fip = new->fip; |
| struct fcoe_ctlr_device *cdev; |
| struct fcoe_fcf_device *fcf_dev; |
| |
| list_del(&new->list); |
| fip->fcf_count--; |
| |
| /* |
| * If ctlr_dev doesn't exist then it means we're a libfcoe user |
| * who doesn't use fcoe_syfs and didn't allocate a fcoe_ctlr_device |
| * or a fcoe_fcf_device. |
| * |
| * fnic would be an example of a driver with this behavior. In this |
| * case we want to remove the fcoe_fcf from the fcoe_ctlr list (above), |
| * but we don't want to make sysfs changes. |
| */ |
| cdev = fcoe_ctlr_to_ctlr_dev(fip); |
| if (cdev) { |
| mutex_lock(&cdev->lock); |
| fcf_dev = fcoe_fcf_to_fcf_dev(new); |
| WARN_ON(!fcf_dev); |
| new->fcf_dev = NULL; |
| fcoe_fcf_device_delete(fcf_dev); |
| mutex_unlock(&cdev->lock); |
| } |
| kfree(new); |
| } |
| |
| /** |
| * fcoe_ctlr_reset_fcfs() - Reset and free all FCFs for a controller |
| * @fip: The FCoE controller whose FCFs are to be reset |
| * |
| * Called with &fcoe_ctlr lock held. |
| */ |
| static void fcoe_ctlr_reset_fcfs(struct fcoe_ctlr *fip) |
| { |
| struct fcoe_fcf *fcf; |
| struct fcoe_fcf *next; |
| |
| fip->sel_fcf = NULL; |
| list_for_each_entry_safe(fcf, next, &fip->fcfs, list) { |
| fcoe_sysfs_fcf_del(fcf); |
| } |
| WARN_ON(fip->fcf_count); |
| |
| fip->sel_time = 0; |
| } |
| |
| /** |
| * fcoe_ctlr_destroy() - Disable and tear down a FCoE controller |
| * @fip: The FCoE controller to tear down |
| * |
| * This is called by FCoE drivers before freeing the &fcoe_ctlr. |
| * |
| * The receive handler will have been deleted before this to guarantee |
| * that no more recv_work will be scheduled. |
| * |
| * The timer routine will simply return once we set FIP_ST_DISABLED. |
| * This guarantees that no further timeouts or work will be scheduled. |
| */ |
| void fcoe_ctlr_destroy(struct fcoe_ctlr *fip) |
| { |
| cancel_work_sync(&fip->recv_work); |
| skb_queue_purge(&fip->fip_recv_list); |
| |
| mutex_lock(&fip->ctlr_mutex); |
| fcoe_ctlr_set_state(fip, FIP_ST_DISABLED); |
| fcoe_ctlr_reset_fcfs(fip); |
| mutex_unlock(&fip->ctlr_mutex); |
| del_timer_sync(&fip->timer); |
| cancel_work_sync(&fip->timer_work); |
| } |
| EXPORT_SYMBOL(fcoe_ctlr_destroy); |
| |
| /** |
| * fcoe_ctlr_announce() - announce new FCF selection |
| * @fip: The FCoE controller |
| * |
| * Also sets the destination MAC for FCoE and control packets |
| * |
| * Called with neither ctlr_mutex nor ctlr_lock held. |
| */ |
| static void fcoe_ctlr_announce(struct fcoe_ctlr *fip) |
| { |
| struct fcoe_fcf *sel; |
| struct fcoe_fcf *fcf; |
| |
| mutex_lock(&fip->ctlr_mutex); |
| spin_lock_bh(&fip->ctlr_lock); |
| |
| kfree_skb(fip->flogi_req); |
| fip->flogi_req = NULL; |
| list_for_each_entry(fcf, &fip->fcfs, list) |
| fcf->flogi_sent = 0; |
| |
| spin_unlock_bh(&fip->ctlr_lock); |
| sel = fip->sel_fcf; |
| |
| if (sel && ether_addr_equal(sel->fcf_mac, fip->dest_addr)) |
| goto unlock; |
| if (!is_zero_ether_addr(fip->dest_addr)) { |
| printk(KERN_NOTICE "libfcoe: host%d: " |
| "FIP Fibre-Channel Forwarder MAC %pM deselected\n", |
| fip->lp->host->host_no, fip->dest_addr); |
| eth_zero_addr(fip->dest_addr); |
| } |
| if (sel) { |
| printk(KERN_INFO "libfcoe: host%d: FIP selected " |
| "Fibre-Channel Forwarder MAC %pM\n", |
| fip->lp->host->host_no, sel->fcf_mac); |
| memcpy(fip->dest_addr, sel->fcoe_mac, ETH_ALEN); |
| fip->map_dest = 0; |
| } |
| unlock: |
| mutex_unlock(&fip->ctlr_mutex); |
| } |
| |
| /** |
| * fcoe_ctlr_fcoe_size() - Return the maximum FCoE size required for VN_Port |
| * @fip: The FCoE controller to get the maximum FCoE size from |
| * |
| * Returns the maximum packet size including the FCoE header and trailer, |
| * but not including any Ethernet or VLAN headers. |
| */ |
| static inline u32 fcoe_ctlr_fcoe_size(struct fcoe_ctlr *fip) |
| { |
| /* |
| * Determine the max FCoE frame size allowed, including |
| * FCoE header and trailer. |
| * Note: lp->mfs is currently the payload size, not the frame size. |
| */ |
| return fip->lp->mfs + sizeof(struct fc_frame_header) + |
| sizeof(struct fcoe_hdr) + sizeof(struct fcoe_crc_eof); |
| } |
| |
| /** |
| * fcoe_ctlr_solicit() - Send a FIP solicitation |
| * @fip: The FCoE controller to send the solicitation on |
| * @fcf: The destination FCF (if NULL, a multicast solicitation is sent) |
| */ |
| static void fcoe_ctlr_solicit(struct fcoe_ctlr *fip, struct fcoe_fcf *fcf) |
| { |
| struct sk_buff *skb; |
| struct fip_sol { |
| struct ethhdr eth; |
| struct fip_header fip; |
| struct { |
| struct fip_mac_desc mac; |
| struct fip_wwn_desc wwnn; |
| struct fip_size_desc size; |
| } __packed desc; |
| } __packed * sol; |
| u32 fcoe_size; |
| |
| skb = dev_alloc_skb(sizeof(*sol)); |
| if (!skb) |
| return; |
| |
| sol = (struct fip_sol *)skb->data; |
| |
| memset(sol, 0, sizeof(*sol)); |
| memcpy(sol->eth.h_dest, fcf ? fcf->fcf_mac : fcoe_all_fcfs, ETH_ALEN); |
| memcpy(sol->eth.h_source, fip->ctl_src_addr, ETH_ALEN); |
| sol->eth.h_proto = htons(ETH_P_FIP); |
| |
| sol->fip.fip_ver = FIP_VER_ENCAPS(FIP_VER); |
| sol->fip.fip_op = htons(FIP_OP_DISC); |
| sol->fip.fip_subcode = FIP_SC_SOL; |
| sol->fip.fip_dl_len = htons(sizeof(sol->desc) / FIP_BPW); |
| sol->fip.fip_flags = htons(FIP_FL_FPMA); |
| if (fip->spma) |
| sol->fip.fip_flags |= htons(FIP_FL_SPMA); |
| |
| sol->desc.mac.fd_desc.fip_dtype = FIP_DT_MAC; |
| sol->desc.mac.fd_desc.fip_dlen = sizeof(sol->desc.mac) / FIP_BPW; |
| memcpy(sol->desc.mac.fd_mac, fip->ctl_src_addr, ETH_ALEN); |
| |
| sol->desc.wwnn.fd_desc.fip_dtype = FIP_DT_NAME; |
| sol->desc.wwnn.fd_desc.fip_dlen = sizeof(sol->desc.wwnn) / FIP_BPW; |
| put_unaligned_be64(fip->lp->wwnn, &sol->desc.wwnn.fd_wwn); |
| |
| fcoe_size = fcoe_ctlr_fcoe_size(fip); |
| sol->desc.size.fd_desc.fip_dtype = FIP_DT_FCOE_SIZE; |
| sol->desc.size.fd_desc.fip_dlen = sizeof(sol->desc.size) / FIP_BPW; |
| sol->desc.size.fd_size = htons(fcoe_size); |
| |
| skb_put(skb, sizeof(*sol)); |
| skb->protocol = htons(ETH_P_FIP); |
| skb->priority = fip->priority; |
| skb_reset_mac_header(skb); |
| skb_reset_network_header(skb); |
| fip->send(fip, skb); |
| |
| if (!fcf) |
| fip->sol_time = jiffies; |
| } |
| |
| /** |
| * fcoe_ctlr_link_up() - Start FCoE controller |
| * @fip: The FCoE controller to start |
| * |
| * Called from the LLD when the network link is ready. |
| */ |
| void fcoe_ctlr_link_up(struct fcoe_ctlr *fip) |
| { |
| mutex_lock(&fip->ctlr_mutex); |
| if (fip->state == FIP_ST_NON_FIP || fip->state == FIP_ST_AUTO) { |
| mutex_unlock(&fip->ctlr_mutex); |
| fc_linkup(fip->lp); |
| } else if (fip->state == FIP_ST_LINK_WAIT) { |
| if (fip->mode == FIP_MODE_NON_FIP) |
| fcoe_ctlr_set_state(fip, FIP_ST_NON_FIP); |
| else |
| fcoe_ctlr_set_state(fip, FIP_ST_AUTO); |
| switch (fip->mode) { |
| default: |
| LIBFCOE_FIP_DBG(fip, "invalid mode %d\n", fip->mode); |
| fallthrough; |
| case FIP_MODE_AUTO: |
| LIBFCOE_FIP_DBG(fip, "%s", "setting AUTO mode.\n"); |
| fallthrough; |
| case FIP_MODE_FABRIC: |
| case FIP_MODE_NON_FIP: |
| mutex_unlock(&fip->ctlr_mutex); |
| fc_linkup(fip->lp); |
| fcoe_ctlr_solicit(fip, NULL); |
| break; |
| case FIP_MODE_VN2VN: |
| fcoe_ctlr_vn_start(fip); |
| mutex_unlock(&fip->ctlr_mutex); |
| fc_linkup(fip->lp); |
| break; |
| } |
| } else |
| mutex_unlock(&fip->ctlr_mutex); |
| } |
| EXPORT_SYMBOL(fcoe_ctlr_link_up); |
| |
| /** |
| * fcoe_ctlr_reset() - Reset a FCoE controller |
| * @fip: The FCoE controller to reset |
| */ |
| static void fcoe_ctlr_reset(struct fcoe_ctlr *fip) |
| { |
| fcoe_ctlr_reset_fcfs(fip); |
| del_timer(&fip->timer); |
| fip->ctlr_ka_time = 0; |
| fip->port_ka_time = 0; |
| fip->sol_time = 0; |
| fip->flogi_oxid = FC_XID_UNKNOWN; |
| fcoe_ctlr_map_dest(fip); |
| } |
| |
| /** |
| * fcoe_ctlr_link_down() - Stop a FCoE controller |
| * @fip: The FCoE controller to be stopped |
| * |
| * Returns non-zero if the link was up and now isn't. |
| * |
| * Called from the LLD when the network link is not ready. |
| * There may be multiple calls while the link is down. |
| */ |
| int fcoe_ctlr_link_down(struct fcoe_ctlr *fip) |
| { |
| int link_dropped; |
| |
| LIBFCOE_FIP_DBG(fip, "link down.\n"); |
| mutex_lock(&fip->ctlr_mutex); |
| fcoe_ctlr_reset(fip); |
| link_dropped = fip->state != FIP_ST_LINK_WAIT; |
| fcoe_ctlr_set_state(fip, FIP_ST_LINK_WAIT); |
| mutex_unlock(&fip->ctlr_mutex); |
| |
| if (link_dropped) |
| fc_linkdown(fip->lp); |
| return link_dropped; |
| } |
| EXPORT_SYMBOL(fcoe_ctlr_link_down); |
| |
| /** |
| * fcoe_ctlr_send_keep_alive() - Send a keep-alive to the selected FCF |
| * @fip: The FCoE controller to send the FKA on |
| * @lport: libfc fc_lport to send from |
| * @ports: 0 for controller keep-alive, 1 for port keep-alive |
| * @sa: The source MAC address |
| * |
| * A controller keep-alive is sent every fka_period (typically 8 seconds). |
| * The source MAC is the native MAC address. |
| * |
| * A port keep-alive is sent every 90 seconds while logged in. |
| * The source MAC is the assigned mapped source address. |
| * The destination is the FCF's F-port. |
| */ |
| static void fcoe_ctlr_send_keep_alive(struct fcoe_ctlr *fip, |
| struct fc_lport *lport, |
| int ports, u8 *sa) |
| { |
| struct sk_buff *skb; |
| struct fip_kal { |
| struct ethhdr eth; |
| struct fip_header fip; |
| struct fip_mac_desc mac; |
| } __packed * kal; |
| struct fip_vn_desc *vn; |
| u32 len; |
| struct fc_lport *lp; |
| struct fcoe_fcf *fcf; |
| |
| fcf = fip->sel_fcf; |
| lp = fip->lp; |
| if (!fcf || (ports && !lp->port_id)) |
| return; |
| |
| len = sizeof(*kal) + ports * sizeof(*vn); |
| skb = dev_alloc_skb(len); |
| if (!skb) |
| return; |
| |
| kal = (struct fip_kal *)skb->data; |
| memset(kal, 0, len); |
| memcpy(kal->eth.h_dest, fcf->fcf_mac, ETH_ALEN); |
| memcpy(kal->eth.h_source, sa, ETH_ALEN); |
| kal->eth.h_proto = htons(ETH_P_FIP); |
| |
| kal->fip.fip_ver = FIP_VER_ENCAPS(FIP_VER); |
| kal->fip.fip_op = htons(FIP_OP_CTRL); |
| kal->fip.fip_subcode = FIP_SC_KEEP_ALIVE; |
| kal->fip.fip_dl_len = htons((sizeof(kal->mac) + |
| ports * sizeof(*vn)) / FIP_BPW); |
| kal->fip.fip_flags = htons(FIP_FL_FPMA); |
| if (fip->spma) |
| kal->fip.fip_flags |= htons(FIP_FL_SPMA); |
| |
| kal->mac.fd_desc.fip_dtype = FIP_DT_MAC; |
| kal->mac.fd_desc.fip_dlen = sizeof(kal->mac) / FIP_BPW; |
| memcpy(kal->mac.fd_mac, fip->ctl_src_addr, ETH_ALEN); |
| if (ports) { |
| vn = (struct fip_vn_desc *)(kal + 1); |
| vn->fd_desc.fip_dtype = FIP_DT_VN_ID; |
| vn->fd_desc.fip_dlen = sizeof(*vn) / FIP_BPW; |
| memcpy(vn->fd_mac, fip->get_src_addr(lport), ETH_ALEN); |
| hton24(vn->fd_fc_id, lport->port_id); |
| put_unaligned_be64(lport->wwpn, &vn->fd_wwpn); |
| } |
| skb_put(skb, len); |
| skb->protocol = htons(ETH_P_FIP); |
| skb->priority = fip->priority; |
| skb_reset_mac_header(skb); |
| skb_reset_network_header(skb); |
| fip->send(fip, skb); |
| } |
| |
| /** |
| * fcoe_ctlr_encaps() - Encapsulate an ELS frame for FIP, without sending it |
| * @fip: The FCoE controller for the ELS frame |
| * @lport: The local port |
| * @dtype: The FIP descriptor type for the frame |
| * @skb: The FCoE ELS frame including FC header but no FCoE headers |
| * @d_id: The destination port ID. |
| * |
| * Returns non-zero error code on failure. |
| * |
| * The caller must check that the length is a multiple of 4. |
| * |
| * The @skb must have enough headroom (28 bytes) and tailroom (8 bytes). |
| * Headroom includes the FIP encapsulation description, FIP header, and |
| * Ethernet header. The tailroom is for the FIP MAC descriptor. |
| */ |
| static int fcoe_ctlr_encaps(struct fcoe_ctlr *fip, struct fc_lport *lport, |
| u8 dtype, struct sk_buff *skb, u32 d_id) |
| { |
| struct fip_encaps_head { |
| struct ethhdr eth; |
| struct fip_header fip; |
| struct fip_encaps encaps; |
| } __packed * cap; |
| struct fc_frame_header *fh; |
| struct fip_mac_desc *mac; |
| struct fcoe_fcf *fcf; |
| size_t dlen; |
| u16 fip_flags; |
| u8 op; |
| |
| fh = (struct fc_frame_header *)skb->data; |
| op = *(u8 *)(fh + 1); |
| dlen = sizeof(struct fip_encaps) + skb->len; /* len before push */ |
| cap = skb_push(skb, sizeof(*cap)); |
| memset(cap, 0, sizeof(*cap)); |
| |
| if (lport->point_to_multipoint) { |
| if (fcoe_ctlr_vn_lookup(fip, d_id, cap->eth.h_dest)) |
| return -ENODEV; |
| fip_flags = 0; |
| } else { |
| fcf = fip->sel_fcf; |
| if (!fcf) |
| return -ENODEV; |
| fip_flags = fcf->flags; |
| fip_flags &= fip->spma ? FIP_FL_SPMA | FIP_FL_FPMA : |
| FIP_FL_FPMA; |
| if (!fip_flags) |
| return -ENODEV; |
| memcpy(cap->eth.h_dest, fcf->fcf_mac, ETH_ALEN); |
| } |
| memcpy(cap->eth.h_source, fip->ctl_src_addr, ETH_ALEN); |
| cap->eth.h_proto = htons(ETH_P_FIP); |
| |
| cap->fip.fip_ver = FIP_VER_ENCAPS(FIP_VER); |
| cap->fip.fip_op = htons(FIP_OP_LS); |
| if (op == ELS_LS_ACC || op == ELS_LS_RJT) |
| cap->fip.fip_subcode = FIP_SC_REP; |
| else |
| cap->fip.fip_subcode = FIP_SC_REQ; |
| cap->fip.fip_flags = htons(fip_flags); |
| |
| cap->encaps.fd_desc.fip_dtype = dtype; |
| cap->encaps.fd_desc.fip_dlen = dlen / FIP_BPW; |
| |
| if (op != ELS_LS_RJT) { |
| dlen += sizeof(*mac); |
| mac = skb_put_zero(skb, sizeof(*mac)); |
| mac->fd_desc.fip_dtype = FIP_DT_MAC; |
| mac->fd_desc.fip_dlen = sizeof(*mac) / FIP_BPW; |
| if (dtype != FIP_DT_FLOGI && dtype != FIP_DT_FDISC) { |
| memcpy(mac->fd_mac, fip->get_src_addr(lport), ETH_ALEN); |
| } else if (fip->mode == FIP_MODE_VN2VN) { |
| hton24(mac->fd_mac, FIP_VN_FC_MAP); |
| hton24(mac->fd_mac + 3, fip->port_id); |
| } else if (fip_flags & FIP_FL_SPMA) { |
| LIBFCOE_FIP_DBG(fip, "FLOGI/FDISC sent with SPMA\n"); |
| memcpy(mac->fd_mac, fip->ctl_src_addr, ETH_ALEN); |
| } else { |
| LIBFCOE_FIP_DBG(fip, "FLOGI/FDISC sent with FPMA\n"); |
| /* FPMA only FLOGI. Must leave the MAC desc zeroed. */ |
| } |
| } |
| cap->fip.fip_dl_len = htons(dlen / FIP_BPW); |
| |
| skb->protocol = htons(ETH_P_FIP); |
| skb->priority = fip->priority; |
| skb_reset_mac_header(skb); |
| skb_reset_network_header(skb); |
| return 0; |
| } |
| |
| /** |
| * fcoe_ctlr_els_send() - Send an ELS frame encapsulated by FIP if appropriate. |
| * @fip: FCoE controller. |
| * @lport: libfc fc_lport to send from |
| * @skb: FCoE ELS frame including FC header but no FCoE headers. |
| * |
| * Returns a non-zero error code if the frame should not be sent. |
| * Returns zero if the caller should send the frame with FCoE encapsulation. |
| * |
| * The caller must check that the length is a multiple of 4. |
| * The SKB must have enough headroom (28 bytes) and tailroom (8 bytes). |
| * The the skb must also be an fc_frame. |
| * |
| * This is called from the lower-level driver with spinlocks held, |
| * so we must not take a mutex here. |
| */ |
| int fcoe_ctlr_els_send(struct fcoe_ctlr *fip, struct fc_lport *lport, |
| struct sk_buff *skb) |
| { |
| struct fc_frame *fp; |
| struct fc_frame_header *fh; |
| u16 old_xid; |
| u8 op; |
| u8 mac[ETH_ALEN]; |
| |
| fp = container_of(skb, struct fc_frame, skb); |
| fh = (struct fc_frame_header *)skb->data; |
| op = *(u8 *)(fh + 1); |
| |
| if (op == ELS_FLOGI && fip->mode != FIP_MODE_VN2VN) { |
| old_xid = fip->flogi_oxid; |
| fip->flogi_oxid = ntohs(fh->fh_ox_id); |
| if (fip->state == FIP_ST_AUTO) { |
| if (old_xid == FC_XID_UNKNOWN) |
| fip->flogi_count = 0; |
| fip->flogi_count++; |
| if (fip->flogi_count < 3) |
| goto drop; |
| fcoe_ctlr_map_dest(fip); |
| return 0; |
| } |
| if (fip->state == FIP_ST_NON_FIP) |
| fcoe_ctlr_map_dest(fip); |
| } |
| |
| if (fip->state == FIP_ST_NON_FIP) |
| return 0; |
| if (!fip->sel_fcf && fip->mode != FIP_MODE_VN2VN) |
| goto drop; |
| switch (op) { |
| case ELS_FLOGI: |
| op = FIP_DT_FLOGI; |
| if (fip->mode == FIP_MODE_VN2VN) |
| break; |
| spin_lock_bh(&fip->ctlr_lock); |
| kfree_skb(fip->flogi_req); |
| fip->flogi_req = skb; |
| fip->flogi_req_send = 1; |
| spin_unlock_bh(&fip->ctlr_lock); |
| schedule_work(&fip->timer_work); |
| return -EINPROGRESS; |
| case ELS_FDISC: |
| if (ntoh24(fh->fh_s_id)) |
| return 0; |
| op = FIP_DT_FDISC; |
| break; |
| case ELS_LOGO: |
| if (fip->mode == FIP_MODE_VN2VN) { |
| if (fip->state != FIP_ST_VNMP_UP) |
| goto drop; |
| if (ntoh24(fh->fh_d_id) == FC_FID_FLOGI) |
| goto drop; |
| } else { |
| if (fip->state != FIP_ST_ENABLED) |
| return 0; |
| if (ntoh24(fh->fh_d_id) != FC_FID_FLOGI) |
| return 0; |
| } |
| op = FIP_DT_LOGO; |
| break; |
| case ELS_LS_ACC: |
| /* |
| * If non-FIP, we may have gotten an SID by accepting an FLOGI |
| * from a point-to-point connection. Switch to using |
| * the source mac based on the SID. The destination |
| * MAC in this case would have been set by receiving the |
| * FLOGI. |
| */ |
| if (fip->state == FIP_ST_NON_FIP) { |
| if (fip->flogi_oxid == FC_XID_UNKNOWN) |
| return 0; |
| fip->flogi_oxid = FC_XID_UNKNOWN; |
| fc_fcoe_set_mac(mac, fh->fh_d_id); |
| fip->update_mac(lport, mac); |
| } |
| fallthrough; |
| case ELS_LS_RJT: |
| op = fr_encaps(fp); |
| if (op) |
| break; |
| return 0; |
| default: |
| if (fip->state != FIP_ST_ENABLED && |
| fip->state != FIP_ST_VNMP_UP) |
| goto drop; |
| return 0; |
| } |
| LIBFCOE_FIP_DBG(fip, "els_send op %u d_id %x\n", |
| op, ntoh24(fh->fh_d_id)); |
| if (fcoe_ctlr_encaps(fip, lport, op, skb, ntoh24(fh->fh_d_id))) |
| goto drop; |
| fip->send(fip, skb); |
| return -EINPROGRESS; |
| drop: |
| LIBFCOE_FIP_DBG(fip, "drop els_send op %u d_id %x\n", |
| op, ntoh24(fh->fh_d_id)); |
| kfree_skb(skb); |
| return -EINVAL; |
| } |
| EXPORT_SYMBOL(fcoe_ctlr_els_send); |
| |
| /** |
| * fcoe_ctlr_age_fcfs() - Reset and free all old FCFs for a controller |
| * @fip: The FCoE controller to free FCFs on |
| * |
| * Called with lock held and preemption disabled. |
| * |
| * An FCF is considered old if we have missed two advertisements. |
| * That is, there have been no valid advertisement from it for 2.5 |
| * times its keep-alive period. |
| * |
| * In addition, determine the time when an FCF selection can occur. |
| * |
| * Also, increment the MissDiscAdvCount when no advertisement is received |
| * for the corresponding FCF for 1.5 * FKA_ADV_PERIOD (FC-BB-5 LESB). |
| * |
| * Returns the time in jiffies for the next call. |
| */ |
| static unsigned long fcoe_ctlr_age_fcfs(struct fcoe_ctlr *fip) |
| { |
| struct fcoe_fcf *fcf; |
| struct fcoe_fcf *next; |
| unsigned long next_timer = jiffies + msecs_to_jiffies(FIP_VN_KA_PERIOD); |
| unsigned long deadline; |
| unsigned long sel_time = 0; |
| struct list_head del_list; |
| |
| INIT_LIST_HEAD(&del_list); |
| |
| list_for_each_entry_safe(fcf, next, &fip->fcfs, list) { |
| deadline = fcf->time + fcf->fka_period + fcf->fka_period / 2; |
| if (fip->sel_fcf == fcf) { |
| if (time_after(jiffies, deadline)) { |
| u64 miss_cnt; |
| |
| miss_cnt = this_cpu_inc_return(fip->lp->stats->MissDiscAdvCount); |
| printk(KERN_INFO "libfcoe: host%d: " |
| "Missing Discovery Advertisement " |
| "for fab %16.16llx count %lld\n", |
| fip->lp->host->host_no, fcf->fabric_name, |
| miss_cnt); |
| } else if (time_after(next_timer, deadline)) |
| next_timer = deadline; |
| } |
| |
| deadline += fcf->fka_period; |
| if (time_after_eq(jiffies, deadline)) { |
| if (fip->sel_fcf == fcf) |
| fip->sel_fcf = NULL; |
| /* |
| * Move to delete list so we can call |
| * fcoe_sysfs_fcf_del (which can sleep) |
| * after the put_cpu(). |
| */ |
| list_del(&fcf->list); |
| list_add(&fcf->list, &del_list); |
| this_cpu_inc(fip->lp->stats->VLinkFailureCount); |
| } else { |
| if (time_after(next_timer, deadline)) |
| next_timer = deadline; |
| if (fcoe_ctlr_mtu_valid(fcf) && |
| (!sel_time || time_before(sel_time, fcf->time))) |
| sel_time = fcf->time; |
| } |
| } |
| |
| list_for_each_entry_safe(fcf, next, &del_list, list) { |
| /* Removes fcf from current list */ |
| fcoe_sysfs_fcf_del(fcf); |
| } |
| |
| if (sel_time && !fip->sel_fcf && !fip->sel_time) { |
| sel_time += msecs_to_jiffies(FCOE_CTLR_START_DELAY); |
| fip->sel_time = sel_time; |
| } |
| |
| return next_timer; |
| } |
| |
| /** |
| * fcoe_ctlr_parse_adv() - Decode a FIP advertisement into a new FCF entry |
| * @fip: The FCoE controller receiving the advertisement |
| * @skb: The received FIP advertisement frame |
| * @fcf: The resulting FCF entry |
| * |
| * Returns zero on a valid parsed advertisement, |
| * otherwise returns non zero value. |
| */ |
| static int fcoe_ctlr_parse_adv(struct fcoe_ctlr *fip, |
| struct sk_buff *skb, struct fcoe_fcf *fcf) |
| { |
| struct fip_header *fiph; |
| struct fip_desc *desc = NULL; |
| struct fip_wwn_desc *wwn; |
| struct fip_fab_desc *fab; |
| struct fip_fka_desc *fka; |
| unsigned long t; |
| size_t rlen; |
| size_t dlen; |
| u32 desc_mask; |
| |
| memset(fcf, 0, sizeof(*fcf)); |
| fcf->fka_period = msecs_to_jiffies(FCOE_CTLR_DEF_FKA); |
| |
| fiph = (struct fip_header *)skb->data; |
| fcf->flags = ntohs(fiph->fip_flags); |
| |
| /* |
| * mask of required descriptors. validating each one clears its bit. |
| */ |
| desc_mask = BIT(FIP_DT_PRI) | BIT(FIP_DT_MAC) | BIT(FIP_DT_NAME) | |
| BIT(FIP_DT_FAB) | BIT(FIP_DT_FKA); |
| |
| rlen = ntohs(fiph->fip_dl_len) * 4; |
| if (rlen + sizeof(*fiph) > skb->len) |
| return -EINVAL; |
| |
| desc = (struct fip_desc *)(fiph + 1); |
| while (rlen > 0) { |
| dlen = desc->fip_dlen * FIP_BPW; |
| if (dlen < sizeof(*desc) || dlen > rlen) |
| return -EINVAL; |
| /* Drop Adv if there are duplicate critical descriptors */ |
| if ((desc->fip_dtype < 32) && |
| !(desc_mask & 1U << desc->fip_dtype)) { |
| LIBFCOE_FIP_DBG(fip, "Duplicate Critical " |
| "Descriptors in FIP adv\n"); |
| return -EINVAL; |
| } |
| switch (desc->fip_dtype) { |
| case FIP_DT_PRI: |
| if (dlen != sizeof(struct fip_pri_desc)) |
| goto len_err; |
| fcf->pri = ((struct fip_pri_desc *)desc)->fd_pri; |
| desc_mask &= ~BIT(FIP_DT_PRI); |
| break; |
| case FIP_DT_MAC: |
| if (dlen != sizeof(struct fip_mac_desc)) |
| goto len_err; |
| memcpy(fcf->fcf_mac, |
| ((struct fip_mac_desc *)desc)->fd_mac, |
| ETH_ALEN); |
| memcpy(fcf->fcoe_mac, fcf->fcf_mac, ETH_ALEN); |
| if (!is_valid_ether_addr(fcf->fcf_mac)) { |
| LIBFCOE_FIP_DBG(fip, |
| "Invalid MAC addr %pM in FIP adv\n", |
| fcf->fcf_mac); |
| return -EINVAL; |
| } |
| desc_mask &= ~BIT(FIP_DT_MAC); |
| break; |
| case FIP_DT_NAME: |
| if (dlen != sizeof(struct fip_wwn_desc)) |
| goto len_err; |
| wwn = (struct fip_wwn_desc *)desc; |
| fcf->switch_name = get_unaligned_be64(&wwn->fd_wwn); |
| desc_mask &= ~BIT(FIP_DT_NAME); |
| break; |
| case FIP_DT_FAB: |
| if (dlen != sizeof(struct fip_fab_desc)) |
| goto len_err; |
| fab = (struct fip_fab_desc *)desc; |
| fcf->fabric_name = get_unaligned_be64(&fab->fd_wwn); |
| fcf->vfid = ntohs(fab->fd_vfid); |
| fcf->fc_map = ntoh24(fab->fd_map); |
| desc_mask &= ~BIT(FIP_DT_FAB); |
| break; |
| case FIP_DT_FKA: |
| if (dlen != sizeof(struct fip_fka_desc)) |
| goto len_err; |
| fka = (struct fip_fka_desc *)desc; |
| if (fka->fd_flags & FIP_FKA_ADV_D) |
| fcf->fd_flags = 1; |
| t = ntohl(fka->fd_fka_period); |
| if (t >= FCOE_CTLR_MIN_FKA) |
| fcf->fka_period = msecs_to_jiffies(t); |
| desc_mask &= ~BIT(FIP_DT_FKA); |
| break; |
| case FIP_DT_MAP_OUI: |
| case FIP_DT_FCOE_SIZE: |
| case FIP_DT_FLOGI: |
| case FIP_DT_FDISC: |
| case FIP_DT_LOGO: |
| case FIP_DT_ELP: |
| default: |
| LIBFCOE_FIP_DBG(fip, "unexpected descriptor type %x " |
| "in FIP adv\n", desc->fip_dtype); |
| /* standard says ignore unknown descriptors >= 128 */ |
| if (desc->fip_dtype < FIP_DT_NON_CRITICAL) |
| return -EINVAL; |
| break; |
| } |
| desc = (struct fip_desc *)((char *)desc + dlen); |
| rlen -= dlen; |
| } |
| if (!fcf->fc_map || (fcf->fc_map & 0x10000)) |
| return -EINVAL; |
| if (!fcf->switch_name) |
| return -EINVAL; |
| if (desc_mask) { |
| LIBFCOE_FIP_DBG(fip, "adv missing descriptors mask %x\n", |
| desc_mask); |
| return -EINVAL; |
| } |
| return 0; |
| |
| len_err: |
| LIBFCOE_FIP_DBG(fip, "FIP length error in descriptor type %x len %zu\n", |
| desc->fip_dtype, dlen); |
| return -EINVAL; |
| } |
| |
| /** |
| * fcoe_ctlr_recv_adv() - Handle an incoming advertisement |
| * @fip: The FCoE controller receiving the advertisement |
| * @skb: The received FIP packet |
| */ |
| static void fcoe_ctlr_recv_adv(struct fcoe_ctlr *fip, struct sk_buff *skb) |
| { |
| struct fcoe_fcf *fcf; |
| struct fcoe_fcf new; |
| unsigned long sol_tov = msecs_to_jiffies(FCOE_CTLR_SOL_TOV); |
| int first = 0; |
| int mtu_valid; |
| int found = 0; |
| int rc = 0; |
| |
| if (fcoe_ctlr_parse_adv(fip, skb, &new)) |
| return; |
| |
| mutex_lock(&fip->ctlr_mutex); |
| first = list_empty(&fip->fcfs); |
| list_for_each_entry(fcf, &fip->fcfs, list) { |
| if (fcf->switch_name == new.switch_name && |
| fcf->fabric_name == new.fabric_name && |
| fcf->fc_map == new.fc_map && |
| ether_addr_equal(fcf->fcf_mac, new.fcf_mac)) { |
| found = 1; |
| break; |
| } |
| } |
| if (!found) { |
| if (fip->fcf_count >= FCOE_CTLR_FCF_LIMIT) |
| goto out; |
| |
| fcf = kmalloc(sizeof(*fcf), GFP_ATOMIC); |
| if (!fcf) |
| goto out; |
| |
| memcpy(fcf, &new, sizeof(new)); |
| fcf->fip = fip; |
| rc = fcoe_sysfs_fcf_add(fcf); |
| if (rc) { |
| printk(KERN_ERR "Failed to allocate sysfs instance " |
| "for FCF, fab %16.16llx mac %pM\n", |
| new.fabric_name, new.fcf_mac); |
| kfree(fcf); |
| goto out; |
| } |
| } else { |
| /* |
| * Update the FCF's keep-alive descriptor flags. |
| * Other flag changes from new advertisements are |
| * ignored after a solicited advertisement is |
| * received and the FCF is selectable (usable). |
| */ |
| fcf->fd_flags = new.fd_flags; |
| if (!fcoe_ctlr_fcf_usable(fcf)) |
| fcf->flags = new.flags; |
| |
| if (fcf == fip->sel_fcf && !fcf->fd_flags) { |
| fip->ctlr_ka_time -= fcf->fka_period; |
| fip->ctlr_ka_time += new.fka_period; |
| if (time_before(fip->ctlr_ka_time, fip->timer.expires)) |
| mod_timer(&fip->timer, fip->ctlr_ka_time); |
| } |
| fcf->fka_period = new.fka_period; |
| memcpy(fcf->fcf_mac, new.fcf_mac, ETH_ALEN); |
| } |
| |
| mtu_valid = fcoe_ctlr_mtu_valid(fcf); |
| fcf->time = jiffies; |
| if (!found) |
| LIBFCOE_FIP_DBG(fip, "New FCF fab %16.16llx mac %pM\n", |
| fcf->fabric_name, fcf->fcf_mac); |
| |
| /* |
| * If this advertisement is not solicited and our max receive size |
| * hasn't been verified, send a solicited advertisement. |
| */ |
| if (!mtu_valid) |
| fcoe_ctlr_solicit(fip, fcf); |
| |
| /* |
| * If its been a while since we did a solicit, and this is |
| * the first advertisement we've received, do a multicast |
| * solicitation to gather as many advertisements as we can |
| * before selection occurs. |
| */ |
| if (first && time_after(jiffies, fip->sol_time + sol_tov)) |
| fcoe_ctlr_solicit(fip, NULL); |
| |
| /* |
| * Put this FCF at the head of the list for priority among equals. |
| * This helps in the case of an NPV switch which insists we use |
| * the FCF that answers multicast solicitations, not the others that |
| * are sending periodic multicast advertisements. |
| */ |
| if (mtu_valid) |
| list_move(&fcf->list, &fip->fcfs); |
| |
| /* |
| * If this is the first validated FCF, note the time and |
| * set a timer to trigger selection. |
| */ |
| if (mtu_valid && !fip->sel_fcf && !fip->sel_time && |
| fcoe_ctlr_fcf_usable(fcf)) { |
| fip->sel_time = jiffies + |
| msecs_to_jiffies(FCOE_CTLR_START_DELAY); |
| if (!timer_pending(&fip->timer) || |
| time_before(fip->sel_time, fip->timer.expires)) |
| mod_timer(&fip->timer, fip->sel_time); |
| } |
| |
| out: |
| mutex_unlock(&fip->ctlr_mutex); |
| } |
| |
| /** |
| * fcoe_ctlr_recv_els() - Handle an incoming FIP encapsulated ELS frame |
| * @fip: The FCoE controller which received the packet |
| * @skb: The received FIP packet |
| */ |
| static void fcoe_ctlr_recv_els(struct fcoe_ctlr *fip, struct sk_buff *skb) |
| { |
| struct fc_lport *lport = fip->lp; |
| struct fip_header *fiph; |
| struct fc_frame *fp = (struct fc_frame *)skb; |
| struct fc_frame_header *fh = NULL; |
| struct fip_desc *desc; |
| struct fip_encaps *els; |
| struct fcoe_fcf *sel; |
| enum fip_desc_type els_dtype = 0; |
| u8 els_op; |
| u8 sub; |
| u8 granted_mac[ETH_ALEN] = { 0 }; |
| size_t els_len = 0; |
| size_t rlen; |
| size_t dlen; |
| u32 desc_mask = 0; |
| u32 desc_cnt = 0; |
| |
| fiph = (struct fip_header *)skb->data; |
| sub = fiph->fip_subcode; |
| if (sub != FIP_SC_REQ && sub != FIP_SC_REP) |
| goto drop; |
| |
| rlen = ntohs(fiph->fip_dl_len) * 4; |
| if (rlen + sizeof(*fiph) > skb->len) |
| goto drop; |
| |
| desc = (struct fip_desc *)(fiph + 1); |
| while (rlen > 0) { |
| desc_cnt++; |
| dlen = desc->fip_dlen * FIP_BPW; |
| if (dlen < sizeof(*desc) || dlen > rlen) |
| goto drop; |
| /* Drop ELS if there are duplicate critical descriptors */ |
| if (desc->fip_dtype < 32) { |
| if ((desc->fip_dtype != FIP_DT_MAC) && |
| (desc_mask & 1U << desc->fip_dtype)) { |
| LIBFCOE_FIP_DBG(fip, "Duplicate Critical " |
| "Descriptors in FIP ELS\n"); |
| goto drop; |
| } |
| desc_mask |= (1 << desc->fip_dtype); |
| } |
| switch (desc->fip_dtype) { |
| case FIP_DT_MAC: |
| sel = fip->sel_fcf; |
| if (desc_cnt == 1) { |
| LIBFCOE_FIP_DBG(fip, "FIP descriptors " |
| "received out of order\n"); |
| goto drop; |
| } |
| /* |
| * Some switch implementations send two MAC descriptors, |
| * with first MAC(granted_mac) being the FPMA, and the |
| * second one(fcoe_mac) is used as destination address |
| * for sending/receiving FCoE packets. FIP traffic is |
| * sent using fip_mac. For regular switches, both |
| * fip_mac and fcoe_mac would be the same. |
| */ |
| if (desc_cnt == 2) |
| memcpy(granted_mac, |
| ((struct fip_mac_desc *)desc)->fd_mac, |
| ETH_ALEN); |
| |
| if (dlen != sizeof(struct fip_mac_desc)) |
| goto len_err; |
| |
| if ((desc_cnt == 3) && (sel)) |
| memcpy(sel->fcoe_mac, |
| ((struct fip_mac_desc *)desc)->fd_mac, |
| ETH_ALEN); |
| break; |
| case FIP_DT_FLOGI: |
| case FIP_DT_FDISC: |
| case FIP_DT_LOGO: |
| case FIP_DT_ELP: |
| if (desc_cnt != 1) { |
| LIBFCOE_FIP_DBG(fip, "FIP descriptors " |
| "received out of order\n"); |
| goto drop; |
| } |
| if (fh) |
| goto drop; |
| if (dlen < sizeof(*els) + sizeof(*fh) + 1) |
| goto len_err; |
| els_len = dlen - sizeof(*els); |
| els = (struct fip_encaps *)desc; |
| fh = (struct fc_frame_header *)(els + 1); |
| els_dtype = desc->fip_dtype; |
| break; |
| default: |
| LIBFCOE_FIP_DBG(fip, "unexpected descriptor type %x " |
| "in FIP adv\n", desc->fip_dtype); |
| /* standard says ignore unknown descriptors >= 128 */ |
| if (desc->fip_dtype < FIP_DT_NON_CRITICAL) |
| goto drop; |
| if (desc_cnt <= 2) { |
| LIBFCOE_FIP_DBG(fip, "FIP descriptors " |
| "received out of order\n"); |
| goto drop; |
| } |
| break; |
| } |
| desc = (struct fip_desc *)((char *)desc + dlen); |
| rlen -= dlen; |
| } |
| |
| if (!fh) |
| goto drop; |
| els_op = *(u8 *)(fh + 1); |
| |
| if ((els_dtype == FIP_DT_FLOGI || els_dtype == FIP_DT_FDISC) && |
| sub == FIP_SC_REP && fip->mode != FIP_MODE_VN2VN) { |
| if (els_op == ELS_LS_ACC) { |
| if (!is_valid_ether_addr(granted_mac)) { |
| LIBFCOE_FIP_DBG(fip, |
| "Invalid MAC address %pM in FIP ELS\n", |
| granted_mac); |
| goto drop; |
| } |
| memcpy(fr_cb(fp)->granted_mac, granted_mac, ETH_ALEN); |
| |
| if (fip->flogi_oxid == ntohs(fh->fh_ox_id)) { |
| fip->flogi_oxid = FC_XID_UNKNOWN; |
| if (els_dtype == FIP_DT_FLOGI) |
| fcoe_ctlr_announce(fip); |
| } |
| } else if (els_dtype == FIP_DT_FLOGI && |
| !fcoe_ctlr_flogi_retry(fip)) |
| goto drop; /* retrying FLOGI so drop reject */ |
| } |
| |
| if ((desc_cnt == 0) || ((els_op != ELS_LS_RJT) && |
| (!(1U << FIP_DT_MAC & desc_mask)))) { |
| LIBFCOE_FIP_DBG(fip, "Missing critical descriptors " |
| "in FIP ELS\n"); |
| goto drop; |
| } |
| |
| /* |
| * Convert skb into an fc_frame containing only the ELS. |
| */ |
| skb_pull(skb, (u8 *)fh - skb->data); |
| skb_trim(skb, els_len); |
| fp = (struct fc_frame *)skb; |
| fc_frame_init(fp); |
| fr_sof(fp) = FC_SOF_I3; |
| fr_eof(fp) = FC_EOF_T; |
| fr_dev(fp) = lport; |
| fr_encaps(fp) = els_dtype; |
| |
| this_cpu_inc(lport->stats->RxFrames); |
| this_cpu_add(lport->stats->RxWords, skb->len / FIP_BPW); |
| |
| fc_exch_recv(lport, fp); |
| return; |
| |
| len_err: |
| LIBFCOE_FIP_DBG(fip, "FIP length error in descriptor type %x len %zu\n", |
| desc->fip_dtype, dlen); |
| drop: |
| kfree_skb(skb); |
| } |
| |
| /** |
| * fcoe_ctlr_recv_clr_vlink() - Handle an incoming link reset frame |
| * @fip: The FCoE controller that received the frame |
| * @skb: The received FIP packet |
| * |
| * There may be multiple VN_Port descriptors. |
| * The overall length has already been checked. |
| */ |
| static void fcoe_ctlr_recv_clr_vlink(struct fcoe_ctlr *fip, |
| struct sk_buff *skb) |
| { |
| struct fip_desc *desc; |
| struct fip_mac_desc *mp; |
| struct fip_wwn_desc *wp; |
| struct fip_vn_desc *vp; |
| size_t rlen; |
| size_t dlen; |
| struct fcoe_fcf *fcf = fip->sel_fcf; |
| struct fc_lport *lport = fip->lp; |
| struct fc_lport *vn_port = NULL; |
| u32 desc_mask; |
| int num_vlink_desc; |
| int reset_phys_port = 0; |
| struct fip_vn_desc **vlink_desc_arr = NULL; |
| struct fip_header *fh = (struct fip_header *)skb->data; |
| struct ethhdr *eh = eth_hdr(skb); |
| |
| LIBFCOE_FIP_DBG(fip, "Clear Virtual Link received\n"); |
| |
| if (!fcf) { |
| /* |
| * We are yet to select best FCF, but we got CVL in the |
| * meantime. reset the ctlr and let it rediscover the FCF |
| */ |
| LIBFCOE_FIP_DBG(fip, "Resetting fcoe_ctlr as FCF has not been " |
| "selected yet\n"); |
| mutex_lock(&fip->ctlr_mutex); |
| fcoe_ctlr_reset(fip); |
| mutex_unlock(&fip->ctlr_mutex); |
| return; |
| } |
| |
| /* |
| * If we've selected an FCF check that the CVL is from there to avoid |
| * processing CVLs from an unexpected source. If it is from an |
| * unexpected source drop it on the floor. |
| */ |
| if (!ether_addr_equal(eh->h_source, fcf->fcf_mac)) { |
| LIBFCOE_FIP_DBG(fip, "Dropping CVL due to source address " |
| "mismatch with FCF src=%pM\n", eh->h_source); |
| return; |
| } |
| |
| /* |
| * If we haven't logged into the fabric but receive a CVL we should |
| * reset everything and go back to solicitation. |
| */ |
| if (!lport->port_id) { |
| LIBFCOE_FIP_DBG(fip, "lport not logged in, resoliciting\n"); |
| mutex_lock(&fip->ctlr_mutex); |
| fcoe_ctlr_reset(fip); |
| mutex_unlock(&fip->ctlr_mutex); |
| fc_lport_reset(fip->lp); |
| fcoe_ctlr_solicit(fip, NULL); |
| return; |
| } |
| |
| /* |
| * mask of required descriptors. Validating each one clears its bit. |
| */ |
| desc_mask = BIT(FIP_DT_MAC) | BIT(FIP_DT_NAME); |
| |
| rlen = ntohs(fh->fip_dl_len) * FIP_BPW; |
| desc = (struct fip_desc *)(fh + 1); |
| |
| /* |
| * Actually need to subtract 'sizeof(*mp) - sizeof(*wp)' from 'rlen' |
| * before determining max Vx_Port descriptor but a buggy FCF could have |
| * omitted either or both MAC Address and Name Identifier descriptors |
| */ |
| num_vlink_desc = rlen / sizeof(*vp); |
| if (num_vlink_desc) |
| vlink_desc_arr = kmalloc_array(num_vlink_desc, sizeof(vp), |
| GFP_ATOMIC); |
| if (!vlink_desc_arr) |
| return; |
| num_vlink_desc = 0; |
| |
| while (rlen >= sizeof(*desc)) { |
| dlen = desc->fip_dlen * FIP_BPW; |
| if (dlen > rlen) |
| goto err; |
| /* Drop CVL if there are duplicate critical descriptors */ |
| if ((desc->fip_dtype < 32) && |
| (desc->fip_dtype != FIP_DT_VN_ID) && |
| !(desc_mask & 1U << desc->fip_dtype)) { |
| LIBFCOE_FIP_DBG(fip, "Duplicate Critical " |
| "Descriptors in FIP CVL\n"); |
| goto err; |
| } |
| switch (desc->fip_dtype) { |
| case FIP_DT_MAC: |
| mp = (struct fip_mac_desc *)desc; |
| if (dlen < sizeof(*mp)) |
| goto err; |
| if (!ether_addr_equal(mp->fd_mac, fcf->fcf_mac)) |
| goto err; |
| desc_mask &= ~BIT(FIP_DT_MAC); |
| break; |
| case FIP_DT_NAME: |
| wp = (struct fip_wwn_desc *)desc; |
| if (dlen < sizeof(*wp)) |
| goto err; |
| if (get_unaligned_be64(&wp->fd_wwn) != fcf->switch_name) |
| goto err; |
| desc_mask &= ~BIT(FIP_DT_NAME); |
| break; |
| case FIP_DT_VN_ID: |
| vp = (struct fip_vn_desc *)desc; |
| if (dlen < sizeof(*vp)) |
| goto err; |
| vlink_desc_arr[num_vlink_desc++] = vp; |
| vn_port = fc_vport_id_lookup(lport, |
| ntoh24(vp->fd_fc_id)); |
| if (vn_port && (vn_port == lport)) { |
| mutex_lock(&fip->ctlr_mutex); |
| this_cpu_inc(lport->stats->VLinkFailureCount); |
| fcoe_ctlr_reset(fip); |
| mutex_unlock(&fip->ctlr_mutex); |
| } |
| break; |
| default: |
| /* standard says ignore unknown descriptors >= 128 */ |
| if (desc->fip_dtype < FIP_DT_NON_CRITICAL) |
| goto err; |
| break; |
| } |
| desc = (struct fip_desc *)((char *)desc + dlen); |
| rlen -= dlen; |
| } |
| |
| /* |
| * reset only if all required descriptors were present and valid. |
| */ |
| if (desc_mask) |
| LIBFCOE_FIP_DBG(fip, "missing descriptors mask %x\n", |
| desc_mask); |
| else if (!num_vlink_desc) { |
| LIBFCOE_FIP_DBG(fip, "CVL: no Vx_Port descriptor found\n"); |
| /* |
| * No Vx_Port description. Clear all NPIV ports, |
| * followed by physical port |
| */ |
| mutex_lock(&fip->ctlr_mutex); |
| this_cpu_inc(lport->stats->VLinkFailureCount); |
| fcoe_ctlr_reset(fip); |
| mutex_unlock(&fip->ctlr_mutex); |
| |
| mutex_lock(&lport->lp_mutex); |
| list_for_each_entry(vn_port, &lport->vports, list) |
| fc_lport_reset(vn_port); |
| mutex_unlock(&lport->lp_mutex); |
| |
| fc_lport_reset(fip->lp); |
| fcoe_ctlr_solicit(fip, NULL); |
| } else { |
| int i; |
| |
| LIBFCOE_FIP_DBG(fip, "performing Clear Virtual Link\n"); |
| for (i = 0; i < num_vlink_desc; i++) { |
| vp = vlink_desc_arr[i]; |
| vn_port = fc_vport_id_lookup(lport, |
| ntoh24(vp->fd_fc_id)); |
| if (!vn_port) |
| continue; |
| |
| /* |
| * 'port_id' is already validated, check MAC address and |
| * wwpn |
| */ |
| if (!ether_addr_equal(fip->get_src_addr(vn_port), |
| vp->fd_mac) || |
| get_unaligned_be64(&vp->fd_wwpn) != |
| vn_port->wwpn) |
| continue; |
| |
| if (vn_port == lport) |
| /* |
| * Physical port, defer processing till all |
| * listed NPIV ports are cleared |
| */ |
| reset_phys_port = 1; |
| else /* NPIV port */ |
| fc_lport_reset(vn_port); |
| } |
| |
| if (reset_phys_port) { |
| fc_lport_reset(fip->lp); |
| fcoe_ctlr_solicit(fip, NULL); |
| } |
| } |
| |
| err: |
| kfree(vlink_desc_arr); |
| } |
| |
| /** |
| * fcoe_ctlr_recv() - Receive a FIP packet |
| * @fip: The FCoE controller that received the packet |
| * @skb: The received FIP packet |
| * |
| * This may be called from either NET_RX_SOFTIRQ or IRQ. |
| */ |
| void fcoe_ctlr_recv(struct fcoe_ctlr *fip, struct sk_buff *skb) |
| { |
| skb = skb_share_check(skb, GFP_ATOMIC); |
| if (!skb) |
| return; |
| skb_queue_tail(&fip->fip_recv_list, skb); |
| schedule_work(&fip->recv_work); |
| } |
| EXPORT_SYMBOL(fcoe_ctlr_recv); |
| |
| /** |
| * fcoe_ctlr_recv_handler() - Receive a FIP frame |
| * @fip: The FCoE controller that received the frame |
| * @skb: The received FIP frame |
| * |
| * Returns non-zero if the frame is dropped. |
| */ |
| static int fcoe_ctlr_recv_handler(struct fcoe_ctlr *fip, struct sk_buff *skb) |
| { |
| struct fip_header *fiph; |
| struct ethhdr *eh; |
| enum fip_state state; |
| bool fip_vlan_resp = false; |
| u16 op; |
| u8 sub; |
| |
| if (skb_linearize(skb)) |
| goto drop; |
| if (skb->len < sizeof(*fiph)) |
| goto drop; |
| eh = eth_hdr(skb); |
| if (fip->mode == FIP_MODE_VN2VN) { |
| if (!ether_addr_equal(eh->h_dest, fip->ctl_src_addr) && |
| !ether_addr_equal(eh->h_dest, fcoe_all_vn2vn) && |
| !ether_addr_equal(eh->h_dest, fcoe_all_p2p)) |
| goto drop; |
| } else if (!ether_addr_equal(eh->h_dest, fip->ctl_src_addr) && |
| !ether_addr_equal(eh->h_dest, fcoe_all_enode)) |
| goto drop; |
| fiph = (struct fip_header *)skb->data; |
| op = ntohs(fiph->fip_op); |
| sub = fiph->fip_subcode; |
| |
| if (FIP_VER_DECAPS(fiph->fip_ver) != FIP_VER) |
| goto drop; |
| if (ntohs(fiph->fip_dl_len) * FIP_BPW + sizeof(*fiph) > skb->len) |
| goto drop; |
| |
| mutex_lock(&fip->ctlr_mutex); |
| state = fip->state; |
| if (state == FIP_ST_AUTO) { |
| fip->map_dest = 0; |
| fcoe_ctlr_set_state(fip, FIP_ST_ENABLED); |
| state = FIP_ST_ENABLED; |
| LIBFCOE_FIP_DBG(fip, "Using FIP mode\n"); |
| } |
| fip_vlan_resp = fip->fip_resp; |
| mutex_unlock(&fip->ctlr_mutex); |
| |
| if (fip->mode == FIP_MODE_VN2VN && op == FIP_OP_VN2VN) |
| return fcoe_ctlr_vn_recv(fip, skb); |
| |
| if (fip_vlan_resp && op == FIP_OP_VLAN) { |
| LIBFCOE_FIP_DBG(fip, "fip vlan discovery\n"); |
| return fcoe_ctlr_vlan_recv(fip, skb); |
| } |
| |
| if (state != FIP_ST_ENABLED && state != FIP_ST_VNMP_UP && |
| state != FIP_ST_VNMP_CLAIM) |
| goto drop; |
| |
| if (op == FIP_OP_LS) { |
| fcoe_ctlr_recv_els(fip, skb); /* consumes skb */ |
| return 0; |
| } |
| |
| if (state != FIP_ST_ENABLED) |
| goto drop; |
| |
| if (op == FIP_OP_DISC && sub == FIP_SC_ADV) |
| fcoe_ctlr_recv_adv(fip, skb); |
| else if (op == FIP_OP_CTRL && sub == FIP_SC_CLR_VLINK) |
| fcoe_ctlr_recv_clr_vlink(fip, skb); |
| kfree_skb(skb); |
| return 0; |
| drop: |
| kfree_skb(skb); |
| return -1; |
| } |
| |
| /** |
| * fcoe_ctlr_select() - Select the best FCF (if possible) |
| * @fip: The FCoE controller |
| * |
| * Returns the selected FCF, or NULL if none are usable. |
| * |
| * If there are conflicting advertisements, no FCF can be chosen. |
| * |
| * If there is already a selected FCF, this will choose a better one or |
| * an equivalent one that hasn't already been sent a FLOGI. |
| * |
| * Called with lock held. |
| */ |
| static struct fcoe_fcf *fcoe_ctlr_select(struct fcoe_ctlr *fip) |
| { |
| struct fcoe_fcf *fcf; |
| struct fcoe_fcf *best = fip->sel_fcf; |
| |
| list_for_each_entry(fcf, &fip->fcfs, list) { |
| LIBFCOE_FIP_DBG(fip, "consider FCF fab %16.16llx " |
| "VFID %d mac %pM map %x val %d " |
| "sent %u pri %u\n", |
| fcf->fabric_name, fcf->vfid, fcf->fcf_mac, |
| fcf->fc_map, fcoe_ctlr_mtu_valid(fcf), |
| fcf->flogi_sent, fcf->pri); |
| if (!fcoe_ctlr_fcf_usable(fcf)) { |
| LIBFCOE_FIP_DBG(fip, "FCF for fab %16.16llx " |
| "map %x %svalid %savailable\n", |
| fcf->fabric_name, fcf->fc_map, |
| (fcf->flags & FIP_FL_SOL) ? "" : "in", |
| (fcf->flags & FIP_FL_AVAIL) ? |
| "" : "un"); |
| continue; |
| } |
| if (!best || fcf->pri < best->pri || best->flogi_sent) |
| best = fcf; |
| if (fcf->fabric_name != best->fabric_name || |
| fcf->vfid != best->vfid || |
| fcf->fc_map != best->fc_map) { |
| LIBFCOE_FIP_DBG(fip, "Conflicting fabric, VFID, " |
| "or FC-MAP\n"); |
| return NULL; |
| } |
| } |
| fip->sel_fcf = best; |
| if (best) { |
| LIBFCOE_FIP_DBG(fip, "using FCF mac %pM\n", best->fcf_mac); |
| fip->port_ka_time = jiffies + |
| msecs_to_jiffies(FIP_VN_KA_PERIOD); |
| fip->ctlr_ka_time = jiffies + best->fka_period; |
| if (time_before(fip->ctlr_ka_time, fip->timer.expires)) |
| mod_timer(&fip->timer, fip->ctlr_ka_time); |
| } |
| return best; |
| } |
| |
| /** |
| * fcoe_ctlr_flogi_send_locked() - send FIP-encapsulated FLOGI to current FCF |
| * @fip: The FCoE controller |
| * |
| * Returns non-zero error if it could not be sent. |
| * |
| * Called with ctlr_mutex and ctlr_lock held. |
| * Caller must verify that fip->sel_fcf is not NULL. |
| */ |
| static int fcoe_ctlr_flogi_send_locked(struct fcoe_ctlr *fip) |
| { |
| struct sk_buff *skb; |
| struct sk_buff *skb_orig; |
| struct fc_frame_header *fh; |
| int error; |
| |
| skb_orig = fip->flogi_req; |
| if (!skb_orig) |
| return -EINVAL; |
| |
| /* |
| * Clone and send the FLOGI request. If clone fails, use original. |
| */ |
| skb = skb_clone(skb_orig, GFP_ATOMIC); |
| if (!skb) { |
| skb = skb_orig; |
| fip->flogi_req = NULL; |
| } |
| fh = (struct fc_frame_header *)skb->data; |
| error = fcoe_ctlr_encaps(fip, fip->lp, FIP_DT_FLOGI, skb, |
| ntoh24(fh->fh_d_id)); |
| if (error) { |
| kfree_skb(skb); |
| return error; |
| } |
| fip->send(fip, skb); |
| fip->sel_fcf->flogi_sent = 1; |
| return 0; |
| } |
| |
| /** |
| * fcoe_ctlr_flogi_retry() - resend FLOGI request to a new FCF if possible |
| * @fip: The FCoE controller |
| * |
| * Returns non-zero error code if there's no FLOGI request to retry or |
| * no alternate FCF available. |
| */ |
| static int fcoe_ctlr_flogi_retry(struct fcoe_ctlr *fip) |
| { |
| struct fcoe_fcf *fcf; |
| int error; |
| |
| mutex_lock(&fip->ctlr_mutex); |
| spin_lock_bh(&fip->ctlr_lock); |
| LIBFCOE_FIP_DBG(fip, "re-sending FLOGI - reselect\n"); |
| fcf = fcoe_ctlr_select(fip); |
| if (!fcf || fcf->flogi_sent) { |
| kfree_skb(fip->flogi_req); |
| fip->flogi_req = NULL; |
| error = -ENOENT; |
| } else { |
| fcoe_ctlr_solicit(fip, NULL); |
| error = fcoe_ctlr_flogi_send_locked(fip); |
| } |
| spin_unlock_bh(&fip->ctlr_lock); |
| mutex_unlock(&fip->ctlr_mutex); |
| return error; |
| } |
| |
| |
| /** |
| * fcoe_ctlr_flogi_send() - Handle sending of FIP FLOGI. |
| * @fip: The FCoE controller that timed out |
| * |
| * Done here because fcoe_ctlr_els_send() can't get mutex. |
| * |
| * Called with ctlr_mutex held. The caller must not hold ctlr_lock. |
| */ |
| static void fcoe_ctlr_flogi_send(struct fcoe_ctlr *fip) |
| { |
| struct fcoe_fcf *fcf; |
| |
| spin_lock_bh(&fip->ctlr_lock); |
| fcf = fip->sel_fcf; |
| if (!fcf || !fip->flogi_req_send) |
| goto unlock; |
| |
| LIBFCOE_FIP_DBG(fip, "sending FLOGI\n"); |
| |
| /* |
| * If this FLOGI is being sent due to a timeout retry |
| * to the same FCF as before, select a different FCF if possible. |
| */ |
| if (fcf->flogi_sent) { |
| LIBFCOE_FIP_DBG(fip, "sending FLOGI - reselect\n"); |
| fcf = fcoe_ctlr_select(fip); |
| if (!fcf || fcf->flogi_sent) { |
| LIBFCOE_FIP_DBG(fip, "sending FLOGI - clearing\n"); |
| list_for_each_entry(fcf, &fip->fcfs, list) |
| fcf->flogi_sent = 0; |
| fcf = fcoe_ctlr_select(fip); |
| } |
| } |
| if (fcf) { |
| fcoe_ctlr_flogi_send_locked(fip); |
| fip->flogi_req_send = 0; |
| } else /* XXX */ |
| LIBFCOE_FIP_DBG(fip, "No FCF selected - defer send\n"); |
| unlock: |
| spin_unlock_bh(&fip->ctlr_lock); |
| } |
| |
| /** |
| * fcoe_ctlr_timeout() - FIP timeout handler |
| * @t: Timer context use to obtain the controller reference |
| */ |
| static void fcoe_ctlr_timeout(struct timer_list *t) |
| { |
| struct fcoe_ctlr *fip = from_timer(fip, t, timer); |
| |
| schedule_work(&fip->timer_work); |
| } |
| |
| /** |
| * fcoe_ctlr_timer_work() - Worker thread function for timer work |
| * @work: Handle to a FCoE controller |
| * |
| * Ages FCFs. Triggers FCF selection if possible. |
| * Sends keep-alives and resets. |
| */ |
| static void fcoe_ctlr_timer_work(struct work_struct *work) |
| { |
| struct fcoe_ctlr *fip; |
| struct fc_lport *vport; |
| u8 *mac; |
| u8 reset = 0; |
| u8 send_ctlr_ka = 0; |
| u8 send_port_ka = 0; |
| struct fcoe_fcf *sel; |
| struct fcoe_fcf *fcf; |
| unsigned long next_timer; |
| |
| fip = container_of(work, struct fcoe_ctlr, timer_work); |
| if (fip->mode == FIP_MODE_VN2VN) |
| return fcoe_ctlr_vn_timeout(fip); |
| mutex_lock(&fip->ctlr_mutex); |
| if (fip->state == FIP_ST_DISABLED) { |
| mutex_unlock(&fip->ctlr_mutex); |
| return; |
| } |
| |
| fcf = fip->sel_fcf; |
| next_timer = fcoe_ctlr_age_fcfs(fip); |
| |
| sel = fip->sel_fcf; |
| if (!sel && fip->sel_time) { |
| if (time_after_eq(jiffies, fip->sel_time)) { |
| sel = fcoe_ctlr_select(fip); |
| fip->sel_time = 0; |
| } else if (time_after(next_timer, fip->sel_time)) |
| next_timer = fip->sel_time; |
| } |
| |
| if (sel && fip->flogi_req_send) |
| fcoe_ctlr_flogi_send(fip); |
| else if (!sel && fcf) |
| reset = 1; |
| |
| if (sel && !sel->fd_flags) { |
| if (time_after_eq(jiffies, fip->ctlr_ka_time)) { |
| fip->ctlr_ka_time = jiffies + sel->fka_period; |
| send_ctlr_ka = 1; |
| } |
| if (time_after(next_timer, fip->ctlr_ka_time)) |
| next_timer = fip->ctlr_ka_time; |
| |
| if (time_after_eq(jiffies, fip->port_ka_time)) { |
| fip->port_ka_time = jiffies + |
| msecs_to_jiffies(FIP_VN_KA_PERIOD); |
| send_port_ka = 1; |
| } |
| if (time_after(next_timer, fip->port_ka_time)) |
| next_timer = fip->port_ka_time; |
| } |
| if (!list_empty(&fip->fcfs)) |
| mod_timer(&fip->timer, next_timer); |
| mutex_unlock(&fip->ctlr_mutex); |
| |
| if (reset) { |
| fc_lport_reset(fip->lp); |
| /* restart things with a solicitation */ |
| fcoe_ctlr_solicit(fip, NULL); |
| } |
| |
| if (send_ctlr_ka) |
| fcoe_ctlr_send_keep_alive(fip, NULL, 0, fip->ctl_src_addr); |
| |
| if (send_port_ka) { |
| mutex_lock(&fip->lp->lp_mutex); |
| mac = fip->get_src_addr(fip->lp); |
| fcoe_ctlr_send_keep_alive(fip, fip->lp, 1, mac); |
| list_for_each_entry(vport, &fip->lp->vports, list) { |
| mac = fip->get_src_addr(vport); |
| fcoe_ctlr_send_keep_alive(fip, vport, 1, mac); |
| } |
| mutex_unlock(&fip->lp->lp_mutex); |
| } |
| } |
| |
| /** |
| * fcoe_ctlr_recv_work() - Worker thread function for receiving FIP frames |
| * @recv_work: Handle to a FCoE controller |
| */ |
| static void fcoe_ctlr_recv_work(struct work_struct *recv_work) |
| { |
| struct fcoe_ctlr *fip; |
| struct sk_buff *skb; |
| |
| fip = container_of(recv_work, struct fcoe_ctlr, recv_work); |
| while ((skb = skb_dequeue(&fip->fip_recv_list))) |
| fcoe_ctlr_recv_handler(fip, skb); |
| } |
| |
| /** |
| * fcoe_ctlr_recv_flogi() - Snoop pre-FIP receipt of FLOGI response |
| * @fip: The FCoE controller |
| * @lport: The local port |
| * @fp: The FC frame to snoop |
| * |
| * Snoop potential response to FLOGI or even incoming FLOGI. |
| * |
| * The caller has checked that we are waiting for login as indicated |
| * by fip->flogi_oxid != FC_XID_UNKNOWN. |
| * |
| * The caller is responsible for freeing the frame. |
| * Fill in the granted_mac address. |
| * |
| * Return non-zero if the frame should not be delivered to libfc. |
| */ |
| int fcoe_ctlr_recv_flogi(struct fcoe_ctlr *fip, struct fc_lport *lport, |
| struct fc_frame *fp) |
| { |
| struct fc_frame_header *fh; |
| u8 op; |
| u8 *sa; |
| |
| sa = eth_hdr(&fp->skb)->h_source; |
| fh = fc_frame_header_get(fp); |
| if (fh->fh_type != FC_TYPE_ELS) |
| return 0; |
| |
| op = fc_frame_payload_op(fp); |
| if (op == ELS_LS_ACC && fh->fh_r_ctl == FC_RCTL_ELS_REP && |
| fip->flogi_oxid == ntohs(fh->fh_ox_id)) { |
| |
| mutex_lock(&fip->ctlr_mutex); |
| if (fip->state != FIP_ST_AUTO && fip->state != FIP_ST_NON_FIP) { |
| mutex_unlock(&fip->ctlr_mutex); |
| return -EINVAL; |
| } |
| fcoe_ctlr_set_state(fip, FIP_ST_NON_FIP); |
| LIBFCOE_FIP_DBG(fip, |
| "received FLOGI LS_ACC using non-FIP mode\n"); |
| |
| /* |
| * FLOGI accepted. |
| * If the src mac addr is FC_OUI-based, then we mark the |
| * address_mode flag to use FC_OUI-based Ethernet DA. |
| * Otherwise we use the FCoE gateway addr |
| */ |
| if (ether_addr_equal(sa, (u8[6])FC_FCOE_FLOGI_MAC)) { |
| fcoe_ctlr_map_dest(fip); |
| } else { |
| memcpy(fip->dest_addr, sa, ETH_ALEN); |
| fip->map_dest = 0; |
| } |
| fip->flogi_oxid = FC_XID_UNKNOWN; |
| mutex_unlock(&fip->ctlr_mutex); |
| fc_fcoe_set_mac(fr_cb(fp)->granted_mac, fh->fh_d_id); |
| } else if (op == ELS_FLOGI && fh->fh_r_ctl == FC_RCTL_ELS_REQ && sa) { |
| /* |
| * Save source MAC for point-to-point responses. |
| */ |
| mutex_lock(&fip->ctlr_mutex); |
| if (fip->state == FIP_ST_AUTO || fip->state == FIP_ST_NON_FIP) { |
| memcpy(fip->dest_addr, sa, ETH_ALEN); |
| fip->map_dest = 0; |
| if (fip->state == FIP_ST_AUTO) |
| LIBFCOE_FIP_DBG(fip, "received non-FIP FLOGI. " |
| "Setting non-FIP mode\n"); |
| fcoe_ctlr_set_state(fip, FIP_ST_NON_FIP); |
| } |
| mutex_unlock(&fip->ctlr_mutex); |
| } |
| return 0; |
| } |
| EXPORT_SYMBOL(fcoe_ctlr_recv_flogi); |
| |
| /** |
| * fcoe_wwn_from_mac() - Converts a 48-bit IEEE MAC address to a 64-bit FC WWN |
| * @mac: The MAC address to convert |
| * @scheme: The scheme to use when converting |
| * @port: The port indicator for converting |
| * |
| * Returns: u64 fc world wide name |
| */ |
| u64 fcoe_wwn_from_mac(unsigned char mac[ETH_ALEN], |
| unsigned int scheme, unsigned int port) |
| { |
| u64 wwn; |
| u64 host_mac; |
| |
| /* The MAC is in NO, so flip only the low 48 bits */ |
| host_mac = ((u64) mac[0] << 40) | |
| ((u64) mac[1] << 32) | |
| ((u64) mac[2] << 24) | |
| ((u64) mac[3] << 16) | |
| ((u64) mac[4] << 8) | |
| (u64) mac[5]; |
| |
| WARN_ON(host_mac >= (1ULL << 48)); |
| wwn = host_mac | ((u64) scheme << 60); |
| switch (scheme) { |
| case 1: |
| WARN_ON(port != 0); |
| break; |
| case 2: |
| WARN_ON(port >= 0xfff); |
| wwn |= (u64) port << 48; |
| break; |
| default: |
| WARN_ON(1); |
| break; |
| } |
| |
| return wwn; |
| } |
| EXPORT_SYMBOL_GPL(fcoe_wwn_from_mac); |
| |
| /** |
| * fcoe_ctlr_rport() - return the fcoe_rport for a given fc_rport_priv |
| * @rdata: libfc remote port |
| */ |
| static inline struct fcoe_rport *fcoe_ctlr_rport(struct fc_rport_priv *rdata) |
| { |
| return container_of(rdata, struct fcoe_rport, rdata); |
| } |
| |
| /** |
| * fcoe_ctlr_vn_send() - Send a FIP VN2VN Probe Request or Reply. |
| * @fip: The FCoE controller |
| * @sub: sub-opcode for probe request, reply, or advertisement. |
| * @dest: The destination Ethernet MAC address |
| * @min_len: minimum size of the Ethernet payload to be sent |
| */ |
| static void fcoe_ctlr_vn_send(struct fcoe_ctlr *fip, |
| enum fip_vn2vn_subcode sub, |
| const u8 *dest, size_t min_len) |
| { |
| struct sk_buff *skb; |
| struct fip_vn2vn_probe_frame { |
| struct ethhdr eth; |
| struct fip_header fip; |
| struct fip_mac_desc mac; |
| struct fip_wwn_desc wwnn; |
| struct fip_vn_desc vn; |
| } __packed * frame; |
| struct fip_fc4_feat *ff; |
| struct fip_size_desc *size; |
| u32 fcp_feat; |
| size_t len; |
| size_t dlen; |
| |
| len = sizeof(*frame); |
| dlen = 0; |
| if (sub == FIP_SC_VN_CLAIM_NOTIFY || sub == FIP_SC_VN_CLAIM_REP) { |
| dlen = sizeof(struct fip_fc4_feat) + |
| sizeof(struct fip_size_desc); |
| len += dlen; |
| } |
| dlen += sizeof(frame->mac) + sizeof(frame->wwnn) + sizeof(frame->vn); |
| len = max(len, min_len + sizeof(struct ethhdr)); |
| |
| skb = dev_alloc_skb(len); |
| if (!skb) |
| return; |
| |
| frame = (struct fip_vn2vn_probe_frame *)skb->data; |
| memset(frame, 0, len); |
| memcpy(frame->eth.h_dest, dest, ETH_ALEN); |
| |
| if (sub == FIP_SC_VN_BEACON) { |
| hton24(frame->eth.h_source, FIP_VN_FC_MAP); |
| hton24(frame->eth.h_source + 3, fip->port_id); |
| } else { |
| memcpy(frame->eth.h_source, fip->ctl_src_addr, ETH_ALEN); |
| } |
| frame->eth.h_proto = htons(ETH_P_FIP); |
| |
| frame->fip.fip_ver = FIP_VER_ENCAPS(FIP_VER); |
| frame->fip.fip_op = htons(FIP_OP_VN2VN); |
| frame->fip.fip_subcode = sub; |
| frame->fip.fip_dl_len = htons(dlen / FIP_BPW); |
| |
| frame->mac.fd_desc.fip_dtype = FIP_DT_MAC; |
| frame->mac.fd_desc.fip_dlen = sizeof(frame->mac) / FIP_BPW; |
| memcpy(frame->mac.fd_mac, fip->ctl_src_addr, ETH_ALEN); |
| |
| frame->wwnn.fd_desc.fip_dtype = FIP_DT_NAME; |
| frame->wwnn.fd_desc.fip_dlen = sizeof(frame->wwnn) / FIP_BPW; |
| put_unaligned_be64(fip->lp->wwnn, &frame->wwnn.fd_wwn); |
| |
| frame->vn.fd_desc.fip_dtype = FIP_DT_VN_ID; |
| frame->vn.fd_desc.fip_dlen = sizeof(frame->vn) / FIP_BPW; |
| hton24(frame->vn.fd_mac, FIP_VN_FC_MAP); |
| hton24(frame->vn.fd_mac + 3, fip->port_id); |
| hton24(frame->vn.fd_fc_id, fip->port_id); |
| put_unaligned_be64(fip->lp->wwpn, &frame->vn.fd_wwpn); |
| |
| /* |
| * For claims, add FC-4 features. |
| * TBD: Add interface to get fc-4 types and features from libfc. |
| */ |
| if (sub == FIP_SC_VN_CLAIM_NOTIFY || sub == FIP_SC_VN_CLAIM_REP) { |
| ff = (struct fip_fc4_feat *)(frame + 1); |
| ff->fd_desc.fip_dtype = FIP_DT_FC4F; |
| ff->fd_desc.fip_dlen = sizeof(*ff) / FIP_BPW; |
| ff->fd_fts = fip->lp->fcts; |
| |
| fcp_feat = 0; |
| if (fip->lp->service_params & FCP_SPPF_INIT_FCN) |
| fcp_feat |= FCP_FEAT_INIT; |
| if (fip->lp->service_params & FCP_SPPF_TARG_FCN) |
| fcp_feat |= FCP_FEAT_TARG; |
| fcp_feat <<= (FC_TYPE_FCP * 4) % 32; |
| ff->fd_ff.fd_feat[FC_TYPE_FCP * 4 / 32] = htonl(fcp_feat); |
| |
| size = (struct fip_size_desc *)(ff + 1); |
| size->fd_desc.fip_dtype = FIP_DT_FCOE_SIZE; |
| size->fd_desc.fip_dlen = sizeof(*size) / FIP_BPW; |
| size->fd_size = htons(fcoe_ctlr_fcoe_size(fip)); |
| } |
| |
| skb_put(skb, len); |
| skb->protocol = htons(ETH_P_FIP); |
| skb->priority = fip->priority; |
| skb_reset_mac_header(skb); |
| skb_reset_network_header(skb); |
| |
| fip->send(fip, skb); |
| } |
| |
| /** |
| * fcoe_ctlr_vn_rport_callback - Event handler for rport events. |
| * @lport: The lport which is receiving the event |
| * @rdata: remote port private data |
| * @event: The event that occurred |
| * |
| * Locking Note: The rport lock must not be held when calling this function. |
| */ |
| static void fcoe_ctlr_vn_rport_callback(struct fc_lport *lport, |
| struct fc_rport_priv *rdata, |
| enum fc_rport_event event) |
| { |
| struct fcoe_ctlr *fip = lport->disc.priv; |
| struct fcoe_rport *frport = fcoe_ctlr_rport(rdata); |
| |
| LIBFCOE_FIP_DBG(fip, "vn_rport_callback %x event %d\n", |
| rdata->ids.port_id, event); |
| |
| mutex_lock(&fip->ctlr_mutex); |
| switch (event) { |
| case RPORT_EV_READY: |
| frport->login_count = 0; |
| break; |
| case RPORT_EV_LOGO: |
| case RPORT_EV_FAILED: |
| case RPORT_EV_STOP: |
| frport->login_count++; |
| if (frport->login_count > FCOE_CTLR_VN2VN_LOGIN_LIMIT) { |
| LIBFCOE_FIP_DBG(fip, |
| "rport FLOGI limited port_id %6.6x\n", |
| rdata->ids.port_id); |
| fc_rport_logoff(rdata); |
| } |
| break; |
| default: |
| break; |
| } |
| mutex_unlock(&fip->ctlr_mutex); |
| } |
| |
| static struct fc_rport_operations fcoe_ctlr_vn_rport_ops = { |
| .event_callback = fcoe_ctlr_vn_rport_callback, |
| }; |
| |
| /** |
| * fcoe_ctlr_disc_stop_locked() - stop discovery in VN2VN mode |
| * @lport: The local port |
| * |
| * Called with ctlr_mutex held. |
| */ |
| static void fcoe_ctlr_disc_stop_locked(struct fc_lport *lport) |
| { |
| struct fc_rport_priv *rdata; |
| |
| mutex_lock(&lport->disc.disc_mutex); |
| list_for_each_entry_rcu(rdata, &lport->disc.rports, peers) { |
| if (kref_get_unless_zero(&rdata->kref)) { |
| fc_rport_logoff(rdata); |
| kref_put(&rdata->kref, fc_rport_destroy); |
| } |
| } |
| lport->disc.disc_callback = NULL; |
| mutex_unlock(&lport->disc.disc_mutex); |
| } |
| |
| /** |
| * fcoe_ctlr_disc_stop() - stop discovery in VN2VN mode |
| * @lport: The local port |
| * |
| * Called through the local port template for discovery. |
| * Called without the ctlr_mutex held. |
| */ |
| static void fcoe_ctlr_disc_stop(struct fc_lport *lport) |
| { |
| struct fcoe_ctlr *fip = lport->disc.priv; |
| |
| mutex_lock(&fip->ctlr_mutex); |
| fcoe_ctlr_disc_stop_locked(lport); |
| mutex_unlock(&fip->ctlr_mutex); |
| } |
| |
| /** |
| * fcoe_ctlr_disc_stop_final() - stop discovery for shutdown in VN2VN mode |
| * @lport: The local port |
| * |
| * Called through the local port template for discovery. |
| * Called without the ctlr_mutex held. |
| */ |
| static void fcoe_ctlr_disc_stop_final(struct fc_lport *lport) |
| { |
| fcoe_ctlr_disc_stop(lport); |
| fc_rport_flush_queue(); |
| synchronize_rcu(); |
| } |
| |
| /** |
| * fcoe_ctlr_vn_restart() - VN2VN probe restart with new port_id |
| * @fip: The FCoE controller |
| * |
| * Called with fcoe_ctlr lock held. |
| */ |
| static void fcoe_ctlr_vn_restart(struct fcoe_ctlr *fip) |
| { |
| unsigned long wait; |
| u32 port_id; |
| |
| fcoe_ctlr_disc_stop_locked(fip->lp); |
| |
| /* |
| * Get proposed port ID. |
| * If this is the first try after link up, use any previous port_id. |
| * If there was none, use the low bits of the port_name. |
| * On subsequent tries, get the next random one. |
| * Don't use reserved IDs, use another non-zero value, just as random. |
| */ |
| port_id = fip->port_id; |
| if (fip->probe_tries) |
| port_id = prandom_u32_state(&fip->rnd_state) & 0xffff; |
| else if (!port_id) |
| port_id = fip->lp->wwpn & 0xffff; |
| if (!port_id || port_id == 0xffff) |
| port_id = 1; |
| fip->port_id = port_id; |
| |
| if (fip->probe_tries < FIP_VN_RLIM_COUNT) { |
| fip->probe_tries++; |
| wait = get_random_u32_below(FIP_VN_PROBE_WAIT); |
| } else |
| wait = FIP_VN_RLIM_INT; |
| mod_timer(&fip->timer, jiffies + msecs_to_jiffies(wait)); |
| fcoe_ctlr_set_state(fip, FIP_ST_VNMP_START); |
| } |
| |
| /** |
| * fcoe_ctlr_vn_start() - Start in VN2VN mode |
| * @fip: The FCoE controller |
| * |
| * Called with fcoe_ctlr lock held. |
| */ |
| static void fcoe_ctlr_vn_start(struct fcoe_ctlr *fip) |
| { |
| fip->probe_tries = 0; |
| prandom_seed_state(&fip->rnd_state, fip->lp->wwpn); |
| fcoe_ctlr_vn_restart(fip); |
| } |
| |
| /** |
| * fcoe_ctlr_vn_parse - parse probe request or response |
| * @fip: The FCoE controller |
| * @skb: incoming packet |
| * @frport: parsed FCoE rport from the probe request |
| * |
| * Returns non-zero error number on error. |
| * Does not consume the packet. |
| */ |
| static int fcoe_ctlr_vn_parse(struct fcoe_ctlr *fip, |
| struct sk_buff *skb, |
| struct fcoe_rport *frport) |
| { |
| struct fip_header *fiph; |
| struct fip_desc *desc = NULL; |
| struct fip_mac_desc *macd = NULL; |
| struct fip_wwn_desc *wwn = NULL; |
| struct fip_vn_desc *vn = NULL; |
| struct fip_size_desc *size = NULL; |
| size_t rlen; |
| size_t dlen; |
| u32 desc_mask = 0; |
| u32 dtype; |
| u8 sub; |
| |
| fiph = (struct fip_header *)skb->data; |
| frport->flags = ntohs(fiph->fip_flags); |
| |
| sub = fiph->fip_subcode; |
| switch (sub) { |
| case FIP_SC_VN_PROBE_REQ: |
| case FIP_SC_VN_PROBE_REP: |
| case FIP_SC_VN_BEACON: |
| desc_mask = BIT(FIP_DT_MAC) | BIT(FIP_DT_NAME) | |
| BIT(FIP_DT_VN_ID); |
| break; |
| case FIP_SC_VN_CLAIM_NOTIFY: |
| case FIP_SC_VN_CLAIM_REP: |
| desc_mask = BIT(FIP_DT_MAC) | BIT(FIP_DT_NAME) | |
| BIT(FIP_DT_VN_ID) | BIT(FIP_DT_FC4F) | |
| BIT(FIP_DT_FCOE_SIZE); |
| break; |
| default: |
| LIBFCOE_FIP_DBG(fip, "vn_parse unknown subcode %u\n", sub); |
| return -EINVAL; |
| } |
| |
| rlen = ntohs(fiph->fip_dl_len) * 4; |
| if (rlen + sizeof(*fiph) > skb->len) |
| return -EINVAL; |
| |
| desc = (struct fip_desc *)(fiph + 1); |
| while (rlen > 0) { |
| dlen = desc->fip_dlen * FIP_BPW; |
| if (dlen < sizeof(*desc) || dlen > rlen) |
| return -EINVAL; |
| |
| dtype = desc->fip_dtype; |
| if (dtype < 32) { |
| if (!(desc_mask & BIT(dtype))) { |
| LIBFCOE_FIP_DBG(fip, |
| "unexpected or duplicated desc " |
| "desc type %u in " |
| "FIP VN2VN subtype %u\n", |
| dtype, sub); |
| return -EINVAL; |
| } |
| desc_mask &= ~BIT(dtype); |
| } |
| |
| switch (dtype) { |
| case FIP_DT_MAC: |
| if (dlen != sizeof(struct fip_mac_desc)) |
| goto len_err; |
| macd = (struct fip_mac_desc *)desc; |
| if (!is_valid_ether_addr(macd->fd_mac)) { |
| LIBFCOE_FIP_DBG(fip, |
| "Invalid MAC addr %pM in FIP VN2VN\n", |
| macd->fd_mac); |
| return -EINVAL; |
| } |
| memcpy(frport->enode_mac, macd->fd_mac, ETH_ALEN); |
| break; |
| case FIP_DT_NAME: |
| if (dlen != sizeof(struct fip_wwn_desc)) |
| goto len_err; |
| wwn = (struct fip_wwn_desc *)desc; |
| frport->rdata.ids.node_name = |
| get_unaligned_be64(&wwn->fd_wwn); |
| break; |
| case FIP_DT_VN_ID: |
| if (dlen != sizeof(struct fip_vn_desc)) |
| goto len_err; |
| vn = (struct fip_vn_desc *)desc; |
| memcpy(frport->vn_mac, vn->fd_mac, ETH_ALEN); |
| frport->rdata.ids.port_id = ntoh24(vn->fd_fc_id); |
| frport->rdata.ids.port_name = |
| get_unaligned_be64(&vn->fd_wwpn); |
| break; |
| case FIP_DT_FC4F: |
| if (dlen != sizeof(struct fip_fc4_feat)) |
| goto len_err; |
| break; |
| case FIP_DT_FCOE_SIZE: |
| if (dlen != sizeof(struct fip_size_desc)) |
| goto len_err; |
| size = (struct fip_size_desc *)desc; |
| frport->fcoe_len = ntohs(size->fd_size); |
| break; |
| default: |
| LIBFCOE_FIP_DBG(fip, "unexpected descriptor type %x " |
| "in FIP probe\n", dtype); |
| /* standard says ignore unknown descriptors >= 128 */ |
| if (dtype < FIP_DT_NON_CRITICAL) |
| return -EINVAL; |
| break; |
| } |
| desc = (struct fip_desc *)((char *)desc + dlen); |
| rlen -= dlen; |
| } |
| return 0; |
| |
| len_err: |
| LIBFCOE_FIP_DBG(fip, "FIP length error in descriptor type %x len %zu\n", |
| dtype, dlen); |
| return -EINVAL; |
| } |
| |
| /** |
| * fcoe_ctlr_vn_send_claim() - send multicast FIP VN2VN Claim Notification. |
| * @fip: The FCoE controller |
| * |
| * Called with ctlr_mutex held. |
| */ |
| static void fcoe_ctlr_vn_send_claim(struct fcoe_ctlr *fip) |
| { |
| fcoe_ctlr_vn_send(fip, FIP_SC_VN_CLAIM_NOTIFY, fcoe_all_vn2vn, 0); |
| fip->sol_time = jiffies; |
| } |
| |
| /** |
| * fcoe_ctlr_vn_probe_req() - handle incoming VN2VN probe request. |
| * @fip: The FCoE controller |
| * @frport: parsed FCoE rport from the probe request |
| * |
| * Called with ctlr_mutex held. |
| */ |
| static void fcoe_ctlr_vn_probe_req(struct fcoe_ctlr *fip, |
| struct fcoe_rport *frport) |
| { |
| if (frport->rdata.ids.port_id != fip->port_id) |
| return; |
| |
| switch (fip->state) { |
| case FIP_ST_VNMP_CLAIM: |
| case FIP_ST_VNMP_UP: |
| LIBFCOE_FIP_DBG(fip, "vn_probe_req: send reply, state %x\n", |
| fip->state); |
| fcoe_ctlr_vn_send(fip, FIP_SC_VN_PROBE_REP, |
| frport->enode_mac, 0); |
| break; |
| case FIP_ST_VNMP_PROBE1: |
| case FIP_ST_VNMP_PROBE2: |
| /* |
| * Decide whether to reply to the Probe. |
| * Our selected address is never a "recorded" one, so |
| * only reply if our WWPN is greater and the |
| * Probe's REC bit is not set. |
| * If we don't reply, we will change our address. |
| */ |
| if (fip->lp->wwpn > frport->rdata.ids.port_name && |
| !(frport->flags & FIP_FL_REC_OR_P2P)) { |
| LIBFCOE_FIP_DBG(fip, "vn_probe_req: " |
| "port_id collision\n"); |
| fcoe_ctlr_vn_send(fip, FIP_SC_VN_PROBE_REP, |
| frport->enode_mac, 0); |
| break; |
| } |
| fallthrough; |
| case FIP_ST_VNMP_START: |
| LIBFCOE_FIP_DBG(fip, "vn_probe_req: " |
| "restart VN2VN negotiation\n"); |
| fcoe_ctlr_vn_restart(fip); |
| break; |
| default: |
| LIBFCOE_FIP_DBG(fip, "vn_probe_req: ignore state %x\n", |
| fip->state); |
| break; |
| } |
| } |
| |
| /** |
| * fcoe_ctlr_vn_probe_reply() - handle incoming VN2VN probe reply. |
| * @fip: The FCoE controller |
| * @frport: parsed FCoE rport from the probe request |
| * |
| * Called with ctlr_mutex held. |
| */ |
| static void fcoe_ctlr_vn_probe_reply(struct fcoe_ctlr *fip, |
| struct fcoe_rport *frport) |
| { |
| if (frport->rdata.ids.port_id != fip->port_id) |
| return; |
| switch (fip->state) { |
| case FIP_ST_VNMP_START: |
| case FIP_ST_VNMP_PROBE1: |
| case FIP_ST_VNMP_PROBE2: |
| case FIP_ST_VNMP_CLAIM: |
| LIBFCOE_FIP_DBG(fip, "vn_probe_reply: restart state %x\n", |
| fip->state); |
| fcoe_ctlr_vn_restart(fip); |
| break; |
| case FIP_ST_VNMP_UP: |
| LIBFCOE_FIP_DBG(fip, "vn_probe_reply: send claim notify\n"); |
| fcoe_ctlr_vn_send_claim(fip); |
| break; |
| default: |
| break; |
| } |
| } |
| |
| /** |
| * fcoe_ctlr_vn_add() - Add a VN2VN entry to the list, based on a claim reply. |
| * @fip: The FCoE controller |
| * @new: newly-parsed FCoE rport as a template for new rdata |
| * |
| * Called with ctlr_mutex held. |
| */ |
| static void fcoe_ctlr_vn_add(struct fcoe_ctlr *fip, struct fcoe_rport *new) |
| { |
| struct fc_lport *lport = fip->lp; |
| struct fc_rport_priv *rdata; |
| struct fc_rport_identifiers *ids; |
| struct fcoe_rport *frport; |
| u32 port_id; |
| |
| port_id = new->rdata.ids.port_id; |
| if (port_id == fip->port_id) |
| return; |
| |
| mutex_lock(&lport->disc.disc_mutex); |
| rdata = fc_rport_create(lport, port_id); |
| if (!rdata) { |
| mutex_unlock(&lport->disc.disc_mutex); |
| return; |
| } |
| mutex_lock(&rdata->rp_mutex); |
| mutex_unlock(&lport->disc.disc_mutex); |
| |
| rdata->ops = &fcoe_ctlr_vn_rport_ops; |
| rdata->disc_id = lport->disc.disc_id; |
| |
| ids = &rdata->ids; |
| if ((ids->port_name != -1 && |
| ids->port_name != new->rdata.ids.port_name) || |
| (ids->node_name != -1 && |
| ids->node_name != new->rdata.ids.node_name)) { |
| mutex_unlock(&rdata->rp_mutex); |
| LIBFCOE_FIP_DBG(fip, "vn_add rport logoff %6.6x\n", port_id); |
| fc_rport_logoff(rdata); |
| mutex_lock(&rdata->rp_mutex); |
| } |
| ids->port_name = new->rdata.ids.port_name; |
| ids->node_name = new->rdata.ids.node_name; |
| mutex_unlock(&rdata->rp_mutex); |
| |
| frport = fcoe_ctlr_rport(rdata); |
| LIBFCOE_FIP_DBG(fip, "vn_add rport %6.6x %s state %d\n", |
| port_id, frport->fcoe_len ? "old" : "new", |
| rdata->rp_state); |
| frport->fcoe_len = new->fcoe_len; |
| frport->flags = new->flags; |
| frport->login_count = new->login_count; |
| memcpy(frport->enode_mac, new->enode_mac, ETH_ALEN); |
| memcpy(frport->vn_mac, new->vn_mac, ETH_ALEN); |
| frport->time = 0; |
| } |
| |
| /** |
| * fcoe_ctlr_vn_lookup() - Find VN remote port's MAC address |
| * @fip: The FCoE controller |
| * @port_id: The port_id of the remote VN_node |
| * @mac: buffer which will hold the VN_NODE destination MAC address, if found. |
| * |
| * Returns non-zero error if no remote port found. |
| */ |
| static int fcoe_ctlr_vn_lookup(struct fcoe_ctlr *fip, u32 port_id, u8 *mac) |
| { |
| struct fc_lport *lport = fip->lp; |
| struct fc_rport_priv *rdata; |
| struct fcoe_rport *frport; |
| int ret = -1; |
| |
| rdata = fc_rport_lookup(lport, port_id); |
| if (rdata) { |
| frport = fcoe_ctlr_rport(rdata); |
| memcpy(mac, frport->enode_mac, ETH_ALEN); |
| ret = 0; |
| kref_put(&rdata->kref, fc_rport_destroy); |
| } |
| return ret; |
| } |
| |
| /** |
| * fcoe_ctlr_vn_claim_notify() - handle received FIP VN2VN Claim Notification |
| * @fip: The FCoE controller |
| * @new: newly-parsed FCoE rport as a template for new rdata |
| * |
| * Called with ctlr_mutex held. |
| */ |
| static void fcoe_ctlr_vn_claim_notify(struct fcoe_ctlr *fip, |
| struct fcoe_rport *new) |
| { |
| if (new->flags & FIP_FL_REC_OR_P2P) { |
| LIBFCOE_FIP_DBG(fip, "send probe req for P2P/REC\n"); |
| fcoe_ctlr_vn_send(fip, FIP_SC_VN_PROBE_REQ, fcoe_all_vn2vn, 0); |
| return; |
| } |
| switch (fip->state) { |
| case FIP_ST_VNMP_START: |
| case FIP_ST_VNMP_PROBE1: |
| case FIP_ST_VNMP_PROBE2: |
| if (new->rdata.ids.port_id == fip->port_id) { |
| LIBFCOE_FIP_DBG(fip, "vn_claim_notify: " |
| "restart, state %d\n", |
| fip->state); |
| fcoe_ctlr_vn_restart(fip); |
| } |
| break; |
| case FIP_ST_VNMP_CLAIM: |
| case FIP_ST_VNMP_UP: |
| if (new->rdata.ids.port_id == fip->port_id) { |
| if (new->rdata.ids.port_name > fip->lp->wwpn) { |
| LIBFCOE_FIP_DBG(fip, "vn_claim_notify: " |
| "restart, port_id collision\n"); |
| fcoe_ctlr_vn_restart(fip); |
| break; |
| } |
| LIBFCOE_FIP_DBG(fip, "vn_claim_notify: " |
| "send claim notify\n"); |
| fcoe_ctlr_vn_send_claim(fip); |
| break; |
| } |
| LIBFCOE_FIP_DBG(fip, "vn_claim_notify: send reply to %x\n", |
| new->rdata.ids.port_id); |
| fcoe_ctlr_vn_send(fip, FIP_SC_VN_CLAIM_REP, new->enode_mac, |
| min((u32)new->fcoe_len, |
| fcoe_ctlr_fcoe_size(fip))); |
| fcoe_ctlr_vn_add(fip, new); |
| break; |
| default: |
| LIBFCOE_FIP_DBG(fip, "vn_claim_notify: " |
| "ignoring claim from %x\n", |
| new->rdata.ids.port_id); |
| break; |
| } |
| } |
| |
| /** |
| * fcoe_ctlr_vn_claim_resp() - handle received Claim Response |
| * @fip: The FCoE controller that received the frame |
| * @new: newly-parsed FCoE rport from the Claim Response |
| * |
| * Called with ctlr_mutex held. |
| */ |
| static void fcoe_ctlr_vn_claim_resp(struct fcoe_ctlr *fip, |
| struct fcoe_rport *new) |
| { |
| LIBFCOE_FIP_DBG(fip, "claim resp from from rport %x - state %s\n", |
| new->rdata.ids.port_id, fcoe_ctlr_state(fip->state)); |
| if (fip->state == FIP_ST_VNMP_UP || fip->state == FIP_ST_VNMP_CLAIM) |
| fcoe_ctlr_vn_add(fip, new); |
| } |
| |
| /** |
| * fcoe_ctlr_vn_beacon() - handle received beacon. |
| * @fip: The FCoE controller that received the frame |
| * @new: newly-parsed FCoE rport from the Beacon |
| * |
| * Called with ctlr_mutex held. |
| */ |
| static void fcoe_ctlr_vn_beacon(struct fcoe_ctlr *fip, |
| struct fcoe_rport *new) |
| { |
| struct fc_lport *lport = fip->lp; |
| struct fc_rport_priv *rdata; |
| struct fcoe_rport *frport; |
| |
| if (new->flags & FIP_FL_REC_OR_P2P) { |
| LIBFCOE_FIP_DBG(fip, "p2p beacon while in vn2vn mode\n"); |
| fcoe_ctlr_vn_send(fip, FIP_SC_VN_PROBE_REQ, fcoe_all_vn2vn, 0); |
| return; |
| } |
| rdata = fc_rport_lookup(lport, new->rdata.ids.port_id); |
| if (rdata) { |
| if (rdata->ids.node_name == new->rdata.ids.node_name && |
| rdata->ids.port_name == new->rdata.ids.port_name) { |
| frport = fcoe_ctlr_rport(rdata); |
| |
| LIBFCOE_FIP_DBG(fip, "beacon from rport %x\n", |
| rdata->ids.port_id); |
| if (!frport->time && fip->state == FIP_ST_VNMP_UP) { |
| LIBFCOE_FIP_DBG(fip, "beacon expired " |
| "for rport %x\n", |
| rdata->ids.port_id); |
| fc_rport_login(rdata); |
| } |
| frport->time = jiffies; |
| } |
| kref_put(&rdata->kref, fc_rport_destroy); |
| return; |
| } |
| if (fip->state != FIP_ST_VNMP_UP) |
| return; |
| |
| /* |
| * Beacon from a new neighbor. |
| * Send a claim notify if one hasn't been sent recently. |
| * Don't add the neighbor yet. |
| */ |
| LIBFCOE_FIP_DBG(fip, "beacon from new rport %x. sending claim notify\n", |
| new->rdata.ids.port_id); |
| if (time_after(jiffies, |
| fip->sol_time + msecs_to_jiffies(FIP_VN_ANN_WAIT))) |
| fcoe_ctlr_vn_send_claim(fip); |
| } |
| |
| /** |
| * fcoe_ctlr_vn_age() - Check for VN_ports without recent beacons |
| * @fip: The FCoE controller |
| * |
| * Called with ctlr_mutex held. |
| * Called only in state FIP_ST_VNMP_UP. |
| * Returns the soonest time for next age-out or a time far in the future. |
| */ |
| static unsigned long fcoe_ctlr_vn_age(struct fcoe_ctlr *fip) |
| { |
| struct fc_lport *lport = fip->lp; |
| struct fc_rport_priv *rdata; |
| struct fcoe_rport *frport; |
| unsigned long next_time; |
| unsigned long deadline; |
| |
| next_time = jiffies + msecs_to_jiffies(FIP_VN_BEACON_INT * 10); |
| mutex_lock(&lport->disc.disc_mutex); |
| list_for_each_entry_rcu(rdata, &lport->disc.rports, peers) { |
| if (!kref_get_unless_zero(&rdata->kref)) |
| continue; |
| frport = fcoe_ctlr_rport(rdata); |
| if (!frport->time) { |
| kref_put(&rdata->kref, fc_rport_destroy); |
| continue; |
| } |
| deadline = frport->time + |
| msecs_to_jiffies(FIP_VN_BEACON_INT * 25 / 10); |
| if (time_after_eq(jiffies, deadline)) { |
| frport->time = 0; |
| LIBFCOE_FIP_DBG(fip, |
| "port %16.16llx fc_id %6.6x beacon expired\n", |
| rdata->ids.port_name, rdata->ids.port_id); |
| fc_rport_logoff(rdata); |
| } else if (time_before(deadline, next_time)) |
| next_time = deadline; |
| kref_put(&rdata->kref, fc_rport_destroy); |
| } |
| mutex_unlock(&lport->disc.disc_mutex); |
| return next_time; |
| } |
| |
| /** |
| * fcoe_ctlr_vn_recv() - Receive a FIP frame |
| * @fip: The FCoE controller that received the frame |
| * @skb: The received FIP frame |
| * |
| * Returns non-zero if the frame is dropped. |
| * Always consumes the frame. |
| */ |
| static int fcoe_ctlr_vn_recv(struct fcoe_ctlr *fip, struct sk_buff *skb) |
| { |
| struct fip_header *fiph; |
| enum fip_vn2vn_subcode sub; |
| struct fcoe_rport frport = { }; |
| int rc, vlan_id = 0; |
| |
| fiph = (struct fip_header *)skb->data; |
| sub = fiph->fip_subcode; |
| |
| if (fip->lp->vlan) |
| vlan_id = skb_vlan_tag_get_id(skb); |
| |
| if (vlan_id && vlan_id != fip->lp->vlan) { |
| LIBFCOE_FIP_DBG(fip, "vn_recv drop frame sub %x vlan %d\n", |
| sub, vlan_id); |
| rc = -EAGAIN; |
| goto drop; |
| } |
| |
| rc = fcoe_ctlr_vn_parse(fip, skb, &frport); |
| if (rc) { |
| LIBFCOE_FIP_DBG(fip, "vn_recv vn_parse error %d\n", rc); |
| goto drop; |
| } |
| |
| mutex_lock(&fip->ctlr_mutex); |
| switch (sub) { |
| case FIP_SC_VN_PROBE_REQ: |
| fcoe_ctlr_vn_probe_req(fip, &frport); |
| break; |
| case FIP_SC_VN_PROBE_REP: |
| fcoe_ctlr_vn_probe_reply(fip, &frport); |
| break; |
| case FIP_SC_VN_CLAIM_NOTIFY: |
| fcoe_ctlr_vn_claim_notify(fip, &frport); |
| break; |
| case FIP_SC_VN_CLAIM_REP: |
| fcoe_ctlr_vn_claim_resp(fip, &frport); |
| break; |
| case FIP_SC_VN_BEACON: |
| fcoe_ctlr_vn_beacon(fip, &frport); |
| break; |
| default: |
| LIBFCOE_FIP_DBG(fip, "vn_recv unknown subcode %d\n", sub); |
| rc = -1; |
| break; |
| } |
| mutex_unlock(&fip->ctlr_mutex); |
| drop: |
| kfree_skb(skb); |
| return rc; |
| } |
| |
| /** |
| * fcoe_ctlr_vlan_parse - parse vlan discovery request or response |
| * @fip: The FCoE controller |
| * @skb: incoming packet |
| * @frport: parsed FCoE rport from the probe request |
| * |
| * Returns non-zero error number on error. |
| * Does not consume the packet. |
| */ |
| static int fcoe_ctlr_vlan_parse(struct fcoe_ctlr *fip, |
| struct sk_buff *skb, |
| struct fcoe_rport *frport) |
| { |
| struct fip_header *fiph; |
| struct fip_desc *desc = NULL; |
| struct fip_mac_desc *macd = NULL; |
| struct fip_wwn_desc *wwn = NULL; |
| size_t rlen; |
| size_t dlen; |
| u32 desc_mask = 0; |
| u32 dtype; |
| u8 sub; |
| |
| fiph = (struct fip_header *)skb->data; |
| frport->flags = ntohs(fiph->fip_flags); |
| |
| sub = fiph->fip_subcode; |
| switch (sub) { |
| case FIP_SC_VL_REQ: |
| desc_mask = BIT(FIP_DT_MAC) | BIT(FIP_DT_NAME); |
| break; |
| default: |
| LIBFCOE_FIP_DBG(fip, "vn_parse unknown subcode %u\n", sub); |
| return -EINVAL; |
| } |
| |
| rlen = ntohs(fiph->fip_dl_len) * 4; |
| if (rlen + sizeof(*fiph) > skb->len) |
| return -EINVAL; |
| |
| desc = (struct fip_desc *)(fiph + 1); |
| while (rlen > 0) { |
| dlen = desc->fip_dlen * FIP_BPW; |
| if (dlen < sizeof(*desc) || dlen > rlen) |
| return -EINVAL; |
| |
| dtype = desc->fip_dtype; |
| if (dtype < 32) { |
| if (!(desc_mask & BIT(dtype))) { |
| LIBFCOE_FIP_DBG(fip, |
| "unexpected or duplicated desc " |
| "desc type %u in " |
| "FIP VN2VN subtype %u\n", |
| dtype, sub); |
| return -EINVAL; |
| } |
| desc_mask &= ~BIT(dtype); |
| } |
| |
| switch (dtype) { |
| case FIP_DT_MAC: |
| if (dlen != sizeof(struct fip_mac_desc)) |
| goto len_err; |
| macd = (struct fip_mac_desc *)desc; |
| if (!is_valid_ether_addr(macd->fd_mac)) { |
| LIBFCOE_FIP_DBG(fip, |
| "Invalid MAC addr %pM in FIP VN2VN\n", |
| macd->fd_mac); |
| return -EINVAL; |
| } |
| memcpy(frport->enode_mac, macd->fd_mac, ETH_ALEN); |
| break; |
| case FIP_DT_NAME: |
| if (dlen != sizeof(struct fip_wwn_desc)) |
| goto len_err; |
| wwn = (struct fip_wwn_desc *)desc; |
| frport->rdata.ids.node_name = |
| get_unaligned_be64(&wwn->fd_wwn); |
| break; |
| default: |
| LIBFCOE_FIP_DBG(fip, "unexpected descriptor type %x " |
| "in FIP probe\n", dtype); |
| /* standard says ignore unknown descriptors >= 128 */ |
| if (dtype < FIP_DT_NON_CRITICAL) |
| return -EINVAL; |
| break; |
| } |
| desc = (struct fip_desc *)((char *)desc + dlen); |
| rlen -= dlen; |
| } |
| return 0; |
| |
| len_err: |
| LIBFCOE_FIP_DBG(fip, "FIP length error in descriptor type %x len %zu\n", |
| dtype, dlen); |
| return -EINVAL; |
| } |
| |
| /** |
| * fcoe_ctlr_vlan_send() - Send a FIP VLAN Notification |
| * @fip: The FCoE controller |
| * @sub: sub-opcode for vlan notification or vn2vn vlan notification |
| * @dest: The destination Ethernet MAC address |
| */ |
| static void fcoe_ctlr_vlan_send(struct fcoe_ctlr *fip, |
| enum fip_vlan_subcode sub, |
| const u8 *dest) |
| { |
| struct sk_buff *skb; |
| struct fip_vlan_notify_frame { |
| struct ethhdr eth; |
| struct fip_header fip; |
| struct fip_mac_desc mac; |
| struct fip_vlan_desc vlan; |
| } __packed * frame; |
| size_t len; |
| size_t dlen; |
| |
| len = sizeof(*frame); |
| dlen = sizeof(frame->mac) + sizeof(frame->vlan); |
| len = max(len, sizeof(struct ethhdr)); |
| |
| skb = dev_alloc_skb(len); |
| if (!skb) |
| return; |
| |
| LIBFCOE_FIP_DBG(fip, "fip %s vlan notification, vlan %d\n", |
| fip->mode == FIP_MODE_VN2VN ? "vn2vn" : "fcf", |
| fip->lp->vlan); |
| |
| frame = (struct fip_vlan_notify_frame *)skb->data; |
| memset(frame, 0, len); |
| memcpy(frame->eth.h_dest, dest, ETH_ALEN); |
| |
| memcpy(frame->eth.h_source, fip->ctl_src_addr, ETH_ALEN); |
| frame->eth.h_proto = htons(ETH_P_FIP); |
| |
| frame->fip.fip_ver = FIP_VER_ENCAPS(FIP_VER); |
| frame->fip.fip_op = htons(FIP_OP_VLAN); |
| frame->fip.fip_subcode = sub; |
| frame->fip.fip_dl_len = htons(dlen / FIP_BPW); |
| |
| frame->mac.fd_desc.fip_dtype = FIP_DT_MAC; |
| frame->mac.fd_desc.fip_dlen = sizeof(frame->mac) / FIP_BPW; |
| memcpy(frame->mac.fd_mac, fip->ctl_src_addr, ETH_ALEN); |
| |
| frame->vlan.fd_desc.fip_dtype = FIP_DT_VLAN; |
| frame->vlan.fd_desc.fip_dlen = sizeof(frame->vlan) / FIP_BPW; |
| put_unaligned_be16(fip->lp->vlan, &frame->vlan.fd_vlan); |
| |
| skb_put(skb, len); |
| skb->protocol = htons(ETH_P_FIP); |
| skb->priority = fip->priority; |
| skb_reset_mac_header(skb); |
| skb_reset_network_header(skb); |
| |
| fip->send(fip, skb); |
| } |
| |
| /** |
| * fcoe_ctlr_vlan_disc_reply() - send FIP VLAN Discovery Notification. |
| * @fip: The FCoE controller |
| * @frport: The newly-parsed FCoE rport from the Discovery Request |
| * |
| * Called with ctlr_mutex held. |
| */ |
| static void fcoe_ctlr_vlan_disc_reply(struct fcoe_ctlr *fip, |
| struct fcoe_rport *frport) |
| { |
| enum fip_vlan_subcode sub = FIP_SC_VL_NOTE; |
| |
| if (fip->mode == FIP_MODE_VN2VN) |
| sub = FIP_SC_VL_VN2VN_NOTE; |
| |
| fcoe_ctlr_vlan_send(fip, sub, frport->enode_mac); |
| } |
| |
| /** |
| * fcoe_ctlr_vlan_recv - vlan request receive handler for VN2VN mode. |
| * @fip: The FCoE controller |
| * @skb: The received FIP packet |
| */ |
| static int fcoe_ctlr_vlan_recv(struct fcoe_ctlr *fip, struct sk_buff *skb) |
| { |
| struct fip_header *fiph; |
| enum fip_vlan_subcode sub; |
| struct fcoe_rport frport = { }; |
| int rc; |
| |
| fiph = (struct fip_header *)skb->data; |
| sub = fiph->fip_subcode; |
| rc = fcoe_ctlr_vlan_parse(fip, skb, &frport); |
| if (rc) { |
| LIBFCOE_FIP_DBG(fip, "vlan_recv vlan_parse error %d\n", rc); |
| goto drop; |
| } |
| mutex_lock(&fip->ctlr_mutex); |
| if (sub == FIP_SC_VL_REQ) |
| fcoe_ctlr_vlan_disc_reply(fip, &frport); |
| mutex_unlock(&fip->ctlr_mutex); |
| |
| drop: |
| kfree_skb(skb); |
| return rc; |
| } |
| |
| /** |
| * fcoe_ctlr_disc_recv - discovery receive handler for VN2VN mode. |
| * @lport: The local port |
| * @fp: The received frame |
| * |
| * This should never be called since we don't see RSCNs or other |
| * fabric-generated ELSes. |
| */ |
| static void fcoe_ctlr_disc_recv(struct fc_lport *lport, struct fc_frame *fp) |
| { |
| struct fc_seq_els_data rjt_data; |
| |
| rjt_data.reason = ELS_RJT_UNSUP; |
| rjt_data.explan = ELS_EXPL_NONE; |
| fc_seq_els_rsp_send(fp, ELS_LS_RJT, &rjt_data); |
| fc_frame_free(fp); |
| } |
| |
| /* |
| * fcoe_ctlr_disc_start - start discovery for VN2VN mode. |
| * |
| * This sets a flag indicating that remote ports should be created |
| * and started for the peers we discover. We use the disc_callback |
| * pointer as that flag. Peers already discovered are created here. |
| * |
| * The lport lock is held during this call. The callback must be done |
| * later, without holding either the lport or discovery locks. |
| * The fcoe_ctlr lock may also be held during this call. |
| */ |
| static void fcoe_ctlr_disc_start(void (*callback)(struct fc_lport *, |
| enum fc_disc_event), |
| struct fc_lport *lport) |
| { |
| struct fc_disc *disc = &lport->disc; |
| struct fcoe_ctlr *fip = disc->priv; |
| |
| mutex_lock(&disc->disc_mutex); |
| disc->disc_callback = callback; |
| disc->disc_id = (disc->disc_id + 2) | 1; |
| disc->pending = 1; |
| schedule_work(&fip->timer_work); |
| mutex_unlock(&disc->disc_mutex); |
| } |
| |
| /** |
| * fcoe_ctlr_vn_disc() - report FIP VN_port discovery results after claim state. |
| * @fip: The FCoE controller |
| * |
| * Starts the FLOGI and PLOGI login process to each discovered rport for which |
| * we've received at least one beacon. |
| * Performs the discovery complete callback. |
| */ |
| static void fcoe_ctlr_vn_disc(struct fcoe_ctlr *fip) |
| { |
| struct fc_lport *lport = fip->lp; |
| struct fc_disc *disc = &lport->disc; |
| struct fc_rport_priv *rdata; |
| struct fcoe_rport *frport; |
| void (*callback)(struct fc_lport *, enum fc_disc_event); |
| |
| mutex_lock(&disc->disc_mutex); |
| callback = disc->pending ? disc->disc_callback : NULL; |
| disc->pending = 0; |
| list_for_each_entry_rcu(rdata, &disc->rports, peers) { |
| if (!kref_get_unless_zero(&rdata->kref)) |
| continue; |
| frport = fcoe_ctlr_rport(rdata); |
| if (frport->time) |
| fc_rport_login(rdata); |
| kref_put(&rdata->kref, fc_rport_destroy); |
| } |
| mutex_unlock(&disc->disc_mutex); |
| if (callback) |
| callback(lport, DISC_EV_SUCCESS); |
| } |
| |
| /** |
| * fcoe_ctlr_vn_timeout - timer work function for VN2VN mode. |
| * @fip: The FCoE controller |
| */ |
| static void fcoe_ctlr_vn_timeout(struct fcoe_ctlr *fip) |
| { |
| unsigned long next_time; |
| u8 mac[ETH_ALEN]; |
| u32 new_port_id = 0; |
| |
| mutex_lock(&fip->ctlr_mutex); |
| switch (fip->state) { |
| case FIP_ST_VNMP_START: |
| fcoe_ctlr_set_state(fip, FIP_ST_VNMP_PROBE1); |
| LIBFCOE_FIP_DBG(fip, "vn_timeout: send 1st probe request\n"); |
| fcoe_ctlr_vn_send(fip, FIP_SC_VN_PROBE_REQ, fcoe_all_vn2vn, 0); |
| next_time = jiffies + msecs_to_jiffies(FIP_VN_PROBE_WAIT); |
| break; |
| case FIP_ST_VNMP_PROBE1: |
| fcoe_ctlr_set_state(fip, FIP_ST_VNMP_PROBE2); |
| LIBFCOE_FIP_DBG(fip, "vn_timeout: send 2nd probe request\n"); |
| fcoe_ctlr_vn_send(fip, FIP_SC_VN_PROBE_REQ, fcoe_all_vn2vn, 0); |
| next_time = jiffies + msecs_to_jiffies(FIP_VN_ANN_WAIT); |
| break; |
| case FIP_ST_VNMP_PROBE2: |
| fcoe_ctlr_set_state(fip, FIP_ST_VNMP_CLAIM); |
| new_port_id = fip->port_id; |
| hton24(mac, FIP_VN_FC_MAP); |
| hton24(mac + 3, new_port_id); |
| fcoe_ctlr_map_dest(fip); |
| fip->update_mac(fip->lp, mac); |
| LIBFCOE_FIP_DBG(fip, "vn_timeout: send claim notify\n"); |
| fcoe_ctlr_vn_send_claim(fip); |
| next_time = jiffies + msecs_to_jiffies(FIP_VN_ANN_WAIT); |
| break; |
| case FIP_ST_VNMP_CLAIM: |
| /* |
| * This may be invoked either by starting discovery so don't |
| * go to the next state unless it's been long enough. |
| */ |
| next_time = fip->sol_time + msecs_to_jiffies(FIP_VN_ANN_WAIT); |
| if (time_after_eq(jiffies, next_time)) { |
| fcoe_ctlr_set_state(fip, FIP_ST_VNMP_UP); |
| LIBFCOE_FIP_DBG(fip, "vn_timeout: send vn2vn beacon\n"); |
| fcoe_ctlr_vn_send(fip, FIP_SC_VN_BEACON, |
| fcoe_all_vn2vn, 0); |
| next_time = jiffies + msecs_to_jiffies(FIP_VN_ANN_WAIT); |
| fip->port_ka_time = next_time; |
| } |
| fcoe_ctlr_vn_disc(fip); |
| break; |
| case FIP_ST_VNMP_UP: |
| next_time = fcoe_ctlr_vn_age(fip); |
| if (time_after_eq(jiffies, fip->port_ka_time)) { |
| LIBFCOE_FIP_DBG(fip, "vn_timeout: send vn2vn beacon\n"); |
| fcoe_ctlr_vn_send(fip, FIP_SC_VN_BEACON, |
| fcoe_all_vn2vn, 0); |
| fip->port_ka_time = jiffies + |
| msecs_to_jiffies(FIP_VN_BEACON_INT + |
| get_random_u32_below(FIP_VN_BEACON_FUZZ)); |
| } |
| if (time_before(fip->port_ka_time, next_time)) |
| next_time = fip->port_ka_time; |
| break; |
| case FIP_ST_LINK_WAIT: |
| goto unlock; |
| default: |
| WARN(1, "unexpected state %d\n", fip->state); |
| goto unlock; |
| } |
| mod_timer(&fip->timer, next_time); |
| unlock: |
| mutex_unlock(&fip->ctlr_mutex); |
| |
| /* If port ID is new, notify local port after dropping ctlr_mutex */ |
| if (new_port_id) |
| fc_lport_set_local_id(fip->lp, new_port_id); |
| } |
| |
| /** |
| * fcoe_ctlr_mode_set() - Set or reset the ctlr's mode |
| * @lport: The local port to be (re)configured |
| * @fip: The FCoE controller whose mode is changing |
| * @fip_mode: The new fip mode |
| * |
| * Note that the we shouldn't be changing the libfc discovery settings |
| * (fc_disc_config) while an lport is going through the libfc state |
| * machine. The mode can only be changed when a fcoe_ctlr device is |
| * disabled, so that should ensure that this routine is only called |
| * when nothing is happening. |
| */ |
| static void fcoe_ctlr_mode_set(struct fc_lport *lport, struct fcoe_ctlr *fip, |
| enum fip_mode fip_mode) |
| { |
| void *priv; |
| |
| WARN_ON(lport->state != LPORT_ST_RESET && |
| lport->state != LPORT_ST_DISABLED); |
| |
| if (fip_mode == FIP_MODE_VN2VN) { |
| lport->rport_priv_size = sizeof(struct fcoe_rport); |
| lport->point_to_multipoint = 1; |
| lport->tt.disc_recv_req = fcoe_ctlr_disc_recv; |
| lport->tt.disc_start = fcoe_ctlr_disc_start; |
| lport->tt.disc_stop = fcoe_ctlr_disc_stop; |
| lport->tt.disc_stop_final = fcoe_ctlr_disc_stop_final; |
| priv = fip; |
| } else { |
| lport->rport_priv_size = 0; |
| lport->point_to_multipoint = 0; |
| lport->tt.disc_recv_req = NULL; |
| lport->tt.disc_start = NULL; |
| lport->tt.disc_stop = NULL; |
| lport->tt.disc_stop_final = NULL; |
| priv = lport; |
| } |
| |
| fc_disc_config(lport, priv); |
| } |
| |
| /** |
| * fcoe_libfc_config() - Sets up libfc related properties for local port |
| * @lport: The local port to configure libfc for |
| * @fip: The FCoE controller in use by the local port |
| * @tt: The libfc function template |
| * @init_fcp: If non-zero, the FCP portion of libfc should be initialized |
| * |
| * Returns : 0 for success |
| */ |
| int fcoe_libfc_config(struct fc_lport *lport, struct fcoe_ctlr *fip, |
| const struct libfc_function_template *tt, int init_fcp) |
| { |
| /* Set the function pointers set by the LLDD */ |
| memcpy(&lport->tt, tt, sizeof(*tt)); |
| if (init_fcp && fc_fcp_init(lport)) |
| return -ENOMEM; |
| fc_exch_init(lport); |
| fc_elsct_init(lport); |
| fc_lport_init(lport); |
| fc_disc_init(lport); |
| fcoe_ctlr_mode_set(lport, fip, fip->mode); |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(fcoe_libfc_config); |
| |
| void fcoe_fcf_get_selected(struct fcoe_fcf_device *fcf_dev) |
| { |
| struct fcoe_ctlr_device *ctlr_dev = fcoe_fcf_dev_to_ctlr_dev(fcf_dev); |
| struct fcoe_ctlr *fip = fcoe_ctlr_device_priv(ctlr_dev); |
| struct fcoe_fcf *fcf; |
| |
| mutex_lock(&fip->ctlr_mutex); |
| mutex_lock(&ctlr_dev->lock); |
| |
| fcf = fcoe_fcf_device_priv(fcf_dev); |
| if (fcf) |
| fcf_dev->selected = (fcf == fip->sel_fcf) ? 1 : 0; |
| else |
| fcf_dev->selected = 0; |
| |
| mutex_unlock(&ctlr_dev->lock); |
| mutex_unlock(&fip->ctlr_mutex); |
| } |
| EXPORT_SYMBOL(fcoe_fcf_get_selected); |
| |
| void fcoe_ctlr_set_fip_mode(struct fcoe_ctlr_device *ctlr_dev) |
| { |
| struct fcoe_ctlr *ctlr = fcoe_ctlr_device_priv(ctlr_dev); |
| struct fc_lport *lport = ctlr->lp; |
| |
| mutex_lock(&ctlr->ctlr_mutex); |
| switch (ctlr_dev->mode) { |
| case FIP_CONN_TYPE_VN2VN: |
| ctlr->mode = FIP_MODE_VN2VN; |
| break; |
| case FIP_CONN_TYPE_FABRIC: |
| default: |
| ctlr->mode = FIP_MODE_FABRIC; |
| break; |
| } |
| |
| mutex_unlock(&ctlr->ctlr_mutex); |
| |
| fcoe_ctlr_mode_set(lport, ctlr, ctlr->mode); |
| } |
| EXPORT_SYMBOL(fcoe_ctlr_set_fip_mode); |