drivers/scsi/fcoe/fcoe_ctlr.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Copyright (c) 2008-2009 Cisco Systems, Inc.  All rights reserved.
   4  * Copyright (c) 2009 Intel Corporation.  All rights reserved.
   5  *
   6  * Maintained at www.Open-FCoE.org
   7  */
   8
   9 #include <linux/types.h>
  10 #include <linux/module.h>
  11 #include <linux/kernel.h>
  12 #include <linux/list.h>
  13 #include <linux/spinlock.h>
  14 #include <linux/timer.h>
  15 #include <linux/netdevice.h>
  16 #include <linux/etherdevice.h>
  17 #include <linux/ethtool.h>
  18 #include <linux/if_ether.h>
  19 #include <linux/if_vlan.h>
  20 #include <linux/errno.h>
  21 #include <linux/bitops.h>
  22 #include <linux/slab.h>
  23 #include <net/rtnetlink.h>
  24
  25 #include <scsi/fc/fc_els.h>
  26 #include <scsi/fc/fc_fs.h>
  27 #include <scsi/fc/fc_fip.h>
  28 #include <scsi/fc/fc_encaps.h>
  29 #include <scsi/fc/fc_fcoe.h>
  30 #include <scsi/fc/fc_fcp.h>
  31
  32 #include <scsi/libfc.h>
  33 #include <scsi/libfcoe.h>
  34
  35 #include "libfcoe.h"
  36
  37 #define FCOE_CTLR_MIN_FKA       500             /* min keep alive (mS) */
  38 #define FCOE_CTLR_DEF_FKA       FIP_DEF_FKA     /* default keep alive (mS) */
  39
  40 static void fcoe_ctlr_timeout(struct timer_list *);
  41 static void fcoe_ctlr_timer_work(struct work_struct *);
  42 static void fcoe_ctlr_recv_work(struct work_struct *);
  43 static int fcoe_ctlr_flogi_retry(struct fcoe_ctlr *);
  44
  45 static void fcoe_ctlr_vn_start(struct fcoe_ctlr *);
  46 static int fcoe_ctlr_vn_recv(struct fcoe_ctlr *, struct sk_buff *);
  47 static void fcoe_ctlr_vn_timeout(struct fcoe_ctlr *);
  48 static int fcoe_ctlr_vn_lookup(struct fcoe_ctlr *, u32, u8 *);
  49
  50 static int fcoe_ctlr_vlan_recv(struct fcoe_ctlr *, struct sk_buff *);
  51
  52 static u8 fcoe_all_fcfs[ETH_ALEN] = FIP_ALL_FCF_MACS;
  53 static u8 fcoe_all_enode[ETH_ALEN] = FIP_ALL_ENODE_MACS;
  54 static u8 fcoe_all_vn2vn[ETH_ALEN] = FIP_ALL_VN2VN_MACS;
  55 static u8 fcoe_all_p2p[ETH_ALEN] = FIP_ALL_P2P_MACS;
  56
  57 static const char * const fcoe_ctlr_states[] = {
  58         [FIP_ST_DISABLED] =     "DISABLED",
  59         [FIP_ST_LINK_WAIT] =    "LINK_WAIT",
  60         [FIP_ST_AUTO] =         "AUTO",
  61         [FIP_ST_NON_FIP] =      "NON_FIP",
  62         [FIP_ST_ENABLED] =      "ENABLED",
  63         [FIP_ST_VNMP_START] =   "VNMP_START",
  64         [FIP_ST_VNMP_PROBE1] =  "VNMP_PROBE1",
  65         [FIP_ST_VNMP_PROBE2] =  "VNMP_PROBE2",
  66         [FIP_ST_VNMP_CLAIM] =   "VNMP_CLAIM",
  67         [FIP_ST_VNMP_UP] =      "VNMP_UP",
  68 };
  69
  70 static const char *fcoe_ctlr_state(enum fip_state state)
  71 {
  72         const char *cp = "unknown";
  73
  74         if (state < ARRAY_SIZE(fcoe_ctlr_states))
  75                 cp = fcoe_ctlr_states[state];
  76         if (!cp)
  77                 cp = "unknown";
  78         return cp;
  79 }
  80
  81 /**
  82  * fcoe_ctlr_set_state() - Set and do debug printing for the new FIP state.
  83  * @fip: The FCoE controller
  84  * @state: The new state
  85  */
  86 static void fcoe_ctlr_set_state(struct fcoe_ctlr *fip, enum fip_state state)
  87 {
  88         if (state == fip->state)
  89                 return;
  90         if (fip->lp)
  91                 LIBFCOE_FIP_DBG(fip, "state %s -> %s\n",
  92                         fcoe_ctlr_state(fip->state), fcoe_ctlr_state(state));
  93         fip->state = state;
  94 }
  95
  96 /**
  97  * fcoe_ctlr_mtu_valid() - Check if a FCF's MTU is valid
  98  * @fcf: The FCF to check
  99  *
 100  * Return non-zero if FCF fcoe_size has been validated.
 101  */
 102 static inline int fcoe_ctlr_mtu_valid(const struct fcoe_fcf *fcf)
 103 {
 104         return (fcf->flags & FIP_FL_SOL) != 0;
 105 }
 106
 107 /**
 108  * fcoe_ctlr_fcf_usable() - Check if a FCF is usable
 109  * @fcf: The FCF to check
 110  *
 111  * Return non-zero if the FCF is usable.
 112  */
 113 static inline int fcoe_ctlr_fcf_usable(struct fcoe_fcf *fcf)
 114 {
 115         u16 flags = FIP_FL_SOL | FIP_FL_AVAIL;
 116
 117         return (fcf->flags & flags) == flags;
 118 }
 119
 120 /**
 121  * fcoe_ctlr_map_dest() - Set flag and OUI for mapping destination addresses
 122  * @fip: The FCoE controller
 123  */
 124 static void fcoe_ctlr_map_dest(struct fcoe_ctlr *fip)
 125 {
 126         if (fip->mode == FIP_MODE_VN2VN)
 127                 hton24(fip->dest_addr, FIP_VN_FC_MAP);
 128         else
 129                 hton24(fip->dest_addr, FIP_DEF_FC_MAP);
 130         hton24(fip->dest_addr + 3, 0);
 131         fip->map_dest = 1;
 132 }
 133
 134 /**
 135  * fcoe_ctlr_init() - Initialize the FCoE Controller instance
 136  * @fip: The FCoE controller to initialize
 137  * @mode: FIP mode to set
 138  */
 139 void fcoe_ctlr_init(struct fcoe_ctlr *fip, enum fip_mode mode)
 140 {
 141         fcoe_ctlr_set_state(fip, FIP_ST_LINK_WAIT);
 142         fip->mode = mode;
 143         fip->fip_resp = false;
 144         INIT_LIST_HEAD(&fip->fcfs);
 145         mutex_init(&fip->ctlr_mutex);
 146         spin_lock_init(&fip->ctlr_lock);
 147         fip->flogi_oxid = FC_XID_UNKNOWN;
 148         timer_setup(&fip->timer, fcoe_ctlr_timeout, 0);
 149         INIT_WORK(&fip->timer_work, fcoe_ctlr_timer_work);
 150         INIT_WORK(&fip->recv_work, fcoe_ctlr_recv_work);
 151         skb_queue_head_init(&fip->fip_recv_list);
 152 }
 153 EXPORT_SYMBOL(fcoe_ctlr_init);
 154
 155 /**
 156  * fcoe_sysfs_fcf_add() - Add a fcoe_fcf{,_device} to a fcoe_ctlr{,_device}
 157  * @new: The newly discovered FCF
 158  *
 159  * Called with fip->ctlr_mutex held
 160  */
 161 static int fcoe_sysfs_fcf_add(struct fcoe_fcf *new)
 162 {
 163         struct fcoe_ctlr *fip = new->fip;
 164         struct fcoe_ctlr_device *ctlr_dev;
 165         struct fcoe_fcf_device *temp, *fcf_dev;
 166         int rc = -ENOMEM;
 167
 168         LIBFCOE_FIP_DBG(fip, "New FCF fab %16.16llx mac %pM\n",
 169                         new->fabric_name, new->fcf_mac);
 170
 171         temp = kzalloc(sizeof(*temp), GFP_KERNEL);
 172         if (!temp)
 173                 goto out;
 174
 175         temp->fabric_name = new->fabric_name;
 176         temp->switch_name = new->switch_name;
 177         temp->fc_map = new->fc_map;
 178         temp->vfid = new->vfid;
 179         memcpy(temp->mac, new->fcf_mac, ETH_ALEN);
 180         temp->priority = new->pri;
 181         temp->fka_period = new->fka_period;
 182         temp->selected = 0; /* default to unselected */
 183
 184         /*
 185          * If ctlr_dev doesn't exist then it means we're a libfcoe user
 186          * who doesn't use fcoe_syfs and didn't allocate a fcoe_ctlr_device.
 187          * fnic would be an example of a driver with this behavior. In this
 188          * case we want to add the fcoe_fcf to the fcoe_ctlr list, but we
 189          * don't want to make sysfs changes.
 190          */
 191
 192         ctlr_dev = fcoe_ctlr_to_ctlr_dev(fip);
 193         if (ctlr_dev) {
 194                 mutex_lock(&ctlr_dev->lock);
 195                 fcf_dev = fcoe_fcf_device_add(ctlr_dev, temp);
 196                 if (unlikely(!fcf_dev)) {
 197                         rc = -ENOMEM;
 198                         mutex_unlock(&ctlr_dev->lock);
 199                         goto out;
 200                 }
 201
 202                 /*
 203                  * The fcoe_sysfs layer can return a CONNECTED fcf that
 204                  * has a priv (fcf was never deleted) or a CONNECTED fcf
 205                  * that doesn't have a priv (fcf was deleted). However,
 206                  * libfcoe will always delete FCFs before trying to add
 207                  * them. This is ensured because both recv_adv and
 208                  * age_fcfs are protected by the the fcoe_ctlr's mutex.
 209                  * This means that we should never get a FCF with a
 210                  * non-NULL priv pointer.
 211                  */
 212                 BUG_ON(fcf_dev->priv);
 213
 214                 fcf_dev->priv = new;
 215                 new->fcf_dev = fcf_dev;
 216                 mutex_unlock(&ctlr_dev->lock);
 217         }
 218
 219         list_add(&new->list, &fip->fcfs);
 220         fip->fcf_count++;
 221         rc = 0;
 222
 223 out:
 224         kfree(temp);
 225         return rc;
 226 }
 227
 228 /**
 229  * fcoe_sysfs_fcf_del() - Remove a fcoe_fcf{,_device} to a fcoe_ctlr{,_device}
 230  * @new: The FCF to be removed
 231  *
 232  * Called with fip->ctlr_mutex held
 233  */
 234 static void fcoe_sysfs_fcf_del(struct fcoe_fcf *new)
 235 {
 236         struct fcoe_ctlr *fip = new->fip;
 237         struct fcoe_ctlr_device *cdev;
 238         struct fcoe_fcf_device *fcf_dev;
 239
 240         list_del(&new->list);
 241         fip->fcf_count--;
 242
 243         /*
 244          * If ctlr_dev doesn't exist then it means we're a libfcoe user
 245          * who doesn't use fcoe_syfs and didn't allocate a fcoe_ctlr_device
 246          * or a fcoe_fcf_device.
 247          *
 248          * fnic would be an example of a driver with this behavior. In this
 249          * case we want to remove the fcoe_fcf from the fcoe_ctlr list (above),
 250          * but we don't want to make sysfs changes.
 251          */
 252         cdev = fcoe_ctlr_to_ctlr_dev(fip);
 253         if (cdev) {
 254                 mutex_lock(&cdev->lock);
 255                 fcf_dev = fcoe_fcf_to_fcf_dev(new);
 256                 WARN_ON(!fcf_dev);
 257                 new->fcf_dev = NULL;
 258                 fcoe_fcf_device_delete(fcf_dev);
 259                 mutex_unlock(&cdev->lock);
 260         }
 261         kfree(new);
 262 }
 263
 264 /**
 265  * fcoe_ctlr_reset_fcfs() - Reset and free all FCFs for a controller
 266  * @fip: The FCoE controller whose FCFs are to be reset
 267  *
 268  * Called with &fcoe_ctlr lock held.
 269  */
 270 static void fcoe_ctlr_reset_fcfs(struct fcoe_ctlr *fip)
 271 {
 272         struct fcoe_fcf *fcf;
 273         struct fcoe_fcf *next;
 274
 275         fip->sel_fcf = NULL;
 276         list_for_each_entry_safe(fcf, next, &fip->fcfs, list) {
 277                 fcoe_sysfs_fcf_del(fcf);
 278         }
 279         WARN_ON(fip->fcf_count);
 280
 281         fip->sel_time = 0;
 282 }
 283
 284 /**
 285  * fcoe_ctlr_destroy() - Disable and tear down a FCoE controller
 286  * @fip: The FCoE controller to tear down
 287  *
 288  * This is called by FCoE drivers before freeing the &fcoe_ctlr.
 289  *
 290  * The receive handler will have been deleted before this to guarantee
 291  * that no more recv_work will be scheduled.
 292  *
 293  * The timer routine will simply return once we set FIP_ST_DISABLED.
 294  * This guarantees that no further timeouts or work will be scheduled.
 295  */
 296 void fcoe_ctlr_destroy(struct fcoe_ctlr *fip)
 297 {
 298         cancel_work_sync(&fip->recv_work);
 299         skb_queue_purge(&fip->fip_recv_list);
 300
 301         mutex_lock(&fip->ctlr_mutex);
 302         fcoe_ctlr_set_state(fip, FIP_ST_DISABLED);
 303         fcoe_ctlr_reset_fcfs(fip);
 304         mutex_unlock(&fip->ctlr_mutex);
 305         del_timer_sync(&fip->timer);
 306         cancel_work_sync(&fip->timer_work);
 307 }
 308 EXPORT_SYMBOL(fcoe_ctlr_destroy);
 309
 310 /**
 311  * fcoe_ctlr_announce() - announce new FCF selection
 312  * @fip: The FCoE controller
 313  *
 314  * Also sets the destination MAC for FCoE and control packets
 315  *
 316  * Called with neither ctlr_mutex nor ctlr_lock held.
 317  */
 318 static void fcoe_ctlr_announce(struct fcoe_ctlr *fip)
 319 {
 320         struct fcoe_fcf *sel;
 321         struct fcoe_fcf *fcf;
 322
 323         mutex_lock(&fip->ctlr_mutex);
 324         spin_lock_bh(&fip->ctlr_lock);
 325
 326         kfree_skb(fip->flogi_req);
 327         fip->flogi_req = NULL;
 328         list_for_each_entry(fcf, &fip->fcfs, list)
 329                 fcf->flogi_sent = 0;
 330
 331         spin_unlock_bh(&fip->ctlr_lock);
 332         sel = fip->sel_fcf;
 333
 334         if (sel && ether_addr_equal(sel->fcf_mac, fip->dest_addr))
 335                 goto unlock;
 336         if (!is_zero_ether_addr(fip->dest_addr)) {
 337                 printk(KERN_NOTICE "libfcoe: host%d: "
 338                        "FIP Fibre-Channel Forwarder MAC %pM deselected\n",
 339                        fip->lp->host->host_no, fip->dest_addr);
 340                 eth_zero_addr(fip->dest_addr);
 341         }
 342         if (sel) {
 343                 printk(KERN_INFO "libfcoe: host%d: FIP selected "
 344                        "Fibre-Channel Forwarder MAC %pM\n",
 345                        fip->lp->host->host_no, sel->fcf_mac);
 346                 memcpy(fip->dest_addr, sel->fcoe_mac, ETH_ALEN);
 347                 fip->map_dest = 0;
 348         }
 349 unlock:
 350         mutex_unlock(&fip->ctlr_mutex);
 351 }
 352
 353 /**
 354  * fcoe_ctlr_fcoe_size() - Return the maximum FCoE size required for VN_Port
 355  * @fip: The FCoE controller to get the maximum FCoE size from
 356  *
 357  * Returns the maximum packet size including the FCoE header and trailer,
 358  * but not including any Ethernet or VLAN headers.
 359  */
 360 static inline u32 fcoe_ctlr_fcoe_size(struct fcoe_ctlr *fip)
 361 {
 362         /*
 363          * Determine the max FCoE frame size allowed, including
 364          * FCoE header and trailer.
 365          * Note:  lp->mfs is currently the payload size, not the frame size.
 366          */
 367         return fip->lp->mfs + sizeof(struct fc_frame_header) +
 368                 sizeof(struct fcoe_hdr) + sizeof(struct fcoe_crc_eof);
 369 }
 370
 371 /**
 372  * fcoe_ctlr_solicit() - Send a FIP solicitation
 373  * @fip: The FCoE controller to send the solicitation on
 374  * @fcf: The destination FCF (if NULL, a multicast solicitation is sent)
 375  */
 376 static void fcoe_ctlr_solicit(struct fcoe_ctlr *fip, struct fcoe_fcf *fcf)
 377 {
 378         struct sk_buff *skb;
 379         struct fip_sol {
 380                 struct ethhdr eth;
 381                 struct fip_header fip;
 382                 struct {
 383                         struct fip_mac_desc mac;
 384                         struct fip_wwn_desc wwnn;
 385                         struct fip_size_desc size;
 386                 } __packed desc;
 387         }  __packed * sol;
 388         u32 fcoe_size;
 389
 390         skb = dev_alloc_skb(sizeof(*sol));
 391         if (!skb)
 392                 return;
 393
 394         sol = (struct fip_sol *)skb->data;
 395
 396         memset(sol, 0, sizeof(*sol));
 397         memcpy(sol->eth.h_dest, fcf ? fcf->fcf_mac : fcoe_all_fcfs, ETH_ALEN);
 398         memcpy(sol->eth.h_source, fip->ctl_src_addr, ETH_ALEN);
 399         sol->eth.h_proto = htons(ETH_P_FIP);
 400
 401         sol->fip.fip_ver = FIP_VER_ENCAPS(FIP_VER);
 402         sol->fip.fip_op = htons(FIP_OP_DISC);
 403         sol->fip.fip_subcode = FIP_SC_SOL;
 404         sol->fip.fip_dl_len = htons(sizeof(sol->desc) / FIP_BPW);
 405         sol->fip.fip_flags = htons(FIP_FL_FPMA);
 406         if (fip->spma)
 407                 sol->fip.fip_flags |= htons(FIP_FL_SPMA);
 408
 409         sol->desc.mac.fd_desc.fip_dtype = FIP_DT_MAC;
 410         sol->desc.mac.fd_desc.fip_dlen = sizeof(sol->desc.mac) / FIP_BPW;
 411         memcpy(sol->desc.mac.fd_mac, fip->ctl_src_addr, ETH_ALEN);
 412
 413         sol->desc.wwnn.fd_desc.fip_dtype = FIP_DT_NAME;
 414         sol->desc.wwnn.fd_desc.fip_dlen = sizeof(sol->desc.wwnn) / FIP_BPW;
 415         put_unaligned_be64(fip->lp->wwnn, &sol->desc.wwnn.fd_wwn);
 416
 417         fcoe_size = fcoe_ctlr_fcoe_size(fip);
 418         sol->desc.size.fd_desc.fip_dtype = FIP_DT_FCOE_SIZE;
 419         sol->desc.size.fd_desc.fip_dlen = sizeof(sol->desc.size) / FIP_BPW;
 420         sol->desc.size.fd_size = htons(fcoe_size);
 421
 422         skb_put(skb, sizeof(*sol));
 423         skb->protocol = htons(ETH_P_FIP);
 424         skb->priority = fip->priority;
 425         skb_reset_mac_header(skb);
 426         skb_reset_network_header(skb);
 427         fip->send(fip, skb);
 428
 429         if (!fcf)
 430                 fip->sol_time = jiffies;
 431 }
 432
 433 /**
 434  * fcoe_ctlr_link_up() - Start FCoE controller
 435  * @fip: The FCoE controller to start
 436  *
 437  * Called from the LLD when the network link is ready.
 438  */
 439 void fcoe_ctlr_link_up(struct fcoe_ctlr *fip)
 440 {
 441         mutex_lock(&fip->ctlr_mutex);
 442         if (fip->state == FIP_ST_NON_FIP || fip->state == FIP_ST_AUTO) {
 443                 mutex_unlock(&fip->ctlr_mutex);
 444                 fc_linkup(fip->lp);
 445         } else if (fip->state == FIP_ST_LINK_WAIT) {
 446                 if (fip->mode == FIP_MODE_NON_FIP)
 447                         fcoe_ctlr_set_state(fip, FIP_ST_NON_FIP);
 448                 else
 449                         fcoe_ctlr_set_state(fip, FIP_ST_AUTO);
 450                 switch (fip->mode) {
 451                 default:
 452                         LIBFCOE_FIP_DBG(fip, "invalid mode %d\n", fip->mode);
 453                         fallthrough;
 454                 case FIP_MODE_AUTO:
 455                         LIBFCOE_FIP_DBG(fip, "%s", "setting AUTO mode.\n");
 456                         fallthrough;
 457                 case FIP_MODE_FABRIC:
 458                 case FIP_MODE_NON_FIP:
 459                         mutex_unlock(&fip->ctlr_mutex);
 460                         fc_linkup(fip->lp);
 461                         fcoe_ctlr_solicit(fip, NULL);
 462                         break;
 463                 case FIP_MODE_VN2VN:
 464                         fcoe_ctlr_vn_start(fip);
 465                         mutex_unlock(&fip->ctlr_mutex);
 466                         fc_linkup(fip->lp);
 467                         break;
 468                 }
 469         } else
 470                 mutex_unlock(&fip->ctlr_mutex);
 471 }
 472 EXPORT_SYMBOL(fcoe_ctlr_link_up);
 473
 474 /**
 475  * fcoe_ctlr_reset() - Reset a FCoE controller
 476  * @fip:       The FCoE controller to reset
 477  */
 478 static void fcoe_ctlr_reset(struct fcoe_ctlr *fip)
 479 {
 480         fcoe_ctlr_reset_fcfs(fip);
 481         del_timer(&fip->timer);
 482         fip->ctlr_ka_time = 0;
 483         fip->port_ka_time = 0;
 484         fip->sol_time = 0;
 485         fip->flogi_oxid = FC_XID_UNKNOWN;
 486         fcoe_ctlr_map_dest(fip);
 487 }
 488
 489 /**
 490  * fcoe_ctlr_link_down() - Stop a FCoE controller
 491  * @fip: The FCoE controller to be stopped
 492  *
 493  * Returns non-zero if the link was up and now isn't.
 494  *
 495  * Called from the LLD when the network link is not ready.
 496  * There may be multiple calls while the link is down.
 497  */
 498 int fcoe_ctlr_link_down(struct fcoe_ctlr *fip)
 499 {
 500         int link_dropped;
 501
 502         LIBFCOE_FIP_DBG(fip, "link down.\n");
 503         mutex_lock(&fip->ctlr_mutex);
 504         fcoe_ctlr_reset(fip);
 505         link_dropped = fip->state != FIP_ST_LINK_WAIT;
 506         fcoe_ctlr_set_state(fip, FIP_ST_LINK_WAIT);
 507         mutex_unlock(&fip->ctlr_mutex);
 508
 509         if (link_dropped)
 510                 fc_linkdown(fip->lp);
 511         return link_dropped;
 512 }
 513 EXPORT_SYMBOL(fcoe_ctlr_link_down);
 514
 515 /**
 516  * fcoe_ctlr_send_keep_alive() - Send a keep-alive to the selected FCF
 517  * @fip:   The FCoE controller to send the FKA on
 518  * @lport: libfc fc_lport to send from
 519  * @ports: 0 for controller keep-alive, 1 for port keep-alive
 520  * @sa:    The source MAC address
 521  *
 522  * A controller keep-alive is sent every fka_period (typically 8 seconds).
 523  * The source MAC is the native MAC address.
 524  *
 525  * A port keep-alive is sent every 90 seconds while logged in.
 526  * The source MAC is the assigned mapped source address.
 527  * The destination is the FCF's F-port.
 528  */
 529 static void fcoe_ctlr_send_keep_alive(struct fcoe_ctlr *fip,
 530                                       struct fc_lport *lport,
 531                                       int ports, u8 *sa)
 532 {
 533         struct sk_buff *skb;
 534         struct fip_kal {
 535                 struct ethhdr eth;
 536                 struct fip_header fip;
 537                 struct fip_mac_desc mac;
 538         } __packed * kal;
 539         struct fip_vn_desc *vn;
 540         u32 len;
 541         struct fc_lport *lp;
 542         struct fcoe_fcf *fcf;
 543
 544         fcf = fip->sel_fcf;
 545         lp = fip->lp;
 546         if (!fcf || (ports && !lp->port_id))
 547                 return;
 548
 549         len = sizeof(*kal) + ports * sizeof(*vn);
 550         skb = dev_alloc_skb(len);
 551         if (!skb)
 552                 return;
 553
 554         kal = (struct fip_kal *)skb->data;
 555         memset(kal, 0, len);
 556         memcpy(kal->eth.h_dest, fcf->fcf_mac, ETH_ALEN);
 557         memcpy(kal->eth.h_source, sa, ETH_ALEN);
 558         kal->eth.h_proto = htons(ETH_P_FIP);
 559
 560         kal->fip.fip_ver = FIP_VER_ENCAPS(FIP_VER);
 561         kal->fip.fip_op = htons(FIP_OP_CTRL);
 562         kal->fip.fip_subcode = FIP_SC_KEEP_ALIVE;
 563         kal->fip.fip_dl_len = htons((sizeof(kal->mac) +
 564                                      ports * sizeof(*vn)) / FIP_BPW);
 565         kal->fip.fip_flags = htons(FIP_FL_FPMA);
 566         if (fip->spma)
 567                 kal->fip.fip_flags |= htons(FIP_FL_SPMA);
 568
 569         kal->mac.fd_desc.fip_dtype = FIP_DT_MAC;
 570         kal->mac.fd_desc.fip_dlen = sizeof(kal->mac) / FIP_BPW;
 571         memcpy(kal->mac.fd_mac, fip->ctl_src_addr, ETH_ALEN);
 572         if (ports) {
 573                 vn = (struct fip_vn_desc *)(kal + 1);
 574                 vn->fd_desc.fip_dtype = FIP_DT_VN_ID;
 575                 vn->fd_desc.fip_dlen = sizeof(*vn) / FIP_BPW;
 576                 memcpy(vn->fd_mac, fip->get_src_addr(lport), ETH_ALEN);
 577                 hton24(vn->fd_fc_id, lport->port_id);
 578                 put_unaligned_be64(lport->wwpn, &vn->fd_wwpn);
 579         }
 580         skb_put(skb, len);
 581         skb->protocol = htons(ETH_P_FIP);
 582         skb->priority = fip->priority;
 583         skb_reset_mac_header(skb);
 584         skb_reset_network_header(skb);
 585         fip->send(fip, skb);
 586 }
 587
 588 /**
 589  * fcoe_ctlr_encaps() - Encapsulate an ELS frame for FIP, without sending it
 590  * @fip:   The FCoE controller for the ELS frame
 591  * @lport: The local port
 592  * @dtype: The FIP descriptor type for the frame
 593  * @skb:   The FCoE ELS frame including FC header but no FCoE headers
 594  * @d_id:  The destination port ID.
 595  *
 596  * Returns non-zero error code on failure.
 597  *
 598  * The caller must check that the length is a multiple of 4.
 599  *
 600  * The @skb must have enough headroom (28 bytes) and tailroom (8 bytes).
 601  * Headroom includes the FIP encapsulation description, FIP header, and
 602  * Ethernet header.  The tailroom is for the FIP MAC descriptor.
 603  */
 604 static int fcoe_ctlr_encaps(struct fcoe_ctlr *fip, struct fc_lport *lport,
 605                             u8 dtype, struct sk_buff *skb, u32 d_id)
 606 {
 607         struct fip_encaps_head {
 608                 struct ethhdr eth;
 609                 struct fip_header fip;
 610                 struct fip_encaps encaps;
 611         } __packed * cap;
 612         struct fc_frame_header *fh;
 613         struct fip_mac_desc *mac;
 614         struct fcoe_fcf *fcf;
 615         size_t dlen;
 616         u16 fip_flags;
 617         u8 op;
 618
 619         fh = (struct fc_frame_header *)skb->data;
 620         op = *(u8 *)(fh + 1);
 621         dlen = sizeof(struct fip_encaps) + skb->len;    /* len before push */
 622         cap = skb_push(skb, sizeof(*cap));
 623         memset(cap, 0, sizeof(*cap));
 624
 625         if (lport->point_to_multipoint) {
 626                 if (fcoe_ctlr_vn_lookup(fip, d_id, cap->eth.h_dest))
 627                         return -ENODEV;
 628                 fip_flags = 0;
 629         } else {
 630                 fcf = fip->sel_fcf;
 631                 if (!fcf)
 632                         return -ENODEV;
 633                 fip_flags = fcf->flags;
 634                 fip_flags &= fip->spma ? FIP_FL_SPMA | FIP_FL_FPMA :
 635                                          FIP_FL_FPMA;
 636                 if (!fip_flags)
 637                         return -ENODEV;
 638                 memcpy(cap->eth.h_dest, fcf->fcf_mac, ETH_ALEN);
 639         }
 640         memcpy(cap->eth.h_source, fip->ctl_src_addr, ETH_ALEN);
 641         cap->eth.h_proto = htons(ETH_P_FIP);
 642
 643         cap->fip.fip_ver = FIP_VER_ENCAPS(FIP_VER);
 644         cap->fip.fip_op = htons(FIP_OP_LS);
 645         if (op == ELS_LS_ACC || op == ELS_LS_RJT)
 646                 cap->fip.fip_subcode = FIP_SC_REP;
 647         else
 648                 cap->fip.fip_subcode = FIP_SC_REQ;
 649         cap->fip.fip_flags = htons(fip_flags);
 650
 651         cap->encaps.fd_desc.fip_dtype = dtype;
 652         cap->encaps.fd_desc.fip_dlen = dlen / FIP_BPW;
 653
 654         if (op != ELS_LS_RJT) {
 655                 dlen += sizeof(*mac);
 656                 mac = skb_put_zero(skb, sizeof(*mac));
 657                 mac->fd_desc.fip_dtype = FIP_DT_MAC;
 658                 mac->fd_desc.fip_dlen = sizeof(*mac) / FIP_BPW;
 659                 if (dtype != FIP_DT_FLOGI && dtype != FIP_DT_FDISC) {
 660                         memcpy(mac->fd_mac, fip->get_src_addr(lport), ETH_ALEN);
 661                 } else if (fip->mode == FIP_MODE_VN2VN) {
 662                         hton24(mac->fd_mac, FIP_VN_FC_MAP);
 663                         hton24(mac->fd_mac + 3, fip->port_id);
 664                 } else if (fip_flags & FIP_FL_SPMA) {
 665                         LIBFCOE_FIP_DBG(fip, "FLOGI/FDISC sent with SPMA\n");
 666                         memcpy(mac->fd_mac, fip->ctl_src_addr, ETH_ALEN);
 667                 } else {
 668                         LIBFCOE_FIP_DBG(fip, "FLOGI/FDISC sent with FPMA\n");
 669                         /* FPMA only FLOGI.  Must leave the MAC desc zeroed. */
 670                 }
 671         }
 672         cap->fip.fip_dl_len = htons(dlen / FIP_BPW);
 673
 674         skb->protocol = htons(ETH_P_FIP);
 675         skb->priority = fip->priority;
 676         skb_reset_mac_header(skb);
 677         skb_reset_network_header(skb);
 678         return 0;
 679 }
 680
 681 /**
 682  * fcoe_ctlr_els_send() - Send an ELS frame encapsulated by FIP if appropriate.
 683  * @fip:        FCoE controller.
 684  * @lport:      libfc fc_lport to send from
 685  * @skb:        FCoE ELS frame including FC header but no FCoE headers.
 686  *
 687  * Returns a non-zero error code if the frame should not be sent.
 688  * Returns zero if the caller should send the frame with FCoE encapsulation.
 689  *
 690  * The caller must check that the length is a multiple of 4.
 691  * The SKB must have enough headroom (28 bytes) and tailroom (8 bytes).
 692  * The the skb must also be an fc_frame.
 693  *
 694  * This is called from the lower-level driver with spinlocks held,
 695  * so we must not take a mutex here.
 696  */
 697 int fcoe_ctlr_els_send(struct fcoe_ctlr *fip, struct fc_lport *lport,
 698                        struct sk_buff *skb)
 699 {
 700         struct fc_frame *fp;
 701         struct fc_frame_header *fh;
 702         u16 old_xid;
 703         u8 op;
 704         u8 mac[ETH_ALEN];
 705
 706         fp = container_of(skb, struct fc_frame, skb);
 707         fh = (struct fc_frame_header *)skb->data;
 708         op = *(u8 *)(fh + 1);
 709
 710         if (op == ELS_FLOGI && fip->mode != FIP_MODE_VN2VN) {
 711                 old_xid = fip->flogi_oxid;
 712                 fip->flogi_oxid = ntohs(fh->fh_ox_id);
 713                 if (fip->state == FIP_ST_AUTO) {
 714                         if (old_xid == FC_XID_UNKNOWN)
 715                                 fip->flogi_count = 0;
 716                         fip->flogi_count++;
 717                         if (fip->flogi_count < 3)
 718                                 goto drop;
 719                         fcoe_ctlr_map_dest(fip);
 720                         return 0;
 721                 }
 722                 if (fip->state == FIP_ST_NON_FIP)
 723                         fcoe_ctlr_map_dest(fip);
 724         }
 725
 726         if (fip->state == FIP_ST_NON_FIP)
 727                 return 0;
 728         if (!fip->sel_fcf && fip->mode != FIP_MODE_VN2VN)
 729                 goto drop;
 730         switch (op) {
 731         case ELS_FLOGI:
 732                 op = FIP_DT_FLOGI;
 733                 if (fip->mode == FIP_MODE_VN2VN)
 734                         break;
 735                 spin_lock_bh(&fip->ctlr_lock);
 736                 kfree_skb(fip->flogi_req);
 737                 fip->flogi_req = skb;
 738                 fip->flogi_req_send = 1;
 739                 spin_unlock_bh(&fip->ctlr_lock);
 740                 schedule_work(&fip->timer_work);
 741                 return -EINPROGRESS;
 742         case ELS_FDISC:
 743                 if (ntoh24(fh->fh_s_id))
 744                         return 0;
 745                 op = FIP_DT_FDISC;
 746                 break;
 747         case ELS_LOGO:
 748                 if (fip->mode == FIP_MODE_VN2VN) {
 749                         if (fip->state != FIP_ST_VNMP_UP)
 750                                 goto drop;
 751                         if (ntoh24(fh->fh_d_id) == FC_FID_FLOGI)
 752                                 goto drop;
 753                 } else {
 754                         if (fip->state != FIP_ST_ENABLED)
 755                                 return 0;
 756                         if (ntoh24(fh->fh_d_id) != FC_FID_FLOGI)
 757                                 return 0;
 758                 }
 759                 op = FIP_DT_LOGO;
 760                 break;
 761         case ELS_LS_ACC:
 762                 /*
 763                  * If non-FIP, we may have gotten an SID by accepting an FLOGI
 764                  * from a point-to-point connection.  Switch to using
 765                  * the source mac based on the SID.  The destination
 766                  * MAC in this case would have been set by receiving the
 767                  * FLOGI.
 768                  */
 769                 if (fip->state == FIP_ST_NON_FIP) {
 770                         if (fip->flogi_oxid == FC_XID_UNKNOWN)
 771                                 return 0;
 772                         fip->flogi_oxid = FC_XID_UNKNOWN;
 773                         fc_fcoe_set_mac(mac, fh->fh_d_id);
 774                         fip->update_mac(lport, mac);
 775                 }
 776                 fallthrough;
 777         case ELS_LS_RJT:
 778                 op = fr_encaps(fp);
 779                 if (op)
 780                         break;
 781                 return 0;
 782         default:
 783                 if (fip->state != FIP_ST_ENABLED &&
 784                     fip->state != FIP_ST_VNMP_UP)
 785                         goto drop;
 786                 return 0;
 787         }
 788         LIBFCOE_FIP_DBG(fip, "els_send op %u d_id %x\n",
 789                         op, ntoh24(fh->fh_d_id));
 790         if (fcoe_ctlr_encaps(fip, lport, op, skb, ntoh24(fh->fh_d_id)))
 791                 goto drop;
 792         fip->send(fip, skb);
 793         return -EINPROGRESS;
 794 drop:
 795         LIBFCOE_FIP_DBG(fip, "drop els_send op %u d_id %x\n",
 796                         op, ntoh24(fh->fh_d_id));
 797         kfree_skb(skb);
 798         return -EINVAL;
 799 }
 800 EXPORT_SYMBOL(fcoe_ctlr_els_send);
 801
 802 /**
 803  * fcoe_ctlr_age_fcfs() - Reset and free all old FCFs for a controller
 804  * @fip: The FCoE controller to free FCFs on
 805  *
 806  * Called with lock held and preemption disabled.
 807  *
 808  * An FCF is considered old if we have missed two advertisements.
 809  * That is, there have been no valid advertisement from it for 2.5
 810  * times its keep-alive period.
 811  *
 812  * In addition, determine the time when an FCF selection can occur.
 813  *
 814  * Also, increment the MissDiscAdvCount when no advertisement is received
 815  * for the corresponding FCF for 1.5 * FKA_ADV_PERIOD (FC-BB-5 LESB).
 816  *
 817  * Returns the time in jiffies for the next call.
 818  */
 819 static unsigned long fcoe_ctlr_age_fcfs(struct fcoe_ctlr *fip)
 820 {
 821         struct fcoe_fcf *fcf;
 822         struct fcoe_fcf *next;
 823         unsigned long next_timer = jiffies + msecs_to_jiffies(FIP_VN_KA_PERIOD);
 824         unsigned long deadline;
 825         unsigned long sel_time = 0;
 826         struct list_head del_list;
 827
 828         INIT_LIST_HEAD(&del_list);
 829
 830         list_for_each_entry_safe(fcf, next, &fip->fcfs, list) {
 831                 deadline = fcf->time + fcf->fka_period + fcf->fka_period / 2;
 832                 if (fip->sel_fcf == fcf) {
 833                         if (time_after(jiffies, deadline)) {
 834                                 u64 miss_cnt;
 835
 836                                 miss_cnt = this_cpu_inc_return(fip->lp->stats->MissDiscAdvCount);
 837                                 printk(KERN_INFO "libfcoe: host%d: "
 838                                        "Missing Discovery Advertisement "
 839                                        "for fab %16.16llx count %lld\n",
 840                                        fip->lp->host->host_no, fcf->fabric_name,
 841                                        miss_cnt);
 842                         } else if (time_after(next_timer, deadline))
 843                                 next_timer = deadline;
 844                 }
 845
 846                 deadline += fcf->fka_period;
 847                 if (time_after_eq(jiffies, deadline)) {
 848                         if (fip->sel_fcf == fcf)
 849                                 fip->sel_fcf = NULL;
 850                         /*
 851                          * Move to delete list so we can call
 852                          * fcoe_sysfs_fcf_del (which can sleep)
 853                          * after the put_cpu().
 854                          */
 855                         list_del(&fcf->list);
 856                         list_add(&fcf->list, &del_list);
 857                         this_cpu_inc(fip->lp->stats->VLinkFailureCount);
 858                 } else {
 859                         if (time_after(next_timer, deadline))
 860                                 next_timer = deadline;
 861                         if (fcoe_ctlr_mtu_valid(fcf) &&
 862                             (!sel_time || time_before(sel_time, fcf->time)))
 863                                 sel_time = fcf->time;
 864                 }
 865         }
 866
 867         list_for_each_entry_safe(fcf, next, &del_list, list) {
 868                 /* Removes fcf from current list */
 869                 fcoe_sysfs_fcf_del(fcf);
 870         }
 871
 872         if (sel_time && !fip->sel_fcf && !fip->sel_time) {
 873                 sel_time += msecs_to_jiffies(FCOE_CTLR_START_DELAY);
 874                 fip->sel_time = sel_time;
 875         }
 876
 877         return next_timer;
 878 }
 879
 880 /**
 881  * fcoe_ctlr_parse_adv() - Decode a FIP advertisement into a new FCF entry
 882  * @fip: The FCoE controller receiving the advertisement
 883  * @skb: The received FIP advertisement frame
 884  * @fcf: The resulting FCF entry
 885  *
 886  * Returns zero on a valid parsed advertisement,
 887  * otherwise returns non zero value.
 888  */
 889 static int fcoe_ctlr_parse_adv(struct fcoe_ctlr *fip,
 890                                struct sk_buff *skb, struct fcoe_fcf *fcf)
 891 {
 892         struct fip_header *fiph;
 893         struct fip_desc *desc = NULL;
 894         struct fip_wwn_desc *wwn;
 895         struct fip_fab_desc *fab;
 896         struct fip_fka_desc *fka;
 897         unsigned long t;
 898         size_t rlen;
 899         size_t dlen;
 900         u32 desc_mask;
 901
 902         memset(fcf, 0, sizeof(*fcf));
 903         fcf->fka_period = msecs_to_jiffies(FCOE_CTLR_DEF_FKA);
 904
 905         fiph = (struct fip_header *)skb->data;
 906         fcf->flags = ntohs(fiph->fip_flags);
 907
 908         /*
 909          * mask of required descriptors. validating each one clears its bit.
 910          */
 911         desc_mask = BIT(FIP_DT_PRI) | BIT(FIP_DT_MAC) | BIT(FIP_DT_NAME) |
 912                         BIT(FIP_DT_FAB) | BIT(FIP_DT_FKA);
 913
 914         rlen = ntohs(fiph->fip_dl_len) * 4;
 915         if (rlen + sizeof(*fiph) > skb->len)
 916                 return -EINVAL;
 917
 918         desc = (struct fip_desc *)(fiph + 1);
 919         while (rlen > 0) {
 920                 dlen = desc->fip_dlen * FIP_BPW;
 921                 if (dlen < sizeof(*desc) || dlen > rlen)
 922                         return -EINVAL;
 923                 /* Drop Adv if there are duplicate critical descriptors */
 924                 if ((desc->fip_dtype < 32) &&
 925                     !(desc_mask & 1U << desc->fip_dtype)) {
 926                         LIBFCOE_FIP_DBG(fip, "Duplicate Critical "
 927                                         "Descriptors in FIP adv\n");
 928                         return -EINVAL;
 929                 }
 930                 switch (desc->fip_dtype) {
 931                 case FIP_DT_PRI:
 932                         if (dlen != sizeof(struct fip_pri_desc))
 933                                 goto len_err;
 934                         fcf->pri = ((struct fip_pri_desc *)desc)->fd_pri;
 935                         desc_mask &= ~BIT(FIP_DT_PRI);
 936                         break;
 937                 case FIP_DT_MAC:
 938                         if (dlen != sizeof(struct fip_mac_desc))
 939                                 goto len_err;
 940                         memcpy(fcf->fcf_mac,
 941                                ((struct fip_mac_desc *)desc)->fd_mac,
 942                                ETH_ALEN);
 943                         memcpy(fcf->fcoe_mac, fcf->fcf_mac, ETH_ALEN);
 944                         if (!is_valid_ether_addr(fcf->fcf_mac)) {
 945                                 LIBFCOE_FIP_DBG(fip,
 946                                         "Invalid MAC addr %pM in FIP adv\n",
 947                                         fcf->fcf_mac);
 948                                 return -EINVAL;
 949                         }
 950                         desc_mask &= ~BIT(FIP_DT_MAC);
 951                         break;
 952                 case FIP_DT_NAME:
 953                         if (dlen != sizeof(struct fip_wwn_desc))
 954                                 goto len_err;
 955                         wwn = (struct fip_wwn_desc *)desc;
 956                         fcf->switch_name = get_unaligned_be64(&wwn->fd_wwn);
 957                         desc_mask &= ~BIT(FIP_DT_NAME);
 958                         break;
 959                 case FIP_DT_FAB:
 960                         if (dlen != sizeof(struct fip_fab_desc))
 961                                 goto len_err;
 962                         fab = (struct fip_fab_desc *)desc;
 963                         fcf->fabric_name = get_unaligned_be64(&fab->fd_wwn);
 964                         fcf->vfid = ntohs(fab->fd_vfid);
 965                         fcf->fc_map = ntoh24(fab->fd_map);
 966                         desc_mask &= ~BIT(FIP_DT_FAB);
 967                         break;
 968                 case FIP_DT_FKA:
 969                         if (dlen != sizeof(struct fip_fka_desc))
 970                                 goto len_err;
 971                         fka = (struct fip_fka_desc *)desc;
 972                         if (fka->fd_flags & FIP_FKA_ADV_D)
 973                                 fcf->fd_flags = 1;
 974                         t = ntohl(fka->fd_fka_period);
 975                         if (t >= FCOE_CTLR_MIN_FKA)
 976                                 fcf->fka_period = msecs_to_jiffies(t);
 977                         desc_mask &= ~BIT(FIP_DT_FKA);
 978                         break;
 979                 case FIP_DT_MAP_OUI:
 980                 case FIP_DT_FCOE_SIZE:
 981                 case FIP_DT_FLOGI:
 982                 case FIP_DT_FDISC:
 983                 case FIP_DT_LOGO:
 984                 case FIP_DT_ELP:
 985                 default:
 986                         LIBFCOE_FIP_DBG(fip, "unexpected descriptor type %x "
 987                                         "in FIP adv\n", desc->fip_dtype);
 988                         /* standard says ignore unknown descriptors >= 128 */
 989                         if (desc->fip_dtype < FIP_DT_NON_CRITICAL)
 990                                 return -EINVAL;
 991                         break;
 992                 }
 993                 desc = (struct fip_desc *)((char *)desc + dlen);
 994                 rlen -= dlen;
 995         }
 996         if (!fcf->fc_map || (fcf->fc_map & 0x10000))
 997                 return -EINVAL;
 998         if (!fcf->switch_name)
 999                 return -EINVAL;
1000         if (desc_mask) {
1001                 LIBFCOE_FIP_DBG(fip, "adv missing descriptors mask %x\n",
1002                                 desc_mask);
1003                 return -EINVAL;
1004         }
1005         return 0;
1006
1007 len_err:
1008         LIBFCOE_FIP_DBG(fip, "FIP length error in descriptor type %x len %zu\n",
1009                         desc->fip_dtype, dlen);
1010         return -EINVAL;
1011 }
1012
1013 /**
1014  * fcoe_ctlr_recv_adv() - Handle an incoming advertisement
1015  * @fip: The FCoE controller receiving the advertisement
1016  * @skb: The received FIP packet
1017  */
1018 static void fcoe_ctlr_recv_adv(struct fcoe_ctlr *fip, struct sk_buff *skb)
1019 {
1020         struct fcoe_fcf *fcf;
1021         struct fcoe_fcf new;
1022         unsigned long sol_tov = msecs_to_jiffies(FCOE_CTLR_SOL_TOV);
1023         int first = 0;
1024         int mtu_valid;
1025         int found = 0;
1026         int rc = 0;
1027
1028         if (fcoe_ctlr_parse_adv(fip, skb, &new))
1029                 return;
1030
1031         mutex_lock(&fip->ctlr_mutex);
1032         first = list_empty(&fip->fcfs);
1033         list_for_each_entry(fcf, &fip->fcfs, list) {
1034                 if (fcf->switch_name == new.switch_name &&
1035                     fcf->fabric_name == new.fabric_name &&
1036                     fcf->fc_map == new.fc_map &&
1037                     ether_addr_equal(fcf->fcf_mac, new.fcf_mac)) {
1038                         found = 1;
1039                         break;
1040                 }
1041         }
1042         if (!found) {
1043                 if (fip->fcf_count >= FCOE_CTLR_FCF_LIMIT)
1044                         goto out;
1045
1046                 fcf = kmalloc(sizeof(*fcf), GFP_ATOMIC);
1047                 if (!fcf)
1048                         goto out;
1049
1050                 memcpy(fcf, &new, sizeof(new));
1051                 fcf->fip = fip;
1052                 rc = fcoe_sysfs_fcf_add(fcf);
1053                 if (rc) {
1054                         printk(KERN_ERR "Failed to allocate sysfs instance "
1055                                "for FCF, fab %16.16llx mac %pM\n",
1056                                new.fabric_name, new.fcf_mac);
1057                         kfree(fcf);
1058                         goto out;
1059                 }
1060         } else {
1061                 /*
1062                  * Update the FCF's keep-alive descriptor flags.
1063                  * Other flag changes from new advertisements are
1064                  * ignored after a solicited advertisement is
1065                  * received and the FCF is selectable (usable).
1066                  */
1067                 fcf->fd_flags = new.fd_flags;
1068                 if (!fcoe_ctlr_fcf_usable(fcf))
1069                         fcf->flags = new.flags;
1070
1071                 if (fcf == fip->sel_fcf && !fcf->fd_flags) {
1072                         fip->ctlr_ka_time -= fcf->fka_period;
1073                         fip->ctlr_ka_time += new.fka_period;
1074                         if (time_before(fip->ctlr_ka_time, fip->timer.expires))
1075                                 mod_timer(&fip->timer, fip->ctlr_ka_time);
1076                 }
1077                 fcf->fka_period = new.fka_period;
1078                 memcpy(fcf->fcf_mac, new.fcf_mac, ETH_ALEN);
1079         }
1080
1081         mtu_valid = fcoe_ctlr_mtu_valid(fcf);
1082         fcf->time = jiffies;
1083         if (!found)
1084                 LIBFCOE_FIP_DBG(fip, "New FCF fab %16.16llx mac %pM\n",
1085                                 fcf->fabric_name, fcf->fcf_mac);
1086
1087         /*
1088          * If this advertisement is not solicited and our max receive size
1089          * hasn't been verified, send a solicited advertisement.
1090          */
1091         if (!mtu_valid)
1092                 fcoe_ctlr_solicit(fip, fcf);
1093
1094         /*
1095          * If its been a while since we did a solicit, and this is
1096          * the first advertisement we've received, do a multicast
1097          * solicitation to gather as many advertisements as we can
1098          * before selection occurs.
1099          */
1100         if (first && time_after(jiffies, fip->sol_time + sol_tov))
1101                 fcoe_ctlr_solicit(fip, NULL);
1102
1103         /*
1104          * Put this FCF at the head of the list for priority among equals.
1105          * This helps in the case of an NPV switch which insists we use
1106          * the FCF that answers multicast solicitations, not the others that
1107          * are sending periodic multicast advertisements.
1108          */
1109         if (mtu_valid)
1110                 list_move(&fcf->list, &fip->fcfs);
1111
1112         /*
1113          * If this is the first validated FCF, note the time and
1114          * set a timer to trigger selection.
1115          */
1116         if (mtu_valid && !fip->sel_fcf && !fip->sel_time &&
1117             fcoe_ctlr_fcf_usable(fcf)) {
1118                 fip->sel_time = jiffies +
1119                         msecs_to_jiffies(FCOE_CTLR_START_DELAY);
1120                 if (!timer_pending(&fip->timer) ||
1121                     time_before(fip->sel_time, fip->timer.expires))
1122                         mod_timer(&fip->timer, fip->sel_time);
1123         }
1124
1125 out:
1126         mutex_unlock(&fip->ctlr_mutex);
1127 }
1128
1129 /**
1130  * fcoe_ctlr_recv_els() - Handle an incoming FIP encapsulated ELS frame
1131  * @fip: The FCoE controller which received the packet
1132  * @skb: The received FIP packet
1133  */
1134 static void fcoe_ctlr_recv_els(struct fcoe_ctlr *fip, struct sk_buff *skb)
1135 {
1136         struct fc_lport *lport = fip->lp;
1137         struct fip_header *fiph;
1138         struct fc_frame *fp = (struct fc_frame *)skb;
1139         struct fc_frame_header *fh = NULL;
1140         struct fip_desc *desc;
1141         struct fip_encaps *els;
1142         struct fcoe_fcf *sel;
1143         enum fip_desc_type els_dtype = 0;
1144         u8 els_op;
1145         u8 sub;
1146         u8 granted_mac[ETH_ALEN] = { 0 };
1147         size_t els_len = 0;
1148         size_t rlen;
1149         size_t dlen;
1150         u32 desc_mask = 0;
1151         u32 desc_cnt = 0;
1152
1153         fiph = (struct fip_header *)skb->data;
1154         sub = fiph->fip_subcode;
1155         if (sub != FIP_SC_REQ && sub != FIP_SC_REP)
1156                 goto drop;
1157
1158         rlen = ntohs(fiph->fip_dl_len) * 4;
1159         if (rlen + sizeof(*fiph) > skb->len)
1160                 goto drop;
1161
1162         desc = (struct fip_desc *)(fiph + 1);
1163         while (rlen > 0) {
1164                 desc_cnt++;
1165                 dlen = desc->fip_dlen * FIP_BPW;
1166                 if (dlen < sizeof(*desc) || dlen > rlen)
1167                         goto drop;
1168                 /* Drop ELS if there are duplicate critical descriptors */
1169                 if (desc->fip_dtype < 32) {
1170                         if ((desc->fip_dtype != FIP_DT_MAC) &&
1171                             (desc_mask & 1U << desc->fip_dtype)) {
1172                                 LIBFCOE_FIP_DBG(fip, "Duplicate Critical "
1173                                                 "Descriptors in FIP ELS\n");
1174                                 goto drop;
1175                         }
1176                         desc_mask |= (1 << desc->fip_dtype);
1177                 }
1178                 switch (desc->fip_dtype) {
1179                 case FIP_DT_MAC:
1180                         sel = fip->sel_fcf;
1181                         if (desc_cnt == 1) {
1182                                 LIBFCOE_FIP_DBG(fip, "FIP descriptors "
1183                                                 "received out of order\n");
1184                                 goto drop;
1185                         }
1186                         /*
1187                          * Some switch implementations send two MAC descriptors,
1188                          * with first MAC(granted_mac) being the FPMA, and the
1189                          * second one(fcoe_mac) is used as destination address
1190                          * for sending/receiving FCoE packets. FIP traffic is
1191                          * sent using fip_mac. For regular switches, both
1192                          * fip_mac and fcoe_mac would be the same.
1193                          */
1194                         if (desc_cnt == 2)
1195                                 memcpy(granted_mac,
1196                                        ((struct fip_mac_desc *)desc)->fd_mac,
1197                                        ETH_ALEN);
1198
1199                         if (dlen != sizeof(struct fip_mac_desc))
1200                                 goto len_err;
1201
1202                         if ((desc_cnt == 3) && (sel))
1203                                 memcpy(sel->fcoe_mac,
1204                                        ((struct fip_mac_desc *)desc)->fd_mac,
1205                                        ETH_ALEN);
1206                         break;
1207                 case FIP_DT_FLOGI:
1208                 case FIP_DT_FDISC:
1209                 case FIP_DT_LOGO:
1210                 case FIP_DT_ELP:
1211                         if (desc_cnt != 1) {
1212                                 LIBFCOE_FIP_DBG(fip, "FIP descriptors "
1213                                                 "received out of order\n");
1214                                 goto drop;
1215                         }
1216                         if (fh)
1217                                 goto drop;
1218                         if (dlen < sizeof(*els) + sizeof(*fh) + 1)
1219                                 goto len_err;
1220                         els_len = dlen - sizeof(*els);
1221                         els = (struct fip_encaps *)desc;
1222                         fh = (struct fc_frame_header *)(els + 1);
1223                         els_dtype = desc->fip_dtype;
1224                         break;
1225                 default:
1226                         LIBFCOE_FIP_DBG(fip, "unexpected descriptor type %x "
1227                                         "in FIP adv\n", desc->fip_dtype);
1228                         /* standard says ignore unknown descriptors >= 128 */
1229                         if (desc->fip_dtype < FIP_DT_NON_CRITICAL)
1230                                 goto drop;
1231                         if (desc_cnt <= 2) {
1232                                 LIBFCOE_FIP_DBG(fip, "FIP descriptors "
1233                                                 "received out of order\n");
1234                                 goto drop;
1235                         }
1236                         break;
1237                 }
1238                 desc = (struct fip_desc *)((char *)desc + dlen);
1239                 rlen -= dlen;
1240         }
1241
1242         if (!fh)
1243                 goto drop;
1244         els_op = *(u8 *)(fh + 1);
1245
1246         if ((els_dtype == FIP_DT_FLOGI || els_dtype == FIP_DT_FDISC) &&
1247             sub == FIP_SC_REP && fip->mode != FIP_MODE_VN2VN) {
1248                 if (els_op == ELS_LS_ACC) {
1249                         if (!is_valid_ether_addr(granted_mac)) {
1250                                 LIBFCOE_FIP_DBG(fip,
1251                                         "Invalid MAC address %pM in FIP ELS\n",
1252                                         granted_mac);
1253                                 goto drop;
1254                         }
1255                         memcpy(fr_cb(fp)->granted_mac, granted_mac, ETH_ALEN);
1256
1257                         if (fip->flogi_oxid == ntohs(fh->fh_ox_id)) {
1258                                 fip->flogi_oxid = FC_XID_UNKNOWN;
1259                                 if (els_dtype == FIP_DT_FLOGI)
1260                                         fcoe_ctlr_announce(fip);
1261                         }
1262                 } else if (els_dtype == FIP_DT_FLOGI &&
1263                            !fcoe_ctlr_flogi_retry(fip))
1264                         goto drop;      /* retrying FLOGI so drop reject */
1265         }
1266
1267         if ((desc_cnt == 0) || ((els_op != ELS_LS_RJT) &&
1268             (!(1U << FIP_DT_MAC & desc_mask)))) {
1269                 LIBFCOE_FIP_DBG(fip, "Missing critical descriptors "
1270                                 "in FIP ELS\n");
1271                 goto drop;
1272         }
1273
1274         /*
1275          * Convert skb into an fc_frame containing only the ELS.
1276          */
1277         skb_pull(skb, (u8 *)fh - skb->data);
1278         skb_trim(skb, els_len);
1279         fp = (struct fc_frame *)skb;
1280         fc_frame_init(fp);
1281         fr_sof(fp) = FC_SOF_I3;
1282         fr_eof(fp) = FC_EOF_T;
1283         fr_dev(fp) = lport;
1284         fr_encaps(fp) = els_dtype;
1285
1286         this_cpu_inc(lport->stats->RxFrames);
1287         this_cpu_add(lport->stats->RxWords, skb->len / FIP_BPW);
1288
1289         fc_exch_recv(lport, fp);
1290         return;
1291
1292 len_err:
1293         LIBFCOE_FIP_DBG(fip, "FIP length error in descriptor type %x len %zu\n",
1294                         desc->fip_dtype, dlen);
1295 drop:
1296         kfree_skb(skb);
1297 }
1298
1299 /**
1300  * fcoe_ctlr_recv_clr_vlink() - Handle an incoming link reset frame
1301  * @fip: The FCoE controller that received the frame
1302  * @skb: The received FIP packet
1303  *
1304  * There may be multiple VN_Port descriptors.
1305  * The overall length has already been checked.
1306  */
1307 static void fcoe_ctlr_recv_clr_vlink(struct fcoe_ctlr *fip,
1308                                      struct sk_buff *skb)
1309 {
1310         struct fip_desc *desc;
1311         struct fip_mac_desc *mp;
1312         struct fip_wwn_desc *wp;
1313         struct fip_vn_desc *vp;
1314         size_t rlen;
1315         size_t dlen;
1316         struct fcoe_fcf *fcf = fip->sel_fcf;
1317         struct fc_lport *lport = fip->lp;
1318         struct fc_lport *vn_port = NULL;
1319         u32 desc_mask;
1320         int num_vlink_desc;
1321         int reset_phys_port = 0;
1322         struct fip_vn_desc **vlink_desc_arr = NULL;
1323         struct fip_header *fh = (struct fip_header *)skb->data;
1324         struct ethhdr *eh = eth_hdr(skb);
1325
1326         LIBFCOE_FIP_DBG(fip, "Clear Virtual Link received\n");
1327
1328         if (!fcf) {
1329                 /*
1330                  * We are yet to select best FCF, but we got CVL in the
1331                  * meantime. reset the ctlr and let it rediscover the FCF
1332                  */
1333                 LIBFCOE_FIP_DBG(fip, "Resetting fcoe_ctlr as FCF has not been "
1334                     "selected yet\n");
1335                 mutex_lock(&fip->ctlr_mutex);
1336                 fcoe_ctlr_reset(fip);
1337                 mutex_unlock(&fip->ctlr_mutex);
1338                 return;
1339         }
1340
1341         /*
1342          * If we've selected an FCF check that the CVL is from there to avoid
1343          * processing CVLs from an unexpected source.  If it is from an
1344          * unexpected source drop it on the floor.
1345          */
1346         if (!ether_addr_equal(eh->h_source, fcf->fcf_mac)) {
1347                 LIBFCOE_FIP_DBG(fip, "Dropping CVL due to source address "
1348                     "mismatch with FCF src=%pM\n", eh->h_source);
1349                 return;
1350         }
1351
1352         /*
1353          * If we haven't logged into the fabric but receive a CVL we should
1354          * reset everything and go back to solicitation.
1355          */
1356         if (!lport->port_id) {
1357                 LIBFCOE_FIP_DBG(fip, "lport not logged in, resoliciting\n");
1358                 mutex_lock(&fip->ctlr_mutex);
1359                 fcoe_ctlr_reset(fip);
1360                 mutex_unlock(&fip->ctlr_mutex);
1361                 fc_lport_reset(fip->lp);
1362                 fcoe_ctlr_solicit(fip, NULL);
1363                 return;
1364         }
1365
1366         /*
1367          * mask of required descriptors.  Validating each one clears its bit.
1368          */
1369         desc_mask = BIT(FIP_DT_MAC) | BIT(FIP_DT_NAME);
1370
1371         rlen = ntohs(fh->fip_dl_len) * FIP_BPW;
1372         desc = (struct fip_desc *)(fh + 1);
1373
1374         /*
1375          * Actually need to subtract 'sizeof(*mp) - sizeof(*wp)' from 'rlen'
1376          * before determining max Vx_Port descriptor but a buggy FCF could have
1377          * omitted either or both MAC Address and Name Identifier descriptors
1378          */
1379         num_vlink_desc = rlen / sizeof(*vp);
1380         if (num_vlink_desc)
1381                 vlink_desc_arr = kmalloc_array(num_vlink_desc, sizeof(vp),
1382                                                GFP_ATOMIC);
1383         if (!vlink_desc_arr)
1384                 return;
1385         num_vlink_desc = 0;
1386
1387         while (rlen >= sizeof(*desc)) {
1388                 dlen = desc->fip_dlen * FIP_BPW;
1389                 if (dlen > rlen)
1390                         goto err;
1391                 /* Drop CVL if there are duplicate critical descriptors */
1392                 if ((desc->fip_dtype < 32) &&
1393                     (desc->fip_dtype != FIP_DT_VN_ID) &&
1394                     !(desc_mask & 1U << desc->fip_dtype)) {
1395                         LIBFCOE_FIP_DBG(fip, "Duplicate Critical "
1396                                         "Descriptors in FIP CVL\n");
1397                         goto err;
1398                 }
1399                 switch (desc->fip_dtype) {
1400                 case FIP_DT_MAC:
1401                         mp = (struct fip_mac_desc *)desc;
1402                         if (dlen < sizeof(*mp))
1403                                 goto err;
1404                         if (!ether_addr_equal(mp->fd_mac, fcf->fcf_mac))
1405                                 goto err;
1406                         desc_mask &= ~BIT(FIP_DT_MAC);
1407                         break;
1408                 case FIP_DT_NAME:
1409                         wp = (struct fip_wwn_desc *)desc;
1410                         if (dlen < sizeof(*wp))
1411                                 goto err;
1412                         if (get_unaligned_be64(&wp->fd_wwn) != fcf->switch_name)
1413                                 goto err;
1414                         desc_mask &= ~BIT(FIP_DT_NAME);
1415                         break;
1416                 case FIP_DT_VN_ID:
1417                         vp = (struct fip_vn_desc *)desc;
1418                         if (dlen < sizeof(*vp))
1419                                 goto err;
1420                         vlink_desc_arr[num_vlink_desc++] = vp;
1421                         vn_port = fc_vport_id_lookup(lport,
1422                                                       ntoh24(vp->fd_fc_id));
1423                         if (vn_port && (vn_port == lport)) {
1424                                 mutex_lock(&fip->ctlr_mutex);
1425                                 this_cpu_inc(lport->stats->VLinkFailureCount);
1426                                 fcoe_ctlr_reset(fip);
1427                                 mutex_unlock(&fip->ctlr_mutex);
1428                         }
1429                         break;
1430                 default:
1431                         /* standard says ignore unknown descriptors >= 128 */
1432                         if (desc->fip_dtype < FIP_DT_NON_CRITICAL)
1433                                 goto err;
1434                         break;
1435                 }
1436                 desc = (struct fip_desc *)((char *)desc + dlen);
1437                 rlen -= dlen;
1438         }
1439
1440         /*
1441          * reset only if all required descriptors were present and valid.
1442          */
1443         if (desc_mask)
1444                 LIBFCOE_FIP_DBG(fip, "missing descriptors mask %x\n",
1445                                 desc_mask);
1446         else if (!num_vlink_desc) {
1447                 LIBFCOE_FIP_DBG(fip, "CVL: no Vx_Port descriptor found\n");
1448                 /*
1449                  * No Vx_Port description. Clear all NPIV ports,
1450                  * followed by physical port
1451                  */
1452                 mutex_lock(&fip->ctlr_mutex);
1453                 this_cpu_inc(lport->stats->VLinkFailureCount);
1454                 fcoe_ctlr_reset(fip);
1455                 mutex_unlock(&fip->ctlr_mutex);
1456
1457                 mutex_lock(&lport->lp_mutex);
1458                 list_for_each_entry(vn_port, &lport->vports, list)
1459                         fc_lport_reset(vn_port);
1460                 mutex_unlock(&lport->lp_mutex);
1461
1462                 fc_lport_reset(fip->lp);
1463                 fcoe_ctlr_solicit(fip, NULL);
1464         } else {
1465                 int i;
1466
1467                 LIBFCOE_FIP_DBG(fip, "performing Clear Virtual Link\n");
1468                 for (i = 0; i < num_vlink_desc; i++) {
1469                         vp = vlink_desc_arr[i];
1470                         vn_port = fc_vport_id_lookup(lport,
1471                                                      ntoh24(vp->fd_fc_id));
1472                         if (!vn_port)
1473                                 continue;
1474
1475                         /*
1476                          * 'port_id' is already validated, check MAC address and
1477                          * wwpn
1478                          */
1479                         if (!ether_addr_equal(fip->get_src_addr(vn_port),
1480                                               vp->fd_mac) ||
1481                                 get_unaligned_be64(&vp->fd_wwpn) !=
1482                                                         vn_port->wwpn)
1483                                 continue;
1484
1485                         if (vn_port == lport)
1486                                 /*
1487                                  * Physical port, defer processing till all
1488                                  * listed NPIV ports are cleared
1489                                  */
1490                                 reset_phys_port = 1;
1491                         else    /* NPIV port */
1492                                 fc_lport_reset(vn_port);
1493                 }
1494
1495                 if (reset_phys_port) {
1496                         fc_lport_reset(fip->lp);
1497                         fcoe_ctlr_solicit(fip, NULL);
1498                 }
1499         }
1500
1501 err:
1502         kfree(vlink_desc_arr);
1503 }
1504
1505 /**
1506  * fcoe_ctlr_recv() - Receive a FIP packet
1507  * @fip: The FCoE controller that received the packet
1508  * @skb: The received FIP packet
1509  *
1510  * This may be called from either NET_RX_SOFTIRQ or IRQ.
1511  */
1512 void fcoe_ctlr_recv(struct fcoe_ctlr *fip, struct sk_buff *skb)
1513 {
1514         skb = skb_share_check(skb, GFP_ATOMIC);
1515         if (!skb)
1516                 return;
1517         skb_queue_tail(&fip->fip_recv_list, skb);
1518         schedule_work(&fip->recv_work);
1519 }
1520 EXPORT_SYMBOL(fcoe_ctlr_recv);
1521
1522 /**
1523  * fcoe_ctlr_recv_handler() - Receive a FIP frame
1524  * @fip: The FCoE controller that received the frame
1525  * @skb: The received FIP frame
1526  *
1527  * Returns non-zero if the frame is dropped.
1528  */
1529 static int fcoe_ctlr_recv_handler(struct fcoe_ctlr *fip, struct sk_buff *skb)
1530 {
1531         struct fip_header *fiph;
1532         struct ethhdr *eh;
1533         enum fip_state state;
1534         bool fip_vlan_resp = false;
1535         u16 op;
1536         u8 sub;
1537
1538         if (skb_linearize(skb))
1539                 goto drop;
1540         if (skb->len < sizeof(*fiph))
1541                 goto drop;
1542         eh = eth_hdr(skb);
1543         if (fip->mode == FIP_MODE_VN2VN) {
1544                 if (!ether_addr_equal(eh->h_dest, fip->ctl_src_addr) &&
1545                     !ether_addr_equal(eh->h_dest, fcoe_all_vn2vn) &&
1546                     !ether_addr_equal(eh->h_dest, fcoe_all_p2p))
1547                         goto drop;
1548         } else if (!ether_addr_equal(eh->h_dest, fip->ctl_src_addr) &&
1549                    !ether_addr_equal(eh->h_dest, fcoe_all_enode))
1550                 goto drop;
1551         fiph = (struct fip_header *)skb->data;
1552         op = ntohs(fiph->fip_op);
1553         sub = fiph->fip_subcode;
1554
1555         if (FIP_VER_DECAPS(fiph->fip_ver) != FIP_VER)
1556                 goto drop;
1557         if (ntohs(fiph->fip_dl_len) * FIP_BPW + sizeof(*fiph) > skb->len)
1558                 goto drop;
1559
1560         mutex_lock(&fip->ctlr_mutex);
1561         state = fip->state;
1562         if (state == FIP_ST_AUTO) {
1563                 fip->map_dest = 0;
1564                 fcoe_ctlr_set_state(fip, FIP_ST_ENABLED);
1565                 state = FIP_ST_ENABLED;
1566                 LIBFCOE_FIP_DBG(fip, "Using FIP mode\n");
1567         }
1568         fip_vlan_resp = fip->fip_resp;
1569         mutex_unlock(&fip->ctlr_mutex);
1570
1571         if (fip->mode == FIP_MODE_VN2VN && op == FIP_OP_VN2VN)
1572                 return fcoe_ctlr_vn_recv(fip, skb);
1573
1574         if (fip_vlan_resp && op == FIP_OP_VLAN) {
1575                 LIBFCOE_FIP_DBG(fip, "fip vlan discovery\n");
1576                 return fcoe_ctlr_vlan_recv(fip, skb);
1577         }
1578
1579         if (state != FIP_ST_ENABLED && state != FIP_ST_VNMP_UP &&
1580             state != FIP_ST_VNMP_CLAIM)
1581                 goto drop;
1582
1583         if (op == FIP_OP_LS) {
1584                 fcoe_ctlr_recv_els(fip, skb);   /* consumes skb */
1585                 return 0;
1586         }
1587
1588         if (state != FIP_ST_ENABLED)
1589                 goto drop;
1590
1591         if (op == FIP_OP_DISC && sub == FIP_SC_ADV)
1592                 fcoe_ctlr_recv_adv(fip, skb);
1593         else if (op == FIP_OP_CTRL && sub == FIP_SC_CLR_VLINK)
1594                 fcoe_ctlr_recv_clr_vlink(fip, skb);
1595         kfree_skb(skb);
1596         return 0;
1597 drop:
1598         kfree_skb(skb);
1599         return -1;
1600 }
1601
1602 /**
1603  * fcoe_ctlr_select() - Select the best FCF (if possible)
1604  * @fip: The FCoE controller
1605  *
1606  * Returns the selected FCF, or NULL if none are usable.
1607  *
1608  * If there are conflicting advertisements, no FCF can be chosen.
1609  *
1610  * If there is already a selected FCF, this will choose a better one or
1611  * an equivalent one that hasn't already been sent a FLOGI.
1612  *
1613  * Called with lock held.
1614  */
1615 static struct fcoe_fcf *fcoe_ctlr_select(struct fcoe_ctlr *fip)
1616 {
1617         struct fcoe_fcf *fcf;
1618         struct fcoe_fcf *best = fip->sel_fcf;
1619
1620         list_for_each_entry(fcf, &fip->fcfs, list) {
1621                 LIBFCOE_FIP_DBG(fip, "consider FCF fab %16.16llx "
1622                                 "VFID %d mac %pM map %x val %d "
1623                                 "sent %u pri %u\n",
1624                                 fcf->fabric_name, fcf->vfid, fcf->fcf_mac,
1625                                 fcf->fc_map, fcoe_ctlr_mtu_valid(fcf),
1626                                 fcf->flogi_sent, fcf->pri);
1627                 if (!fcoe_ctlr_fcf_usable(fcf)) {
1628                         LIBFCOE_FIP_DBG(fip, "FCF for fab %16.16llx "
1629                                         "map %x %svalid %savailable\n",
1630                                         fcf->fabric_name, fcf->fc_map,
1631                                         (fcf->flags & FIP_FL_SOL) ? "" : "in",
1632                                         (fcf->flags & FIP_FL_AVAIL) ?
1633                                         "" : "un");
1634                         continue;
1635                 }
1636                 if (!best || fcf->pri < best->pri || best->flogi_sent)
1637                         best = fcf;
1638                 if (fcf->fabric_name != best->fabric_name ||
1639                     fcf->vfid != best->vfid ||
1640                     fcf->fc_map != best->fc_map) {
1641                         LIBFCOE_FIP_DBG(fip, "Conflicting fabric, VFID, "
1642                                         "or FC-MAP\n");
1643                         return NULL;
1644                 }
1645         }
1646         fip->sel_fcf = best;
1647         if (best) {
1648                 LIBFCOE_FIP_DBG(fip, "using FCF mac %pM\n", best->fcf_mac);
1649                 fip->port_ka_time = jiffies +
1650                         msecs_to_jiffies(FIP_VN_KA_PERIOD);
1651                 fip->ctlr_ka_time = jiffies + best->fka_period;
1652                 if (time_before(fip->ctlr_ka_time, fip->timer.expires))
1653                         mod_timer(&fip->timer, fip->ctlr_ka_time);
1654         }
1655         return best;
1656 }
1657
1658 /**
1659  * fcoe_ctlr_flogi_send_locked() - send FIP-encapsulated FLOGI to current FCF
1660  * @fip: The FCoE controller
1661  *
1662  * Returns non-zero error if it could not be sent.
1663  *
1664  * Called with ctlr_mutex and ctlr_lock held.
1665  * Caller must verify that fip->sel_fcf is not NULL.
1666  */
1667 static int fcoe_ctlr_flogi_send_locked(struct fcoe_ctlr *fip)
1668 {
1669         struct sk_buff *skb;
1670         struct sk_buff *skb_orig;
1671         struct fc_frame_header *fh;
1672         int error;
1673
1674         skb_orig = fip->flogi_req;
1675         if (!skb_orig)
1676                 return -EINVAL;
1677
1678         /*
1679          * Clone and send the FLOGI request.  If clone fails, use original.
1680          */
1681         skb = skb_clone(skb_orig, GFP_ATOMIC);
1682         if (!skb) {
1683                 skb = skb_orig;
1684                 fip->flogi_req = NULL;
1685         }
1686         fh = (struct fc_frame_header *)skb->data;
1687         error = fcoe_ctlr_encaps(fip, fip->lp, FIP_DT_FLOGI, skb,
1688                                  ntoh24(fh->fh_d_id));
1689         if (error) {
1690                 kfree_skb(skb);
1691                 return error;
1692         }
1693         fip->send(fip, skb);
1694         fip->sel_fcf->flogi_sent = 1;
1695         return 0;
1696 }
1697
1698 /**
1699  * fcoe_ctlr_flogi_retry() - resend FLOGI request to a new FCF if possible
1700  * @fip: The FCoE controller
1701  *
1702  * Returns non-zero error code if there's no FLOGI request to retry or
1703  * no alternate FCF available.
1704  */
1705 static int fcoe_ctlr_flogi_retry(struct fcoe_ctlr *fip)
1706 {
1707         struct fcoe_fcf *fcf;
1708         int error;
1709
1710         mutex_lock(&fip->ctlr_mutex);
1711         spin_lock_bh(&fip->ctlr_lock);
1712         LIBFCOE_FIP_DBG(fip, "re-sending FLOGI - reselect\n");
1713         fcf = fcoe_ctlr_select(fip);
1714         if (!fcf || fcf->flogi_sent) {
1715                 kfree_skb(fip->flogi_req);
1716                 fip->flogi_req = NULL;
1717                 error = -ENOENT;
1718         } else {
1719                 fcoe_ctlr_solicit(fip, NULL);
1720                 error = fcoe_ctlr_flogi_send_locked(fip);
1721         }
1722         spin_unlock_bh(&fip->ctlr_lock);
1723         mutex_unlock(&fip->ctlr_mutex);
1724         return error;
1725 }
1726
1727
1728 /**
1729  * fcoe_ctlr_flogi_send() - Handle sending of FIP FLOGI.
1730  * @fip: The FCoE controller that timed out
1731  *
1732  * Done here because fcoe_ctlr_els_send() can't get mutex.
1733  *
1734  * Called with ctlr_mutex held.  The caller must not hold ctlr_lock.
1735  */
1736 static void fcoe_ctlr_flogi_send(struct fcoe_ctlr *fip)
1737 {
1738         struct fcoe_fcf *fcf;
1739
1740         spin_lock_bh(&fip->ctlr_lock);
1741         fcf = fip->sel_fcf;
1742         if (!fcf || !fip->flogi_req_send)
1743                 goto unlock;
1744
1745         LIBFCOE_FIP_DBG(fip, "sending FLOGI\n");
1746
1747         /*
1748          * If this FLOGI is being sent due to a timeout retry
1749          * to the same FCF as before, select a different FCF if possible.
1750          */
1751         if (fcf->flogi_sent) {
1752                 LIBFCOE_FIP_DBG(fip, "sending FLOGI - reselect\n");
1753                 fcf = fcoe_ctlr_select(fip);
1754                 if (!fcf || fcf->flogi_sent) {
1755                         LIBFCOE_FIP_DBG(fip, "sending FLOGI - clearing\n");
1756                         list_for_each_entry(fcf, &fip->fcfs, list)
1757                                 fcf->flogi_sent = 0;
1758                         fcf = fcoe_ctlr_select(fip);
1759                 }
1760         }
1761         if (fcf) {
1762                 fcoe_ctlr_flogi_send_locked(fip);
1763                 fip->flogi_req_send = 0;
1764         } else /* XXX */
1765                 LIBFCOE_FIP_DBG(fip, "No FCF selected - defer send\n");
1766 unlock:
1767         spin_unlock_bh(&fip->ctlr_lock);
1768 }
1769
1770 /**
1771  * fcoe_ctlr_timeout() - FIP timeout handler
1772  * @t: Timer context use to obtain the controller reference
1773  */
1774 static void fcoe_ctlr_timeout(struct timer_list *t)
1775 {
1776         struct fcoe_ctlr *fip = from_timer(fip, t, timer);
1777
1778         schedule_work(&fip->timer_work);
1779 }
1780
1781 /**
1782  * fcoe_ctlr_timer_work() - Worker thread function for timer work
1783  * @work: Handle to a FCoE controller
1784  *
1785  * Ages FCFs.  Triggers FCF selection if possible.
1786  * Sends keep-alives and resets.
1787  */
1788 static void fcoe_ctlr_timer_work(struct work_struct *work)
1789 {
1790         struct fcoe_ctlr *fip;
1791         struct fc_lport *vport;
1792         u8 *mac;
1793         u8 reset = 0;
1794         u8 send_ctlr_ka = 0;
1795         u8 send_port_ka = 0;
1796         struct fcoe_fcf *sel;
1797         struct fcoe_fcf *fcf;
1798         unsigned long next_timer;
1799
1800         fip = container_of(work, struct fcoe_ctlr, timer_work);
1801         if (fip->mode == FIP_MODE_VN2VN)
1802                 return fcoe_ctlr_vn_timeout(fip);
1803         mutex_lock(&fip->ctlr_mutex);
1804         if (fip->state == FIP_ST_DISABLED) {
1805                 mutex_unlock(&fip->ctlr_mutex);
1806                 return;
1807         }
1808
1809         fcf = fip->sel_fcf;
1810         next_timer = fcoe_ctlr_age_fcfs(fip);
1811
1812         sel = fip->sel_fcf;
1813         if (!sel && fip->sel_time) {
1814                 if (time_after_eq(jiffies, fip->sel_time)) {
1815                         sel = fcoe_ctlr_select(fip);
1816                         fip->sel_time = 0;
1817                 } else if (time_after(next_timer, fip->sel_time))
1818                         next_timer = fip->sel_time;
1819         }
1820
1821         if (sel && fip->flogi_req_send)
1822                 fcoe_ctlr_flogi_send(fip);
1823         else if (!sel && fcf)
1824                 reset = 1;
1825
1826         if (sel && !sel->fd_flags) {
1827                 if (time_after_eq(jiffies, fip->ctlr_ka_time)) {
1828                         fip->ctlr_ka_time = jiffies + sel->fka_period;
1829                         send_ctlr_ka = 1;
1830                 }
1831                 if (time_after(next_timer, fip->ctlr_ka_time))
1832                         next_timer = fip->ctlr_ka_time;
1833
1834                 if (time_after_eq(jiffies, fip->port_ka_time)) {
1835                         fip->port_ka_time = jiffies +
1836                                 msecs_to_jiffies(FIP_VN_KA_PERIOD);
1837                         send_port_ka = 1;
1838                 }
1839                 if (time_after(next_timer, fip->port_ka_time))
1840                         next_timer = fip->port_ka_time;
1841         }
1842         if (!list_empty(&fip->fcfs))
1843                 mod_timer(&fip->timer, next_timer);
1844         mutex_unlock(&fip->ctlr_mutex);
1845
1846         if (reset) {
1847                 fc_lport_reset(fip->lp);
1848                 /* restart things with a solicitation */
1849                 fcoe_ctlr_solicit(fip, NULL);
1850         }
1851
1852         if (send_ctlr_ka)
1853                 fcoe_ctlr_send_keep_alive(fip, NULL, 0, fip->ctl_src_addr);
1854
1855         if (send_port_ka) {
1856                 mutex_lock(&fip->lp->lp_mutex);
1857                 mac = fip->get_src_addr(fip->lp);
1858                 fcoe_ctlr_send_keep_alive(fip, fip->lp, 1, mac);
1859                 list_for_each_entry(vport, &fip->lp->vports, list) {
1860                         mac = fip->get_src_addr(vport);
1861                         fcoe_ctlr_send_keep_alive(fip, vport, 1, mac);
1862                 }
1863                 mutex_unlock(&fip->lp->lp_mutex);
1864         }
1865 }
1866
1867 /**
1868  * fcoe_ctlr_recv_work() - Worker thread function for receiving FIP frames
1869  * @recv_work: Handle to a FCoE controller
1870  */
1871 static void fcoe_ctlr_recv_work(struct work_struct *recv_work)
1872 {
1873         struct fcoe_ctlr *fip;
1874         struct sk_buff *skb;
1875
1876         fip = container_of(recv_work, struct fcoe_ctlr, recv_work);
1877         while ((skb = skb_dequeue(&fip->fip_recv_list)))
1878                 fcoe_ctlr_recv_handler(fip, skb);
1879 }
1880
1881 /**
1882  * fcoe_ctlr_recv_flogi() - Snoop pre-FIP receipt of FLOGI response
1883  * @fip: The FCoE controller
1884  * @lport: The local port
1885  * @fp:  The FC frame to snoop
1886  *
1887  * Snoop potential response to FLOGI or even incoming FLOGI.
1888  *
1889  * The caller has checked that we are waiting for login as indicated
1890  * by fip->flogi_oxid != FC_XID_UNKNOWN.
1891  *
1892  * The caller is responsible for freeing the frame.
1893  * Fill in the granted_mac address.
1894  *
1895  * Return non-zero if the frame should not be delivered to libfc.
1896  */
1897 int fcoe_ctlr_recv_flogi(struct fcoe_ctlr *fip, struct fc_lport *lport,
1898                          struct fc_frame *fp)
1899 {
1900         struct fc_frame_header *fh;
1901         u8 op;
1902         u8 *sa;
1903
1904         sa = eth_hdr(&fp->skb)->h_source;
1905         fh = fc_frame_header_get(fp);
1906         if (fh->fh_type != FC_TYPE_ELS)
1907                 return 0;
1908
1909         op = fc_frame_payload_op(fp);
1910         if (op == ELS_LS_ACC && fh->fh_r_ctl == FC_RCTL_ELS_REP &&
1911             fip->flogi_oxid == ntohs(fh->fh_ox_id)) {
1912
1913                 mutex_lock(&fip->ctlr_mutex);
1914                 if (fip->state != FIP_ST_AUTO && fip->state != FIP_ST_NON_FIP) {
1915                         mutex_unlock(&fip->ctlr_mutex);
1916                         return -EINVAL;
1917                 }
1918                 fcoe_ctlr_set_state(fip, FIP_ST_NON_FIP);
1919                 LIBFCOE_FIP_DBG(fip,
1920                                 "received FLOGI LS_ACC using non-FIP mode\n");
1921
1922                 /*
1923                  * FLOGI accepted.
1924                  * If the src mac addr is FC_OUI-based, then we mark the
1925                  * address_mode flag to use FC_OUI-based Ethernet DA.
1926                  * Otherwise we use the FCoE gateway addr
1927                  */
1928                 if (ether_addr_equal(sa, (u8[6])FC_FCOE_FLOGI_MAC)) {
1929                         fcoe_ctlr_map_dest(fip);
1930                 } else {
1931                         memcpy(fip->dest_addr, sa, ETH_ALEN);
1932                         fip->map_dest = 0;
1933                 }
1934                 fip->flogi_oxid = FC_XID_UNKNOWN;
1935                 mutex_unlock(&fip->ctlr_mutex);
1936                 fc_fcoe_set_mac(fr_cb(fp)->granted_mac, fh->fh_d_id);
1937         } else if (op == ELS_FLOGI && fh->fh_r_ctl == FC_RCTL_ELS_REQ && sa) {
1938                 /*
1939                  * Save source MAC for point-to-point responses.
1940                  */
1941                 mutex_lock(&fip->ctlr_mutex);
1942                 if (fip->state == FIP_ST_AUTO || fip->state == FIP_ST_NON_FIP) {
1943                         memcpy(fip->dest_addr, sa, ETH_ALEN);
1944                         fip->map_dest = 0;
1945                         if (fip->state == FIP_ST_AUTO)
1946                                 LIBFCOE_FIP_DBG(fip, "received non-FIP FLOGI. "
1947                                                 "Setting non-FIP mode\n");
1948                         fcoe_ctlr_set_state(fip, FIP_ST_NON_FIP);
1949                 }
1950                 mutex_unlock(&fip->ctlr_mutex);
1951         }
1952         return 0;
1953 }
1954 EXPORT_SYMBOL(fcoe_ctlr_recv_flogi);
1955
1956 /**
1957  * fcoe_wwn_from_mac() - Converts a 48-bit IEEE MAC address to a 64-bit FC WWN
1958  * @mac:    The MAC address to convert
1959  * @scheme: The scheme to use when converting
1960  * @port:   The port indicator for converting
1961  *
1962  * Returns: u64 fc world wide name
1963  */
1964 u64 fcoe_wwn_from_mac(unsigned char mac[ETH_ALEN],
1965                       unsigned int scheme, unsigned int port)
1966 {
1967         u64 wwn;
1968         u64 host_mac;
1969
1970         /* The MAC is in NO, so flip only the low 48 bits */
1971         host_mac = ((u64) mac[0] << 40) |
1972                 ((u64) mac[1] << 32) |
1973                 ((u64) mac[2] << 24) |
1974                 ((u64) mac[3] << 16) |
1975                 ((u64) mac[4] << 8) |
1976                 (u64) mac[5];
1977
1978         WARN_ON(host_mac >= (1ULL << 48));
1979         wwn = host_mac | ((u64) scheme << 60);
1980         switch (scheme) {
1981         case 1:
1982                 WARN_ON(port != 0);
1983                 break;
1984         case 2:
1985                 WARN_ON(port >= 0xfff);
1986                 wwn |= (u64) port << 48;
1987                 break;
1988         default:
1989                 WARN_ON(1);
1990                 break;
1991         }
1992
1993         return wwn;
1994 }
1995 EXPORT_SYMBOL_GPL(fcoe_wwn_from_mac);
1996
1997 /**
1998  * fcoe_ctlr_rport() - return the fcoe_rport for a given fc_rport_priv
1999  * @rdata: libfc remote port
2000  */
2001 static inline struct fcoe_rport *fcoe_ctlr_rport(struct fc_rport_priv *rdata)
2002 {
2003         return container_of(rdata, struct fcoe_rport, rdata);
2004 }
2005
2006 /**
2007  * fcoe_ctlr_vn_send() - Send a FIP VN2VN Probe Request or Reply.
2008  * @fip: The FCoE controller
2009  * @sub: sub-opcode for probe request, reply, or advertisement.
2010  * @dest: The destination Ethernet MAC address
2011  * @min_len: minimum size of the Ethernet payload to be sent
2012  */
2013 static void fcoe_ctlr_vn_send(struct fcoe_ctlr *fip,
2014                               enum fip_vn2vn_subcode sub,
2015                               const u8 *dest, size_t min_len)
2016 {
2017         struct sk_buff *skb;
2018         struct fip_vn2vn_probe_frame {
2019                 struct ethhdr eth;
2020                 struct fip_header fip;
2021                 struct fip_mac_desc mac;
2022                 struct fip_wwn_desc wwnn;
2023                 struct fip_vn_desc vn;
2024         } __packed * frame;
2025         struct fip_fc4_feat *ff;
2026         struct fip_size_desc *size;
2027         u32 fcp_feat;
2028         size_t len;
2029         size_t dlen;
2030
2031         len = sizeof(*frame);
2032         dlen = 0;
2033         if (sub == FIP_SC_VN_CLAIM_NOTIFY || sub == FIP_SC_VN_CLAIM_REP) {
2034                 dlen = sizeof(struct fip_fc4_feat) +
2035                        sizeof(struct fip_size_desc);
2036                 len += dlen;
2037         }
2038         dlen += sizeof(frame->mac) + sizeof(frame->wwnn) + sizeof(frame->vn);
2039         len = max(len, min_len + sizeof(struct ethhdr));
2040
2041         skb = dev_alloc_skb(len);
2042         if (!skb)
2043                 return;
2044
2045         frame = (struct fip_vn2vn_probe_frame *)skb->data;
2046         memset(frame, 0, len);
2047         memcpy(frame->eth.h_dest, dest, ETH_ALEN);
2048
2049         if (sub == FIP_SC_VN_BEACON) {
2050                 hton24(frame->eth.h_source, FIP_VN_FC_MAP);
2051                 hton24(frame->eth.h_source + 3, fip->port_id);
2052         } else {
2053                 memcpy(frame->eth.h_source, fip->ctl_src_addr, ETH_ALEN);
2054         }
2055         frame->eth.h_proto = htons(ETH_P_FIP);
2056
2057         frame->fip.fip_ver = FIP_VER_ENCAPS(FIP_VER);
2058         frame->fip.fip_op = htons(FIP_OP_VN2VN);
2059         frame->fip.fip_subcode = sub;
2060         frame->fip.fip_dl_len = htons(dlen / FIP_BPW);
2061
2062         frame->mac.fd_desc.fip_dtype = FIP_DT_MAC;
2063         frame->mac.fd_desc.fip_dlen = sizeof(frame->mac) / FIP_BPW;
2064         memcpy(frame->mac.fd_mac, fip->ctl_src_addr, ETH_ALEN);
2065
2066         frame->wwnn.fd_desc.fip_dtype = FIP_DT_NAME;
2067         frame->wwnn.fd_desc.fip_dlen = sizeof(frame->wwnn) / FIP_BPW;
2068         put_unaligned_be64(fip->lp->wwnn, &frame->wwnn.fd_wwn);
2069
2070         frame->vn.fd_desc.fip_dtype = FIP_DT_VN_ID;
2071         frame->vn.fd_desc.fip_dlen = sizeof(frame->vn) / FIP_BPW;
2072         hton24(frame->vn.fd_mac, FIP_VN_FC_MAP);
2073         hton24(frame->vn.fd_mac + 3, fip->port_id);
2074         hton24(frame->vn.fd_fc_id, fip->port_id);
2075         put_unaligned_be64(fip->lp->wwpn, &frame->vn.fd_wwpn);
2076
2077         /*
2078          * For claims, add FC-4 features.
2079          * TBD: Add interface to get fc-4 types and features from libfc.
2080          */
2081         if (sub == FIP_SC_VN_CLAIM_NOTIFY || sub == FIP_SC_VN_CLAIM_REP) {
2082                 ff = (struct fip_fc4_feat *)(frame + 1);
2083                 ff->fd_desc.fip_dtype = FIP_DT_FC4F;
2084                 ff->fd_desc.fip_dlen = sizeof(*ff) / FIP_BPW;
2085                 ff->fd_fts = fip->lp->fcts;
2086
2087                 fcp_feat = 0;
2088                 if (fip->lp->service_params & FCP_SPPF_INIT_FCN)
2089                         fcp_feat |= FCP_FEAT_INIT;
2090                 if (fip->lp->service_params & FCP_SPPF_TARG_FCN)
2091                         fcp_feat |= FCP_FEAT_TARG;
2092                 fcp_feat <<= (FC_TYPE_FCP * 4) % 32;
2093                 ff->fd_ff.fd_feat[FC_TYPE_FCP * 4 / 32] = htonl(fcp_feat);
2094
2095                 size = (struct fip_size_desc *)(ff + 1);
2096                 size->fd_desc.fip_dtype = FIP_DT_FCOE_SIZE;
2097                 size->fd_desc.fip_dlen = sizeof(*size) / FIP_BPW;
2098                 size->fd_size = htons(fcoe_ctlr_fcoe_size(fip));
2099         }
2100
2101         skb_put(skb, len);
2102         skb->protocol = htons(ETH_P_FIP);
2103         skb->priority = fip->priority;
2104         skb_reset_mac_header(skb);
2105         skb_reset_network_header(skb);
2106
2107         fip->send(fip, skb);
2108 }
2109
2110 /**
2111  * fcoe_ctlr_vn_rport_callback - Event handler for rport events.
2112  * @lport: The lport which is receiving the event
2113  * @rdata: remote port private data
2114  * @event: The event that occurred
2115  *
2116  * Locking Note:  The rport lock must not be held when calling this function.
2117  */
2118 static void fcoe_ctlr_vn_rport_callback(struct fc_lport *lport,
2119                                         struct fc_rport_priv *rdata,
2120                                         enum fc_rport_event event)
2121 {
2122         struct fcoe_ctlr *fip = lport->disc.priv;
2123         struct fcoe_rport *frport = fcoe_ctlr_rport(rdata);
2124
2125         LIBFCOE_FIP_DBG(fip, "vn_rport_callback %x event %d\n",
2126                         rdata->ids.port_id, event);
2127
2128         mutex_lock(&fip->ctlr_mutex);
2129         switch (event) {
2130         case RPORT_EV_READY:
2131                 frport->login_count = 0;
2132                 break;
2133         case RPORT_EV_LOGO:
2134         case RPORT_EV_FAILED:
2135         case RPORT_EV_STOP:
2136                 frport->login_count++;
2137                 if (frport->login_count > FCOE_CTLR_VN2VN_LOGIN_LIMIT) {
2138                         LIBFCOE_FIP_DBG(fip,
2139                                         "rport FLOGI limited port_id %6.6x\n",
2140                                         rdata->ids.port_id);
2141                         fc_rport_logoff(rdata);
2142                 }
2143                 break;
2144         default:
2145                 break;
2146         }
2147         mutex_unlock(&fip->ctlr_mutex);
2148 }
2149
2150 static struct fc_rport_operations fcoe_ctlr_vn_rport_ops = {
2151         .event_callback = fcoe_ctlr_vn_rport_callback,
2152 };
2153
2154 /**
2155  * fcoe_ctlr_disc_stop_locked() - stop discovery in VN2VN mode
2156  * @lport: The local port
2157  *
2158  * Called with ctlr_mutex held.
2159  */
2160 static void fcoe_ctlr_disc_stop_locked(struct fc_lport *lport)
2161 {
2162         struct fc_rport_priv *rdata;
2163
2164         mutex_lock(&lport->disc.disc_mutex);
2165         list_for_each_entry_rcu(rdata, &lport->disc.rports, peers) {
2166                 if (kref_get_unless_zero(&rdata->kref)) {
2167                         fc_rport_logoff(rdata);
2168                         kref_put(&rdata->kref, fc_rport_destroy);
2169                 }
2170         }
2171         lport->disc.disc_callback = NULL;
2172         mutex_unlock(&lport->disc.disc_mutex);
2173 }
2174
2175 /**
2176  * fcoe_ctlr_disc_stop() - stop discovery in VN2VN mode
2177  * @lport: The local port
2178  *
2179  * Called through the local port template for discovery.
2180  * Called without the ctlr_mutex held.
2181  */
2182 static void fcoe_ctlr_disc_stop(struct fc_lport *lport)
2183 {
2184         struct fcoe_ctlr *fip = lport->disc.priv;
2185
2186         mutex_lock(&fip->ctlr_mutex);
2187         fcoe_ctlr_disc_stop_locked(lport);
2188         mutex_unlock(&fip->ctlr_mutex);
2189 }
2190
2191 /**
2192  * fcoe_ctlr_disc_stop_final() - stop discovery for shutdown in VN2VN mode
2193  * @lport: The local port
2194  *
2195  * Called through the local port template for discovery.
2196  * Called without the ctlr_mutex held.
2197  */
2198 static void fcoe_ctlr_disc_stop_final(struct fc_lport *lport)
2199 {
2200         fcoe_ctlr_disc_stop(lport);
2201         fc_rport_flush_queue();
2202         synchronize_rcu();
2203 }
2204
2205 /**
2206  * fcoe_ctlr_vn_restart() - VN2VN probe restart with new port_id
2207  * @fip: The FCoE controller
2208  *
2209  * Called with fcoe_ctlr lock held.
2210  */
2211 static void fcoe_ctlr_vn_restart(struct fcoe_ctlr *fip)
2212 {
2213         unsigned long wait;
2214         u32 port_id;
2215
2216         fcoe_ctlr_disc_stop_locked(fip->lp);
2217
2218         /*
2219          * Get proposed port ID.
2220          * If this is the first try after link up, use any previous port_id.
2221          * If there was none, use the low bits of the port_name.
2222          * On subsequent tries, get the next random one.
2223          * Don't use reserved IDs, use another non-zero value, just as random.
2224          */
2225         port_id = fip->port_id;
2226         if (fip->probe_tries)
2227                 port_id = prandom_u32_state(&fip->rnd_state) & 0xffff;
2228         else if (!port_id)
2229                 port_id = fip->lp->wwpn & 0xffff;
2230         if (!port_id || port_id == 0xffff)
2231                 port_id = 1;
2232         fip->port_id = port_id;
2233
2234         if (fip->probe_tries < FIP_VN_RLIM_COUNT) {
2235                 fip->probe_tries++;
2236                 wait = get_random_u32_below(FIP_VN_PROBE_WAIT);
2237         } else
2238                 wait = FIP_VN_RLIM_INT;
2239         mod_timer(&fip->timer, jiffies + msecs_to_jiffies(wait));
2240         fcoe_ctlr_set_state(fip, FIP_ST_VNMP_START);
2241 }
2242
2243 /**
2244  * fcoe_ctlr_vn_start() - Start in VN2VN mode
2245  * @fip: The FCoE controller
2246  *
2247  * Called with fcoe_ctlr lock held.
2248  */
2249 static void fcoe_ctlr_vn_start(struct fcoe_ctlr *fip)
2250 {
2251         fip->probe_tries = 0;
2252         prandom_seed_state(&fip->rnd_state, fip->lp->wwpn);
2253         fcoe_ctlr_vn_restart(fip);
2254 }
2255
2256 /**
2257  * fcoe_ctlr_vn_parse - parse probe request or response
2258  * @fip: The FCoE controller
2259  * @skb: incoming packet
2260  * @frport: parsed FCoE rport from the probe request
2261  *
2262  * Returns non-zero error number on error.
2263  * Does not consume the packet.
2264  */
2265 static int fcoe_ctlr_vn_parse(struct fcoe_ctlr *fip,
2266                               struct sk_buff *skb,
2267                               struct fcoe_rport *frport)
2268 {
2269         struct fip_header *fiph;
2270         struct fip_desc *desc = NULL;
2271         struct fip_mac_desc *macd = NULL;
2272         struct fip_wwn_desc *wwn = NULL;
2273         struct fip_vn_desc *vn = NULL;
2274         struct fip_size_desc *size = NULL;
2275         size_t rlen;
2276         size_t dlen;
2277         u32 desc_mask = 0;
2278         u32 dtype;
2279         u8 sub;
2280
2281         fiph = (struct fip_header *)skb->data;
2282         frport->flags = ntohs(fiph->fip_flags);
2283
2284         sub = fiph->fip_subcode;
2285         switch (sub) {
2286         case FIP_SC_VN_PROBE_REQ:
2287         case FIP_SC_VN_PROBE_REP:
2288         case FIP_SC_VN_BEACON:
2289                 desc_mask = BIT(FIP_DT_MAC) | BIT(FIP_DT_NAME) |
2290                             BIT(FIP_DT_VN_ID);
2291                 break;
2292         case FIP_SC_VN_CLAIM_NOTIFY:
2293         case FIP_SC_VN_CLAIM_REP:
2294                 desc_mask = BIT(FIP_DT_MAC) | BIT(FIP_DT_NAME) |
2295                             BIT(FIP_DT_VN_ID) | BIT(FIP_DT_FC4F) |
2296                             BIT(FIP_DT_FCOE_SIZE);
2297                 break;
2298         default:
2299                 LIBFCOE_FIP_DBG(fip, "vn_parse unknown subcode %u\n", sub);
2300                 return -EINVAL;
2301         }
2302
2303         rlen = ntohs(fiph->fip_dl_len) * 4;
2304         if (rlen + sizeof(*fiph) > skb->len)
2305                 return -EINVAL;
2306
2307         desc = (struct fip_desc *)(fiph + 1);
2308         while (rlen > 0) {
2309                 dlen = desc->fip_dlen * FIP_BPW;
2310                 if (dlen < sizeof(*desc) || dlen > rlen)
2311                         return -EINVAL;
2312
2313                 dtype = desc->fip_dtype;
2314                 if (dtype < 32) {
2315                         if (!(desc_mask & BIT(dtype))) {
2316                                 LIBFCOE_FIP_DBG(fip,
2317                                                 "unexpected or duplicated desc "
2318                                                 "desc type %u in "
2319                                                 "FIP VN2VN subtype %u\n",
2320                                                 dtype, sub);
2321                                 return -EINVAL;
2322                         }
2323                         desc_mask &= ~BIT(dtype);
2324                 }
2325
2326                 switch (dtype) {
2327                 case FIP_DT_MAC:
2328                         if (dlen != sizeof(struct fip_mac_desc))
2329                                 goto len_err;
2330                         macd = (struct fip_mac_desc *)desc;
2331                         if (!is_valid_ether_addr(macd->fd_mac)) {
2332                                 LIBFCOE_FIP_DBG(fip,
2333                                         "Invalid MAC addr %pM in FIP VN2VN\n",
2334                                          macd->fd_mac);
2335                                 return -EINVAL;
2336                         }
2337                         memcpy(frport->enode_mac, macd->fd_mac, ETH_ALEN);
2338                         break;
2339                 case FIP_DT_NAME:
2340                         if (dlen != sizeof(struct fip_wwn_desc))
2341                                 goto len_err;
2342                         wwn = (struct fip_wwn_desc *)desc;
2343                         frport->rdata.ids.node_name =
2344                                 get_unaligned_be64(&wwn->fd_wwn);
2345                         break;
2346                 case FIP_DT_VN_ID:
2347                         if (dlen != sizeof(struct fip_vn_desc))
2348                                 goto len_err;
2349                         vn = (struct fip_vn_desc *)desc;
2350                         memcpy(frport->vn_mac, vn->fd_mac, ETH_ALEN);
2351                         frport->rdata.ids.port_id = ntoh24(vn->fd_fc_id);
2352                         frport->rdata.ids.port_name =
2353                                 get_unaligned_be64(&vn->fd_wwpn);
2354                         break;
2355                 case FIP_DT_FC4F:
2356                         if (dlen != sizeof(struct fip_fc4_feat))
2357                                 goto len_err;
2358                         break;
2359                 case FIP_DT_FCOE_SIZE:
2360                         if (dlen != sizeof(struct fip_size_desc))
2361                                 goto len_err;
2362                         size = (struct fip_size_desc *)desc;
2363                         frport->fcoe_len = ntohs(size->fd_size);
2364                         break;
2365                 default:
2366                         LIBFCOE_FIP_DBG(fip, "unexpected descriptor type %x "
2367                                         "in FIP probe\n", dtype);
2368                         /* standard says ignore unknown descriptors >= 128 */
2369                         if (dtype < FIP_DT_NON_CRITICAL)
2370                                 return -EINVAL;
2371                         break;
2372                 }
2373                 desc = (struct fip_desc *)((char *)desc + dlen);
2374                 rlen -= dlen;
2375         }
2376         return 0;
2377
2378 len_err:
2379         LIBFCOE_FIP_DBG(fip, "FIP length error in descriptor type %x len %zu\n",
2380                         dtype, dlen);
2381         return -EINVAL;
2382 }
2383
2384 /**
2385  * fcoe_ctlr_vn_send_claim() - send multicast FIP VN2VN Claim Notification.
2386  * @fip: The FCoE controller
2387  *
2388  * Called with ctlr_mutex held.
2389  */
2390 static void fcoe_ctlr_vn_send_claim(struct fcoe_ctlr *fip)
2391 {
2392         fcoe_ctlr_vn_send(fip, FIP_SC_VN_CLAIM_NOTIFY, fcoe_all_vn2vn, 0);
2393         fip->sol_time = jiffies;
2394 }
2395
2396 /**
2397  * fcoe_ctlr_vn_probe_req() - handle incoming VN2VN probe request.
2398  * @fip: The FCoE controller
2399  * @frport: parsed FCoE rport from the probe request
2400  *
2401  * Called with ctlr_mutex held.
2402  */
2403 static void fcoe_ctlr_vn_probe_req(struct fcoe_ctlr *fip,
2404                                    struct fcoe_rport *frport)
2405 {
2406         if (frport->rdata.ids.port_id != fip->port_id)
2407                 return;
2408
2409         switch (fip->state) {
2410         case FIP_ST_VNMP_CLAIM:
2411         case FIP_ST_VNMP_UP:
2412                 LIBFCOE_FIP_DBG(fip, "vn_probe_req: send reply, state %x\n",
2413                                 fip->state);
2414                 fcoe_ctlr_vn_send(fip, FIP_SC_VN_PROBE_REP,
2415                                   frport->enode_mac, 0);
2416                 break;
2417         case FIP_ST_VNMP_PROBE1:
2418         case FIP_ST_VNMP_PROBE2:
2419                 /*
2420                  * Decide whether to reply to the Probe.
2421                  * Our selected address is never a "recorded" one, so
2422                  * only reply if our WWPN is greater and the
2423                  * Probe's REC bit is not set.
2424                  * If we don't reply, we will change our address.
2425                  */
2426                 if (fip->lp->wwpn > frport->rdata.ids.port_name &&
2427                     !(frport->flags & FIP_FL_REC_OR_P2P)) {
2428                         LIBFCOE_FIP_DBG(fip, "vn_probe_req: "
2429                                         "port_id collision\n");
2430                         fcoe_ctlr_vn_send(fip, FIP_SC_VN_PROBE_REP,
2431                                           frport->enode_mac, 0);
2432                         break;
2433                 }
2434                 fallthrough;
2435         case FIP_ST_VNMP_START:
2436                 LIBFCOE_FIP_DBG(fip, "vn_probe_req: "
2437                                 "restart VN2VN negotiation\n");
2438                 fcoe_ctlr_vn_restart(fip);
2439                 break;
2440         default:
2441                 LIBFCOE_FIP_DBG(fip, "vn_probe_req: ignore state %x\n",
2442                                 fip->state);
2443                 break;
2444         }
2445 }
2446
2447 /**
2448  * fcoe_ctlr_vn_probe_reply() - handle incoming VN2VN probe reply.
2449  * @fip: The FCoE controller
2450  * @frport: parsed FCoE rport from the probe request
2451  *
2452  * Called with ctlr_mutex held.
2453  */
2454 static void fcoe_ctlr_vn_probe_reply(struct fcoe_ctlr *fip,
2455                                      struct fcoe_rport *frport)
2456 {
2457         if (frport->rdata.ids.port_id != fip->port_id)
2458                 return;
2459         switch (fip->state) {
2460         case FIP_ST_VNMP_START:
2461         case FIP_ST_VNMP_PROBE1:
2462         case FIP_ST_VNMP_PROBE2:
2463         case FIP_ST_VNMP_CLAIM:
2464                 LIBFCOE_FIP_DBG(fip, "vn_probe_reply: restart state %x\n",
2465                                 fip->state);
2466                 fcoe_ctlr_vn_restart(fip);
2467                 break;
2468         case FIP_ST_VNMP_UP:
2469                 LIBFCOE_FIP_DBG(fip, "vn_probe_reply: send claim notify\n");
2470                 fcoe_ctlr_vn_send_claim(fip);
2471                 break;
2472         default:
2473                 break;
2474         }
2475 }
2476
2477 /**
2478  * fcoe_ctlr_vn_add() - Add a VN2VN entry to the list, based on a claim reply.
2479  * @fip: The FCoE controller
2480  * @new: newly-parsed FCoE rport as a template for new rdata
2481  *
2482  * Called with ctlr_mutex held.
2483  */
2484 static void fcoe_ctlr_vn_add(struct fcoe_ctlr *fip, struct fcoe_rport *new)
2485 {
2486         struct fc_lport *lport = fip->lp;
2487         struct fc_rport_priv *rdata;
2488         struct fc_rport_identifiers *ids;
2489         struct fcoe_rport *frport;
2490         u32 port_id;
2491
2492         port_id = new->rdata.ids.port_id;
2493         if (port_id == fip->port_id)
2494                 return;
2495
2496         mutex_lock(&lport->disc.disc_mutex);
2497         rdata = fc_rport_create(lport, port_id);
2498         if (!rdata) {
2499                 mutex_unlock(&lport->disc.disc_mutex);
2500                 return;
2501         }
2502         mutex_lock(&rdata->rp_mutex);
2503         mutex_unlock(&lport->disc.disc_mutex);
2504
2505         rdata->ops = &fcoe_ctlr_vn_rport_ops;
2506         rdata->disc_id = lport->disc.disc_id;
2507
2508         ids = &rdata->ids;
2509         if ((ids->port_name != -1 &&
2510              ids->port_name != new->rdata.ids.port_name) ||
2511             (ids->node_name != -1 &&
2512              ids->node_name != new->rdata.ids.node_name)) {
2513                 mutex_unlock(&rdata->rp_mutex);
2514                 LIBFCOE_FIP_DBG(fip, "vn_add rport logoff %6.6x\n", port_id);
2515                 fc_rport_logoff(rdata);
2516                 mutex_lock(&rdata->rp_mutex);
2517         }
2518         ids->port_name = new->rdata.ids.port_name;
2519         ids->node_name = new->rdata.ids.node_name;
2520         mutex_unlock(&rdata->rp_mutex);
2521
2522         frport = fcoe_ctlr_rport(rdata);
2523         LIBFCOE_FIP_DBG(fip, "vn_add rport %6.6x %s state %d\n",
2524                         port_id, frport->fcoe_len ? "old" : "new",
2525                         rdata->rp_state);
2526         frport->fcoe_len = new->fcoe_len;
2527         frport->flags = new->flags;
2528         frport->login_count = new->login_count;
2529         memcpy(frport->enode_mac, new->enode_mac, ETH_ALEN);
2530         memcpy(frport->vn_mac, new->vn_mac, ETH_ALEN);
2531         frport->time = 0;
2532 }
2533
2534 /**
2535  * fcoe_ctlr_vn_lookup() - Find VN remote port's MAC address
2536  * @fip: The FCoE controller
2537  * @port_id:  The port_id of the remote VN_node
2538  * @mac: buffer which will hold the VN_NODE destination MAC address, if found.
2539  *
2540  * Returns non-zero error if no remote port found.
2541  */
2542 static int fcoe_ctlr_vn_lookup(struct fcoe_ctlr *fip, u32 port_id, u8 *mac)
2543 {
2544         struct fc_lport *lport = fip->lp;
2545         struct fc_rport_priv *rdata;
2546         struct fcoe_rport *frport;
2547         int ret = -1;
2548
2549         rdata = fc_rport_lookup(lport, port_id);
2550         if (rdata) {
2551                 frport = fcoe_ctlr_rport(rdata);
2552                 memcpy(mac, frport->enode_mac, ETH_ALEN);
2553                 ret = 0;
2554                 kref_put(&rdata->kref, fc_rport_destroy);
2555         }
2556         return ret;
2557 }
2558
2559 /**
2560  * fcoe_ctlr_vn_claim_notify() - handle received FIP VN2VN Claim Notification
2561  * @fip: The FCoE controller
2562  * @new: newly-parsed FCoE rport as a template for new rdata
2563  *
2564  * Called with ctlr_mutex held.
2565  */
2566 static void fcoe_ctlr_vn_claim_notify(struct fcoe_ctlr *fip,
2567                                       struct fcoe_rport *new)
2568 {
2569         if (new->flags & FIP_FL_REC_OR_P2P) {
2570                 LIBFCOE_FIP_DBG(fip, "send probe req for P2P/REC\n");
2571                 fcoe_ctlr_vn_send(fip, FIP_SC_VN_PROBE_REQ, fcoe_all_vn2vn, 0);
2572                 return;
2573         }
2574         switch (fip->state) {
2575         case FIP_ST_VNMP_START:
2576         case FIP_ST_VNMP_PROBE1:
2577         case FIP_ST_VNMP_PROBE2:
2578                 if (new->rdata.ids.port_id == fip->port_id) {
2579                         LIBFCOE_FIP_DBG(fip, "vn_claim_notify: "
2580                                         "restart, state %d\n",
2581                                         fip->state);
2582                         fcoe_ctlr_vn_restart(fip);
2583                 }
2584                 break;
2585         case FIP_ST_VNMP_CLAIM:
2586         case FIP_ST_VNMP_UP:
2587                 if (new->rdata.ids.port_id == fip->port_id) {
2588                         if (new->rdata.ids.port_name > fip->lp->wwpn) {
2589                                 LIBFCOE_FIP_DBG(fip, "vn_claim_notify: "
2590                                                 "restart, port_id collision\n");
2591                                 fcoe_ctlr_vn_restart(fip);
2592                                 break;
2593                         }
2594                         LIBFCOE_FIP_DBG(fip, "vn_claim_notify: "
2595                                         "send claim notify\n");
2596                         fcoe_ctlr_vn_send_claim(fip);
2597                         break;
2598                 }
2599                 LIBFCOE_FIP_DBG(fip, "vn_claim_notify: send reply to %x\n",
2600                                 new->rdata.ids.port_id);
2601                 fcoe_ctlr_vn_send(fip, FIP_SC_VN_CLAIM_REP, new->enode_mac,
2602                                   min((u32)new->fcoe_len,
2603                                       fcoe_ctlr_fcoe_size(fip)));
2604                 fcoe_ctlr_vn_add(fip, new);
2605                 break;
2606         default:
2607                 LIBFCOE_FIP_DBG(fip, "vn_claim_notify: "
2608                                 "ignoring claim from %x\n",
2609                                 new->rdata.ids.port_id);
2610                 break;
2611         }
2612 }
2613
2614 /**
2615  * fcoe_ctlr_vn_claim_resp() - handle received Claim Response
2616  * @fip: The FCoE controller that received the frame
2617  * @new: newly-parsed FCoE rport from the Claim Response
2618  *
2619  * Called with ctlr_mutex held.
2620  */
2621 static void fcoe_ctlr_vn_claim_resp(struct fcoe_ctlr *fip,
2622                                     struct fcoe_rport *new)
2623 {
2624         LIBFCOE_FIP_DBG(fip, "claim resp from from rport %x - state %s\n",
2625                         new->rdata.ids.port_id, fcoe_ctlr_state(fip->state));
2626         if (fip->state == FIP_ST_VNMP_UP || fip->state == FIP_ST_VNMP_CLAIM)
2627                 fcoe_ctlr_vn_add(fip, new);
2628 }
2629
2630 /**
2631  * fcoe_ctlr_vn_beacon() - handle received beacon.
2632  * @fip: The FCoE controller that received the frame
2633  * @new: newly-parsed FCoE rport from the Beacon
2634  *
2635  * Called with ctlr_mutex held.
2636  */
2637 static void fcoe_ctlr_vn_beacon(struct fcoe_ctlr *fip,
2638                                 struct fcoe_rport *new)
2639 {
2640         struct fc_lport *lport = fip->lp;
2641         struct fc_rport_priv *rdata;
2642         struct fcoe_rport *frport;
2643
2644         if (new->flags & FIP_FL_REC_OR_P2P) {
2645                 LIBFCOE_FIP_DBG(fip, "p2p beacon while in vn2vn mode\n");
2646                 fcoe_ctlr_vn_send(fip, FIP_SC_VN_PROBE_REQ, fcoe_all_vn2vn, 0);
2647                 return;
2648         }
2649         rdata = fc_rport_lookup(lport, new->rdata.ids.port_id);
2650         if (rdata) {
2651                 if (rdata->ids.node_name == new->rdata.ids.node_name &&
2652                     rdata->ids.port_name == new->rdata.ids.port_name) {
2653                         frport = fcoe_ctlr_rport(rdata);
2654
2655                         LIBFCOE_FIP_DBG(fip, "beacon from rport %x\n",
2656                                         rdata->ids.port_id);
2657                         if (!frport->time && fip->state == FIP_ST_VNMP_UP) {
2658                                 LIBFCOE_FIP_DBG(fip, "beacon expired "
2659                                                 "for rport %x\n",
2660                                                 rdata->ids.port_id);
2661                                 fc_rport_login(rdata);
2662                         }
2663                         frport->time = jiffies;
2664                 }
2665                 kref_put(&rdata->kref, fc_rport_destroy);
2666                 return;
2667         }
2668         if (fip->state != FIP_ST_VNMP_UP)
2669                 return;
2670
2671         /*
2672          * Beacon from a new neighbor.
2673          * Send a claim notify if one hasn't been sent recently.
2674          * Don't add the neighbor yet.
2675          */
2676         LIBFCOE_FIP_DBG(fip, "beacon from new rport %x. sending claim notify\n",
2677                         new->rdata.ids.port_id);
2678         if (time_after(jiffies,
2679                        fip->sol_time + msecs_to_jiffies(FIP_VN_ANN_WAIT)))
2680                 fcoe_ctlr_vn_send_claim(fip);
2681 }
2682
2683 /**
2684  * fcoe_ctlr_vn_age() - Check for VN_ports without recent beacons
2685  * @fip: The FCoE controller
2686  *
2687  * Called with ctlr_mutex held.
2688  * Called only in state FIP_ST_VNMP_UP.
2689  * Returns the soonest time for next age-out or a time far in the future.
2690  */
2691 static unsigned long fcoe_ctlr_vn_age(struct fcoe_ctlr *fip)
2692 {
2693         struct fc_lport *lport = fip->lp;
2694         struct fc_rport_priv *rdata;
2695         struct fcoe_rport *frport;
2696         unsigned long next_time;
2697         unsigned long deadline;
2698
2699         next_time = jiffies + msecs_to_jiffies(FIP_VN_BEACON_INT * 10);
2700         mutex_lock(&lport->disc.disc_mutex);
2701         list_for_each_entry_rcu(rdata, &lport->disc.rports, peers) {
2702                 if (!kref_get_unless_zero(&rdata->kref))
2703                         continue;
2704                 frport = fcoe_ctlr_rport(rdata);
2705                 if (!frport->time) {
2706                         kref_put(&rdata->kref, fc_rport_destroy);
2707                         continue;
2708                 }
2709                 deadline = frport->time +
2710                            msecs_to_jiffies(FIP_VN_BEACON_INT * 25 / 10);
2711                 if (time_after_eq(jiffies, deadline)) {
2712                         frport->time = 0;
2713                         LIBFCOE_FIP_DBG(fip,
2714                                 "port %16.16llx fc_id %6.6x beacon expired\n",
2715                                 rdata->ids.port_name, rdata->ids.port_id);
2716                         fc_rport_logoff(rdata);
2717                 } else if (time_before(deadline, next_time))
2718                         next_time = deadline;
2719                 kref_put(&rdata->kref, fc_rport_destroy);
2720         }
2721         mutex_unlock(&lport->disc.disc_mutex);
2722         return next_time;
2723 }
2724
2725 /**
2726  * fcoe_ctlr_vn_recv() - Receive a FIP frame
2727  * @fip: The FCoE controller that received the frame
2728  * @skb: The received FIP frame
2729  *
2730  * Returns non-zero if the frame is dropped.
2731  * Always consumes the frame.
2732  */
2733 static int fcoe_ctlr_vn_recv(struct fcoe_ctlr *fip, struct sk_buff *skb)
2734 {
2735         struct fip_header *fiph;
2736         enum fip_vn2vn_subcode sub;
2737         struct fcoe_rport frport = { };
2738         int rc, vlan_id = 0;
2739
2740         fiph = (struct fip_header *)skb->data;
2741         sub = fiph->fip_subcode;
2742
2743         if (fip->lp->vlan)
2744                 vlan_id = skb_vlan_tag_get_id(skb);
2745
2746         if (vlan_id && vlan_id != fip->lp->vlan) {
2747                 LIBFCOE_FIP_DBG(fip, "vn_recv drop frame sub %x vlan %d\n",
2748                                 sub, vlan_id);
2749                 rc = -EAGAIN;
2750                 goto drop;
2751         }
2752
2753         rc = fcoe_ctlr_vn_parse(fip, skb, &frport);
2754         if (rc) {
2755                 LIBFCOE_FIP_DBG(fip, "vn_recv vn_parse error %d\n", rc);
2756                 goto drop;
2757         }
2758
2759         mutex_lock(&fip->ctlr_mutex);
2760         switch (sub) {
2761         case FIP_SC_VN_PROBE_REQ:
2762                 fcoe_ctlr_vn_probe_req(fip, &frport);
2763                 break;
2764         case FIP_SC_VN_PROBE_REP:
2765                 fcoe_ctlr_vn_probe_reply(fip, &frport);
2766                 break;
2767         case FIP_SC_VN_CLAIM_NOTIFY:
2768                 fcoe_ctlr_vn_claim_notify(fip, &frport);
2769                 break;
2770         case FIP_SC_VN_CLAIM_REP:
2771                 fcoe_ctlr_vn_claim_resp(fip, &frport);
2772                 break;
2773         case FIP_SC_VN_BEACON:
2774                 fcoe_ctlr_vn_beacon(fip, &frport);
2775                 break;
2776         default:
2777                 LIBFCOE_FIP_DBG(fip, "vn_recv unknown subcode %d\n", sub);
2778                 rc = -1;
2779                 break;
2780         }
2781         mutex_unlock(&fip->ctlr_mutex);
2782 drop:
2783         kfree_skb(skb);
2784         return rc;
2785 }
2786
2787 /**
2788  * fcoe_ctlr_vlan_parse - parse vlan discovery request or response
2789  * @fip: The FCoE controller
2790  * @skb: incoming packet
2791  * @frport: parsed FCoE rport from the probe request
2792  *
2793  * Returns non-zero error number on error.
2794  * Does not consume the packet.
2795  */
2796 static int fcoe_ctlr_vlan_parse(struct fcoe_ctlr *fip,
2797                               struct sk_buff *skb,
2798                               struct fcoe_rport *frport)
2799 {
2800         struct fip_header *fiph;
2801         struct fip_desc *desc = NULL;
2802         struct fip_mac_desc *macd = NULL;
2803         struct fip_wwn_desc *wwn = NULL;
2804         size_t rlen;
2805         size_t dlen;
2806         u32 desc_mask = 0;
2807         u32 dtype;
2808         u8 sub;
2809
2810         fiph = (struct fip_header *)skb->data;
2811         frport->flags = ntohs(fiph->fip_flags);
2812
2813         sub = fiph->fip_subcode;
2814         switch (sub) {
2815         case FIP_SC_VL_REQ:
2816                 desc_mask = BIT(FIP_DT_MAC) | BIT(FIP_DT_NAME);
2817                 break;
2818         default:
2819                 LIBFCOE_FIP_DBG(fip, "vn_parse unknown subcode %u\n", sub);
2820                 return -EINVAL;
2821         }
2822
2823         rlen = ntohs(fiph->fip_dl_len) * 4;
2824         if (rlen + sizeof(*fiph) > skb->len)
2825                 return -EINVAL;
2826
2827         desc = (struct fip_desc *)(fiph + 1);
2828         while (rlen > 0) {
2829                 dlen = desc->fip_dlen * FIP_BPW;
2830                 if (dlen < sizeof(*desc) || dlen > rlen)
2831                         return -EINVAL;
2832
2833                 dtype = desc->fip_dtype;
2834                 if (dtype < 32) {
2835                         if (!(desc_mask & BIT(dtype))) {
2836                                 LIBFCOE_FIP_DBG(fip,
2837                                                 "unexpected or duplicated desc "
2838                                                 "desc type %u in "
2839                                                 "FIP VN2VN subtype %u\n",
2840                                                 dtype, sub);
2841                                 return -EINVAL;
2842                         }
2843                         desc_mask &= ~BIT(dtype);
2844                 }
2845
2846                 switch (dtype) {
2847                 case FIP_DT_MAC:
2848                         if (dlen != sizeof(struct fip_mac_desc))
2849                                 goto len_err;
2850                         macd = (struct fip_mac_desc *)desc;
2851                         if (!is_valid_ether_addr(macd->fd_mac)) {
2852                                 LIBFCOE_FIP_DBG(fip,
2853                                         "Invalid MAC addr %pM in FIP VN2VN\n",
2854                                          macd->fd_mac);
2855                                 return -EINVAL;
2856                         }
2857                         memcpy(frport->enode_mac, macd->fd_mac, ETH_ALEN);
2858                         break;
2859                 case FIP_DT_NAME:
2860                         if (dlen != sizeof(struct fip_wwn_desc))
2861                                 goto len_err;
2862                         wwn = (struct fip_wwn_desc *)desc;
2863                         frport->rdata.ids.node_name =
2864                                 get_unaligned_be64(&wwn->fd_wwn);
2865                         break;
2866                 default:
2867                         LIBFCOE_FIP_DBG(fip, "unexpected descriptor type %x "
2868                                         "in FIP probe\n", dtype);
2869                         /* standard says ignore unknown descriptors >= 128 */
2870                         if (dtype < FIP_DT_NON_CRITICAL)
2871                                 return -EINVAL;
2872                         break;
2873                 }
2874                 desc = (struct fip_desc *)((char *)desc + dlen);
2875                 rlen -= dlen;
2876         }
2877         return 0;
2878
2879 len_err:
2880         LIBFCOE_FIP_DBG(fip, "FIP length error in descriptor type %x len %zu\n",
2881                         dtype, dlen);
2882         return -EINVAL;
2883 }
2884
2885 /**
2886  * fcoe_ctlr_vlan_send() - Send a FIP VLAN Notification
2887  * @fip: The FCoE controller
2888  * @sub: sub-opcode for vlan notification or vn2vn vlan notification
2889  * @dest: The destination Ethernet MAC address
2890  */
2891 static void fcoe_ctlr_vlan_send(struct fcoe_ctlr *fip,
2892                               enum fip_vlan_subcode sub,
2893                               const u8 *dest)
2894 {
2895         struct sk_buff *skb;
2896         struct fip_vlan_notify_frame {
2897                 struct ethhdr eth;
2898                 struct fip_header fip;
2899                 struct fip_mac_desc mac;
2900                 struct fip_vlan_desc vlan;
2901         } __packed * frame;
2902         size_t len;
2903         size_t dlen;
2904
2905         len = sizeof(*frame);
2906         dlen = sizeof(frame->mac) + sizeof(frame->vlan);
2907         len = max(len, sizeof(struct ethhdr));
2908
2909         skb = dev_alloc_skb(len);
2910         if (!skb)
2911                 return;
2912
2913         LIBFCOE_FIP_DBG(fip, "fip %s vlan notification, vlan %d\n",
2914                         fip->mode == FIP_MODE_VN2VN ? "vn2vn" : "fcf",
2915                         fip->lp->vlan);
2916
2917         frame = (struct fip_vlan_notify_frame *)skb->data;
2918         memset(frame, 0, len);
2919         memcpy(frame->eth.h_dest, dest, ETH_ALEN);
2920
2921         memcpy(frame->eth.h_source, fip->ctl_src_addr, ETH_ALEN);
2922         frame->eth.h_proto = htons(ETH_P_FIP);
2923
2924         frame->fip.fip_ver = FIP_VER_ENCAPS(FIP_VER);
2925         frame->fip.fip_op = htons(FIP_OP_VLAN);
2926         frame->fip.fip_subcode = sub;
2927         frame->fip.fip_dl_len = htons(dlen / FIP_BPW);
2928
2929         frame->mac.fd_desc.fip_dtype = FIP_DT_MAC;
2930         frame->mac.fd_desc.fip_dlen = sizeof(frame->mac) / FIP_BPW;
2931         memcpy(frame->mac.fd_mac, fip->ctl_src_addr, ETH_ALEN);
2932
2933         frame->vlan.fd_desc.fip_dtype = FIP_DT_VLAN;
2934         frame->vlan.fd_desc.fip_dlen = sizeof(frame->vlan) / FIP_BPW;
2935         put_unaligned_be16(fip->lp->vlan, &frame->vlan.fd_vlan);
2936
2937         skb_put(skb, len);
2938         skb->protocol = htons(ETH_P_FIP);
2939         skb->priority = fip->priority;
2940         skb_reset_mac_header(skb);
2941         skb_reset_network_header(skb);
2942
2943         fip->send(fip, skb);
2944 }
2945
2946 /**
2947  * fcoe_ctlr_vlan_disc_reply() - send FIP VLAN Discovery Notification.
2948  * @fip: The FCoE controller
2949  * @frport: The newly-parsed FCoE rport from the Discovery Request
2950  *
2951  * Called with ctlr_mutex held.
2952  */
2953 static void fcoe_ctlr_vlan_disc_reply(struct fcoe_ctlr *fip,
2954                                       struct fcoe_rport *frport)
2955 {
2956         enum fip_vlan_subcode sub = FIP_SC_VL_NOTE;
2957
2958         if (fip->mode == FIP_MODE_VN2VN)
2959                 sub = FIP_SC_VL_VN2VN_NOTE;
2960
2961         fcoe_ctlr_vlan_send(fip, sub, frport->enode_mac);
2962 }
2963
2964 /**
2965  * fcoe_ctlr_vlan_recv - vlan request receive handler for VN2VN mode.
2966  * @fip: The FCoE controller
2967  * @skb: The received FIP packet
2968  */
2969 static int fcoe_ctlr_vlan_recv(struct fcoe_ctlr *fip, struct sk_buff *skb)
2970 {
2971         struct fip_header *fiph;
2972         enum fip_vlan_subcode sub;
2973         struct fcoe_rport frport = { };
2974         int rc;
2975
2976         fiph = (struct fip_header *)skb->data;
2977         sub = fiph->fip_subcode;
2978         rc = fcoe_ctlr_vlan_parse(fip, skb, &frport);
2979         if (rc) {
2980                 LIBFCOE_FIP_DBG(fip, "vlan_recv vlan_parse error %d\n", rc);
2981                 goto drop;
2982         }
2983         mutex_lock(&fip->ctlr_mutex);
2984         if (sub == FIP_SC_VL_REQ)
2985                 fcoe_ctlr_vlan_disc_reply(fip, &frport);
2986         mutex_unlock(&fip->ctlr_mutex);
2987
2988 drop:
2989         kfree_skb(skb);
2990         return rc;
2991 }
2992
2993 /**
2994  * fcoe_ctlr_disc_recv - discovery receive handler for VN2VN mode.
2995  * @lport: The local port
2996  * @fp: The received frame
2997  *
2998  * This should never be called since we don't see RSCNs or other
2999  * fabric-generated ELSes.
3000  */
3001 static void fcoe_ctlr_disc_recv(struct fc_lport *lport, struct fc_frame *fp)
3002 {
3003         struct fc_seq_els_data rjt_data;
3004
3005         rjt_data.reason = ELS_RJT_UNSUP;
3006         rjt_data.explan = ELS_EXPL_NONE;
3007         fc_seq_els_rsp_send(fp, ELS_LS_RJT, &rjt_data);
3008         fc_frame_free(fp);
3009 }
3010
3011 /*
3012  * fcoe_ctlr_disc_start - start discovery for VN2VN mode.
3013  *
3014  * This sets a flag indicating that remote ports should be created
3015  * and started for the peers we discover.  We use the disc_callback
3016  * pointer as that flag.  Peers already discovered are created here.
3017  *
3018  * The lport lock is held during this call. The callback must be done
3019  * later, without holding either the lport or discovery locks.
3020  * The fcoe_ctlr lock may also be held during this call.
3021  */
3022 static void fcoe_ctlr_disc_start(void (*callback)(struct fc_lport *,
3023                                                   enum fc_disc_event),
3024                                  struct fc_lport *lport)
3025 {
3026         struct fc_disc *disc = &lport->disc;
3027         struct fcoe_ctlr *fip = disc->priv;
3028
3029         mutex_lock(&disc->disc_mutex);
3030         disc->disc_callback = callback;
3031         disc->disc_id = (disc->disc_id + 2) | 1;
3032         disc->pending = 1;
3033         schedule_work(&fip->timer_work);
3034         mutex_unlock(&disc->disc_mutex);
3035 }
3036
3037 /**
3038  * fcoe_ctlr_vn_disc() - report FIP VN_port discovery results after claim state.
3039  * @fip: The FCoE controller
3040  *
3041  * Starts the FLOGI and PLOGI login process to each discovered rport for which
3042  * we've received at least one beacon.
3043  * Performs the discovery complete callback.
3044  */
3045 static void fcoe_ctlr_vn_disc(struct fcoe_ctlr *fip)
3046 {
3047         struct fc_lport *lport = fip->lp;
3048         struct fc_disc *disc = &lport->disc;
3049         struct fc_rport_priv *rdata;
3050         struct fcoe_rport *frport;
3051         void (*callback)(struct fc_lport *, enum fc_disc_event);
3052
3053         mutex_lock(&disc->disc_mutex);
3054         callback = disc->pending ? disc->disc_callback : NULL;
3055         disc->pending = 0;
3056         list_for_each_entry_rcu(rdata, &disc->rports, peers) {
3057                 if (!kref_get_unless_zero(&rdata->kref))
3058                         continue;
3059                 frport = fcoe_ctlr_rport(rdata);
3060                 if (frport->time)
3061                         fc_rport_login(rdata);
3062                 kref_put(&rdata->kref, fc_rport_destroy);
3063         }
3064         mutex_unlock(&disc->disc_mutex);
3065         if (callback)
3066                 callback(lport, DISC_EV_SUCCESS);
3067 }
3068
3069 /**
3070  * fcoe_ctlr_vn_timeout - timer work function for VN2VN mode.
3071  * @fip: The FCoE controller
3072  */
3073 static void fcoe_ctlr_vn_timeout(struct fcoe_ctlr *fip)
3074 {
3075         unsigned long next_time;
3076         u8 mac[ETH_ALEN];
3077         u32 new_port_id = 0;
3078
3079         mutex_lock(&fip->ctlr_mutex);
3080         switch (fip->state) {
3081         case FIP_ST_VNMP_START:
3082                 fcoe_ctlr_set_state(fip, FIP_ST_VNMP_PROBE1);
3083                 LIBFCOE_FIP_DBG(fip, "vn_timeout: send 1st probe request\n");
3084                 fcoe_ctlr_vn_send(fip, FIP_SC_VN_PROBE_REQ, fcoe_all_vn2vn, 0);
3085                 next_time = jiffies + msecs_to_jiffies(FIP_VN_PROBE_WAIT);
3086                 break;
3087         case FIP_ST_VNMP_PROBE1:
3088                 fcoe_ctlr_set_state(fip, FIP_ST_VNMP_PROBE2);
3089                 LIBFCOE_FIP_DBG(fip, "vn_timeout: send 2nd probe request\n");
3090                 fcoe_ctlr_vn_send(fip, FIP_SC_VN_PROBE_REQ, fcoe_all_vn2vn, 0);
3091                 next_time = jiffies + msecs_to_jiffies(FIP_VN_ANN_WAIT);
3092                 break;
3093         case FIP_ST_VNMP_PROBE2:
3094                 fcoe_ctlr_set_state(fip, FIP_ST_VNMP_CLAIM);
3095                 new_port_id = fip->port_id;
3096                 hton24(mac, FIP_VN_FC_MAP);
3097                 hton24(mac + 3, new_port_id);
3098                 fcoe_ctlr_map_dest(fip);
3099                 fip->update_mac(fip->lp, mac);
3100                 LIBFCOE_FIP_DBG(fip, "vn_timeout: send claim notify\n");
3101                 fcoe_ctlr_vn_send_claim(fip);
3102                 next_time = jiffies + msecs_to_jiffies(FIP_VN_ANN_WAIT);
3103                 break;
3104         case FIP_ST_VNMP_CLAIM:
3105                 /*
3106                  * This may be invoked either by starting discovery so don't
3107                  * go to the next state unless it's been long enough.
3108                  */
3109                 next_time = fip->sol_time + msecs_to_jiffies(FIP_VN_ANN_WAIT);
3110                 if (time_after_eq(jiffies, next_time)) {
3111                         fcoe_ctlr_set_state(fip, FIP_ST_VNMP_UP);
3112                         LIBFCOE_FIP_DBG(fip, "vn_timeout: send vn2vn beacon\n");
3113                         fcoe_ctlr_vn_send(fip, FIP_SC_VN_BEACON,
3114                                           fcoe_all_vn2vn, 0);
3115                         next_time = jiffies + msecs_to_jiffies(FIP_VN_ANN_WAIT);
3116                         fip->port_ka_time = next_time;
3117                 }
3118                 fcoe_ctlr_vn_disc(fip);
3119                 break;
3120         case FIP_ST_VNMP_UP:
3121                 next_time = fcoe_ctlr_vn_age(fip);
3122                 if (time_after_eq(jiffies, fip->port_ka_time)) {
3123                         LIBFCOE_FIP_DBG(fip, "vn_timeout: send vn2vn beacon\n");
3124                         fcoe_ctlr_vn_send(fip, FIP_SC_VN_BEACON,
3125                                           fcoe_all_vn2vn, 0);
3126                         fip->port_ka_time = jiffies +
3127                                  msecs_to_jiffies(FIP_VN_BEACON_INT +
3128                                         get_random_u32_below(FIP_VN_BEACON_FUZZ));
3129                 }
3130                 if (time_before(fip->port_ka_time, next_time))
3131                         next_time = fip->port_ka_time;
3132                 break;
3133         case FIP_ST_LINK_WAIT:
3134                 goto unlock;
3135         default:
3136                 WARN(1, "unexpected state %d\n", fip->state);
3137                 goto unlock;
3138         }
3139         mod_timer(&fip->timer, next_time);
3140 unlock:
3141         mutex_unlock(&fip->ctlr_mutex);
3142
3143         /* If port ID is new, notify local port after dropping ctlr_mutex */
3144         if (new_port_id)
3145                 fc_lport_set_local_id(fip->lp, new_port_id);
3146 }
3147
3148 /**
3149  * fcoe_ctlr_mode_set() - Set or reset the ctlr's mode
3150  * @lport: The local port to be (re)configured
3151  * @fip:   The FCoE controller whose mode is changing
3152  * @fip_mode: The new fip mode
3153  *
3154  * Note that the we shouldn't be changing the libfc discovery settings
3155  * (fc_disc_config) while an lport is going through the libfc state
3156  * machine. The mode can only be changed when a fcoe_ctlr device is
3157  * disabled, so that should ensure that this routine is only called
3158  * when nothing is happening.
3159  */
3160 static void fcoe_ctlr_mode_set(struct fc_lport *lport, struct fcoe_ctlr *fip,
3161                                enum fip_mode fip_mode)
3162 {
3163         void *priv;
3164
3165         WARN_ON(lport->state != LPORT_ST_RESET &&
3166                 lport->state != LPORT_ST_DISABLED);
3167
3168         if (fip_mode == FIP_MODE_VN2VN) {
3169                 lport->rport_priv_size = sizeof(struct fcoe_rport);
3170                 lport->point_to_multipoint = 1;
3171                 lport->tt.disc_recv_req = fcoe_ctlr_disc_recv;
3172                 lport->tt.disc_start = fcoe_ctlr_disc_start;
3173                 lport->tt.disc_stop = fcoe_ctlr_disc_stop;
3174                 lport->tt.disc_stop_final = fcoe_ctlr_disc_stop_final;
3175                 priv = fip;
3176         } else {
3177                 lport->rport_priv_size = 0;
3178                 lport->point_to_multipoint = 0;
3179                 lport->tt.disc_recv_req = NULL;
3180                 lport->tt.disc_start = NULL;
3181                 lport->tt.disc_stop = NULL;
3182                 lport->tt.disc_stop_final = NULL;
3183                 priv = lport;
3184         }
3185
3186         fc_disc_config(lport, priv);
3187 }
3188
3189 /**
3190  * fcoe_libfc_config() - Sets up libfc related properties for local port
3191  * @lport:    The local port to configure libfc for
3192  * @fip:      The FCoE controller in use by the local port
3193  * @tt:       The libfc function template
3194  * @init_fcp: If non-zero, the FCP portion of libfc should be initialized
3195  *
3196  * Returns : 0 for success
3197  */
3198 int fcoe_libfc_config(struct fc_lport *lport, struct fcoe_ctlr *fip,
3199                       const struct libfc_function_template *tt, int init_fcp)
3200 {
3201         /* Set the function pointers set by the LLDD */
3202         memcpy(&lport->tt, tt, sizeof(*tt));
3203         if (init_fcp && fc_fcp_init(lport))
3204                 return -ENOMEM;
3205         fc_exch_init(lport);
3206         fc_elsct_init(lport);
3207         fc_lport_init(lport);
3208         fc_disc_init(lport);
3209         fcoe_ctlr_mode_set(lport, fip, fip->mode);
3210         return 0;
3211 }
3212 EXPORT_SYMBOL_GPL(fcoe_libfc_config);
3213
3214 void fcoe_fcf_get_selected(struct fcoe_fcf_device *fcf_dev)
3215 {
3216         struct fcoe_ctlr_device *ctlr_dev = fcoe_fcf_dev_to_ctlr_dev(fcf_dev);
3217         struct fcoe_ctlr *fip = fcoe_ctlr_device_priv(ctlr_dev);
3218         struct fcoe_fcf *fcf;
3219
3220         mutex_lock(&fip->ctlr_mutex);
3221         mutex_lock(&ctlr_dev->lock);
3222
3223         fcf = fcoe_fcf_device_priv(fcf_dev);
3224         if (fcf)
3225                 fcf_dev->selected = (fcf == fip->sel_fcf) ? 1 : 0;
3226         else
3227                 fcf_dev->selected = 0;
3228
3229         mutex_unlock(&ctlr_dev->lock);
3230         mutex_unlock(&fip->ctlr_mutex);
3231 }
3232 EXPORT_SYMBOL(fcoe_fcf_get_selected);
3233
3234 void fcoe_ctlr_set_fip_mode(struct fcoe_ctlr_device *ctlr_dev)
3235 {
3236         struct fcoe_ctlr *ctlr = fcoe_ctlr_device_priv(ctlr_dev);
3237         struct fc_lport *lport = ctlr->lp;
3238
3239         mutex_lock(&ctlr->ctlr_mutex);
3240         switch (ctlr_dev->mode) {
3241         case FIP_CONN_TYPE_VN2VN:
3242                 ctlr->mode = FIP_MODE_VN2VN;
3243                 break;
3244         case FIP_CONN_TYPE_FABRIC:
3245         default:
3246                 ctlr->mode = FIP_MODE_FABRIC;
3247                 break;
3248         }
3249
3250         mutex_unlock(&ctlr->ctlr_mutex);
3251
3252         fcoe_ctlr_mode_set(lport, ctlr, ctlr->mode);
3253 }
3254 EXPORT_SYMBOL(fcoe_ctlr_set_fip_mode);