drivers/scsi/qedf/qedf_fip.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  *  QLogic FCoE Offload Driver
   4  *  Copyright (c) 2016-2018 Cavium Inc.
   5  */
   6 #include <linux/if_ether.h>
   7 #include <linux/if_vlan.h>
   8 #include "qedf.h"
   9
  10 extern const struct qed_fcoe_ops *qed_ops;
  11 /*
  12  * FIP VLAN functions that will eventually move to libfcoe.
  13  */
  14
  15 void 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
  79 static 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
 121 void 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 VLAN
 143          * 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
 165 static u8 fcoe_all_enode[ETH_ALEN] = FIP_ALL_ENODE_MACS;
 166
 167 /* Process incoming FIP frames. */
 168 void 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 determine
 229                  * if we want to reset the fcoe link
 230                  */
 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_port
 264                                  * fabric ID OR Check vx_port MAC
 265                                  */
 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
 296 u8 *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 }