fcoe.c 66.9 KB
Newer Older
1
/*
2
 * Copyright(c) 2007 - 2009 Intel Corporation. All rights reserved.
3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms and conditions of the GNU General Public License,
 * version 2, as published by the Free Software Foundation.
 *
 * This program is distributed in the hope it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 * more details.
 *
 * You should have received a copy of the GNU General Public License along with
 * this program; if not, write to the Free Software Foundation, Inc.,
 * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
 *
 * Maintained at www.Open-FCoE.org
 */

#include <linux/module.h>
#include <linux/version.h>
#include <linux/spinlock.h>
#include <linux/netdevice.h>
#include <linux/etherdevice.h>
#include <linux/ethtool.h>
#include <linux/if_ether.h>
#include <linux/if_vlan.h>
#include <linux/crc32.h>
29
#include <linux/slab.h>
30 31 32 33
#include <linux/cpu.h>
#include <linux/fs.h>
#include <linux/sysfs.h>
#include <linux/ctype.h>
34
#include <linux/workqueue.h>
35 36 37 38 39 40 41
#include <scsi/scsi_tcq.h>
#include <scsi/scsicam.h>
#include <scsi/scsi_transport.h>
#include <scsi/scsi_transport_fc.h>
#include <net/rtnetlink.h>

#include <scsi/fc/fc_encaps.h>
42
#include <scsi/fc/fc_fip.h>
43 44 45 46 47

#include <scsi/libfc.h>
#include <scsi/fc_frame.h>
#include <scsi/libfcoe.h>

48
#include "fcoe.h"
49

50 51
MODULE_AUTHOR("Open-FCoE.org");
MODULE_DESCRIPTION("FCoE");
52
MODULE_LICENSE("GPL v2");
53

54 55 56 57 58 59
/* Performance tuning parameters for fcoe */
static unsigned int fcoe_ddp_min;
module_param_named(ddp_min, fcoe_ddp_min, uint, S_IRUGO | S_IWUSR);
MODULE_PARM_DESC(ddp_min, "Minimum I/O size in bytes for "	\
		 "Direct Data Placement (DDP).");

60 61
DEFINE_MUTEX(fcoe_config_mutex);

62 63
static struct workqueue_struct *fcoe_wq;

64 65 66
/* fcoe_percpu_clean completion.  Waiter protected by fcoe_create_mutex */
static DECLARE_COMPLETION(fcoe_flush_completion);

67
/* fcoe host list */
68
/* must only by accessed under the RTNL mutex */
69
LIST_HEAD(fcoe_hostlist);
70
DEFINE_PER_CPU(struct fcoe_percpu_s, fcoe_percpu);
71

72
/* Function Prototypes */
73
static int fcoe_reset(struct Scsi_Host *);
74 75 76
static int fcoe_xmit(struct fc_lport *, struct fc_frame *);
static int fcoe_rcv(struct sk_buff *, struct net_device *,
		    struct packet_type *, struct net_device *);
77 78
static int fcoe_percpu_receive_thread(void *);
static void fcoe_percpu_clean(struct fc_lport *);
79
static int fcoe_link_speed_update(struct fc_lport *);
80
static int fcoe_link_ok(struct fc_lport *);
81 82 83 84

static struct fc_lport *fcoe_hostlist_lookup(const struct net_device *);
static int fcoe_hostlist_add(const struct fc_lport *);

85 86 87
static int fcoe_device_notification(struct notifier_block *, ulong, void *);
static void fcoe_dev_setup(void);
static void fcoe_dev_cleanup(void);
88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104
static struct fcoe_interface
*fcoe_hostlist_lookup_port(const struct net_device *);

static int fcoe_fip_recv(struct sk_buff *, struct net_device *,
			 struct packet_type *, struct net_device *);

static void fcoe_fip_send(struct fcoe_ctlr *, struct sk_buff *);
static void fcoe_update_src_mac(struct fc_lport *, u8 *);
static u8 *fcoe_get_src_mac(struct fc_lport *);
static void fcoe_destroy_work(struct work_struct *);

static int fcoe_ddp_setup(struct fc_lport *, u16, struct scatterlist *,
			  unsigned int);
static int fcoe_ddp_done(struct fc_lport *, u16);

static int fcoe_cpu_callback(struct notifier_block *, unsigned long, void *);

105 106 107 108 109
static bool fcoe_match(struct net_device *netdev);
static int fcoe_create(struct net_device *netdev, enum fip_state fip_mode);
static int fcoe_destroy(struct net_device *netdev);
static int fcoe_enable(struct net_device *netdev);
static int fcoe_disable(struct net_device *netdev);
110 111 112 113 114 115 116 117

static struct fc_seq *fcoe_elsct_send(struct fc_lport *,
				      u32 did, struct fc_frame *,
				      unsigned int op,
				      void (*resp)(struct fc_seq *,
						   struct fc_frame *,
						   void *),
				      void *, u32 timeout);
118
static void fcoe_recv_frame(struct sk_buff *skb);
119

120 121
static void fcoe_get_lesb(struct fc_lport *, struct fc_els_lesb *);

122
/* notification function for packets from net device */
123 124 125 126
static struct notifier_block fcoe_notifier = {
	.notifier_call = fcoe_device_notification,
};

127 128 129 130 131
/* notification function for CPU hotplug events */
static struct notifier_block fcoe_cpu_notifier = {
	.notifier_call = fcoe_cpu_callback,
};

132 133
static struct scsi_transport_template *fcoe_nport_scsi_transport;
static struct scsi_transport_template *fcoe_vport_scsi_transport;
134

135 136 137 138
static int fcoe_vport_destroy(struct fc_vport *);
static int fcoe_vport_create(struct fc_vport *, bool disabled);
static int fcoe_vport_disable(struct fc_vport *, bool disable);
static void fcoe_set_vport_symbolic_name(struct fc_vport *);
139
static void fcoe_set_port_id(struct fc_lport *, u32, struct fc_frame *);
140 141 142 143 144 145

static struct libfc_function_template fcoe_libfc_fcn_templ = {
	.frame_send = fcoe_xmit,
	.ddp_setup = fcoe_ddp_setup,
	.ddp_done = fcoe_ddp_done,
	.elsct_send = fcoe_elsct_send,
146
	.get_lesb = fcoe_get_lesb,
147
	.lport_set_port_id = fcoe_set_port_id,
148
};
149

150
struct fc_function_template fcoe_nport_fc_functions = {
151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180
	.show_host_node_name = 1,
	.show_host_port_name = 1,
	.show_host_supported_classes = 1,
	.show_host_supported_fc4s = 1,
	.show_host_active_fc4s = 1,
	.show_host_maxframe_size = 1,

	.show_host_port_id = 1,
	.show_host_supported_speeds = 1,
	.get_host_speed = fc_get_host_speed,
	.show_host_speed = 1,
	.show_host_port_type = 1,
	.get_host_port_state = fc_get_host_port_state,
	.show_host_port_state = 1,
	.show_host_symbolic_name = 1,

	.dd_fcrport_size = sizeof(struct fc_rport_libfc_priv),
	.show_rport_maxframe_size = 1,
	.show_rport_supported_classes = 1,

	.show_host_fabric_name = 1,
	.show_starget_node_name = 1,
	.show_starget_port_name = 1,
	.show_starget_port_id = 1,
	.set_rport_dev_loss_tmo = fc_set_rport_loss_tmo,
	.show_rport_dev_loss_tmo = 1,
	.get_fc_host_stats = fc_get_host_stats,
	.issue_fc_host_lip = fcoe_reset,

	.terminate_rport_io = fc_rport_terminate_io,
181 182 183 184

	.vport_create = fcoe_vport_create,
	.vport_delete = fcoe_vport_destroy,
	.vport_disable = fcoe_vport_disable,
185
	.set_vport_symbolic_name = fcoe_set_vport_symbolic_name,
186 187

	.bsg_request = fc_lport_bsg_request,
188 189
};

190
struct fc_function_template fcoe_vport_fc_functions = {
191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220
	.show_host_node_name = 1,
	.show_host_port_name = 1,
	.show_host_supported_classes = 1,
	.show_host_supported_fc4s = 1,
	.show_host_active_fc4s = 1,
	.show_host_maxframe_size = 1,

	.show_host_port_id = 1,
	.show_host_supported_speeds = 1,
	.get_host_speed = fc_get_host_speed,
	.show_host_speed = 1,
	.show_host_port_type = 1,
	.get_host_port_state = fc_get_host_port_state,
	.show_host_port_state = 1,
	.show_host_symbolic_name = 1,

	.dd_fcrport_size = sizeof(struct fc_rport_libfc_priv),
	.show_rport_maxframe_size = 1,
	.show_rport_supported_classes = 1,

	.show_host_fabric_name = 1,
	.show_starget_node_name = 1,
	.show_starget_port_name = 1,
	.show_starget_port_id = 1,
	.set_rport_dev_loss_tmo = fc_set_rport_loss_tmo,
	.show_rport_dev_loss_tmo = 1,
	.get_fc_host_stats = fc_get_host_stats,
	.issue_fc_host_lip = fcoe_reset,

	.terminate_rport_io = fc_rport_terminate_io,
221 222

	.bsg_request = fc_lport_bsg_request,
223 224
};

225 226 227 228 229 230 231 232 233 234 235 236
static struct scsi_host_template fcoe_shost_template = {
	.module = THIS_MODULE,
	.name = "FCoE Driver",
	.proc_name = FCOE_NAME,
	.queuecommand = fc_queuecommand,
	.eh_abort_handler = fc_eh_abort,
	.eh_device_reset_handler = fc_eh_device_reset,
	.eh_host_reset_handler = fc_eh_host_reset,
	.slave_alloc = fc_slave_alloc,
	.change_queue_depth = fc_change_queue_depth,
	.change_queue_type = fc_change_queue_type,
	.this_id = -1,
237
	.cmd_per_lun = 3,
238 239 240 241 242 243
	.can_queue = FCOE_MAX_OUTSTANDING_COMMANDS,
	.use_clustering = ENABLE_CLUSTERING,
	.sg_tablesize = SG_ALL,
	.max_sectors = 0xffff,
};

244
/**
245 246 247
 * fcoe_interface_setup() - Setup a FCoE interface
 * @fcoe:   The new FCoE interface
 * @netdev: The net device that the fcoe interface is on
248 249
 *
 * Returns : 0 for success
250
 * Locking: must be called with the RTNL mutex held
251 252 253 254 255 256
 */
static int fcoe_interface_setup(struct fcoe_interface *fcoe,
				struct net_device *netdev)
{
	struct fcoe_ctlr *fip = &fcoe->ctlr;
	struct netdev_hw_addr *ha;
257
	struct net_device *real_dev;
258
	u8 flogi_maddr[ETH_ALEN];
259
	const struct net_device_ops *ops;
260 261 262

	fcoe->netdev = netdev;

263 264 265 266 267 268 269 270
	/* Let LLD initialize for FCoE */
	ops = netdev->netdev_ops;
	if (ops->ndo_fcoe_enable) {
		if (ops->ndo_fcoe_enable(netdev))
			FCOE_NETDEV_DBG(netdev, "Failed to enable FCoE"
					" specific feature for LLD.\n");
	}

271 272 273 274
	/* Do not support for bonding device */
	if ((netdev->priv_flags & IFF_MASTER_ALB) ||
	    (netdev->priv_flags & IFF_SLAVE_INACTIVE) ||
	    (netdev->priv_flags & IFF_MASTER_8023AD)) {
275
		FCOE_NETDEV_DBG(netdev, "Bonded interfaces not supported\n");
276 277 278 279 280
		return -EOPNOTSUPP;
	}

	/* look for SAN MAC address, if multiple SAN MACs exist, only
	 * use the first one for SPMA */
281 282
	real_dev = (netdev->priv_flags & IFF_802_1Q_VLAN) ?
		vlan_dev_real_dev(netdev) : netdev;
283
	rcu_read_lock();
284
	for_each_dev_addr(real_dev, ha) {
285
		if ((ha->type == NETDEV_HW_ADDR_T_SAN) &&
Y
Yi Zou 已提交
286
		    (is_valid_ether_addr(ha->addr))) {
287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303
			memcpy(fip->ctl_src_addr, ha->addr, ETH_ALEN);
			fip->spma = 1;
			break;
		}
	}
	rcu_read_unlock();

	/* setup Source Mac Address */
	if (!fip->spma)
		memcpy(fip->ctl_src_addr, netdev->dev_addr, netdev->addr_len);

	/*
	 * Add FCoE MAC address as second unicast MAC address
	 * or enter promiscuous mode if not capable of listening
	 * for multiple unicast MACs.
	 */
	memcpy(flogi_maddr, (u8[6]) FC_FCOE_FLOGI_MAC, ETH_ALEN);
304
	dev_uc_add(netdev, flogi_maddr);
305
	if (fip->spma)
306
		dev_uc_add(netdev, fip->ctl_src_addr);
307 308 309 310 311
	if (fip->mode == FIP_MODE_VN2VN) {
		dev_mc_add(netdev, FIP_ALL_VN2VN_MACS);
		dev_mc_add(netdev, FIP_ALL_P2P_MACS);
	} else
		dev_mc_add(netdev, FIP_ALL_ENODE_MACS);
312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329

	/*
	 * setup the receive function from ethernet driver
	 * on the ethertype for the given device
	 */
	fcoe->fcoe_packet_type.func = fcoe_rcv;
	fcoe->fcoe_packet_type.type = __constant_htons(ETH_P_FCOE);
	fcoe->fcoe_packet_type.dev = netdev;
	dev_add_pack(&fcoe->fcoe_packet_type);

	fcoe->fip_packet_type.func = fcoe_fip_recv;
	fcoe->fip_packet_type.type = htons(ETH_P_FIP);
	fcoe->fip_packet_type.dev = netdev;
	dev_add_pack(&fcoe->fip_packet_type);

	return 0;
}

330
/**
331 332
 * fcoe_interface_create() - Create a FCoE interface on a net device
 * @netdev: The net device to create the FCoE interface on
333
 * @fip_mode: The mode to use for FIP
334 335 336
 *
 * Returns: pointer to a struct fcoe_interface or NULL on error
 */
337 338
static struct fcoe_interface *fcoe_interface_create(struct net_device *netdev,
						    enum fip_state fip_mode)
339 340
{
	struct fcoe_interface *fcoe;
341
	int err;
342

343 344 345 346 347 348 349
	if (!try_module_get(THIS_MODULE)) {
		FCOE_NETDEV_DBG(netdev,
				"Could not get a reference to the module\n");
		fcoe = ERR_PTR(-EBUSY);
		goto out;
	}

350 351 352
	fcoe = kzalloc(sizeof(*fcoe), GFP_KERNEL);
	if (!fcoe) {
		FCOE_NETDEV_DBG(netdev, "Could not allocate fcoe structure\n");
353 354
		fcoe = ERR_PTR(-ENOMEM);
		goto out_nomod;
355 356
	}

357
	dev_hold(netdev);
358
	kref_init(&fcoe->kref);
359 360 361 362

	/*
	 * Initialize FIP.
	 */
363
	fcoe_ctlr_init(&fcoe->ctlr, fip_mode);
364 365
	fcoe->ctlr.send = fcoe_fip_send;
	fcoe->ctlr.update_mac = fcoe_update_src_mac;
366
	fcoe->ctlr.get_src_addr = fcoe_get_src_mac;
367

368 369 370 371 372
	err = fcoe_interface_setup(fcoe, netdev);
	if (err) {
		fcoe_ctlr_destroy(&fcoe->ctlr);
		kfree(fcoe);
		dev_put(netdev);
373 374
		fcoe = ERR_PTR(err);
		goto out_nomod;
375
	}
376

377 378 379 380 381
	goto out;

out_nomod:
	module_put(THIS_MODULE);
out:
382 383 384
	return fcoe;
}

385
/**
386 387
 * fcoe_interface_cleanup() - Clean up a FCoE interface
 * @fcoe: The FCoE interface to be cleaned up
388 389
 *
 * Caller must be holding the RTNL mutex
390 391 392 393 394 395
 */
void fcoe_interface_cleanup(struct fcoe_interface *fcoe)
{
	struct net_device *netdev = fcoe->netdev;
	struct fcoe_ctlr *fip = &fcoe->ctlr;
	u8 flogi_maddr[ETH_ALEN];
396
	const struct net_device_ops *ops;
397 398 399 400 401 402 403 404 405 406 407 408 409

	/*
	 * Don't listen for Ethernet packets anymore.
	 * synchronize_net() ensures that the packet handlers are not running
	 * on another CPU. dev_remove_pack() would do that, this calls the
	 * unsyncronized version __dev_remove_pack() to avoid multiple delays.
	 */
	__dev_remove_pack(&fcoe->fcoe_packet_type);
	__dev_remove_pack(&fcoe->fip_packet_type);
	synchronize_net();

	/* Delete secondary MAC addresses */
	memcpy(flogi_maddr, (u8[6]) FC_FCOE_FLOGI_MAC, ETH_ALEN);
410
	dev_uc_del(netdev, flogi_maddr);
411
	if (fip->spma)
412
		dev_uc_del(netdev, fip->ctl_src_addr);
413 414 415 416 417
	if (fip->mode == FIP_MODE_VN2VN) {
		dev_mc_del(netdev, FIP_ALL_VN2VN_MACS);
		dev_mc_del(netdev, FIP_ALL_P2P_MACS);
	} else
		dev_mc_del(netdev, FIP_ALL_ENODE_MACS);
418 419 420 421 422 423 424 425

	/* Tell the LLD we are done w/ FCoE */
	ops = netdev->netdev_ops;
	if (ops->ndo_fcoe_disable) {
		if (ops->ndo_fcoe_disable(netdev))
			FCOE_NETDEV_DBG(netdev, "Failed to disable FCoE"
					" specific feature for LLD.\n");
	}
426 427
}

428 429
/**
 * fcoe_interface_release() - fcoe_port kref release function
430
 * @kref: Embedded reference count in an fcoe_interface struct
431 432 433 434
 */
static void fcoe_interface_release(struct kref *kref)
{
	struct fcoe_interface *fcoe;
435
	struct net_device *netdev;
436 437

	fcoe = container_of(kref, struct fcoe_interface, kref);
438 439 440
	netdev = fcoe->netdev;
	/* tear-down the FCoE controller */
	fcoe_ctlr_destroy(&fcoe->ctlr);
441
	kfree(fcoe);
442
	dev_put(netdev);
443
	module_put(THIS_MODULE);
444 445 446
}

/**
447 448
 * fcoe_interface_get() - Get a reference to a FCoE interface
 * @fcoe: The FCoE interface to be held
449 450 451 452 453 454 455
 */
static inline void fcoe_interface_get(struct fcoe_interface *fcoe)
{
	kref_get(&fcoe->kref);
}

/**
456 457
 * fcoe_interface_put() - Put a reference to a FCoE interface
 * @fcoe: The FCoE interface to be released
458 459 460 461 462 463
 */
static inline void fcoe_interface_put(struct fcoe_interface *fcoe)
{
	kref_put(&fcoe->kref, fcoe_interface_release);
}

464
/**
465 466 467 468 469 470
 * fcoe_fip_recv() - Handler for received FIP frames
 * @skb:      The receive skb
 * @netdev:   The associated net device
 * @ptype:    The packet_type structure which was used to register this handler
 * @orig_dev: The original net_device the the skb was received on.
 *	      (in case dev is a bond)
471 472 473
 *
 * Returns: 0 for success
 */
474
static int fcoe_fip_recv(struct sk_buff *skb, struct net_device *netdev,
475 476 477
			 struct packet_type *ptype,
			 struct net_device *orig_dev)
{
478
	struct fcoe_interface *fcoe;
479

480
	fcoe = container_of(ptype, struct fcoe_interface, fip_packet_type);
481
	fcoe_ctlr_recv(&fcoe->ctlr, skb);
482 483 484 485
	return 0;
}

/**
486 487 488
 * fcoe_fip_send() - Send an Ethernet-encapsulated FIP frame
 * @fip: The FCoE controller
 * @skb: The FIP packet to be sent
489 490 491
 */
static void fcoe_fip_send(struct fcoe_ctlr *fip, struct sk_buff *skb)
{
492
	skb->dev = fcoe_from_ctlr(fip)->netdev;
493 494 495 496
	dev_queue_xmit(skb);
}

/**
497 498 499
 * fcoe_update_src_mac() - Update the Ethernet MAC filters
 * @lport: The local port to update the source MAC on
 * @addr:  Unicast MAC address to add
500 501 502 503
 *
 * Remove any previously-set unicast MAC filter.
 * Add secondary FCoE MAC address filter for our OUI.
 */
504
static void fcoe_update_src_mac(struct fc_lport *lport, u8 *addr)
505
{
506
	struct fcoe_port *port = lport_priv(lport);
507
	struct fcoe_interface *fcoe = port->priv;
508

509
	rtnl_lock();
510
	if (!is_zero_ether_addr(port->data_src_addr))
511
		dev_uc_del(fcoe->netdev, port->data_src_addr);
512
	if (!is_zero_ether_addr(addr))
513
		dev_uc_add(fcoe->netdev, addr);
514
	memcpy(port->data_src_addr, addr, ETH_ALEN);
515 516 517
	rtnl_unlock();
}

518 519 520 521 522 523 524 525 526 527 528
/**
 * fcoe_get_src_mac() - return the Ethernet source address for an lport
 * @lport: libfc lport
 */
static u8 *fcoe_get_src_mac(struct fc_lport *lport)
{
	struct fcoe_port *port = lport_priv(lport);

	return port->data_src_addr;
}

529
/**
530 531
 * fcoe_lport_config() - Set up a local port
 * @lport: The local port to be setup
532 533 534
 *
 * Returns: 0 for success
 */
535
static int fcoe_lport_config(struct fc_lport *lport)
536
{
537 538 539 540 541 542 543 544 545 546 547
	lport->link_up = 0;
	lport->qfull = 0;
	lport->max_retry_count = 3;
	lport->max_rport_retry_count = 3;
	lport->e_d_tov = 2 * 1000;	/* FC-FS default */
	lport->r_a_tov = 2 * 2 * 1000;
	lport->service_params = (FCP_SPPF_INIT_FCN | FCP_SPPF_RD_XRDY_DIS |
				 FCP_SPPF_RETRY | FCP_SPPF_CONF_COMPL);
	lport->does_npiv = 1;

	fc_lport_init_stats(lport);
548 549

	/* lport fc_lport related configuration */
550
	fc_lport_config(lport);
551 552

	/* offload related configuration */
553 554 555 556 557
	lport->crc_offload = 0;
	lport->seq_offload = 0;
	lport->lro_enabled = 0;
	lport->lro_xid = 0;
	lport->lso_max = 0;
558 559 560 561

	return 0;
}

562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578
/**
 * fcoe_get_wwn() - Get the world wide name from LLD if it supports it
 * @netdev: the associated net device
 * @wwn: the output WWN
 * @type: the type of WWN (WWPN or WWNN)
 *
 * Returns: 0 for success
 */
static int fcoe_get_wwn(struct net_device *netdev, u64 *wwn, int type)
{
	const struct net_device_ops *ops = netdev->netdev_ops;

	if (ops->ndo_fcoe_get_wwn)
		return ops->ndo_fcoe_get_wwn(netdev, wwn, type);
	return -EINVAL;
}

579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622
/**
 * fcoe_netdev_features_change - Updates the lport's offload flags based
 * on the LLD netdev's FCoE feature flags
 */
static void fcoe_netdev_features_change(struct fc_lport *lport,
					struct net_device *netdev)
{
	mutex_lock(&lport->lp_mutex);

	if (netdev->features & NETIF_F_SG)
		lport->sg_supp = 1;
	else
		lport->sg_supp = 0;

	if (netdev->features & NETIF_F_FCOE_CRC) {
		lport->crc_offload = 1;
		FCOE_NETDEV_DBG(netdev, "Supports FCCRC offload\n");
	} else {
		lport->crc_offload = 0;
	}

	if (netdev->features & NETIF_F_FSO) {
		lport->seq_offload = 1;
		lport->lso_max = netdev->gso_max_size;
		FCOE_NETDEV_DBG(netdev, "Supports LSO for max len 0x%x\n",
				lport->lso_max);
	} else {
		lport->seq_offload = 0;
		lport->lso_max = 0;
	}

	if (netdev->fcoe_ddp_xid) {
		lport->lro_enabled = 1;
		lport->lro_xid = netdev->fcoe_ddp_xid;
		FCOE_NETDEV_DBG(netdev, "Supports LRO for max xid 0x%x\n",
				lport->lro_xid);
	} else {
		lport->lro_enabled = 0;
		lport->lro_xid = 0;
	}

	mutex_unlock(&lport->lp_mutex);
}

623
/**
624 625 626
 * fcoe_netdev_config() - Set up net devive for SW FCoE
 * @lport:  The local port that is associated with the net device
 * @netdev: The associated net device
627
 *
628
 * Must be called after fcoe_lport_config() as it will use local port mutex
629
 *
630
 * Returns: 0 for success
631
 */
632
static int fcoe_netdev_config(struct fc_lport *lport, struct net_device *netdev)
633 634 635
{
	u32 mfs;
	u64 wwnn, wwpn;
636
	struct fcoe_interface *fcoe;
637
	struct fcoe_port *port;
638 639

	/* Setup lport private data to point to fcoe softc */
640
	port = lport_priv(lport);
641
	fcoe = port->priv;
642 643 644 645 646 647

	/*
	 * Determine max frame size based on underlying device and optional
	 * user-configured limit.  If the MFS is too low, fcoe_link_ok()
	 * will return 0, so do this first.
	 */
648 649 650 651 652 653
	mfs = netdev->mtu;
	if (netdev->features & NETIF_F_FCOE_MTU) {
		mfs = FCOE_MTU;
		FCOE_NETDEV_DBG(netdev, "Supports FCOE_MTU of %d bytes\n", mfs);
	}
	mfs -= (sizeof(struct fcoe_hdr) + sizeof(struct fcoe_crc_eof));
654
	if (fc_set_mfs(lport, mfs))
655 656 657
		return -EINVAL;

	/* offload features support */
658
	fcoe_netdev_features_change(lport, netdev);
659

660 661
	skb_queue_head_init(&port->fcoe_pending_queue);
	port->fcoe_pending_queue_active = 0;
662
	setup_timer(&port->timer, fcoe_queue_timer, (unsigned long)lport);
663

664 665
	fcoe_link_speed_update(lport);

666
	if (!lport->vport) {
667 668
		if (fcoe_get_wwn(netdev, &wwnn, NETDEV_FCOE_WWNN))
			wwnn = fcoe_wwn_from_mac(fcoe->ctlr.ctl_src_addr, 1, 0);
669
		fc_set_wwnn(lport, wwnn);
670 671
		if (fcoe_get_wwn(netdev, &wwpn, NETDEV_FCOE_WWPN))
			wwpn = fcoe_wwn_from_mac(fcoe->ctlr.ctl_src_addr,
672
						 2, 0);
673
		fc_set_wwpn(lport, wwpn);
674
	}
675 676 677 678 679

	return 0;
}

/**
680 681 682
 * fcoe_shost_config() - Set up the SCSI host associated with a local port
 * @lport: The local port
 * @dev:   The device associated with the SCSI host
683 684 685
 *
 * Must be called after fcoe_lport_config() and fcoe_netdev_config()
 *
686
 * Returns: 0 for success
687
 */
688
static int fcoe_shost_config(struct fc_lport *lport, struct device *dev)
689 690 691 692
{
	int rc = 0;

	/* lport scsi host config */
693 694 695
	lport->host->max_lun = FCOE_MAX_LUN;
	lport->host->max_id = FCOE_MAX_FCP_TARGET;
	lport->host->max_channel = 0;
696 697
	lport->host->max_cmd_len = FCOE_MAX_CMD_LEN;

698
	if (lport->vport)
699
		lport->host->transportt = fcoe_vport_scsi_transport;
700
	else
701
		lport->host->transportt = fcoe_nport_scsi_transport;
702 703

	/* add the new host to the SCSI-ml */
704
	rc = scsi_add_host(lport->host, dev);
705
	if (rc) {
706
		FCOE_NETDEV_DBG(fcoe_netdev(lport), "fcoe_shost_config: "
707
				"error on scsi_add_host\n");
708 709
		return rc;
	}
710

711
	if (!lport->vport)
712
		fc_host_max_npiv_vports(lport->host) = USHRT_MAX;
713

714
	snprintf(fc_host_symbolic_name(lport->host), FC_SYMBOLIC_NAME_SIZE,
715
		 "%s v%s over %s", FCOE_NAME, FCOE_VERSION,
716
		 fcoe_netdev(lport)->name);
717 718 719 720

	return 0;
}

721 722 723
/**
 * fcoe_oem_match() - The match routine for the offloaded exchange manager
 * @fp: The I/O frame
724
 *
725 726 727 728 729 730 731 732 733 734
 * This routine will be associated with an exchange manager (EM). When
 * the libfc exchange handling code is looking for an EM to use it will
 * call this routine and pass it the frame that it wishes to send. This
 * routine will return True if the associated EM is to be used and False
 * if the echange code should continue looking for an EM.
 *
 * The offload EM that this routine is associated with will handle any
 * packets that are for SCSI read requests.
 *
 * Returns: True for read types I/O, otherwise returns false.
735 736 737
 */
bool fcoe_oem_match(struct fc_frame *fp)
{
738 739
	return fc_fcp_is_read(fr_fsp(fp)) &&
		(fr_fsp(fp)->data_len > fcoe_ddp_min);
740 741
}

742
/**
743 744
 * fcoe_em_config() - Allocate and configure an exchange manager
 * @lport: The local port that the new EM will be associated with
745
 *
746
 * Returns: 0 on success
747
 */
748
static inline int fcoe_em_config(struct fc_lport *lport)
749
{
750
	struct fcoe_port *port = lport_priv(lport);
751
	struct fcoe_interface *fcoe = port->priv;
752
	struct fcoe_interface *oldfcoe = NULL;
753
	struct net_device *old_real_dev, *cur_real_dev;
754 755 756 757 758 759 760
	u16 min_xid = FCOE_MIN_XID;
	u16 max_xid = FCOE_MAX_XID;

	/*
	 * Check if need to allocate an em instance for
	 * offload exchange ids to be shared across all VN_PORTs/lport.
	 */
761 762 763
	if (!lport->lro_enabled || !lport->lro_xid ||
	    (lport->lro_xid >= max_xid)) {
		lport->lro_xid = 0;
764 765 766 767 768
		goto skip_oem;
	}

	/*
	 * Reuse existing offload em instance in case
769
	 * it is already allocated on real eth device
770
	 */
771 772
	if (fcoe->netdev->priv_flags & IFF_802_1Q_VLAN)
		cur_real_dev = vlan_dev_real_dev(fcoe->netdev);
773
	else
774
		cur_real_dev = fcoe->netdev;
775

776 777 778
	list_for_each_entry(oldfcoe, &fcoe_hostlist, list) {
		if (oldfcoe->netdev->priv_flags & IFF_802_1Q_VLAN)
			old_real_dev = vlan_dev_real_dev(oldfcoe->netdev);
779
		else
780
			old_real_dev = oldfcoe->netdev;
781 782

		if (cur_real_dev == old_real_dev) {
783
			fcoe->oem = oldfcoe->oem;
784 785 786 787
			break;
		}
	}

788
	if (fcoe->oem) {
789
		if (!fc_exch_mgr_add(lport, fcoe->oem, fcoe_oem_match)) {
790 791
			printk(KERN_ERR "fcoe_em_config: failed to add "
			       "offload em:%p on interface:%s\n",
792
			       fcoe->oem, fcoe->netdev->name);
793 794 795
			return -ENOMEM;
		}
	} else {
796 797 798
		fcoe->oem = fc_exch_mgr_alloc(lport, FC_CLASS_3,
					      FCOE_MIN_XID, lport->lro_xid,
					      fcoe_oem_match);
799
		if (!fcoe->oem) {
800 801
			printk(KERN_ERR "fcoe_em_config: failed to allocate "
			       "em for offload exches on interface:%s\n",
802
			       fcoe->netdev->name);
803 804 805 806 807 808 809
			return -ENOMEM;
		}
	}

	/*
	 * Exclude offload EM xid range from next EM xid range.
	 */
810
	min_xid += lport->lro_xid + 1;
811 812

skip_oem:
813
	if (!fc_exch_mgr_alloc(lport, FC_CLASS_3, min_xid, max_xid, NULL)) {
814
		printk(KERN_ERR "fcoe_em_config: failed to "
815
		       "allocate em on interface %s\n", fcoe->netdev->name);
816
		return -ENOMEM;
817
	}
818 819 820 821 822

	return 0;
}

/**
823 824
 * fcoe_if_destroy() - Tear down a SW FCoE instance
 * @lport: The local port to be destroyed
825 826 827 828 829 830
 *
 * Locking: must be called with the RTNL mutex held and RTNL mutex
 * needed to be dropped by this function since not dropping RTNL
 * would cause circular locking warning on synchronous fip worker
 * cancelling thru fcoe_interface_put invoked by this function.
 *
831
 */
832
static void fcoe_if_destroy(struct fc_lport *lport)
833
{
834
	struct fcoe_port *port = lport_priv(lport);
835
	struct fcoe_interface *fcoe = port->priv;
836
	struct net_device *netdev = fcoe->netdev;
837

838
	FCOE_NETDEV_DBG(netdev, "Destroying interface\n");
839 840

	/* Logout of the fabric */
841
	fc_fabric_logoff(lport);
842

843 844 845 846 847
	/* Cleanup the fc_lport */
	fc_lport_destroy(lport);

	/* Stop the transmit retry timer */
	del_timer_sync(&port->timer);
848

849 850 851
	/* Free existing transmit skbs */
	fcoe_clean_pending_queue(lport);

852
	if (!is_zero_ether_addr(port->data_src_addr))
853
		dev_uc_del(netdev, port->data_src_addr);
854 855
	rtnl_unlock();

856 857
	/* receives may not be stopped until after this */
	fcoe_interface_put(fcoe);
858

859
	/* Free queued packets for the per-CPU receive threads */
860
	fcoe_percpu_clean(lport);
861

862
	/* Detach from the scsi-ml */
863 864
	fc_remove_host(lport->host);
	scsi_remove_host(lport->host);
865

866 867 868
	/* Destroy lport scsi_priv */
	fc_fcp_destroy(lport);

869
	/* There are no more rports or I/O, free the EM */
870
	fc_exch_mgr_free(lport);
871 872

	/* Free memory used by statistical counters */
873
	fc_lport_free_stats(lport);
874

875
	/* Release the Scsi_Host */
876
	scsi_host_put(lport->host);
877 878
}

879 880 881 882 883 884
/**
 * fcoe_ddp_setup() - Call a LLD's ddp_setup through the net device
 * @lport: The local port to setup DDP for
 * @xid:   The exchange ID for this DDP transfer
 * @sgl:   The scatterlist describing this transfer
 * @sgc:   The number of sg items
885
 *
886
 * Returns: 0 if the DDP context was not configured
887
 */
888 889
static int fcoe_ddp_setup(struct fc_lport *lport, u16 xid,
			  struct scatterlist *sgl, unsigned int sgc)
890
{
891
	struct net_device *netdev = fcoe_netdev(lport);
892

893 894 895 896
	if (netdev->netdev_ops->ndo_fcoe_ddp_setup)
		return netdev->netdev_ops->ndo_fcoe_ddp_setup(netdev,
							      xid, sgl,
							      sgc);
897 898 899 900

	return 0;
}

901 902 903 904
/**
 * fcoe_ddp_done() - Call a LLD's ddp_done through the net device
 * @lport: The local port to complete DDP on
 * @xid:   The exchange ID for this DDP transfer
905
 *
906
 * Returns: the length of data that have been completed by DDP
907
 */
908
static int fcoe_ddp_done(struct fc_lport *lport, u16 xid)
909
{
910
	struct net_device *netdev = fcoe_netdev(lport);
911

912 913
	if (netdev->netdev_ops->ndo_fcoe_ddp_done)
		return netdev->netdev_ops->ndo_fcoe_ddp_done(netdev, xid);
914 915 916 917
	return 0;
}

/**
918 919 920 921
 * fcoe_if_create() - Create a FCoE instance on an interface
 * @fcoe:   The FCoE interface to create a local port on
 * @parent: The device pointer to be the parent in sysfs for the SCSI host
 * @npiv:   Indicates if the port is a vport or not
922
 *
923
 * Creates a fc_lport instance and a Scsi_Host instance and configure them.
924
 *
925
 * Returns: The allocated fc_lport or an error pointer
926
 */
927
static struct fc_lport *fcoe_if_create(struct fcoe_interface *fcoe,
928
				       struct device *parent, int npiv)
929
{
930
	struct net_device *netdev = fcoe->netdev;
931
	struct fc_lport *lport = NULL;
932
	struct fcoe_port *port;
933
	int rc;
934 935 936 937 938
	/*
	 * parent is only a vport if npiv is 1,
	 * but we'll only use vport in that case so go ahead and set it
	 */
	struct fc_vport *vport = dev_to_vport(parent);
939

940
	FCOE_NETDEV_DBG(netdev, "Create Interface\n");
941

942 943 944 945 946 947 948
	if (!npiv) {
		lport = libfc_host_alloc(&fcoe_shost_template,
					 sizeof(struct fcoe_port));
	} else	{
		lport = libfc_vport_create(vport,
					   sizeof(struct fcoe_port));
	}
949
	if (!lport) {
950
		FCOE_NETDEV_DBG(netdev, "Could not allocate host structure\n");
951
		rc = -ENOMEM;
952
		goto out;
953
	}
954
	port = lport_priv(lport);
955
	port->lport = lport;
956 957 958
	port->priv = fcoe;
	port->max_queue_depth = FCOE_MAX_QUEUE_DEPTH;
	port->min_queue_depth = FCOE_MIN_QUEUE_DEPTH;
959
	INIT_WORK(&port->destroy_work, fcoe_destroy_work);
960

961
	/* configure a fc_lport including the exchange manager */
962
	rc = fcoe_lport_config(lport);
963
	if (rc) {
964 965
		FCOE_NETDEV_DBG(netdev, "Could not configure lport for the "
				"interface\n");
966 967 968
		goto out_host_put;
	}

969
	if (npiv) {
970 971
		FCOE_NETDEV_DBG(netdev, "Setting vport names, "
				"%16.16llx %16.16llx\n",
972
				vport->node_name, vport->port_name);
973 974 975 976
		fc_set_wwnn(lport, vport->node_name);
		fc_set_wwpn(lport, vport->port_name);
	}

977
	/* configure lport network properties */
978
	rc = fcoe_netdev_config(lport, netdev);
979
	if (rc) {
980 981
		FCOE_NETDEV_DBG(netdev, "Could not configure netdev for the "
				"interface\n");
982
		goto out_lp_destroy;
983
	}
984

985
	/* configure lport scsi host properties */
986
	rc = fcoe_shost_config(lport, parent);
987
	if (rc) {
988 989
		FCOE_NETDEV_DBG(netdev, "Could not configure shost for the "
				"interface\n");
990
		goto out_lp_destroy;
991 992
	}

993
	/* Initialize the library */
994
	rc = fcoe_libfc_config(lport, &fcoe->ctlr, &fcoe_libfc_fcn_templ, 1);
995
	if (rc) {
996
		FCOE_NETDEV_DBG(netdev, "Could not configure libfc for the "
997
				"interface\n");
998
		goto out_lp_destroy;
999 1000
	}

1001 1002 1003 1004 1005 1006 1007 1008 1009 1010
	if (!npiv) {
		/*
		 * fcoe_em_alloc() and fcoe_hostlist_add() both
		 * need to be atomic with respect to other changes to the
		 * hostlist since fcoe_em_alloc() looks for an existing EM
		 * instance on host list updated by fcoe_hostlist_add().
		 *
		 * This is currently handled through the fcoe_config_mutex
		 * begin held.
		 */
1011

1012 1013 1014 1015
		/* lport exch manager allocation */
		rc = fcoe_em_config(lport);
		if (rc) {
			FCOE_NETDEV_DBG(netdev, "Could not configure the EM "
1016
					"for the interface\n");
1017 1018
			goto out_lp_destroy;
		}
1019 1020
	}

1021
	fcoe_interface_get(fcoe);
1022
	return lport;
1023 1024

out_lp_destroy:
1025
	fc_exch_mgr_free(lport);
1026
out_host_put:
1027 1028 1029
	scsi_host_put(lport->host);
out:
	return ERR_PTR(rc);
1030 1031 1032
}

/**
1033
 * fcoe_if_init() - Initialization routine for fcoe.ko
1034
 *
1035 1036 1037
 * Attaches the SW FCoE transport to the FC transport
 *
 * Returns: 0 on success
1038 1039 1040 1041
 */
static int __init fcoe_if_init(void)
{
	/* attach to scsi transport */
1042 1043 1044 1045
	fcoe_nport_scsi_transport =
		fc_attach_transport(&fcoe_nport_fc_functions);
	fcoe_vport_scsi_transport =
		fc_attach_transport(&fcoe_vport_fc_functions);
1046

1047
	if (!fcoe_nport_scsi_transport) {
1048
		printk(KERN_ERR "fcoe: Failed to attach to the FC transport\n");
1049 1050 1051 1052 1053 1054 1055
		return -ENODEV;
	}

	return 0;
}

/**
1056 1057 1058
 * fcoe_if_exit() - Tear down fcoe.ko
 *
 * Detaches the SW FCoE transport from the FC transport
1059
 *
1060
 * Returns: 0 on success
1061 1062 1063
 */
int __exit fcoe_if_exit(void)
{
1064 1065 1066 1067
	fc_release_transport(fcoe_nport_scsi_transport);
	fc_release_transport(fcoe_vport_scsi_transport);
	fcoe_nport_scsi_transport = NULL;
	fcoe_vport_scsi_transport = NULL;
1068 1069 1070
	return 0;
}

1071
/**
1072 1073
 * fcoe_percpu_thread_create() - Create a receive thread for an online CPU
 * @cpu: The CPU index of the CPU to create a receive thread for
1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084
 */
static void fcoe_percpu_thread_create(unsigned int cpu)
{
	struct fcoe_percpu_s *p;
	struct task_struct *thread;

	p = &per_cpu(fcoe_percpu, cpu);

	thread = kthread_create(fcoe_percpu_receive_thread,
				(void *)p, "fcoethread/%d", cpu);

1085
	if (likely(!IS_ERR(thread))) {
1086 1087 1088 1089 1090 1091 1092 1093 1094 1095
		kthread_bind(thread, cpu);
		wake_up_process(thread);

		spin_lock_bh(&p->fcoe_rx_list.lock);
		p->thread = thread;
		spin_unlock_bh(&p->fcoe_rx_list.lock);
	}
}

/**
1096 1097
 * fcoe_percpu_thread_destroy() - Remove the receive thread of a CPU
 * @cpu: The CPU index of the CPU whose receive thread is to be destroyed
1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110
 *
 * Destroys a per-CPU Rx thread. Any pending skbs are moved to the
 * current CPU's Rx thread. If the thread being destroyed is bound to
 * the CPU processing this context the skbs will be freed.
 */
static void fcoe_percpu_thread_destroy(unsigned int cpu)
{
	struct fcoe_percpu_s *p;
	struct task_struct *thread;
	struct page *crc_eof;
	struct sk_buff *skb;
#ifdef CONFIG_SMP
	struct fcoe_percpu_s *p0;
1111
	unsigned targ_cpu = get_cpu();
1112 1113
#endif /* CONFIG_SMP */

1114
	FCOE_DBG("Destroying receive thread for CPU %d\n", cpu);
1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135

	/* Prevent any new skbs from being queued for this CPU. */
	p = &per_cpu(fcoe_percpu, cpu);
	spin_lock_bh(&p->fcoe_rx_list.lock);
	thread = p->thread;
	p->thread = NULL;
	crc_eof = p->crc_eof_page;
	p->crc_eof_page = NULL;
	p->crc_eof_offset = 0;
	spin_unlock_bh(&p->fcoe_rx_list.lock);

#ifdef CONFIG_SMP
	/*
	 * Don't bother moving the skb's if this context is running
	 * on the same CPU that is having its thread destroyed. This
	 * can easily happen when the module is removed.
	 */
	if (cpu != targ_cpu) {
		p0 = &per_cpu(fcoe_percpu, targ_cpu);
		spin_lock_bh(&p0->fcoe_rx_list.lock);
		if (p0->thread) {
1136 1137
			FCOE_DBG("Moving frames from CPU %d to CPU %d\n",
				 cpu, targ_cpu);
1138 1139 1140 1141 1142 1143 1144

			while ((skb = __skb_dequeue(&p->fcoe_rx_list)) != NULL)
				__skb_queue_tail(&p0->fcoe_rx_list, skb);
			spin_unlock_bh(&p0->fcoe_rx_list.lock);
		} else {
			/*
			 * The targeted CPU is not initialized and cannot accept
1145
			 * new	skbs. Unlock the targeted CPU and drop the skbs
1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166
			 * on the CPU that is going offline.
			 */
			while ((skb = __skb_dequeue(&p->fcoe_rx_list)) != NULL)
				kfree_skb(skb);
			spin_unlock_bh(&p0->fcoe_rx_list.lock);
		}
	} else {
		/*
		 * This scenario occurs when the module is being removed
		 * and all threads are being destroyed. skbs will continue
		 * to be shifted from the CPU thread that is being removed
		 * to the CPU thread associated with the CPU that is processing
		 * the module removal. Once there is only one CPU Rx thread it
		 * will reach this case and we will drop all skbs and later
		 * stop the thread.
		 */
		spin_lock_bh(&p->fcoe_rx_list.lock);
		while ((skb = __skb_dequeue(&p->fcoe_rx_list)) != NULL)
			kfree_skb(skb);
		spin_unlock_bh(&p->fcoe_rx_list.lock);
	}
1167
	put_cpu();
1168 1169
#else
	/*
1170
	 * This a non-SMP scenario where the singular Rx thread is
1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186
	 * being removed. Free all skbs and stop the thread.
	 */
	spin_lock_bh(&p->fcoe_rx_list.lock);
	while ((skb = __skb_dequeue(&p->fcoe_rx_list)) != NULL)
		kfree_skb(skb);
	spin_unlock_bh(&p->fcoe_rx_list.lock);
#endif

	if (thread)
		kthread_stop(thread);

	if (crc_eof)
		put_page(crc_eof);
}

/**
1187 1188 1189 1190
 * fcoe_cpu_callback() - Handler for CPU hotplug events
 * @nfb:    The callback data block
 * @action: The event triggering the callback
 * @hcpu:   The index of the CPU that the event is for
1191
 *
1192
 * This creates or destroys per-CPU data for fcoe
1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203
 *
 * Returns NOTIFY_OK always.
 */
static int fcoe_cpu_callback(struct notifier_block *nfb,
			     unsigned long action, void *hcpu)
{
	unsigned cpu = (unsigned long)hcpu;

	switch (action) {
	case CPU_ONLINE:
	case CPU_ONLINE_FROZEN:
1204
		FCOE_DBG("CPU %x online: Create Rx thread\n", cpu);
1205 1206 1207 1208
		fcoe_percpu_thread_create(cpu);
		break;
	case CPU_DEAD:
	case CPU_DEAD_FROZEN:
1209
		FCOE_DBG("CPU %x offline: Remove Rx thread\n", cpu);
1210 1211 1212 1213 1214 1215 1216 1217
		fcoe_percpu_thread_destroy(cpu);
		break;
	default:
		break;
	}
	return NOTIFY_OK;
}

1218
/**
1219 1220 1221 1222 1223
 * fcoe_rcv() - Receive packets from a net device
 * @skb:    The received packet
 * @netdev: The net device that the packet was received on
 * @ptype:  The packet type context
 * @olddev: The last device net device
1224
 *
1225 1226
 * This routine is called by NET_RX_SOFTIRQ. It receives a packet, builds a
 * FC frame and passes the frame to libfc.
1227 1228
 *
 * Returns: 0 for success
1229
 */
1230
int fcoe_rcv(struct sk_buff *skb, struct net_device *netdev,
1231 1232
	     struct packet_type *ptype, struct net_device *olddev)
{
1233
	struct fc_lport *lport;
1234
	struct fcoe_rcv_info *fr;
1235
	struct fcoe_interface *fcoe;
1236 1237
	struct fc_frame_header *fh;
	struct fcoe_percpu_s *fps;
1238
	struct ethhdr *eh;
1239
	unsigned int cpu;
1240

1241
	fcoe = container_of(ptype, struct fcoe_interface, fcoe_packet_type);
1242 1243 1244
	lport = fcoe->ctlr.lp;
	if (unlikely(!lport)) {
		FCOE_NETDEV_DBG(netdev, "Cannot find hba structure");
1245 1246
		goto err2;
	}
1247
	if (!lport->link_up)
1248
		goto err2;
1249

1250
	FCOE_NETDEV_DBG(netdev, "skb_info: len:%d data_len:%d head:%p "
1251 1252 1253 1254
			"data:%p tail:%p end:%p sum:%d dev:%s",
			skb->len, skb->data_len, skb->head, skb->data,
			skb_tail_pointer(skb), skb_end_pointer(skb),
			skb->csum, skb->dev ? skb->dev->name : "<NULL>");
1255

1256 1257 1258 1259 1260 1261
	eh = eth_hdr(skb);

	if (is_fip_mode(&fcoe->ctlr) &&
	    compare_ether_addr(eh->h_source, fcoe->ctlr.dest_addr)) {
		FCOE_NETDEV_DBG(netdev, "wrong source mac address:%pM\n",
				eh->h_source);
1262 1263 1264 1265 1266 1267 1268 1269
		goto err;
	}

	/*
	 * Check for minimum frame length, and make sure required FCoE
	 * and FC headers are pulled into the linear data area.
	 */
	if (unlikely((skb->len < FCOE_MIN_FRAME) ||
1270
		     !pskb_may_pull(skb, FCOE_HEADER_LEN)))
1271 1272 1273 1274 1275
		goto err;

	skb_set_transport_header(skb, sizeof(struct fcoe_hdr));
	fh = (struct fc_frame_header *) skb_transport_header(skb);

1276 1277 1278 1279 1280 1281
	if (ntoh24(&eh->h_dest[3]) != ntoh24(fh->fh_d_id)) {
		FCOE_NETDEV_DBG(netdev, "FC frame d_id mismatch with MAC:%pM\n",
				eh->h_dest);
		goto err;
	}

1282
	fr = fcoe_dev_from_skb(skb);
1283
	fr->fr_dev = lport;
1284
	fr->ptype = ptype;
1285

1286
	/*
1287 1288 1289 1290
	 * In case the incoming frame's exchange is originated from
	 * the initiator, then received frame's exchange id is ANDed
	 * with fc_cpu_mask bits to get the same cpu on which exchange
	 * was originated, otherwise just use the current cpu.
1291
	 */
1292 1293 1294 1295
	if (ntoh24(fh->fh_f_ctl) & FC_FC_EX_CTX)
		cpu = ntohs(fh->fh_ox_id) & fc_cpu_mask;
	else
		cpu = smp_processor_id();
1296

1297
	fps = &per_cpu(fcoe_percpu, cpu);
1298
	spin_lock_bh(&fps->fcoe_rx_list.lock);
1299 1300 1301 1302 1303 1304
	if (unlikely(!fps->thread)) {
		/*
		 * The targeted CPU is not ready, let's target
		 * the first CPU now. For non-SMP systems this
		 * will check the same CPU twice.
		 */
1305
		FCOE_NETDEV_DBG(netdev, "CPU is online, but no receive thread "
1306 1307
				"ready for incoming skb- using first online "
				"CPU.\n");
1308 1309

		spin_unlock_bh(&fps->fcoe_rx_list.lock);
1310
		cpu = cpumask_first(cpu_online_mask);
1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323
		fps = &per_cpu(fcoe_percpu, cpu);
		spin_lock_bh(&fps->fcoe_rx_list.lock);
		if (!fps->thread) {
			spin_unlock_bh(&fps->fcoe_rx_list.lock);
			goto err;
		}
	}

	/*
	 * We now have a valid CPU that we're targeting for
	 * this skb. We also have this receive thread locked,
	 * so we're free to queue skbs into it's queue.
	 */
1324

1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342
	/* If this is a SCSI-FCP frame, and this is already executing on the
	 * correct CPU, and the queue for this CPU is empty, then go ahead
	 * and process the frame directly in the softirq context.
	 * This lets us process completions without context switching from the
	 * NET_RX softirq, to our receive processing thread, and then back to
	 * BLOCK softirq context.
	 */
	if (fh->fh_type == FC_TYPE_FCP &&
	    cpu == smp_processor_id() &&
	    skb_queue_empty(&fps->fcoe_rx_list)) {
		spin_unlock_bh(&fps->fcoe_rx_list.lock);
		fcoe_recv_frame(skb);
	} else {
		__skb_queue_tail(&fps->fcoe_rx_list, skb);
		if (fps->fcoe_rx_list.qlen == 1)
			wake_up_process(fps->thread);
		spin_unlock_bh(&fps->fcoe_rx_list.lock);
	}
1343 1344 1345

	return 0;
err:
1346 1347
	per_cpu_ptr(lport->dev_stats, get_cpu())->ErrorFrames++;
	put_cpu();
1348 1349 1350 1351 1352 1353
err2:
	kfree_skb(skb);
	return -1;
}

/**
1354
 * fcoe_alloc_paged_crc_eof() - Allocate a page to be used for the trailer CRC
1355 1356 1357
 * @skb:  The packet to be transmitted
 * @tlen: The total length of the trailer
 *
1358
 * Returns: 0 for success
1359
 */
1360
static int fcoe_alloc_paged_crc_eof(struct sk_buff *skb, int tlen)
1361 1362
{
	struct fcoe_percpu_s *fps;
1363
	int rc;
1364

1365
	fps = &get_cpu_var(fcoe_percpu);
1366
	rc = fcoe_get_paged_crc_eof(skb, tlen, fps);
1367
	put_cpu_var(fcoe_percpu);
1368

1369
	return rc;
1370 1371 1372
}

/**
1373 1374 1375
 * fcoe_xmit() - Transmit a FCoE frame
 * @lport: The local port that the frame is to be transmitted for
 * @fp:	   The frame to be transmitted
1376
 *
1377
 * Return: 0 for success
1378
 */
1379
int fcoe_xmit(struct fc_lport *lport, struct fc_frame *fp)
1380
{
1381
	int wlen;
1382 1383 1384 1385 1386 1387 1388 1389 1390
	u32 crc;
	struct ethhdr *eh;
	struct fcoe_crc_eof *cp;
	struct sk_buff *skb;
	struct fcoe_dev_stats *stats;
	struct fc_frame_header *fh;
	unsigned int hlen;		/* header length implies the version */
	unsigned int tlen;		/* trailer length */
	unsigned int elen;		/* eth header, may include vlan */
1391
	struct fcoe_port *port = lport_priv(lport);
1392
	struct fcoe_interface *fcoe = port->priv;
1393 1394 1395 1396 1397 1398
	u8 sof, eof;
	struct fcoe_hdr *hp;

	WARN_ON((fr_len(fp) % sizeof(u32)) != 0);

	fh = fc_frame_header_get(fp);
1399 1400 1401
	skb = fp_skb(fp);
	wlen = skb->len / FCOE_WORD_TO_BYTE;

1402
	if (!lport->link_up) {
1403
		kfree_skb(skb);
1404
		return 0;
1405 1406
	}

1407
	if (unlikely(fh->fh_type == FC_TYPE_ELS) &&
1408
	    fcoe_ctlr_els_send(&fcoe->ctlr, lport, skb))
1409 1410
		return 0;

1411 1412 1413
	sof = fr_sof(fp);
	eof = fr_eof(fp);

1414
	elen = sizeof(struct ethhdr);
1415 1416 1417 1418 1419
	hlen = sizeof(struct fcoe_hdr);
	tlen = sizeof(struct fcoe_crc_eof);
	wlen = (skb->len - tlen + sizeof(crc)) / FCOE_WORD_TO_BYTE;

	/* crc offload */
1420
	if (likely(lport->crc_offload)) {
1421
		skb->ip_summed = CHECKSUM_PARTIAL;
1422 1423 1424 1425 1426 1427 1428 1429
		skb->csum_start = skb_headroom(skb);
		skb->csum_offset = skb->len;
		crc = 0;
	} else {
		skb->ip_summed = CHECKSUM_NONE;
		crc = fcoe_fc_crc(fp);
	}

1430
	/* copy port crc and eof to the skb buff */
1431 1432
	if (skb_is_nonlinear(skb)) {
		skb_frag_t *frag;
1433
		if (fcoe_alloc_paged_crc_eof(skb, tlen)) {
R
Roel Kluin 已提交
1434
			kfree_skb(skb);
1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452
			return -ENOMEM;
		}
		frag = &skb_shinfo(skb)->frags[skb_shinfo(skb)->nr_frags - 1];
		cp = kmap_atomic(frag->page, KM_SKB_DATA_SOFTIRQ)
			+ frag->page_offset;
	} else {
		cp = (struct fcoe_crc_eof *)skb_put(skb, tlen);
	}

	memset(cp, 0, sizeof(*cp));
	cp->fcoe_eof = eof;
	cp->fcoe_crc32 = cpu_to_le32(~crc);

	if (skb_is_nonlinear(skb)) {
		kunmap_atomic(cp, KM_SKB_DATA_SOFTIRQ);
		cp = NULL;
	}

1453
	/* adjust skb network/transport offsets to match mac/fcoe/port */
1454 1455 1456 1457
	skb_push(skb, elen + hlen);
	skb_reset_mac_header(skb);
	skb_reset_network_header(skb);
	skb->mac_len = elen;
1458
	skb->protocol = htons(ETH_P_FCOE);
1459
	skb->dev = fcoe->netdev;
1460 1461 1462 1463

	/* fill up mac and fcoe headers */
	eh = eth_hdr(skb);
	eh->h_proto = htons(ETH_P_FCOE);
1464
	memcpy(eh->h_dest, fcoe->ctlr.dest_addr, ETH_ALEN);
1465
	if (fcoe->ctlr.map_dest)
1466
		memcpy(eh->h_dest + 3, fh->fh_d_id, 3);
1467

1468 1469
	if (unlikely(fcoe->ctlr.flogi_oxid != FC_XID_UNKNOWN))
		memcpy(eh->h_source, fcoe->ctlr.ctl_src_addr, ETH_ALEN);
1470
	else
1471
		memcpy(eh->h_source, port->data_src_addr, ETH_ALEN);
1472 1473 1474 1475 1476 1477 1478

	hp = (struct fcoe_hdr *)(eh + 1);
	memset(hp, 0, sizeof(*hp));
	if (FC_FCOE_VER)
		FC_FCOE_ENCAPS_VER(hp, FC_FCOE_VER);
	hp->fcoe_sof = sof;

1479
	/* fcoe lso, mss is in max_payload which is non-zero for FCP data */
1480
	if (lport->seq_offload && fr_max_payload(fp)) {
1481 1482 1483 1484 1485 1486
		skb_shinfo(skb)->gso_type = SKB_GSO_FCOE;
		skb_shinfo(skb)->gso_size = fr_max_payload(fp);
	} else {
		skb_shinfo(skb)->gso_type = 0;
		skb_shinfo(skb)->gso_size = 0;
	}
1487
	/* update tx stats: regardless if LLD fails */
1488
	stats = per_cpu_ptr(lport->dev_stats, get_cpu());
1489 1490
	stats->TxFrames++;
	stats->TxWords += wlen;
1491
	put_cpu();
1492 1493

	/* send down to lld */
1494
	fr_dev(fp) = lport;
1495
	if (port->fcoe_pending_queue.qlen)
1496
		fcoe_check_wait_queue(lport, skb);
1497
	else if (fcoe_start_io(skb))
1498
		fcoe_check_wait_queue(lport, skb);
1499 1500 1501 1502

	return 0;
}

1503
/**
1504 1505
 * fcoe_percpu_flush_done() - Indicate per-CPU queue flush completion
 * @skb: The completed skb (argument required by destructor)
1506 1507 1508 1509 1510 1511
 */
static void fcoe_percpu_flush_done(struct sk_buff *skb)
{
	complete(&fcoe_flush_completion);
}

1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541
/**
 * fcoe_filter_frames() - filter out bad fcoe frames, i.e. bad CRC
 * @lport: The local port the frame was received on
 * @fp:	   The received frame
 *
 * Return: 0 on passing filtering checks
 */
static inline int fcoe_filter_frames(struct fc_lport *lport,
				     struct fc_frame *fp)
{
	struct fcoe_interface *fcoe;
	struct fc_frame_header *fh;
	struct sk_buff *skb = (struct sk_buff *)fp;
	struct fcoe_dev_stats *stats;

	/*
	 * We only check CRC if no offload is available and if it is
	 * it's solicited data, in which case, the FCP layer would
	 * check it during the copy.
	 */
	if (lport->crc_offload && skb->ip_summed == CHECKSUM_UNNECESSARY)
		fr_flags(fp) &= ~FCPHF_CRC_UNCHECKED;
	else
		fr_flags(fp) |= FCPHF_CRC_UNCHECKED;

	fh = (struct fc_frame_header *) skb_transport_header(skb);
	fh = fc_frame_header_get(fp);
	if (fh->fh_r_ctl == FC_RCTL_DD_SOL_DATA && fh->fh_type == FC_TYPE_FCP)
		return 0;

1542
	fcoe = ((struct fcoe_port *)lport_priv(lport))->priv;
1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561
	if (is_fip_mode(&fcoe->ctlr) && fc_frame_payload_op(fp) == ELS_LOGO &&
	    ntoh24(fh->fh_s_id) == FC_FID_FLOGI) {
		FCOE_DBG("fcoe: dropping FCoE lport LOGO in fip mode\n");
		return -EINVAL;
	}

	if (!fr_flags(fp) & FCPHF_CRC_UNCHECKED ||
	    le32_to_cpu(fr_crc(fp)) == ~crc32(~0, skb->data, skb->len)) {
		fr_flags(fp) &= ~FCPHF_CRC_UNCHECKED;
		return 0;
	}

	stats = per_cpu_ptr(lport->dev_stats, get_cpu());
	stats->InvalidCRCCount++;
	if (stats->InvalidCRCCount < 5)
		printk(KERN_WARNING "fcoe: dropping frame with CRC error\n");
	return -EINVAL;
}

1562
/**
1563 1564
 * fcoe_recv_frame() - process a single received frame
 * @skb: frame to process
1565
 */
1566
static void fcoe_recv_frame(struct sk_buff *skb)
1567 1568
{
	u32 fr_len;
1569
	struct fc_lport *lport;
1570 1571 1572 1573
	struct fcoe_rcv_info *fr;
	struct fcoe_dev_stats *stats;
	struct fcoe_crc_eof crc_eof;
	struct fc_frame *fp;
1574
	struct fcoe_port *port;
1575 1576
	struct fcoe_hdr *hp;

1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602
	fr = fcoe_dev_from_skb(skb);
	lport = fr->fr_dev;
	if (unlikely(!lport)) {
		if (skb->destructor != fcoe_percpu_flush_done)
			FCOE_NETDEV_DBG(skb->dev, "NULL lport in skb");
		kfree_skb(skb);
		return;
	}

	FCOE_NETDEV_DBG(skb->dev, "skb_info: len:%d data_len:%d "
			"head:%p data:%p tail:%p end:%p sum:%d dev:%s",
			skb->len, skb->data_len,
			skb->head, skb->data, skb_tail_pointer(skb),
			skb_end_pointer(skb), skb->csum,
			skb->dev ? skb->dev->name : "<NULL>");

	port = lport_priv(lport);
	if (skb_is_nonlinear(skb))
		skb_linearize(skb);	/* not ideal */

	/*
	 * Frame length checks and setting up the header pointers
	 * was done in fcoe_rcv already.
	 */
	hp = (struct fcoe_hdr *) skb_network_header(skb);

1603
	stats = per_cpu_ptr(lport->dev_stats, get_cpu());
1604 1605 1606 1607 1608 1609 1610 1611
	if (unlikely(FC_FCOE_DECAPS_VER(hp) != FC_FCOE_VER)) {
		if (stats->ErrorFrames < 5)
			printk(KERN_WARNING "fcoe: FCoE version "
			       "mismatch: The frame has "
			       "version %x, but the "
			       "initiator supports version "
			       "%x\n", FC_FCOE_DECAPS_VER(hp),
			       FC_FCOE_VER);
1612
		goto drop;
1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624 1625 1626
	}

	skb_pull(skb, sizeof(struct fcoe_hdr));
	fr_len = skb->len - sizeof(struct fcoe_crc_eof);

	stats->RxFrames++;
	stats->RxWords += fr_len / FCOE_WORD_TO_BYTE;

	fp = (struct fc_frame *)skb;
	fc_frame_init(fp);
	fr_dev(fp) = lport;
	fr_sof(fp) = hp->fcoe_sof;

	/* Copy out the CRC and EOF trailer for access */
1627 1628
	if (skb_copy_bits(skb, fr_len, &crc_eof, sizeof(crc_eof)))
		goto drop;
1629 1630
	fr_eof(fp) = crc_eof.fcoe_eof;
	fr_crc(fp) = crc_eof.fcoe_crc32;
1631 1632
	if (pskb_trim(skb, fr_len))
		goto drop;
1633

1634 1635 1636 1637
	if (!fcoe_filter_frames(lport, fp)) {
		put_cpu();
		fc_exch_recv(lport, fp);
		return;
1638
	}
1639 1640 1641 1642
drop:
	stats->ErrorFrames++;
	put_cpu();
	kfree_skb(skb);
1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655
}

/**
 * fcoe_percpu_receive_thread() - The per-CPU packet receive thread
 * @arg: The per-CPU context
 *
 * Return: 0 for success
 */
int fcoe_percpu_receive_thread(void *arg)
{
	struct fcoe_percpu_s *p = arg;
	struct sk_buff *skb;

1656
	set_user_nice(current, -20);
1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670

	while (!kthread_should_stop()) {

		spin_lock_bh(&p->fcoe_rx_list.lock);
		while ((skb = __skb_dequeue(&p->fcoe_rx_list)) == NULL) {
			set_current_state(TASK_INTERRUPTIBLE);
			spin_unlock_bh(&p->fcoe_rx_list.lock);
			schedule();
			set_current_state(TASK_RUNNING);
			if (kthread_should_stop())
				return 0;
			spin_lock_bh(&p->fcoe_rx_list.lock);
		}
		spin_unlock_bh(&p->fcoe_rx_list.lock);
1671
		fcoe_recv_frame(skb);
1672 1673 1674 1675 1676
	}
	return 0;
}

/**
1677
 * fcoe_dev_setup() - Setup the link change notification interface
1678
 */
1679
static void fcoe_dev_setup(void)
1680 1681 1682 1683 1684
{
	register_netdevice_notifier(&fcoe_notifier);
}

/**
1685
 * fcoe_dev_cleanup() - Cleanup the link change notification interface
1686
 */
1687 1688 1689 1690 1691 1692
static void fcoe_dev_cleanup(void)
{
	unregister_netdevice_notifier(&fcoe_notifier);
}

/**
1693 1694 1695 1696
 * fcoe_device_notification() - Handler for net device events
 * @notifier: The context of the notification
 * @event:    The type of event
 * @ptr:      The net device that the event was on
1697
 *
1698
 * This function is called by the Ethernet driver in case of link change event.
1699 1700
 *
 * Returns: 0 for success
1701
 */
1702 1703 1704
static int fcoe_device_notification(struct notifier_block *notifier,
				    ulong event, void *ptr)
{
1705
	struct fc_lport *lport = NULL;
1706
	struct net_device *netdev = ptr;
1707
	struct fcoe_interface *fcoe;
1708
	struct fcoe_port *port;
1709
	struct fcoe_dev_stats *stats;
1710
	u32 link_possible = 1;
1711 1712 1713
	u32 mfs;
	int rc = NOTIFY_OK;

1714
	list_for_each_entry(fcoe, &fcoe_hostlist, list) {
1715
		if (fcoe->netdev == netdev) {
1716
			lport = fcoe->ctlr.lp;
1717 1718 1719
			break;
		}
	}
1720
	if (!lport) {
1721 1722 1723 1724 1725 1726 1727
		rc = NOTIFY_DONE;
		goto out;
	}

	switch (event) {
	case NETDEV_DOWN:
	case NETDEV_GOING_DOWN:
1728
		link_possible = 0;
1729 1730 1731 1732 1733
		break;
	case NETDEV_UP:
	case NETDEV_CHANGE:
		break;
	case NETDEV_CHANGEMTU:
1734 1735
		if (netdev->features & NETIF_F_FCOE_MTU)
			break;
1736 1737
		mfs = netdev->mtu - (sizeof(struct fcoe_hdr) +
				     sizeof(struct fcoe_crc_eof));
1738
		if (mfs >= FC_MIN_MAX_FRAME)
1739
			fc_set_mfs(lport, mfs);
1740 1741 1742
		break;
	case NETDEV_REGISTER:
		break;
1743 1744 1745 1746
	case NETDEV_UNREGISTER:
		list_del(&fcoe->list);
		port = lport_priv(fcoe->ctlr.lp);
		fcoe_interface_cleanup(fcoe);
1747
		queue_work(fcoe_wq, &port->destroy_work);
1748 1749
		goto out;
		break;
1750 1751 1752
	case NETDEV_FEAT_CHANGE:
		fcoe_netdev_features_change(lport, netdev);
		break;
1753
	default:
1754
		FCOE_NETDEV_DBG(netdev, "Unknown event %ld "
1755
				"from netdev netlink\n", event);
1756
	}
1757 1758 1759

	fcoe_link_speed_update(lport);

1760
	if (link_possible && !fcoe_link_ok(lport))
1761 1762
		fcoe_ctlr_link_up(&fcoe->ctlr);
	else if (fcoe_ctlr_link_down(&fcoe->ctlr)) {
1763
		stats = per_cpu_ptr(lport->dev_stats, get_cpu());
1764
		stats->LinkFailureCount++;
1765
		put_cpu();
1766
		fcoe_clean_pending_queue(lport);
1767 1768 1769 1770 1771
	}
out:
	return rc;
}

1772 1773
/**
 * fcoe_disable() - Disables a FCoE interface
1774
 * @netdev  : The net_device object the Ethernet interface to create on
1775
 *
1776
 * Called from fcoe transport.
1777 1778 1779
 *
 * Returns: 0 for success
 */
1780
static int fcoe_disable(struct net_device *netdev)
1781 1782 1783 1784 1785 1786 1787 1788 1789 1790 1791 1792 1793 1794 1795 1796 1797
{
	struct fcoe_interface *fcoe;
	int rc = 0;

	mutex_lock(&fcoe_config_mutex);
#ifdef CONFIG_FCOE_MODULE
	/*
	 * Make sure the module has been initialized, and is not about to be
	 * removed.  Module paramter sysfs files are writable before the
	 * module_init function is called and after module_exit.
	 */
	if (THIS_MODULE->state != MODULE_STATE_LIVE) {
		rc = -ENODEV;
		goto out_nodev;
	}
#endif

1798 1799
	if (!rtnl_trylock()) {
		mutex_unlock(&fcoe_config_mutex);
1800
		return -ERESTARTSYS;
1801 1802
	}

1803 1804 1805
	fcoe = fcoe_hostlist_lookup_port(netdev);
	rtnl_unlock();

1806 1807
	if (fcoe) {
		fcoe_ctlr_link_down(&fcoe->ctlr);
1808
		fcoe_clean_pending_queue(fcoe->ctlr.lp);
1809
	} else
1810 1811 1812 1813 1814 1815 1816 1817 1818
		rc = -ENODEV;

out_nodev:
	mutex_unlock(&fcoe_config_mutex);
	return rc;
}

/**
 * fcoe_enable() - Enables a FCoE interface
1819
 * @netdev  : The net_device object the Ethernet interface to create on
1820
 *
1821
 * Called from fcoe transport.
1822 1823 1824
 *
 * Returns: 0 for success
 */
1825
static int fcoe_enable(struct net_device *netdev)
1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836 1837 1838 1839 1840 1841
{
	struct fcoe_interface *fcoe;
	int rc = 0;

	mutex_lock(&fcoe_config_mutex);
#ifdef CONFIG_FCOE_MODULE
	/*
	 * Make sure the module has been initialized, and is not about to be
	 * removed.  Module paramter sysfs files are writable before the
	 * module_init function is called and after module_exit.
	 */
	if (THIS_MODULE->state != MODULE_STATE_LIVE) {
		rc = -ENODEV;
		goto out_nodev;
	}
#endif
1842 1843
	if (!rtnl_trylock()) {
		mutex_unlock(&fcoe_config_mutex);
1844
		return -ERESTARTSYS;
1845 1846
	}

1847 1848 1849
	fcoe = fcoe_hostlist_lookup_port(netdev);
	rtnl_unlock();

1850
	if (!fcoe)
1851
		rc = -ENODEV;
1852 1853
	else if (!fcoe_link_ok(fcoe->ctlr.lp))
		fcoe_ctlr_link_up(&fcoe->ctlr);
1854 1855 1856 1857 1858 1859

out_nodev:
	mutex_unlock(&fcoe_config_mutex);
	return rc;
}

1860
/**
1861
 * fcoe_destroy() - Destroy a FCoE interface
1862
 * @netdev  : The net_device object the Ethernet interface to create on
1863
 *
1864
 * Called from fcoe transport
1865 1866
 *
 * Returns: 0 for success
1867
 */
1868
static int fcoe_destroy(struct net_device *netdev)
1869
{
1870
	struct fcoe_interface *fcoe;
1871
	int rc = 0;
1872

1873 1874 1875 1876 1877 1878 1879 1880 1881 1882 1883 1884
	mutex_lock(&fcoe_config_mutex);
#ifdef CONFIG_FCOE_MODULE
	/*
	 * Make sure the module has been initialized, and is not about to be
	 * removed.  Module paramter sysfs files are writable before the
	 * module_init function is called and after module_exit.
	 */
	if (THIS_MODULE->state != MODULE_STATE_LIVE) {
		rc = -ENODEV;
		goto out_nodev;
	}
#endif
1885 1886
	if (!rtnl_trylock()) {
		mutex_unlock(&fcoe_config_mutex);
1887
		return -ERESTARTSYS;
1888 1889
	}

1890 1891
	fcoe = fcoe_hostlist_lookup_port(netdev);
	if (!fcoe) {
1892
		rtnl_unlock();
1893
		rc = -ENODEV;
1894
		goto out_nodev;
1895
	}
1896
	fcoe_interface_cleanup(fcoe);
1897
	list_del(&fcoe->list);
1898
	/* RTNL mutex is dropped by fcoe_if_destroy */
1899
	fcoe_if_destroy(fcoe->ctlr.lp);
1900
out_nodev:
1901
	mutex_unlock(&fcoe_config_mutex);
1902 1903 1904
	return rc;
}

1905 1906 1907 1908
/**
 * fcoe_destroy_work() - Destroy a FCoE port in a deferred work context
 * @work: Handle to the FCoE port to be destroyed
 */
1909 1910 1911 1912 1913 1914
static void fcoe_destroy_work(struct work_struct *work)
{
	struct fcoe_port *port;

	port = container_of(work, struct fcoe_port, destroy_work);
	mutex_lock(&fcoe_config_mutex);
1915 1916
	rtnl_lock();
	/* RTNL mutex is dropped by fcoe_if_destroy */
1917 1918 1919 1920
	fcoe_if_destroy(port->lport);
	mutex_unlock(&fcoe_config_mutex);
}

1921 1922 1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933 1934
/**
 * fcoe_match() - Check if the FCoE is supported on the given netdevice
 * @netdev  : The net_device object the Ethernet interface to create on
 *
 * Called from fcoe transport.
 *
 * Returns: always returns true as this is the default FCoE transport,
 * i.e., support all netdevs.
 */
static bool fcoe_match(struct net_device *netdev)
{
	return true;
}

1935
/**
1936
 * fcoe_create() - Create a fcoe interface
1937 1938
 * @netdev  : The net_device object the Ethernet interface to create on
 * @fip_mode: The FIP mode for this creation
1939
 *
1940
 * Called from fcoe transport
1941 1942
 *
 * Returns: 0 for success
1943
 */
1944
static int fcoe_create(struct net_device *netdev, enum fip_state fip_mode)
1945 1946
{
	int rc;
1947
	struct fcoe_interface *fcoe;
1948
	struct fc_lport *lport;
1949

1950
	mutex_lock(&fcoe_config_mutex);
1951 1952 1953

	if (!rtnl_trylock()) {
		mutex_unlock(&fcoe_config_mutex);
1954
		return -ERESTARTSYS;
1955 1956
	}

1957 1958 1959 1960 1961 1962 1963 1964
#ifdef CONFIG_FCOE_MODULE
	/*
	 * Make sure the module has been initialized, and is not about to be
	 * removed.  Module paramter sysfs files are writable before the
	 * module_init function is called and after module_exit.
	 */
	if (THIS_MODULE->state != MODULE_STATE_LIVE) {
		rc = -ENODEV;
1965
		goto out_nodev;
1966 1967 1968
	}
#endif

1969 1970 1971
	/* look for existing lport */
	if (fcoe_hostlist_lookup(netdev)) {
		rc = -EEXIST;
1972
		goto out_nodev;
1973 1974
	}

1975
	fcoe = fcoe_interface_create(netdev, fip_mode);
1976 1977
	if (IS_ERR(fcoe)) {
		rc = PTR_ERR(fcoe);
1978
		goto out_nodev;
1979 1980
	}

1981
	lport = fcoe_if_create(fcoe, &netdev->dev, 0);
1982
	if (IS_ERR(lport)) {
1983
		printk(KERN_ERR "fcoe: Failed to create interface (%s)\n",
1984 1985
		       netdev->name);
		rc = -EIO;
1986
		fcoe_interface_cleanup(fcoe);
1987
		goto out_free;
1988
	}
1989

1990 1991 1992
	/* Make this the "master" N_Port */
	fcoe->ctlr.lp = lport;

1993 1994 1995
	/* add to lports list */
	fcoe_hostlist_add(lport);

1996 1997 1998 1999 2000
	/* start FIP Discovery and FLOGI */
	lport->boot_time = jiffies;
	fc_fabric_login(lport);
	if (!fcoe_link_ok(lport))
		fcoe_ctlr_link_up(&fcoe->ctlr);
2001

2002 2003 2004 2005
	/*
	 * Release from init in fcoe_interface_create(), on success lport
	 * should be holding a reference taken in fcoe_if_create().
	 */
2006
	fcoe_interface_put(fcoe);
2007 2008 2009 2010 2011 2012
	rtnl_unlock();
	mutex_unlock(&fcoe_config_mutex);

	return 0;
out_free:
	fcoe_interface_put(fcoe);
2013
out_nodev:
2014
	rtnl_unlock();
2015
	mutex_unlock(&fcoe_config_mutex);
2016 2017 2018
	return rc;
}

2019
/**
2020 2021
 * fcoe_link_speed_update() - Update the supported and actual link speeds
 * @lport: The local port to update speeds for
2022
 *
2023 2024
 * Returns: 0 if the ethtool query was successful
 *          -1 if the ethtool query failed
2025
 */
2026
int fcoe_link_speed_update(struct fc_lport *lport)
2027
{
2028
	struct net_device *netdev = fcoe_netdev(lport);
2029 2030
	struct ethtool_cmd ecmd = { ETHTOOL_GSET };

2031
	if (!dev_ethtool_get_settings(netdev, &ecmd)) {
2032
		lport->link_supported_speeds &=
2033 2034 2035
			~(FC_PORTSPEED_1GBIT | FC_PORTSPEED_10GBIT);
		if (ecmd.supported & (SUPPORTED_1000baseT_Half |
				      SUPPORTED_1000baseT_Full))
2036
			lport->link_supported_speeds |= FC_PORTSPEED_1GBIT;
2037
		if (ecmd.supported & SUPPORTED_10000baseT_Full)
2038
			lport->link_supported_speeds |=
2039 2040
				FC_PORTSPEED_10GBIT;
		if (ecmd.speed == SPEED_1000)
2041
			lport->link_speed = FC_PORTSPEED_1GBIT;
2042
		if (ecmd.speed == SPEED_10000)
2043
			lport->link_speed = FC_PORTSPEED_10GBIT;
2044

2045 2046 2047
		return 0;
	}
	return -1;
2048 2049
}

2050 2051 2052 2053 2054 2055 2056 2057 2058
/**
 * fcoe_link_ok() - Check if the link is OK for a local port
 * @lport: The local port to check link on
 *
 * Returns: 0 if link is UP and OK, -1 if not
 *
 */
int fcoe_link_ok(struct fc_lport *lport)
{
2059
	struct net_device *netdev = fcoe_netdev(lport);
2060 2061 2062 2063 2064 2065

	if (netif_oper_up(netdev))
		return 0;
	return -1;
}

2066
/**
2067 2068
 * fcoe_percpu_clean() - Clear all pending skbs for an local port
 * @lport: The local port whose skbs are to be cleared
2069 2070 2071 2072 2073 2074 2075
 *
 * Must be called with fcoe_create_mutex held to single-thread completion.
 *
 * This flushes the pending skbs by adding a new skb to each queue and
 * waiting until they are all freed.  This assures us that not only are
 * there no packets that will be handled by the lport, but also that any
 * threads already handling packet have returned.
2076
 */
2077
void fcoe_percpu_clean(struct fc_lport *lport)
2078 2079 2080 2081 2082 2083
{
	struct fcoe_percpu_s *pp;
	struct fcoe_rcv_info *fr;
	struct sk_buff_head *list;
	struct sk_buff *skb, *next;
	struct sk_buff *head;
2084
	unsigned int cpu;
2085

2086 2087 2088 2089 2090 2091 2092 2093 2094
	for_each_possible_cpu(cpu) {
		pp = &per_cpu(fcoe_percpu, cpu);
		spin_lock_bh(&pp->fcoe_rx_list.lock);
		list = &pp->fcoe_rx_list;
		head = list->next;
		for (skb = head; skb != (struct sk_buff *)list;
		     skb = next) {
			next = skb->next;
			fr = fcoe_dev_from_skb(skb);
2095
			if (fr->fr_dev == lport) {
2096 2097
				__skb_unlink(skb, list);
				kfree_skb(skb);
2098 2099
			}
		}
2100 2101 2102 2103 2104 2105 2106 2107 2108 2109 2110 2111 2112 2113 2114 2115

		if (!pp->thread || !cpu_online(cpu)) {
			spin_unlock_bh(&pp->fcoe_rx_list.lock);
			continue;
		}

		skb = dev_alloc_skb(0);
		if (!skb) {
			spin_unlock_bh(&pp->fcoe_rx_list.lock);
			continue;
		}
		skb->destructor = fcoe_percpu_flush_done;

		__skb_queue_tail(&pp->fcoe_rx_list, skb);
		if (pp->fcoe_rx_list.qlen == 1)
			wake_up_process(pp->thread);
2116
		spin_unlock_bh(&pp->fcoe_rx_list.lock);
2117 2118

		wait_for_completion(&fcoe_flush_completion);
2119 2120 2121
	}
}

2122
/**
2123 2124
 * fcoe_reset() - Reset a local port
 * @shost: The SCSI host associated with the local port to be reset
2125
 *
2126
 * Returns: Always 0 (return value required by FC transport template)
2127 2128 2129 2130 2131 2132 2133 2134
 */
int fcoe_reset(struct Scsi_Host *shost)
{
	struct fc_lport *lport = shost_priv(shost);
	fc_lport_reset(lport);
	return 0;
}

2135
/**
2136 2137
 * fcoe_hostlist_lookup_port() - Find the FCoE interface associated with a net device
 * @netdev: The net device used as a key
2138
 *
2139 2140 2141
 * Locking: Must be called with the RNL mutex held.
 *
 * Returns: NULL or the FCoE interface
2142
 */
2143
static struct fcoe_interface *
2144
fcoe_hostlist_lookup_port(const struct net_device *netdev)
2145
{
2146
	struct fcoe_interface *fcoe;
2147

2148
	list_for_each_entry(fcoe, &fcoe_hostlist, list) {
2149
		if (fcoe->netdev == netdev)
2150
			return fcoe;
2151 2152 2153 2154
	}
	return NULL;
}

2155
/**
2156 2157 2158
 * fcoe_hostlist_lookup() - Find the local port associated with a
 *			    given net device
 * @netdev: The netdevice used as a key
2159
 *
2160 2161 2162
 * Locking: Must be called with the RTNL mutex held
 *
 * Returns: NULL or the local port
2163
 */
2164
static struct fc_lport *fcoe_hostlist_lookup(const struct net_device *netdev)
2165
{
2166
	struct fcoe_interface *fcoe;
2167

2168
	fcoe = fcoe_hostlist_lookup_port(netdev);
2169
	return (fcoe) ? fcoe->ctlr.lp : NULL;
2170 2171
}

2172
/**
2173 2174 2175
 * fcoe_hostlist_add() - Add the FCoE interface identified by a local
 *			 port to the hostlist
 * @lport: The local port that identifies the FCoE interface to be added
2176
 *
2177
 * Locking: must be called with the RTNL mutex held
2178 2179
 *
 * Returns: 0 for success
2180
 */
2181
static int fcoe_hostlist_add(const struct fc_lport *lport)
2182
{
2183 2184 2185 2186 2187 2188
	struct fcoe_interface *fcoe;
	struct fcoe_port *port;

	fcoe = fcoe_hostlist_lookup_port(fcoe_netdev(lport));
	if (!fcoe) {
		port = lport_priv(lport);
2189
		fcoe = port->priv;
2190
		list_add_tail(&fcoe->list, &fcoe_hostlist);
2191 2192 2193 2194
	}
	return 0;
}

2195 2196 2197 2198 2199 2200 2201 2202 2203 2204 2205 2206

static struct fcoe_transport fcoe_sw_transport = {
	.name = {FCOE_TRANSPORT_DEFAULT},
	.attached = false,
	.list = LIST_HEAD_INIT(fcoe_sw_transport.list),
	.match = fcoe_match,
	.create = fcoe_create,
	.destroy = fcoe_destroy,
	.enable = fcoe_enable,
	.disable = fcoe_disable,
};

2207
/**
2208
 * fcoe_init() - Initialize fcoe.ko
2209
 *
2210
 * Returns: 0 on success, or a negative value on failure
2211
 */
2212 2213
static int __init fcoe_init(void)
{
2214
	struct fcoe_percpu_s *p;
2215
	unsigned int cpu;
2216
	int rc = 0;
2217

2218 2219 2220 2221
	fcoe_wq = alloc_workqueue("fcoe", 0, 0);
	if (!fcoe_wq)
		return -ENOMEM;

2222 2223 2224 2225 2226 2227 2228 2229
	/* register as a fcoe transport */
	rc = fcoe_transport_attach(&fcoe_sw_transport);
	if (rc) {
		printk(KERN_ERR "failed to register an fcoe transport, check "
			"if libfcoe is loaded\n");
		return rc;
	}

2230 2231
	mutex_lock(&fcoe_config_mutex);

2232
	for_each_possible_cpu(cpu) {
2233
		p = &per_cpu(fcoe_percpu, cpu);
2234 2235 2236
		skb_queue_head_init(&p->fcoe_rx_list);
	}

2237 2238
	for_each_online_cpu(cpu)
		fcoe_percpu_thread_create(cpu);
2239

2240 2241 2242 2243
	/* Initialize per CPU interrupt thread */
	rc = register_hotcpu_notifier(&fcoe_cpu_notifier);
	if (rc)
		goto out_free;
2244

2245
	/* Setup link change notification */
2246 2247
	fcoe_dev_setup();

2248 2249 2250
	rc = fcoe_if_init();
	if (rc)
		goto out_free;
2251

2252
	mutex_unlock(&fcoe_config_mutex);
2253
	return 0;
2254 2255 2256 2257 2258

out_free:
	for_each_online_cpu(cpu) {
		fcoe_percpu_thread_destroy(cpu);
	}
2259
	mutex_unlock(&fcoe_config_mutex);
2260
	destroy_workqueue(fcoe_wq);
2261
	return rc;
2262 2263 2264 2265
}
module_init(fcoe_init);

/**
2266
 * fcoe_exit() - Clean up fcoe.ko
2267
 *
2268
 * Returns: 0 on success or a  negative value on failure
2269
 */
2270 2271
static void __exit fcoe_exit(void)
{
2272
	struct fcoe_interface *fcoe, *tmp;
2273
	struct fcoe_port *port;
2274
	unsigned int cpu;
2275

2276 2277
	mutex_lock(&fcoe_config_mutex);

2278 2279
	fcoe_dev_cleanup();

2280
	/* releases the associated fcoe hosts */
2281 2282
	rtnl_lock();
	list_for_each_entry_safe(fcoe, tmp, &fcoe_hostlist, list) {
2283
		list_del(&fcoe->list);
2284 2285
		port = lport_priv(fcoe->ctlr.lp);
		fcoe_interface_cleanup(fcoe);
2286
		queue_work(fcoe_wq, &port->destroy_work);
2287
	}
2288
	rtnl_unlock();
2289

2290 2291
	unregister_hotcpu_notifier(&fcoe_cpu_notifier);

2292
	for_each_online_cpu(cpu)
2293
		fcoe_percpu_thread_destroy(cpu);
2294

2295
	mutex_unlock(&fcoe_config_mutex);
2296

2297 2298 2299 2300 2301
	/*
	 * destroy_work's may be chained but destroy_workqueue()
	 * can take care of them. Just kill the fcoe_wq.
	 */
	destroy_workqueue(fcoe_wq);
2302

2303 2304 2305 2306 2307
	/*
	 * Detaching from the scsi transport must happen after all
	 * destroys are done on the fcoe_wq. destroy_workqueue will
	 * enusre the fcoe_wq is flushed.
	 */
2308
	fcoe_if_exit();
2309 2310 2311

	/* detach from fcoe transport */
	fcoe_transport_detach(&fcoe_sw_transport);
2312 2313
}
module_exit(fcoe_exit);
2314 2315 2316 2317 2318 2319 2320

/**
 * fcoe_flogi_resp() - FCoE specific FLOGI and FDISC response handler
 * @seq: active sequence in the FLOGI or FDISC exchange
 * @fp: response frame, or error encoded in a pointer (timeout)
 * @arg: pointer the the fcoe_ctlr structure
 *
2321
 * This handles MAC address management for FCoE, then passes control on to
2322 2323 2324 2325 2326 2327 2328 2329 2330 2331 2332 2333 2334 2335 2336
 * the libfc FLOGI response handler.
 */
static void fcoe_flogi_resp(struct fc_seq *seq, struct fc_frame *fp, void *arg)
{
	struct fcoe_ctlr *fip = arg;
	struct fc_exch *exch = fc_seq_exch(seq);
	struct fc_lport *lport = exch->lp;
	u8 *mac;

	if (IS_ERR(fp))
		goto done;

	mac = fr_cb(fp)->granted_mac;
	if (is_zero_ether_addr(mac)) {
		/* pre-FIP */
2337
		if (fcoe_ctlr_recv_flogi(fip, lport, fp)) {
2338 2339 2340 2341
			fc_frame_free(fp);
			return;
		}
	}
2342
	fcoe_update_src_mac(lport, mac);
2343 2344 2345 2346 2347 2348 2349 2350 2351 2352
done:
	fc_lport_flogi_resp(seq, fp, lport);
}

/**
 * fcoe_logo_resp() - FCoE specific LOGO response handler
 * @seq: active sequence in the LOGO exchange
 * @fp: response frame, or error encoded in a pointer (timeout)
 * @arg: pointer the the fcoe_ctlr structure
 *
2353
 * This handles MAC address management for FCoE, then passes control on to
2354 2355 2356 2357
 * the libfc LOGO response handler.
 */
static void fcoe_logo_resp(struct fc_seq *seq, struct fc_frame *fp, void *arg)
{
2358
	struct fc_lport *lport = arg;
2359 2360 2361
	static u8 zero_mac[ETH_ALEN] = { 0 };

	if (!IS_ERR(fp))
2362
		fcoe_update_src_mac(lport, zero_mac);
2363 2364 2365 2366 2367 2368 2369 2370 2371 2372 2373 2374
	fc_lport_logo_resp(seq, fp, lport);
}

/**
 * fcoe_elsct_send - FCoE specific ELS handler
 *
 * This does special case handling of FIP encapsualted ELS exchanges for FCoE,
 * using FCoE specific response handlers and passing the FIP controller as
 * the argument (the lport is still available from the exchange).
 *
 * Most of the work here is just handed off to the libfc routine.
 */
2375 2376 2377 2378 2379 2380
static struct fc_seq *fcoe_elsct_send(struct fc_lport *lport, u32 did,
				      struct fc_frame *fp, unsigned int op,
				      void (*resp)(struct fc_seq *,
						   struct fc_frame *,
						   void *),
				      void *arg, u32 timeout)
2381 2382
{
	struct fcoe_port *port = lport_priv(lport);
2383
	struct fcoe_interface *fcoe = port->priv;
2384 2385 2386 2387 2388 2389
	struct fcoe_ctlr *fip = &fcoe->ctlr;
	struct fc_frame_header *fh = fc_frame_header_get(fp);

	switch (op) {
	case ELS_FLOGI:
	case ELS_FDISC:
2390 2391
		if (lport->point_to_multipoint)
			break;
2392 2393 2394 2395 2396 2397 2398
		return fc_elsct_send(lport, did, fp, op, fcoe_flogi_resp,
				     fip, timeout);
	case ELS_LOGO:
		/* only hook onto fabric logouts, not port logouts */
		if (ntoh24(fh->fh_d_id) != FC_FID_FLOGI)
			break;
		return fc_elsct_send(lport, did, fp, op, fcoe_logo_resp,
2399
				     lport, timeout);
2400 2401 2402 2403
	}
	return fc_elsct_send(lport, did, fp, op, resp, arg, timeout);
}

2404 2405 2406 2407 2408 2409 2410 2411 2412 2413 2414 2415
/**
 * fcoe_vport_create() - create an fc_host/scsi_host for a vport
 * @vport: fc_vport object to create a new fc_host for
 * @disabled: start the new fc_host in a disabled state by default?
 *
 * Returns: 0 for success
 */
static int fcoe_vport_create(struct fc_vport *vport, bool disabled)
{
	struct Scsi_Host *shost = vport_to_shost(vport);
	struct fc_lport *n_port = shost_priv(shost);
	struct fcoe_port *port = lport_priv(n_port);
2416
	struct fcoe_interface *fcoe = port->priv;
2417 2418 2419 2420 2421 2422 2423 2424 2425 2426 2427 2428 2429 2430 2431 2432 2433 2434 2435 2436 2437 2438 2439 2440 2441 2442 2443 2444 2445 2446 2447 2448 2449 2450 2451 2452 2453 2454 2455
	struct net_device *netdev = fcoe->netdev;
	struct fc_lport *vn_port;

	mutex_lock(&fcoe_config_mutex);
	vn_port = fcoe_if_create(fcoe, &vport->dev, 1);
	mutex_unlock(&fcoe_config_mutex);

	if (IS_ERR(vn_port)) {
		printk(KERN_ERR "fcoe: fcoe_vport_create(%s) failed\n",
		       netdev->name);
		return -EIO;
	}

	if (disabled) {
		fc_vport_set_state(vport, FC_VPORT_DISABLED);
	} else {
		vn_port->boot_time = jiffies;
		fc_fabric_login(vn_port);
		fc_vport_setlink(vn_port);
	}
	return 0;
}

/**
 * fcoe_vport_destroy() - destroy the fc_host/scsi_host for a vport
 * @vport: fc_vport object that is being destroyed
 *
 * Returns: 0 for success
 */
static int fcoe_vport_destroy(struct fc_vport *vport)
{
	struct Scsi_Host *shost = vport_to_shost(vport);
	struct fc_lport *n_port = shost_priv(shost);
	struct fc_lport *vn_port = vport->dd_data;
	struct fcoe_port *port = lport_priv(vn_port);

	mutex_lock(&n_port->lp_mutex);
	list_del(&vn_port->list);
	mutex_unlock(&n_port->lp_mutex);
2456
	queue_work(fcoe_wq, &port->destroy_work);
2457 2458 2459 2460 2461 2462 2463 2464 2465 2466 2467 2468 2469 2470 2471 2472 2473 2474 2475 2476 2477 2478 2479 2480
	return 0;
}

/**
 * fcoe_vport_disable() - change vport state
 * @vport: vport to bring online/offline
 * @disable: should the vport be disabled?
 */
static int fcoe_vport_disable(struct fc_vport *vport, bool disable)
{
	struct fc_lport *lport = vport->dd_data;

	if (disable) {
		fc_vport_set_state(vport, FC_VPORT_DISABLED);
		fc_fabric_logoff(lport);
	} else {
		lport->boot_time = jiffies;
		fc_fabric_login(lport);
		fc_vport_setlink(lport);
	}

	return 0;
}

2481 2482 2483 2484 2485 2486 2487 2488 2489 2490 2491 2492 2493 2494 2495 2496 2497 2498 2499 2500 2501 2502 2503 2504 2505 2506 2507 2508
/**
 * fcoe_vport_set_symbolic_name() - append vport string to symbolic name
 * @vport: fc_vport with a new symbolic name string
 *
 * After generating a new symbolic name string, a new RSPN_ID request is
 * sent to the name server.  There is no response handler, so if it fails
 * for some reason it will not be retried.
 */
static void fcoe_set_vport_symbolic_name(struct fc_vport *vport)
{
	struct fc_lport *lport = vport->dd_data;
	struct fc_frame *fp;
	size_t len;

	snprintf(fc_host_symbolic_name(lport->host), FC_SYMBOLIC_NAME_SIZE,
		 "%s v%s over %s : %s", FCOE_NAME, FCOE_VERSION,
		 fcoe_netdev(lport)->name, vport->symbolic_name);

	if (lport->state != LPORT_ST_READY)
		return;

	len = strnlen(fc_host_symbolic_name(lport->host), 255);
	fp = fc_frame_alloc(lport,
			    sizeof(struct fc_ct_hdr) +
			    sizeof(struct fc_ns_rspn) + len);
	if (!fp)
		return;
	lport->tt.elsct_send(lport, FC_FID_DIR_SERV, fp, FC_NS_RSPN_ID,
2509
			     NULL, NULL, 3 * lport->r_a_tov);
2510
}
2511 2512 2513 2514 2515 2516 2517 2518 2519 2520 2521 2522 2523

/**
 * fcoe_get_lesb() - Fill the FCoE Link Error Status Block
 * @lport: the local port
 * @fc_lesb: the link error status block
 */
static void fcoe_get_lesb(struct fc_lport *lport,
			 struct fc_els_lesb *fc_lesb)
{
	unsigned int cpu;
	u32 lfc, vlfc, mdac;
	struct fcoe_dev_stats *devst;
	struct fcoe_fc_els_lesb *lesb;
2524
	struct rtnl_link_stats64 temp;
2525 2526 2527 2528 2529 2530 2531 2532 2533 2534 2535 2536 2537 2538 2539 2540
	struct net_device *netdev = fcoe_netdev(lport);

	lfc = 0;
	vlfc = 0;
	mdac = 0;
	lesb = (struct fcoe_fc_els_lesb *)fc_lesb;
	memset(lesb, 0, sizeof(*lesb));
	for_each_possible_cpu(cpu) {
		devst = per_cpu_ptr(lport->dev_stats, cpu);
		lfc += devst->LinkFailureCount;
		vlfc += devst->VLinkFailureCount;
		mdac += devst->MissDiscAdvCount;
	}
	lesb->lesb_link_fail = htonl(lfc);
	lesb->lesb_vlink_fail = htonl(vlfc);
	lesb->lesb_miss_fka = htonl(mdac);
2541
	lesb->lesb_fcs_error = htonl(dev_get_stats(netdev, &temp)->rx_crc_errors);
2542
}
2543 2544 2545 2546 2547 2548 2549 2550 2551 2552 2553 2554 2555 2556 2557 2558 2559

/**
 * fcoe_set_port_id() - Callback from libfc when Port_ID is set.
 * @lport: the local port
 * @port_id: the port ID
 * @fp: the received frame, if any, that caused the port_id to be set.
 *
 * This routine handles the case where we received a FLOGI and are
 * entering point-to-point mode.  We need to call fcoe_ctlr_recv_flogi()
 * so it can set the non-mapped mode and gateway address.
 *
 * The FLOGI LS_ACC is handled by fcoe_flogi_resp().
 */
static void fcoe_set_port_id(struct fc_lport *lport,
			     u32 port_id, struct fc_frame *fp)
{
	struct fcoe_port *port = lport_priv(lport);
2560
	struct fcoe_interface *fcoe = port->priv;
2561 2562 2563 2564

	if (fp && fc_frame_payload_op(fp) == ELS_FLOGI)
		fcoe_ctlr_recv_flogi(&fcoe->ctlr, lport, fp);
}