/* * QLogic FCoE Offload Driver * Copyright (c) 2016-2018 Cavium Inc. * * This software is available under the terms of the GNU General Public License * (GPL) Version 2, available from the file COPYING in the main directory of * this source tree. */ #include #include #include "qedf.h" extern const struct qed_fcoe_ops *qed_ops; /* * FIP VLAN functions that will eventually move to libfcoe. */ void qedf_fcoe_send_vlan_req(struct qedf_ctx *qedf) { struct sk_buff *skb; char *eth_fr; int fr_len; struct fip_vlan *vlan; #define MY_FIP_ALL_FCF_MACS ((__u8[6]) { 1, 0x10, 0x18, 1, 0, 2 }) static u8 my_fcoe_all_fcfs[ETH_ALEN] = MY_FIP_ALL_FCF_MACS; unsigned long flags = 0; skb = dev_alloc_skb(sizeof(struct fip_vlan)); if (!skb) return; fr_len = sizeof(*vlan); eth_fr = (char *)skb->data; vlan = (struct fip_vlan *)eth_fr; memset(vlan, 0, sizeof(*vlan)); ether_addr_copy(vlan->eth.h_source, qedf->mac); ether_addr_copy(vlan->eth.h_dest, my_fcoe_all_fcfs); vlan->eth.h_proto = htons(ETH_P_FIP); vlan->fip.fip_ver = FIP_VER_ENCAPS(FIP_VER); vlan->fip.fip_op = htons(FIP_OP_VLAN); vlan->fip.fip_subcode = FIP_SC_VL_REQ; vlan->fip.fip_dl_len = htons(sizeof(vlan->desc) / FIP_BPW); vlan->desc.mac.fd_desc.fip_dtype = FIP_DT_MAC; vlan->desc.mac.fd_desc.fip_dlen = sizeof(vlan->desc.mac) / FIP_BPW; ether_addr_copy(vlan->desc.mac.fd_mac, qedf->mac); vlan->desc.wwnn.fd_desc.fip_dtype = FIP_DT_NAME; vlan->desc.wwnn.fd_desc.fip_dlen = sizeof(vlan->desc.wwnn) / FIP_BPW; put_unaligned_be64(qedf->lport->wwnn, &vlan->desc.wwnn.fd_wwn); skb_put(skb, sizeof(*vlan)); skb->protocol = htons(ETH_P_FIP); skb_reset_mac_header(skb); skb_reset_network_header(skb); QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "Sending FIP VLAN " "request."); if (atomic_read(&qedf->link_state) != QEDF_LINK_UP) { QEDF_WARN(&(qedf->dbg_ctx), "Cannot send vlan request " "because link is not up.\n"); kfree_skb(skb); return; } set_bit(QED_LL2_XMIT_FLAGS_FIP_DISCOVERY, &flags); qed_ops->ll2->start_xmit(qedf->cdev, skb, flags); } static void qedf_fcoe_process_vlan_resp(struct qedf_ctx *qedf, struct sk_buff *skb) { struct fip_header *fiph; struct fip_desc *desc; u16 vid = 0; ssize_t rlen; size_t dlen; fiph = (struct fip_header *)(((void *)skb->data) + 2 * ETH_ALEN + 2); rlen = ntohs(fiph->fip_dl_len) * 4; desc = (struct fip_desc *)(fiph + 1); while (rlen > 0) { dlen = desc->fip_dlen * FIP_BPW; switch (desc->fip_dtype) { case FIP_DT_VLAN: vid = ntohs(((struct fip_vlan_desc *)desc)->fd_vlan); break; } desc = (struct fip_desc *)((char *)desc + dlen); rlen -= dlen; } if (atomic_read(&qedf->link_state) == QEDF_LINK_DOWN) { QEDF_INFO(&qedf->dbg_ctx, QEDF_LOG_DISC, "Dropping VLAN response as link is down.\n"); return; } QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "VLAN response, " "vid=0x%x.\n", vid); if (vid > 0 && qedf->vlan_id != vid) { qedf_set_vlan_id(qedf, vid); /* Inform waiter that it's ok to call fcoe_ctlr_link up() */ if (!completion_done(&qedf->fipvlan_compl)) complete(&qedf->fipvlan_compl); } } void qedf_fip_send(struct fcoe_ctlr *fip, struct sk_buff *skb) { struct qedf_ctx *qedf = container_of(fip, struct qedf_ctx, ctlr); struct ethhdr *eth_hdr; struct fip_header *fiph; u16 op, vlan_tci = 0; u8 sub; if (!test_bit(QEDF_LL2_STARTED, &qedf->flags)) { QEDF_WARN(&(qedf->dbg_ctx), "LL2 not started\n"); kfree_skb(skb); return; } fiph = (struct fip_header *) ((void *)skb->data + 2 * ETH_ALEN + 2); eth_hdr = (struct ethhdr *)skb_mac_header(skb); op = ntohs(fiph->fip_op); sub = fiph->fip_subcode; /* * Add VLAN tag to non-offload FIP frame based on current stored VLAN * for FIP/FCoE traffic. */ __vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), qedf->vlan_id); /* Get VLAN ID from skb for printing purposes */ __vlan_hwaccel_get_tag(skb, &vlan_tci); QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_LL2, "FIP frame send: " "dest=%pM op=%x sub=%x vlan=%04x.", eth_hdr->h_dest, op, sub, vlan_tci); if (qedf_dump_frames) print_hex_dump(KERN_WARNING, "fip ", DUMP_PREFIX_OFFSET, 16, 1, skb->data, skb->len, false); qed_ops->ll2->start_xmit(qedf->cdev, skb, 0); } static u8 fcoe_all_enode[ETH_ALEN] = FIP_ALL_ENODE_MACS; /* Process incoming FIP frames. */ void qedf_fip_recv(struct qedf_ctx *qedf, struct sk_buff *skb) { struct ethhdr *eth_hdr; struct fip_header *fiph; struct fip_desc *desc; struct fip_mac_desc *mp; struct fip_wwn_desc *wp; struct fip_vn_desc *vp; size_t rlen, dlen; u16 op; u8 sub; bool fcf_valid = false; /* Default is to handle CVL regardless of fabric id descriptor */ bool fabric_id_valid = true; bool fc_wwpn_valid = false; u64 switch_name; u16 vlan = 0; eth_hdr = (struct ethhdr *)skb_mac_header(skb); fiph = (struct fip_header *) ((void *)skb->data + 2 * ETH_ALEN + 2); op = ntohs(fiph->fip_op); sub = fiph->fip_subcode; QEDF_INFO(&qedf->dbg_ctx, QEDF_LOG_LL2, "FIP frame received: skb=%p fiph=%p source=%pM destn=%pM op=%x sub=%x vlan=%04x", skb, fiph, eth_hdr->h_source, eth_hdr->h_dest, op, sub, vlan); if (qedf_dump_frames) print_hex_dump(KERN_WARNING, "fip ", DUMP_PREFIX_OFFSET, 16, 1, skb->data, skb->len, false); if (!ether_addr_equal(eth_hdr->h_dest, qedf->mac) && !ether_addr_equal(eth_hdr->h_dest, fcoe_all_enode) && !ether_addr_equal(eth_hdr->h_dest, qedf->data_src_addr)) { QEDF_INFO(&qedf->dbg_ctx, QEDF_LOG_LL2, "Dropping FIP type 0x%x pkt due to destination MAC mismatch dest_mac=%pM ctlr.dest_addr=%pM data_src_addr=%pM.\n", op, eth_hdr->h_dest, qedf->mac, qedf->data_src_addr); kfree_skb(skb); return; } /* Handle FIP VLAN resp in the driver */ if (op == FIP_OP_VLAN && sub == FIP_SC_VL_NOTE) { qedf_fcoe_process_vlan_resp(qedf, skb); kfree_skb(skb); } else if (op == FIP_OP_CTRL && sub == FIP_SC_CLR_VLINK) { QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "Clear virtual " "link received.\n"); /* Check that an FCF has been selected by fcoe */ if (qedf->ctlr.sel_fcf == NULL) { QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "Dropping CVL since FCF has not been selected " "yet."); kfree_skb(skb); return; } /* * We need to loop through the CVL descriptors to determine * if we want to reset the fcoe link */ rlen = ntohs(fiph->fip_dl_len) * FIP_BPW; desc = (struct fip_desc *)(fiph + 1); while (rlen >= sizeof(*desc)) { dlen = desc->fip_dlen * FIP_BPW; switch (desc->fip_dtype) { case FIP_DT_MAC: mp = (struct fip_mac_desc *)desc; QEDF_INFO(&qedf->dbg_ctx, QEDF_LOG_DISC, "Switch fd_mac=%pM.\n", mp->fd_mac); if (ether_addr_equal(mp->fd_mac, qedf->ctlr.sel_fcf->fcf_mac)) fcf_valid = true; break; case FIP_DT_NAME: wp = (struct fip_wwn_desc *)desc; switch_name = get_unaligned_be64(&wp->fd_wwn); QEDF_INFO(&qedf->dbg_ctx, QEDF_LOG_DISC, "Switch fd_wwn=%016llx fcf_switch_name=%016llx.\n", switch_name, qedf->ctlr.sel_fcf->switch_name); if (switch_name == qedf->ctlr.sel_fcf->switch_name) fc_wwpn_valid = true; break; case FIP_DT_VN_ID: vp = (struct fip_vn_desc *)desc; QEDF_INFO(&qedf->dbg_ctx, QEDF_LOG_DISC, "vx_port fd_fc_id=%x fd_mac=%pM.\n", ntoh24(vp->fd_fc_id), vp->fd_mac); /* Check vx_port fabric ID */ if (ntoh24(vp->fd_fc_id) != qedf->lport->port_id) fabric_id_valid = false; /* Check vx_port MAC */ if (!ether_addr_equal(vp->fd_mac, qedf->data_src_addr)) fabric_id_valid = false; break; default: /* Ignore anything else */ break; } desc = (struct fip_desc *)((char *)desc + dlen); rlen -= dlen; } QEDF_INFO(&qedf->dbg_ctx, QEDF_LOG_DISC, "fcf_valid=%d fabric_id_valid=%d fc_wwpn_valid=%d.\n", fcf_valid, fabric_id_valid, fc_wwpn_valid); if (fcf_valid && fabric_id_valid && fc_wwpn_valid) qedf_ctx_soft_reset(qedf->lport); kfree_skb(skb); } else { /* Everything else is handled by libfcoe */ __skb_pull(skb, ETH_HLEN); fcoe_ctlr_recv(&qedf->ctlr, skb); } } u8 *qedf_get_src_mac(struct fc_lport *lport) { struct qedf_ctx *qedf = lport_priv(lport); return qedf->data_src_addr; }