302 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/*3 * QLogic FCoE Offload Driver4 * Copyright (c) 2016-2018 Cavium Inc.5 */6#include <linux/if_ether.h>7#include <linux/if_vlan.h>8#include "qedf.h"9 10extern const struct qed_fcoe_ops *qed_ops;11/*12 * FIP VLAN functions that will eventually move to libfcoe.13 */14 15void qedf_fcoe_send_vlan_req(struct qedf_ctx *qedf)16{17 struct sk_buff *skb;18 char *eth_fr;19 struct fip_vlan *vlan;20#define MY_FIP_ALL_FCF_MACS ((__u8[6]) { 1, 0x10, 0x18, 1, 0, 2 })21 static u8 my_fcoe_all_fcfs[ETH_ALEN] = MY_FIP_ALL_FCF_MACS;22 unsigned long flags = 0;23 int rc;24 25 skb = dev_alloc_skb(sizeof(struct fip_vlan));26 if (!skb) {27 QEDF_ERR(&qedf->dbg_ctx,28 "Failed to allocate skb.\n");29 return;30 }31 32 eth_fr = (char *)skb->data;33 vlan = (struct fip_vlan *)eth_fr;34 35 memset(vlan, 0, sizeof(*vlan));36 ether_addr_copy(vlan->eth.h_source, qedf->mac);37 ether_addr_copy(vlan->eth.h_dest, my_fcoe_all_fcfs);38 vlan->eth.h_proto = htons(ETH_P_FIP);39 40 vlan->fip.fip_ver = FIP_VER_ENCAPS(FIP_VER);41 vlan->fip.fip_op = htons(FIP_OP_VLAN);42 vlan->fip.fip_subcode = FIP_SC_VL_REQ;43 vlan->fip.fip_dl_len = htons(sizeof(vlan->desc) / FIP_BPW);44 45 vlan->desc.mac.fd_desc.fip_dtype = FIP_DT_MAC;46 vlan->desc.mac.fd_desc.fip_dlen = sizeof(vlan->desc.mac) / FIP_BPW;47 ether_addr_copy(vlan->desc.mac.fd_mac, qedf->mac);48 49 vlan->desc.wwnn.fd_desc.fip_dtype = FIP_DT_NAME;50 vlan->desc.wwnn.fd_desc.fip_dlen = sizeof(vlan->desc.wwnn) / FIP_BPW;51 put_unaligned_be64(qedf->lport->wwnn, &vlan->desc.wwnn.fd_wwn);52 53 skb_put(skb, sizeof(*vlan));54 skb->protocol = htons(ETH_P_FIP);55 skb_reset_mac_header(skb);56 skb_reset_network_header(skb);57 58 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "Sending FIP VLAN "59 "request.");60 61 if (atomic_read(&qedf->link_state) != QEDF_LINK_UP) {62 QEDF_WARN(&(qedf->dbg_ctx), "Cannot send vlan request "63 "because link is not up.\n");64 65 kfree_skb(skb);66 return;67 }68 69 set_bit(QED_LL2_XMIT_FLAGS_FIP_DISCOVERY, &flags);70 rc = qed_ops->ll2->start_xmit(qedf->cdev, skb, flags);71 if (rc) {72 QEDF_ERR(&qedf->dbg_ctx, "start_xmit failed rc = %d.\n", rc);73 kfree_skb(skb);74 return;75 }76 77}78 79static void qedf_fcoe_process_vlan_resp(struct qedf_ctx *qedf,80 struct sk_buff *skb)81{82 struct fip_header *fiph;83 struct fip_desc *desc;84 u16 vid = 0;85 ssize_t rlen;86 size_t dlen;87 88 fiph = (struct fip_header *)(((void *)skb->data) + 2 * ETH_ALEN + 2);89 90 rlen = ntohs(fiph->fip_dl_len) * 4;91 desc = (struct fip_desc *)(fiph + 1);92 while (rlen > 0) {93 dlen = desc->fip_dlen * FIP_BPW;94 switch (desc->fip_dtype) {95 case FIP_DT_VLAN:96 vid = ntohs(((struct fip_vlan_desc *)desc)->fd_vlan);97 break;98 }99 desc = (struct fip_desc *)((char *)desc + dlen);100 rlen -= dlen;101 }102 103 if (atomic_read(&qedf->link_state) == QEDF_LINK_DOWN) {104 QEDF_INFO(&qedf->dbg_ctx, QEDF_LOG_DISC,105 "Dropping VLAN response as link is down.\n");106 return;107 }108 109 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "VLAN response, "110 "vid=0x%x.\n", vid);111 112 if (vid > 0 && qedf->vlan_id != vid) {113 qedf_set_vlan_id(qedf, vid);114 115 /* Inform waiter that it's ok to call fcoe_ctlr_link up() */116 if (!completion_done(&qedf->fipvlan_compl))117 complete(&qedf->fipvlan_compl);118 }119}120 121void qedf_fip_send(struct fcoe_ctlr *fip, struct sk_buff *skb)122{123 struct qedf_ctx *qedf = container_of(fip, struct qedf_ctx, ctlr);124 struct ethhdr *eth_hdr;125 struct fip_header *fiph;126 u16 op, vlan_tci = 0;127 u8 sub;128 int rc = -1;129 130 if (!test_bit(QEDF_LL2_STARTED, &qedf->flags)) {131 QEDF_WARN(&(qedf->dbg_ctx), "LL2 not started\n");132 kfree_skb(skb);133 return;134 }135 136 fiph = (struct fip_header *) ((void *)skb->data + 2 * ETH_ALEN + 2);137 eth_hdr = (struct ethhdr *)skb_mac_header(skb);138 op = ntohs(fiph->fip_op);139 sub = fiph->fip_subcode;140 141 /*142 * Add VLAN tag to non-offload FIP frame based on current stored VLAN143 * for FIP/FCoE traffic.144 */145 __vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), qedf->vlan_id);146 147 /* Get VLAN ID from skb for printing purposes */148 __vlan_hwaccel_get_tag(skb, &vlan_tci);149 150 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_LL2, "FIP frame send: "151 "dest=%pM op=%x sub=%x vlan=%04x.", eth_hdr->h_dest, op, sub,152 vlan_tci);153 if (qedf_dump_frames)154 print_hex_dump(KERN_WARNING, "fip ", DUMP_PREFIX_OFFSET, 16, 1,155 skb->data, skb->len, false);156 157 rc = qed_ops->ll2->start_xmit(qedf->cdev, skb, 0);158 if (rc) {159 QEDF_ERR(&qedf->dbg_ctx, "start_xmit failed rc = %d.\n", rc);160 kfree_skb(skb);161 return;162 }163}164 165static u8 fcoe_all_enode[ETH_ALEN] = FIP_ALL_ENODE_MACS;166 167/* Process incoming FIP frames. */168void qedf_fip_recv(struct qedf_ctx *qedf, struct sk_buff *skb)169{170 struct ethhdr *eth_hdr;171 struct fip_header *fiph;172 struct fip_desc *desc;173 struct fip_mac_desc *mp;174 struct fip_wwn_desc *wp;175 struct fip_vn_desc *vp;176 size_t rlen, dlen;177 u16 op;178 u8 sub;179 bool fcf_valid = false;180 /* Default is to handle CVL regardless of fabric id descriptor */181 bool fabric_id_valid = true;182 bool fc_wwpn_valid = false;183 u64 switch_name;184 u16 vlan = 0;185 186 eth_hdr = (struct ethhdr *)skb_mac_header(skb);187 fiph = (struct fip_header *) ((void *)skb->data + 2 * ETH_ALEN + 2);188 op = ntohs(fiph->fip_op);189 sub = fiph->fip_subcode;190 191 QEDF_INFO(&qedf->dbg_ctx, QEDF_LOG_LL2,192 "FIP frame received: skb=%p fiph=%p source=%pM destn=%pM op=%x sub=%x vlan=%04x",193 skb, fiph, eth_hdr->h_source, eth_hdr->h_dest, op,194 sub, vlan);195 if (qedf_dump_frames)196 print_hex_dump(KERN_WARNING, "fip ", DUMP_PREFIX_OFFSET, 16, 1,197 skb->data, skb->len, false);198 199 if (!ether_addr_equal(eth_hdr->h_dest, qedf->mac) &&200 !ether_addr_equal(eth_hdr->h_dest, fcoe_all_enode) &&201 !ether_addr_equal(eth_hdr->h_dest, qedf->data_src_addr)) {202 QEDF_INFO(&qedf->dbg_ctx, QEDF_LOG_LL2,203 "Dropping FIP type 0x%x pkt due to destination MAC mismatch dest_mac=%pM ctlr.dest_addr=%pM data_src_addr=%pM.\n",204 op, eth_hdr->h_dest, qedf->mac,205 qedf->data_src_addr);206 kfree_skb(skb);207 return;208 }209 210 /* Handle FIP VLAN resp in the driver */211 if (op == FIP_OP_VLAN && sub == FIP_SC_VL_NOTE) {212 qedf_fcoe_process_vlan_resp(qedf, skb);213 kfree_skb(skb);214 } else if (op == FIP_OP_CTRL && sub == FIP_SC_CLR_VLINK) {215 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "Clear virtual "216 "link received.\n");217 218 /* Check that an FCF has been selected by fcoe */219 if (qedf->ctlr.sel_fcf == NULL) {220 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,221 "Dropping CVL since FCF has not been selected "222 "yet.");223 kfree_skb(skb);224 return;225 }226 227 /*228 * We need to loop through the CVL descriptors to determine229 * if we want to reset the fcoe link230 */231 rlen = ntohs(fiph->fip_dl_len) * FIP_BPW;232 desc = (struct fip_desc *)(fiph + 1);233 while (rlen >= sizeof(*desc)) {234 dlen = desc->fip_dlen * FIP_BPW;235 switch (desc->fip_dtype) {236 case FIP_DT_MAC:237 mp = (struct fip_mac_desc *)desc;238 QEDF_INFO(&qedf->dbg_ctx, QEDF_LOG_DISC,239 "Switch fd_mac=%pM.\n", mp->fd_mac);240 if (ether_addr_equal(mp->fd_mac,241 qedf->ctlr.sel_fcf->fcf_mac))242 fcf_valid = true;243 break;244 case FIP_DT_NAME:245 wp = (struct fip_wwn_desc *)desc;246 switch_name = get_unaligned_be64(&wp->fd_wwn);247 QEDF_INFO(&qedf->dbg_ctx, QEDF_LOG_DISC,248 "Switch fd_wwn=%016llx fcf_switch_name=%016llx.\n",249 switch_name,250 qedf->ctlr.sel_fcf->switch_name);251 if (switch_name ==252 qedf->ctlr.sel_fcf->switch_name)253 fc_wwpn_valid = true;254 break;255 case FIP_DT_VN_ID:256 fabric_id_valid = false;257 vp = (struct fip_vn_desc *)desc;258 259 QEDF_ERR(&qedf->dbg_ctx,260 "CVL vx_port fd_fc_id=0x%x fd_mac=%pM fd_wwpn=%016llx.\n",261 ntoh24(vp->fd_fc_id), vp->fd_mac,262 get_unaligned_be64(&vp->fd_wwpn));263 /* Check for vx_port wwpn OR Check vx_port264 * fabric ID OR Check vx_port MAC265 */266 if ((get_unaligned_be64(&vp->fd_wwpn) ==267 qedf->wwpn) ||268 (ntoh24(vp->fd_fc_id) ==269 qedf->lport->port_id) ||270 (ether_addr_equal(vp->fd_mac,271 qedf->data_src_addr))) {272 fabric_id_valid = true;273 }274 break;275 default:276 /* Ignore anything else */277 break;278 }279 desc = (struct fip_desc *)((char *)desc + dlen);280 rlen -= dlen;281 }282 283 QEDF_INFO(&qedf->dbg_ctx, QEDF_LOG_DISC,284 "fcf_valid=%d fabric_id_valid=%d fc_wwpn_valid=%d.\n",285 fcf_valid, fabric_id_valid, fc_wwpn_valid);286 if (fcf_valid && fabric_id_valid && fc_wwpn_valid)287 qedf_ctx_soft_reset(qedf->lport);288 kfree_skb(skb);289 } else {290 /* Everything else is handled by libfcoe */291 __skb_pull(skb, ETH_HLEN);292 fcoe_ctlr_recv(&qedf->ctlr, skb);293 }294}295 296u8 *qedf_get_src_mac(struct fc_lport *lport)297{298 struct qedf_ctx *qedf = lport_priv(lport);299 300 return qedf->data_src_addr;301}302