fcoe.c 68.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
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);
102 103
static int fcoe_ddp_target(struct fc_lport *, u16, struct scatterlist *,
			   unsigned int);
104 105
static int fcoe_cpu_callback(struct notifier_block *, unsigned long, void *);

106 107 108 109 110
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);
111 112 113 114 115 116 117 118

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);
119
static void fcoe_recv_frame(struct sk_buff *skb);
120

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

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

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

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

136 137 138 139
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 *);
140
static void fcoe_set_port_id(struct fc_lport *, u32, struct fc_frame *);
141
static int fcoe_validate_vport_create(struct fc_vport *);
142 143 144 145 146

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

153
struct fc_function_template fcoe_nport_fc_functions = {
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 181 182 183
	.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,
184 185 186 187

	.vport_create = fcoe_vport_create,
	.vport_delete = fcoe_vport_destroy,
	.vport_disable = fcoe_vport_disable,
188
	.set_vport_symbolic_name = fcoe_set_vport_symbolic_name,
189 190

	.bsg_request = fc_lport_bsg_request,
191 192
};

193
struct fc_function_template fcoe_vport_fc_functions = {
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 221 222 223
	.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,
224 225

	.bsg_request = fc_lport_bsg_request,
226 227
};

228 229 230 231 232 233 234 235 236 237 238 239
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,
240
	.cmd_per_lun = 3,
241 242 243 244 245 246
	.can_queue = FCOE_MAX_OUTSTANDING_COMMANDS,
	.use_clustering = ENABLE_CLUSTERING,
	.sg_tablesize = SG_ALL,
	.max_sectors = 0xffff,
};

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

	fcoe->netdev = netdev;

266 267 268 269 270 271 272 273
	/* 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");
	}

274
	/* Do not support for bonding device */
J
Jiri Pirko 已提交
275
	if (netdev->priv_flags & IFF_BONDING && netdev->flags & IFF_MASTER) {
276
		FCOE_NETDEV_DBG(netdev, "Bonded interfaces not supported\n");
277 278 279 280 281
		return -EOPNOTSUPP;
	}

	/* look for SAN MAC address, if multiple SAN MACs exist, only
	 * use the first one for SPMA */
282 283
	real_dev = (netdev->priv_flags & IFF_802_1Q_VLAN) ?
		vlan_dev_real_dev(netdev) : netdev;
284
	rcu_read_lock();
285
	for_each_dev_addr(real_dev, ha) {
286
		if ((ha->type == NETDEV_HW_ADDR_T_SAN) &&
Y
Yi Zou 已提交
287
		    (is_valid_ether_addr(ha->addr))) {
288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304
			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);
305
	dev_uc_add(netdev, flogi_maddr);
306
	if (fip->spma)
307
		dev_uc_add(netdev, fip->ctl_src_addr);
308 309 310 311 312
	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);
313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330

	/*
	 * 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;
}

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

344 345 346 347 348 349 350
	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;
	}

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

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

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

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

378 379 380 381 382
	goto out;

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

386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421
/**
 * fcoe_interface_release() - fcoe_port kref release function
 * @kref: Embedded reference count in an fcoe_interface struct
 */
static void fcoe_interface_release(struct kref *kref)
{
	struct fcoe_interface *fcoe;
	struct net_device *netdev;

	fcoe = container_of(kref, struct fcoe_interface, kref);
	netdev = fcoe->netdev;
	/* tear-down the FCoE controller */
	fcoe_ctlr_destroy(&fcoe->ctlr);
	kfree(fcoe);
	dev_put(netdev);
	module_put(THIS_MODULE);
}

/**
 * fcoe_interface_get() - Get a reference to a FCoE interface
 * @fcoe: The FCoE interface to be held
 */
static inline void fcoe_interface_get(struct fcoe_interface *fcoe)
{
	kref_get(&fcoe->kref);
}

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

422
/**
423 424
 * fcoe_interface_cleanup() - Clean up a FCoE interface
 * @fcoe: The FCoE interface to be cleaned up
425 426
 *
 * Caller must be holding the RTNL mutex
427 428 429 430 431 432
 */
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];
433
	const struct net_device_ops *ops;
434 435 436 437 438 439 440 441 442 443 444 445 446

	/*
	 * 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);
447
	dev_uc_del(netdev, flogi_maddr);
448
	if (fip->spma)
449
		dev_uc_del(netdev, fip->ctl_src_addr);
450 451 452 453 454
	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);
455 456 457 458 459 460 461 462

	/* 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");
	}
463 464

	/* Release the self-reference taken during fcoe_interface_create() */
465
	fcoe_interface_put(fcoe);
466 467
}

468
/**
469 470 471 472 473 474
 * 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)
475 476 477
 *
 * Returns: 0 for success
 */
478
static int fcoe_fip_recv(struct sk_buff *skb, struct net_device *netdev,
479 480 481
			 struct packet_type *ptype,
			 struct net_device *orig_dev)
{
482
	struct fcoe_interface *fcoe;
483

484
	fcoe = container_of(ptype, struct fcoe_interface, fip_packet_type);
485
	fcoe_ctlr_recv(&fcoe->ctlr, skb);
486 487 488
	return 0;
}

489 490 491 492 493 494 495 496 497 498 499 500 501
/**
 * fcoe_port_send() - Send an Ethernet-encapsulated FIP/FCoE frame
 * @port: The FCoE port
 * @skb: The FIP/FCoE packet to be sent
 */
static void fcoe_port_send(struct fcoe_port *port, struct sk_buff *skb)
{
	if (port->fcoe_pending_queue.qlen)
		fcoe_check_wait_queue(port->lport, skb);
	else if (fcoe_start_io(skb))
		fcoe_check_wait_queue(port->lport, skb);
}

502
/**
503 504 505
 * fcoe_fip_send() - Send an Ethernet-encapsulated FIP frame
 * @fip: The FCoE controller
 * @skb: The FIP packet to be sent
506 507 508
 */
static void fcoe_fip_send(struct fcoe_ctlr *fip, struct sk_buff *skb)
{
509
	skb->dev = fcoe_from_ctlr(fip)->netdev;
510
	fcoe_port_send(lport_priv(fip->lp), skb);
511 512 513
}

/**
514 515 516
 * 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
517 518 519 520
 *
 * Remove any previously-set unicast MAC filter.
 * Add secondary FCoE MAC address filter for our OUI.
 */
521
static void fcoe_update_src_mac(struct fc_lport *lport, u8 *addr)
522
{
523
	struct fcoe_port *port = lport_priv(lport);
524
	struct fcoe_interface *fcoe = port->priv;
525

526
	rtnl_lock();
527
	if (!is_zero_ether_addr(port->data_src_addr))
528
		dev_uc_del(fcoe->netdev, port->data_src_addr);
529
	if (!is_zero_ether_addr(addr))
530
		dev_uc_add(fcoe->netdev, addr);
531
	memcpy(port->data_src_addr, addr, ETH_ALEN);
532 533 534
	rtnl_unlock();
}

535 536 537 538 539 540 541 542 543 544 545
/**
 * 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;
}

546
/**
547 548
 * fcoe_lport_config() - Set up a local port
 * @lport: The local port to be setup
549 550 551
 *
 * Returns: 0 for success
 */
552
static int fcoe_lport_config(struct fc_lport *lport)
553
{
554 555 556 557 558 559 560 561 562 563 564
	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);
565 566

	/* lport fc_lport related configuration */
567
	fc_lport_config(lport);
568 569

	/* offload related configuration */
570 571 572 573 574
	lport->crc_offload = 0;
	lport->seq_offload = 0;
	lport->lro_enabled = 0;
	lport->lro_xid = 0;
	lport->lso_max = 0;
575 576 577 578

	return 0;
}

579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595
/**
 * 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;
}

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 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639
/**
 * 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);
}

640
/**
641 642 643
 * 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
644
 *
645
 * Must be called after fcoe_lport_config() as it will use local port mutex
646
 *
647
 * Returns: 0 for success
648
 */
649
static int fcoe_netdev_config(struct fc_lport *lport, struct net_device *netdev)
650 651 652
{
	u32 mfs;
	u64 wwnn, wwpn;
653
	struct fcoe_interface *fcoe;
654
	struct fcoe_port *port;
655 656

	/* Setup lport private data to point to fcoe softc */
657
	port = lport_priv(lport);
658
	fcoe = port->priv;
659 660 661 662 663 664

	/*
	 * 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.
	 */
665 666 667 668 669 670
	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));
671
	if (fc_set_mfs(lport, mfs))
672 673 674
		return -EINVAL;

	/* offload features support */
675
	fcoe_netdev_features_change(lport, netdev);
676

677 678
	skb_queue_head_init(&port->fcoe_pending_queue);
	port->fcoe_pending_queue_active = 0;
679
	setup_timer(&port->timer, fcoe_queue_timer, (unsigned long)lport);
680

681 682
	fcoe_link_speed_update(lport);

683
	if (!lport->vport) {
684 685
		if (fcoe_get_wwn(netdev, &wwnn, NETDEV_FCOE_WWNN))
			wwnn = fcoe_wwn_from_mac(fcoe->ctlr.ctl_src_addr, 1, 0);
686
		fc_set_wwnn(lport, wwnn);
687 688
		if (fcoe_get_wwn(netdev, &wwpn, NETDEV_FCOE_WWPN))
			wwpn = fcoe_wwn_from_mac(fcoe->ctlr.ctl_src_addr,
689
						 2, 0);
690
		fc_set_wwpn(lport, wwpn);
691
	}
692 693 694 695 696

	return 0;
}

/**
697 698 699
 * 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
700 701 702
 *
 * Must be called after fcoe_lport_config() and fcoe_netdev_config()
 *
703
 * Returns: 0 for success
704
 */
705
static int fcoe_shost_config(struct fc_lport *lport, struct device *dev)
706 707 708 709
{
	int rc = 0;

	/* lport scsi host config */
710 711 712
	lport->host->max_lun = FCOE_MAX_LUN;
	lport->host->max_id = FCOE_MAX_FCP_TARGET;
	lport->host->max_channel = 0;
713 714
	lport->host->max_cmd_len = FCOE_MAX_CMD_LEN;

715
	if (lport->vport)
716
		lport->host->transportt = fcoe_vport_scsi_transport;
717
	else
718
		lport->host->transportt = fcoe_nport_scsi_transport;
719 720

	/* add the new host to the SCSI-ml */
721
	rc = scsi_add_host(lport->host, dev);
722
	if (rc) {
723
		FCOE_NETDEV_DBG(fcoe_netdev(lport), "fcoe_shost_config: "
724
				"error on scsi_add_host\n");
725 726
		return rc;
	}
727

728
	if (!lport->vport)
729
		fc_host_max_npiv_vports(lport->host) = USHRT_MAX;
730

731
	snprintf(fc_host_symbolic_name(lport->host), FC_SYMBOLIC_NAME_SIZE,
732
		 "%s v%s over %s", FCOE_NAME, FCOE_VERSION,
733
		 fcoe_netdev(lport)->name);
734 735 736 737

	return 0;
}

738 739 740
/**
 * fcoe_oem_match() - The match routine for the offloaded exchange manager
 * @fp: The I/O frame
741
 *
742 743 744 745 746 747 748 749 750
 * 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.
 *
751 752 753
 * This has been enhanced to work when FCoE stack is operating in target
 * mode.
 *
754
 * Returns: True for read types I/O, otherwise returns false.
755 756 757
 */
bool fcoe_oem_match(struct fc_frame *fp)
{
758 759 760 761 762 763 764 765 766 767 768 769 770 771
	struct fc_frame_header *fh = fc_frame_header_get(fp);
	struct fcp_cmnd *fcp;

	if (fc_fcp_is_read(fr_fsp(fp)) &&
	    (fr_fsp(fp)->data_len > fcoe_ddp_min))
		return true;
	else if (!(ntoh24(fh->fh_f_ctl) & FC_FC_EX_CTX)) {
		fcp = fc_frame_payload_get(fp, sizeof(*fcp));
		if (ntohs(fh->fh_rx_id) == FC_XID_UNKNOWN &&
		    fcp && (ntohl(fcp->fc_dl) > fcoe_ddp_min) &&
		    (fcp->fc_flags & FCP_CFL_WRDATA))
			return true;
	}
	return false;
772 773
}

774
/**
775 776
 * fcoe_em_config() - Allocate and configure an exchange manager
 * @lport: The local port that the new EM will be associated with
777
 *
778
 * Returns: 0 on success
779
 */
780
static inline int fcoe_em_config(struct fc_lport *lport)
781
{
782
	struct fcoe_port *port = lport_priv(lport);
783
	struct fcoe_interface *fcoe = port->priv;
784
	struct fcoe_interface *oldfcoe = NULL;
785
	struct net_device *old_real_dev, *cur_real_dev;
786 787 788 789 790 791 792
	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.
	 */
793 794 795
	if (!lport->lro_enabled || !lport->lro_xid ||
	    (lport->lro_xid >= max_xid)) {
		lport->lro_xid = 0;
796 797 798 799 800
		goto skip_oem;
	}

	/*
	 * Reuse existing offload em instance in case
801
	 * it is already allocated on real eth device
802
	 */
803 804
	if (fcoe->netdev->priv_flags & IFF_802_1Q_VLAN)
		cur_real_dev = vlan_dev_real_dev(fcoe->netdev);
805
	else
806
		cur_real_dev = fcoe->netdev;
807

808 809 810
	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);
811
		else
812
			old_real_dev = oldfcoe->netdev;
813 814

		if (cur_real_dev == old_real_dev) {
815
			fcoe->oem = oldfcoe->oem;
816 817 818 819
			break;
		}
	}

820
	if (fcoe->oem) {
821
		if (!fc_exch_mgr_add(lport, fcoe->oem, fcoe_oem_match)) {
822 823
			printk(KERN_ERR "fcoe_em_config: failed to add "
			       "offload em:%p on interface:%s\n",
824
			       fcoe->oem, fcoe->netdev->name);
825 826 827
			return -ENOMEM;
		}
	} else {
828 829 830
		fcoe->oem = fc_exch_mgr_alloc(lport, FC_CLASS_3,
					      FCOE_MIN_XID, lport->lro_xid,
					      fcoe_oem_match);
831
		if (!fcoe->oem) {
832 833
			printk(KERN_ERR "fcoe_em_config: failed to allocate "
			       "em for offload exches on interface:%s\n",
834
			       fcoe->netdev->name);
835 836 837 838 839 840 841
			return -ENOMEM;
		}
	}

	/*
	 * Exclude offload EM xid range from next EM xid range.
	 */
842
	min_xid += lport->lro_xid + 1;
843 844

skip_oem:
845
	if (!fc_exch_mgr_alloc(lport, FC_CLASS_3, min_xid, max_xid, NULL)) {
846
		printk(KERN_ERR "fcoe_em_config: failed to "
847
		       "allocate em on interface %s\n", fcoe->netdev->name);
848
		return -ENOMEM;
849
	}
850 851 852 853 854

	return 0;
}

/**
855 856
 * fcoe_if_destroy() - Tear down a SW FCoE instance
 * @lport: The local port to be destroyed
857
 *
858
 */
859
static void fcoe_if_destroy(struct fc_lport *lport)
860
{
861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886
	struct fcoe_port *port = lport_priv(lport);
	struct fcoe_interface *fcoe = port->priv;
	struct net_device *netdev = fcoe->netdev;

	FCOE_NETDEV_DBG(netdev, "Destroying interface\n");

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

	/* Cleanup the fc_lport */
	fc_lport_destroy(lport);

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

	/* Free existing transmit skbs */
	fcoe_clean_pending_queue(lport);

	rtnl_lock();
	if (!is_zero_ether_addr(port->data_src_addr))
		dev_uc_del(netdev, port->data_src_addr);
	rtnl_unlock();

	/* Release reference held in fcoe_if_create() */
	fcoe_interface_put(fcoe);

887
	/* Free queued packets for the per-CPU receive threads */
888
	fcoe_percpu_clean(lport);
889

890
	/* Detach from the scsi-ml */
891 892
	fc_remove_host(lport->host);
	scsi_remove_host(lport->host);
893

894 895 896
	/* Destroy lport scsi_priv */
	fc_fcp_destroy(lport);

897
	/* There are no more rports or I/O, free the EM */
898
	fc_exch_mgr_free(lport);
899 900

	/* Free memory used by statistical counters */
901
	fc_lport_free_stats(lport);
902

903
	/* Release the Scsi_Host */
904
	scsi_host_put(lport->host);
905 906
}

907 908 909 910 911 912
/**
 * 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
913
 *
914
 * Returns: 0 if the DDP context was not configured
915
 */
916 917
static int fcoe_ddp_setup(struct fc_lport *lport, u16 xid,
			  struct scatterlist *sgl, unsigned int sgc)
918
{
919
	struct net_device *netdev = fcoe_netdev(lport);
920

921 922 923 924
	if (netdev->netdev_ops->ndo_fcoe_ddp_setup)
		return netdev->netdev_ops->ndo_fcoe_ddp_setup(netdev,
							      xid, sgl,
							      sgc);
925 926 927 928

	return 0;
}

929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950
/**
 * fcoe_ddp_target() - Call a LLD's ddp_target 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
 *
 * Returns: 0 if the DDP context was not configured
 */
static int fcoe_ddp_target(struct fc_lport *lport, u16 xid,
			   struct scatterlist *sgl, unsigned int sgc)
{
	struct net_device *netdev = fcoe_netdev(lport);

	if (netdev->netdev_ops->ndo_fcoe_ddp_target)
		return netdev->netdev_ops->ndo_fcoe_ddp_target(netdev, xid,
							       sgl, sgc);

	return 0;
}


951 952 953 954
/**
 * 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
955
 *
956
 * Returns: the length of data that have been completed by DDP
957
 */
958
static int fcoe_ddp_done(struct fc_lport *lport, u16 xid)
959
{
960
	struct net_device *netdev = fcoe_netdev(lport);
961

962 963
	if (netdev->netdev_ops->ndo_fcoe_ddp_done)
		return netdev->netdev_ops->ndo_fcoe_ddp_done(netdev, xid);
964 965 966 967
	return 0;
}

/**
968 969 970 971
 * 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
972
 *
973
 * Creates a fc_lport instance and a Scsi_Host instance and configure them.
974
 *
975
 * Returns: The allocated fc_lport or an error pointer
976
 */
977
static struct fc_lport *fcoe_if_create(struct fcoe_interface *fcoe,
978
				       struct device *parent, int npiv)
979
{
980
	struct net_device *netdev = fcoe->netdev;
981
	struct fc_lport *lport, *n_port;
982
	struct fcoe_port *port;
983
	struct Scsi_Host *shost;
984
	int rc;
985 986 987 988 989
	/*
	 * 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);
990

991
	FCOE_NETDEV_DBG(netdev, "Create Interface\n");
992

993 994 995 996 997
	if (!npiv)
		lport = libfc_host_alloc(&fcoe_shost_template, sizeof(*port));
	else
		lport = libfc_vport_create(vport, sizeof(*port));

998
	if (!lport) {
999
		FCOE_NETDEV_DBG(netdev, "Could not allocate host structure\n");
1000
		rc = -ENOMEM;
1001
		goto out;
1002
	}
1003
	port = lport_priv(lport);
1004
	port->lport = lport;
1005 1006 1007
	port->priv = fcoe;
	port->max_queue_depth = FCOE_MAX_QUEUE_DEPTH;
	port->min_queue_depth = FCOE_MIN_QUEUE_DEPTH;
1008
	INIT_WORK(&port->destroy_work, fcoe_destroy_work);
1009

1010
	/* configure a fc_lport including the exchange manager */
1011
	rc = fcoe_lport_config(lport);
1012
	if (rc) {
1013 1014
		FCOE_NETDEV_DBG(netdev, "Could not configure lport for the "
				"interface\n");
1015 1016 1017
		goto out_host_put;
	}

1018
	if (npiv) {
1019 1020
		FCOE_NETDEV_DBG(netdev, "Setting vport names, "
				"%16.16llx %16.16llx\n",
1021
				vport->node_name, vport->port_name);
1022 1023 1024 1025
		fc_set_wwnn(lport, vport->node_name);
		fc_set_wwpn(lport, vport->port_name);
	}

1026
	/* configure lport network properties */
1027
	rc = fcoe_netdev_config(lport, netdev);
1028
	if (rc) {
1029 1030
		FCOE_NETDEV_DBG(netdev, "Could not configure netdev for the "
				"interface\n");
1031
		goto out_lp_destroy;
1032
	}
1033

1034
	/* configure lport scsi host properties */
1035
	rc = fcoe_shost_config(lport, parent);
1036
	if (rc) {
1037 1038
		FCOE_NETDEV_DBG(netdev, "Could not configure shost for the "
				"interface\n");
1039
		goto out_lp_destroy;
1040 1041
	}

1042
	/* Initialize the library */
1043
	rc = fcoe_libfc_config(lport, &fcoe->ctlr, &fcoe_libfc_fcn_templ, 1);
1044
	if (rc) {
1045
		FCOE_NETDEV_DBG(netdev, "Could not configure libfc for the "
1046
				"interface\n");
1047
		goto out_lp_destroy;
1048 1049
	}

1050 1051 1052 1053 1054 1055 1056 1057 1058 1059
	/*
	 * 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.
	 */
	if (!npiv)
1060 1061
		/* lport exch manager allocation */
		rc = fcoe_em_config(lport);
1062 1063 1064 1065 1066 1067 1068 1069 1070
	else {
		shost = vport_to_shost(vport);
		n_port = shost_priv(shost);
		rc = fc_exch_mgr_list_clone(n_port, lport);
	}

	if (rc) {
		FCOE_NETDEV_DBG(netdev, "Could not configure the EM\n");
		goto out_lp_destroy;
1071 1072
	}

1073
	fcoe_interface_get(fcoe);
1074
	return lport;
1075 1076

out_lp_destroy:
1077
	fc_exch_mgr_free(lport);
1078
out_host_put:
1079 1080 1081
	scsi_host_put(lport->host);
out:
	return ERR_PTR(rc);
1082 1083 1084
}

/**
1085
 * fcoe_if_init() - Initialization routine for fcoe.ko
1086
 *
1087 1088 1089
 * Attaches the SW FCoE transport to the FC transport
 *
 * Returns: 0 on success
1090 1091 1092 1093
 */
static int __init fcoe_if_init(void)
{
	/* attach to scsi transport */
1094 1095 1096 1097
	fcoe_nport_scsi_transport =
		fc_attach_transport(&fcoe_nport_fc_functions);
	fcoe_vport_scsi_transport =
		fc_attach_transport(&fcoe_vport_fc_functions);
1098

1099
	if (!fcoe_nport_scsi_transport) {
1100
		printk(KERN_ERR "fcoe: Failed to attach to the FC transport\n");
1101 1102 1103 1104 1105 1106 1107
		return -ENODEV;
	}

	return 0;
}

/**
1108 1109 1110
 * fcoe_if_exit() - Tear down fcoe.ko
 *
 * Detaches the SW FCoE transport from the FC transport
1111
 *
1112
 * Returns: 0 on success
1113 1114 1115
 */
int __exit fcoe_if_exit(void)
{
1116 1117 1118 1119
	fc_release_transport(fcoe_nport_scsi_transport);
	fc_release_transport(fcoe_vport_scsi_transport);
	fcoe_nport_scsi_transport = NULL;
	fcoe_vport_scsi_transport = NULL;
1120 1121 1122
	return 0;
}

1123
/**
1124 1125
 * 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
1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136
 */
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);

1137
	if (likely(!IS_ERR(thread))) {
1138 1139 1140 1141 1142 1143 1144 1145 1146 1147
		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);
	}
}

/**
1148 1149
 * 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
1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162
 *
 * 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;
1163
	unsigned targ_cpu = get_cpu();
1164 1165
#endif /* CONFIG_SMP */

1166
	FCOE_DBG("Destroying receive thread for CPU %d\n", cpu);
1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187

	/* 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) {
1188 1189
			FCOE_DBG("Moving frames from CPU %d to CPU %d\n",
				 cpu, targ_cpu);
1190 1191 1192 1193 1194 1195 1196

			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
1197
			 * new	skbs. Unlock the targeted CPU and drop the skbs
1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218
			 * 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);
	}
1219
	put_cpu();
1220 1221
#else
	/*
1222
	 * This a non-SMP scenario where the singular Rx thread is
1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238
	 * 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);
}

/**
1239 1240 1241 1242
 * 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
1243
 *
1244
 * This creates or destroys per-CPU data for fcoe
1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255
 *
 * 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:
1256
		FCOE_DBG("CPU %x online: Create Rx thread\n", cpu);
1257 1258 1259 1260
		fcoe_percpu_thread_create(cpu);
		break;
	case CPU_DEAD:
	case CPU_DEAD_FROZEN:
1261
		FCOE_DBG("CPU %x offline: Remove Rx thread\n", cpu);
1262 1263 1264 1265 1266 1267 1268 1269
		fcoe_percpu_thread_destroy(cpu);
		break;
	default:
		break;
	}
	return NOTIFY_OK;
}

1270 1271 1272 1273
/**
 * fcoe_select_cpu() - Selects CPU to handle post-processing of incoming
 *			command.
 *
1274 1275
 * This routine selects next CPU based on cpumask to distribute
 * incoming requests in round robin.
1276
 *
1277
 * Returns: int CPU number
1278
 */
1279
static inline unsigned int fcoe_select_cpu(void)
1280 1281 1282
{
	static unsigned int selected_cpu;

1283 1284 1285 1286
	selected_cpu = cpumask_next(selected_cpu, cpu_online_mask);
	if (selected_cpu >= nr_cpu_ids)
		selected_cpu = cpumask_first(cpu_online_mask);

1287 1288 1289
	return selected_cpu;
}

1290
/**
1291 1292 1293 1294 1295
 * 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
1296
 *
1297 1298
 * This routine is called by NET_RX_SOFTIRQ. It receives a packet, builds a
 * FC frame and passes the frame to libfc.
1299 1300
 *
 * Returns: 0 for success
1301
 */
1302
int fcoe_rcv(struct sk_buff *skb, struct net_device *netdev,
1303 1304
	     struct packet_type *ptype, struct net_device *olddev)
{
1305
	struct fc_lport *lport;
1306
	struct fcoe_rcv_info *fr;
1307
	struct fcoe_interface *fcoe;
1308 1309
	struct fc_frame_header *fh;
	struct fcoe_percpu_s *fps;
1310
	struct ethhdr *eh;
1311
	unsigned int cpu;
1312

1313
	fcoe = container_of(ptype, struct fcoe_interface, fcoe_packet_type);
1314 1315 1316
	lport = fcoe->ctlr.lp;
	if (unlikely(!lport)) {
		FCOE_NETDEV_DBG(netdev, "Cannot find hba structure");
1317 1318
		goto err2;
	}
1319
	if (!lport->link_up)
1320
		goto err2;
1321

1322
	FCOE_NETDEV_DBG(netdev, "skb_info: len:%d data_len:%d head:%p "
1323 1324 1325 1326
			"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>");
1327

1328 1329 1330 1331 1332 1333
	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);
1334 1335 1336 1337 1338 1339 1340 1341
		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) ||
1342
		     !pskb_may_pull(skb, FCOE_HEADER_LEN)))
1343 1344 1345 1346 1347
		goto err;

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

1348 1349 1350 1351 1352 1353
	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;
	}

1354
	fr = fcoe_dev_from_skb(skb);
1355
	fr->fr_dev = lport;
1356

1357
	/*
1358 1359 1360
	 * 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
1361 1362
	 * was originated, otherwise select cpu using rx exchange id
	 * or fcoe_select_cpu().
1363
	 */
1364 1365
	if (ntoh24(fh->fh_f_ctl) & FC_FC_EX_CTX)
		cpu = ntohs(fh->fh_ox_id) & fc_cpu_mask;
1366
	else {
1367 1368 1369
		if (ntohs(fh->fh_rx_id) == FC_XID_UNKNOWN)
			cpu = fcoe_select_cpu();
		else
1370
			cpu = ntohs(fh->fh_rx_id) & fc_cpu_mask;
1371
	}
1372 1373 1374 1375

	if (cpu >= nr_cpu_ids)
		goto err;

1376
	fps = &per_cpu(fcoe_percpu, cpu);
1377
	spin_lock_bh(&fps->fcoe_rx_list.lock);
1378 1379 1380 1381 1382 1383
	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.
		 */
1384
		FCOE_NETDEV_DBG(netdev, "CPU is online, but no receive thread "
1385 1386
				"ready for incoming skb- using first online "
				"CPU.\n");
1387 1388

		spin_unlock_bh(&fps->fcoe_rx_list.lock);
1389
		cpu = cpumask_first(cpu_online_mask);
1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402
		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.
	 */
1403

1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421
	/* 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);
	}
1422 1423 1424

	return 0;
err:
1425 1426
	per_cpu_ptr(lport->dev_stats, get_cpu())->ErrorFrames++;
	put_cpu();
1427 1428 1429 1430 1431 1432
err2:
	kfree_skb(skb);
	return -1;
}

/**
1433
 * fcoe_alloc_paged_crc_eof() - Allocate a page to be used for the trailer CRC
1434 1435 1436
 * @skb:  The packet to be transmitted
 * @tlen: The total length of the trailer
 *
1437
 * Returns: 0 for success
1438
 */
1439
static int fcoe_alloc_paged_crc_eof(struct sk_buff *skb, int tlen)
1440 1441
{
	struct fcoe_percpu_s *fps;
1442
	int rc;
1443

1444
	fps = &get_cpu_var(fcoe_percpu);
1445
	rc = fcoe_get_paged_crc_eof(skb, tlen, fps);
1446
	put_cpu_var(fcoe_percpu);
1447

1448
	return rc;
1449 1450 1451
}

/**
1452 1453 1454
 * fcoe_xmit() - Transmit a FCoE frame
 * @lport: The local port that the frame is to be transmitted for
 * @fp:	   The frame to be transmitted
1455
 *
1456
 * Return: 0 for success
1457
 */
1458
int fcoe_xmit(struct fc_lport *lport, struct fc_frame *fp)
1459
{
1460
	int wlen;
1461 1462 1463 1464 1465 1466 1467 1468 1469
	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 */
1470
	struct fcoe_port *port = lport_priv(lport);
1471
	struct fcoe_interface *fcoe = port->priv;
1472 1473 1474 1475 1476 1477
	u8 sof, eof;
	struct fcoe_hdr *hp;

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

	fh = fc_frame_header_get(fp);
1478 1479 1480
	skb = fp_skb(fp);
	wlen = skb->len / FCOE_WORD_TO_BYTE;

1481
	if (!lport->link_up) {
1482
		kfree_skb(skb);
1483
		return 0;
1484 1485
	}

1486
	if (unlikely(fh->fh_type == FC_TYPE_ELS) &&
1487
	    fcoe_ctlr_els_send(&fcoe->ctlr, lport, skb))
1488 1489
		return 0;

1490 1491 1492
	sof = fr_sof(fp);
	eof = fr_eof(fp);

1493
	elen = sizeof(struct ethhdr);
1494 1495 1496 1497 1498
	hlen = sizeof(struct fcoe_hdr);
	tlen = sizeof(struct fcoe_crc_eof);
	wlen = (skb->len - tlen + sizeof(crc)) / FCOE_WORD_TO_BYTE;

	/* crc offload */
1499
	if (likely(lport->crc_offload)) {
1500
		skb->ip_summed = CHECKSUM_PARTIAL;
1501 1502 1503 1504 1505 1506 1507 1508
		skb->csum_start = skb_headroom(skb);
		skb->csum_offset = skb->len;
		crc = 0;
	} else {
		skb->ip_summed = CHECKSUM_NONE;
		crc = fcoe_fc_crc(fp);
	}

1509
	/* copy port crc and eof to the skb buff */
1510 1511
	if (skb_is_nonlinear(skb)) {
		skb_frag_t *frag;
1512
		if (fcoe_alloc_paged_crc_eof(skb, tlen)) {
R
Roel Kluin 已提交
1513
			kfree_skb(skb);
1514 1515 1516
			return -ENOMEM;
		}
		frag = &skb_shinfo(skb)->frags[skb_shinfo(skb)->nr_frags - 1];
1517
		cp = kmap_atomic(skb_frag_page(frag), KM_SKB_DATA_SOFTIRQ)
1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531
			+ 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;
	}

1532
	/* adjust skb network/transport offsets to match mac/fcoe/port */
1533 1534 1535 1536
	skb_push(skb, elen + hlen);
	skb_reset_mac_header(skb);
	skb_reset_network_header(skb);
	skb->mac_len = elen;
1537
	skb->protocol = htons(ETH_P_FCOE);
1538
	skb->dev = fcoe->netdev;
1539 1540 1541 1542

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

1547 1548
	if (unlikely(fcoe->ctlr.flogi_oxid != FC_XID_UNKNOWN))
		memcpy(eh->h_source, fcoe->ctlr.ctl_src_addr, ETH_ALEN);
1549
	else
1550
		memcpy(eh->h_source, port->data_src_addr, ETH_ALEN);
1551 1552 1553 1554 1555 1556 1557

	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;

1558
	/* fcoe lso, mss is in max_payload which is non-zero for FCP data */
1559
	if (lport->seq_offload && fr_max_payload(fp)) {
1560 1561 1562 1563 1564 1565
		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;
	}
1566
	/* update tx stats: regardless if LLD fails */
1567
	stats = per_cpu_ptr(lport->dev_stats, get_cpu());
1568 1569
	stats->TxFrames++;
	stats->TxWords += wlen;
1570
	put_cpu();
1571 1572

	/* send down to lld */
1573
	fr_dev(fp) = lport;
1574
	fcoe_port_send(port, skb);
1575 1576 1577
	return 0;
}

1578
/**
1579 1580
 * fcoe_percpu_flush_done() - Indicate per-CPU queue flush completion
 * @skb: The completed skb (argument required by destructor)
1581 1582 1583 1584 1585 1586
 */
static void fcoe_percpu_flush_done(struct sk_buff *skb)
{
	complete(&fcoe_flush_completion);
}

1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616
/**
 * 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;

1617
	fcoe = ((struct fcoe_port *)lport_priv(lport))->priv;
1618 1619 1620 1621 1622 1623
	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;
	}

1624
	if (!(fr_flags(fp) & FCPHF_CRC_UNCHECKED) ||
1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636
	    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;
}

1637
/**
1638 1639
 * fcoe_recv_frame() - process a single received frame
 * @skb: frame to process
1640
 */
1641
static void fcoe_recv_frame(struct sk_buff *skb)
1642 1643
{
	u32 fr_len;
1644
	struct fc_lport *lport;
1645 1646 1647 1648
	struct fcoe_rcv_info *fr;
	struct fcoe_dev_stats *stats;
	struct fcoe_crc_eof crc_eof;
	struct fc_frame *fp;
1649
	struct fcoe_port *port;
1650 1651
	struct fcoe_hdr *hp;

1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677
	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);

1678
	stats = per_cpu_ptr(lport->dev_stats, get_cpu());
1679 1680 1681 1682 1683 1684 1685 1686
	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);
1687
		goto drop;
1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701
	}

	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 */
1702 1703
	if (skb_copy_bits(skb, fr_len, &crc_eof, sizeof(crc_eof)))
		goto drop;
1704 1705
	fr_eof(fp) = crc_eof.fcoe_eof;
	fr_crc(fp) = crc_eof.fcoe_crc32;
1706 1707
	if (pskb_trim(skb, fr_len))
		goto drop;
1708

1709 1710 1711 1712
	if (!fcoe_filter_frames(lport, fp)) {
		put_cpu();
		fc_exch_recv(lport, fp);
		return;
1713
	}
1714 1715 1716 1717
drop:
	stats->ErrorFrames++;
	put_cpu();
	kfree_skb(skb);
1718 1719 1720 1721 1722 1723 1724 1725 1726 1727 1728 1729 1730
}

/**
 * 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;

1731
	set_user_nice(current, -20);
1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745

	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);
1746
		fcoe_recv_frame(skb);
1747 1748 1749 1750 1751
	}
	return 0;
}

/**
1752
 * fcoe_dev_setup() - Setup the link change notification interface
1753
 */
1754
static void fcoe_dev_setup(void)
1755 1756 1757 1758 1759
{
	register_netdevice_notifier(&fcoe_notifier);
}

/**
1760
 * fcoe_dev_cleanup() - Cleanup the link change notification interface
1761
 */
1762 1763 1764 1765 1766 1767
static void fcoe_dev_cleanup(void)
{
	unregister_netdevice_notifier(&fcoe_notifier);
}

/**
1768 1769 1770 1771
 * 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
1772
 *
1773
 * This function is called by the Ethernet driver in case of link change event.
1774 1775
 *
 * Returns: 0 for success
1776
 */
1777 1778 1779
static int fcoe_device_notification(struct notifier_block *notifier,
				    ulong event, void *ptr)
{
1780
	struct fc_lport *lport = NULL;
1781
	struct net_device *netdev = ptr;
1782
	struct fcoe_interface *fcoe;
1783
	struct fcoe_port *port;
1784
	struct fcoe_dev_stats *stats;
1785
	u32 link_possible = 1;
1786 1787 1788
	u32 mfs;
	int rc = NOTIFY_OK;

1789
	list_for_each_entry(fcoe, &fcoe_hostlist, list) {
1790
		if (fcoe->netdev == netdev) {
1791
			lport = fcoe->ctlr.lp;
1792 1793 1794
			break;
		}
	}
1795
	if (!lport) {
1796 1797 1798 1799 1800 1801 1802
		rc = NOTIFY_DONE;
		goto out;
	}

	switch (event) {
	case NETDEV_DOWN:
	case NETDEV_GOING_DOWN:
1803
		link_possible = 0;
1804 1805 1806 1807 1808
		break;
	case NETDEV_UP:
	case NETDEV_CHANGE:
		break;
	case NETDEV_CHANGEMTU:
1809 1810
		if (netdev->features & NETIF_F_FCOE_MTU)
			break;
1811 1812
		mfs = netdev->mtu - (sizeof(struct fcoe_hdr) +
				     sizeof(struct fcoe_crc_eof));
1813
		if (mfs >= FC_MIN_MAX_FRAME)
1814
			fc_set_mfs(lport, mfs);
1815 1816 1817
		break;
	case NETDEV_REGISTER:
		break;
1818 1819 1820
	case NETDEV_UNREGISTER:
		list_del(&fcoe->list);
		port = lport_priv(fcoe->ctlr.lp);
1821
		queue_work(fcoe_wq, &port->destroy_work);
1822 1823
		goto out;
		break;
1824 1825 1826
	case NETDEV_FEAT_CHANGE:
		fcoe_netdev_features_change(lport, netdev);
		break;
1827
	default:
1828
		FCOE_NETDEV_DBG(netdev, "Unknown event %ld "
1829
				"from netdev netlink\n", event);
1830
	}
1831 1832 1833

	fcoe_link_speed_update(lport);

1834
	if (link_possible && !fcoe_link_ok(lport))
1835 1836
		fcoe_ctlr_link_up(&fcoe->ctlr);
	else if (fcoe_ctlr_link_down(&fcoe->ctlr)) {
1837
		stats = per_cpu_ptr(lport->dev_stats, get_cpu());
1838
		stats->LinkFailureCount++;
1839
		put_cpu();
1840
		fcoe_clean_pending_queue(lport);
1841 1842 1843 1844 1845
	}
out:
	return rc;
}

1846 1847
/**
 * fcoe_disable() - Disables a FCoE interface
1848
 * @netdev  : The net_device object the Ethernet interface to create on
1849
 *
1850
 * Called from fcoe transport.
1851 1852 1853
 *
 * Returns: 0 for success
 */
1854
static int fcoe_disable(struct net_device *netdev)
1855 1856 1857 1858 1859 1860
{
	struct fcoe_interface *fcoe;
	int rc = 0;

	mutex_lock(&fcoe_config_mutex);

1861
	rtnl_lock();
1862 1863 1864
	fcoe = fcoe_hostlist_lookup_port(netdev);
	rtnl_unlock();

1865 1866
	if (fcoe) {
		fcoe_ctlr_link_down(&fcoe->ctlr);
1867
		fcoe_clean_pending_queue(fcoe->ctlr.lp);
1868
	} else
1869 1870 1871 1872 1873 1874 1875 1876
		rc = -ENODEV;

	mutex_unlock(&fcoe_config_mutex);
	return rc;
}

/**
 * fcoe_enable() - Enables a FCoE interface
1877
 * @netdev  : The net_device object the Ethernet interface to create on
1878
 *
1879
 * Called from fcoe transport.
1880 1881 1882
 *
 * Returns: 0 for success
 */
1883
static int fcoe_enable(struct net_device *netdev)
1884 1885 1886 1887 1888
{
	struct fcoe_interface *fcoe;
	int rc = 0;

	mutex_lock(&fcoe_config_mutex);
1889
	rtnl_lock();
1890 1891 1892
	fcoe = fcoe_hostlist_lookup_port(netdev);
	rtnl_unlock();

1893
	if (!fcoe)
1894
		rc = -ENODEV;
1895 1896
	else if (!fcoe_link_ok(fcoe->ctlr.lp))
		fcoe_ctlr_link_up(&fcoe->ctlr);
1897 1898 1899 1900 1901

	mutex_unlock(&fcoe_config_mutex);
	return rc;
}

1902
/**
1903
 * fcoe_destroy() - Destroy a FCoE interface
1904
 * @netdev  : The net_device object the Ethernet interface to create on
1905
 *
1906
 * Called from fcoe transport
1907 1908
 *
 * Returns: 0 for success
1909
 */
1910
static int fcoe_destroy(struct net_device *netdev)
1911
{
1912
	struct fcoe_interface *fcoe;
1913
	struct fc_lport *lport;
1914
	struct fcoe_port *port;
1915
	int rc = 0;
1916

1917
	mutex_lock(&fcoe_config_mutex);
1918
	rtnl_lock();
1919 1920
	fcoe = fcoe_hostlist_lookup_port(netdev);
	if (!fcoe) {
1921
		rc = -ENODEV;
1922
		goto out_nodev;
1923
	}
1924
	lport = fcoe->ctlr.lp;
1925
	port = lport_priv(lport);
1926
	list_del(&fcoe->list);
1927
	queue_work(fcoe_wq, &port->destroy_work);
1928
out_nodev:
1929
	rtnl_unlock();
1930
	mutex_unlock(&fcoe_config_mutex);
1931 1932 1933
	return rc;
}

1934 1935 1936 1937
/**
 * fcoe_destroy_work() - Destroy a FCoE port in a deferred work context
 * @work: Handle to the FCoE port to be destroyed
 */
1938 1939 1940
static void fcoe_destroy_work(struct work_struct *work)
{
	struct fcoe_port *port;
1941 1942
	struct fcoe_interface *fcoe;
	int npiv = 0;
1943 1944 1945

	port = container_of(work, struct fcoe_port, destroy_work);
	mutex_lock(&fcoe_config_mutex);
1946 1947 1948 1949 1950

	/* set if this is an NPIV port */
	npiv = port->lport->vport ? 1 : 0;

	fcoe = port->priv;
1951
	fcoe_if_destroy(port->lport);
1952 1953 1954 1955 1956 1957 1958 1959

	/* Do not tear down the fcoe interface for NPIV port */
	if (!npiv) {
		rtnl_lock();
		fcoe_interface_cleanup(fcoe);
		rtnl_unlock();
	}

1960 1961 1962
	mutex_unlock(&fcoe_config_mutex);
}

1963 1964 1965 1966 1967 1968 1969 1970 1971 1972 1973 1974 1975 1976
/**
 * 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;
}

1977
/**
1978
 * fcoe_create() - Create a fcoe interface
1979 1980
 * @netdev  : The net_device object the Ethernet interface to create on
 * @fip_mode: The FIP mode for this creation
1981
 *
1982
 * Called from fcoe transport
1983 1984
 *
 * Returns: 0 for success
1985
 */
1986
static int fcoe_create(struct net_device *netdev, enum fip_state fip_mode)
1987
{
1988
	int rc = 0;
1989
	struct fcoe_interface *fcoe;
1990
	struct fc_lport *lport;
1991

1992
	mutex_lock(&fcoe_config_mutex);
1993
	rtnl_lock();
1994

1995 1996 1997
	/* look for existing lport */
	if (fcoe_hostlist_lookup(netdev)) {
		rc = -EEXIST;
1998
		goto out_nodev;
1999 2000
	}

2001
	fcoe = fcoe_interface_create(netdev, fip_mode);
2002 2003
	if (IS_ERR(fcoe)) {
		rc = PTR_ERR(fcoe);
2004
		goto out_nodev;
2005 2006
	}

2007
	lport = fcoe_if_create(fcoe, &netdev->dev, 0);
2008
	if (IS_ERR(lport)) {
2009
		printk(KERN_ERR "fcoe: Failed to create interface (%s)\n",
2010 2011
		       netdev->name);
		rc = -EIO;
2012
		fcoe_interface_cleanup(fcoe);
2013
		goto out_nodev;
2014
	}
2015

2016 2017 2018
	/* Make this the "master" N_Port */
	fcoe->ctlr.lp = lport;

2019 2020 2021
	/* add to lports list */
	fcoe_hostlist_add(lport);

2022 2023 2024 2025 2026
	/* start FIP Discovery and FLOGI */
	lport->boot_time = jiffies;
	fc_fabric_login(lport);
	if (!fcoe_link_ok(lport))
		fcoe_ctlr_link_up(&fcoe->ctlr);
2027

2028
out_nodev:
2029
	rtnl_unlock();
2030
	mutex_unlock(&fcoe_config_mutex);
2031 2032 2033
	return rc;
}

2034
/**
2035 2036
 * fcoe_link_speed_update() - Update the supported and actual link speeds
 * @lport: The local port to update speeds for
2037
 *
2038 2039
 * Returns: 0 if the ethtool query was successful
 *          -1 if the ethtool query failed
2040
 */
2041
int fcoe_link_speed_update(struct fc_lport *lport)
2042
{
2043
	struct net_device *netdev = fcoe_netdev(lport);
2044
	struct ethtool_cmd ecmd;
2045

2046
	if (!dev_ethtool_get_settings(netdev, &ecmd)) {
2047
		lport->link_supported_speeds &=
2048 2049 2050
			~(FC_PORTSPEED_1GBIT | FC_PORTSPEED_10GBIT);
		if (ecmd.supported & (SUPPORTED_1000baseT_Half |
				      SUPPORTED_1000baseT_Full))
2051
			lport->link_supported_speeds |= FC_PORTSPEED_1GBIT;
2052
		if (ecmd.supported & SUPPORTED_10000baseT_Full)
2053
			lport->link_supported_speeds |=
2054
				FC_PORTSPEED_10GBIT;
2055 2056
		switch (ethtool_cmd_speed(&ecmd)) {
		case SPEED_1000:
2057
			lport->link_speed = FC_PORTSPEED_1GBIT;
2058 2059
			break;
		case SPEED_10000:
2060
			lport->link_speed = FC_PORTSPEED_10GBIT;
2061 2062
			break;
		}
2063 2064 2065
		return 0;
	}
	return -1;
2066 2067
}

2068 2069 2070 2071 2072 2073 2074 2075 2076
/**
 * 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)
{
2077
	struct net_device *netdev = fcoe_netdev(lport);
2078 2079 2080 2081 2082 2083

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

2084
/**
2085 2086
 * fcoe_percpu_clean() - Clear all pending skbs for an local port
 * @lport: The local port whose skbs are to be cleared
2087 2088 2089 2090 2091 2092 2093
 *
 * 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.
2094
 */
2095
void fcoe_percpu_clean(struct fc_lport *lport)
2096 2097 2098 2099 2100 2101
{
	struct fcoe_percpu_s *pp;
	struct fcoe_rcv_info *fr;
	struct sk_buff_head *list;
	struct sk_buff *skb, *next;
	struct sk_buff *head;
2102
	unsigned int cpu;
2103

2104 2105 2106 2107 2108 2109 2110 2111 2112
	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);
2113
			if (fr->fr_dev == lport) {
2114 2115
				__skb_unlink(skb, list);
				kfree_skb(skb);
2116 2117
			}
		}
2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133

		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);
2134
		spin_unlock_bh(&pp->fcoe_rx_list.lock);
2135 2136

		wait_for_completion(&fcoe_flush_completion);
2137 2138 2139
	}
}

2140
/**
2141 2142
 * fcoe_reset() - Reset a local port
 * @shost: The SCSI host associated with the local port to be reset
2143
 *
2144
 * Returns: Always 0 (return value required by FC transport template)
2145 2146 2147 2148
 */
int fcoe_reset(struct Scsi_Host *shost)
{
	struct fc_lport *lport = shost_priv(shost);
2149 2150 2151 2152 2153 2154 2155
	struct fcoe_port *port = lport_priv(lport);
	struct fcoe_interface *fcoe = port->priv;

	fcoe_ctlr_link_down(&fcoe->ctlr);
	fcoe_clean_pending_queue(fcoe->ctlr.lp);
	if (!fcoe_link_ok(fcoe->ctlr.lp))
		fcoe_ctlr_link_up(&fcoe->ctlr);
2156 2157 2158
	return 0;
}

2159
/**
2160 2161
 * fcoe_hostlist_lookup_port() - Find the FCoE interface associated with a net device
 * @netdev: The net device used as a key
2162
 *
2163 2164 2165
 * Locking: Must be called with the RNL mutex held.
 *
 * Returns: NULL or the FCoE interface
2166
 */
2167
static struct fcoe_interface *
2168
fcoe_hostlist_lookup_port(const struct net_device *netdev)
2169
{
2170
	struct fcoe_interface *fcoe;
2171

2172
	list_for_each_entry(fcoe, &fcoe_hostlist, list) {
2173
		if (fcoe->netdev == netdev)
2174
			return fcoe;
2175 2176 2177 2178
	}
	return NULL;
}

2179
/**
2180 2181 2182
 * fcoe_hostlist_lookup() - Find the local port associated with a
 *			    given net device
 * @netdev: The netdevice used as a key
2183
 *
2184 2185 2186
 * Locking: Must be called with the RTNL mutex held
 *
 * Returns: NULL or the local port
2187
 */
2188
static struct fc_lport *fcoe_hostlist_lookup(const struct net_device *netdev)
2189
{
2190
	struct fcoe_interface *fcoe;
2191

2192
	fcoe = fcoe_hostlist_lookup_port(netdev);
2193
	return (fcoe) ? fcoe->ctlr.lp : NULL;
2194 2195
}

2196
/**
2197 2198 2199
 * 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
2200
 *
2201
 * Locking: must be called with the RTNL mutex held
2202 2203
 *
 * Returns: 0 for success
2204
 */
2205
static int fcoe_hostlist_add(const struct fc_lport *lport)
2206
{
2207 2208 2209 2210 2211 2212
	struct fcoe_interface *fcoe;
	struct fcoe_port *port;

	fcoe = fcoe_hostlist_lookup_port(fcoe_netdev(lport));
	if (!fcoe) {
		port = lport_priv(lport);
2213
		fcoe = port->priv;
2214
		list_add_tail(&fcoe->list, &fcoe_hostlist);
2215 2216 2217 2218
	}
	return 0;
}

2219 2220 2221 2222 2223 2224 2225 2226 2227 2228 2229 2230

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,
};

2231
/**
2232
 * fcoe_init() - Initialize fcoe.ko
2233
 *
2234
 * Returns: 0 on success, or a negative value on failure
2235
 */
2236 2237
static int __init fcoe_init(void)
{
2238
	struct fcoe_percpu_s *p;
2239
	unsigned int cpu;
2240
	int rc = 0;
2241

2242 2243 2244 2245
	fcoe_wq = alloc_workqueue("fcoe", 0, 0);
	if (!fcoe_wq)
		return -ENOMEM;

2246 2247 2248 2249 2250 2251 2252 2253
	/* 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;
	}

2254 2255
	mutex_lock(&fcoe_config_mutex);

2256
	for_each_possible_cpu(cpu) {
2257
		p = &per_cpu(fcoe_percpu, cpu);
2258 2259 2260
		skb_queue_head_init(&p->fcoe_rx_list);
	}

2261 2262
	for_each_online_cpu(cpu)
		fcoe_percpu_thread_create(cpu);
2263

2264 2265 2266 2267
	/* Initialize per CPU interrupt thread */
	rc = register_hotcpu_notifier(&fcoe_cpu_notifier);
	if (rc)
		goto out_free;
2268

2269
	/* Setup link change notification */
2270 2271
	fcoe_dev_setup();

2272 2273 2274
	rc = fcoe_if_init();
	if (rc)
		goto out_free;
2275

2276
	mutex_unlock(&fcoe_config_mutex);
2277
	return 0;
2278 2279 2280 2281 2282

out_free:
	for_each_online_cpu(cpu) {
		fcoe_percpu_thread_destroy(cpu);
	}
2283
	mutex_unlock(&fcoe_config_mutex);
2284
	destroy_workqueue(fcoe_wq);
2285
	return rc;
2286 2287 2288 2289
}
module_init(fcoe_init);

/**
2290
 * fcoe_exit() - Clean up fcoe.ko
2291
 *
2292
 * Returns: 0 on success or a  negative value on failure
2293
 */
2294 2295
static void __exit fcoe_exit(void)
{
2296
	struct fcoe_interface *fcoe, *tmp;
2297
	struct fcoe_port *port;
2298
	unsigned int cpu;
2299

2300 2301
	mutex_lock(&fcoe_config_mutex);

2302 2303
	fcoe_dev_cleanup();

2304
	/* releases the associated fcoe hosts */
2305 2306
	rtnl_lock();
	list_for_each_entry_safe(fcoe, tmp, &fcoe_hostlist, list) {
2307
		list_del(&fcoe->list);
2308
		port = lport_priv(fcoe->ctlr.lp);
2309
		queue_work(fcoe_wq, &port->destroy_work);
2310
	}
2311
	rtnl_unlock();
2312

2313 2314
	unregister_hotcpu_notifier(&fcoe_cpu_notifier);

2315
	for_each_online_cpu(cpu)
2316
		fcoe_percpu_thread_destroy(cpu);
2317

2318
	mutex_unlock(&fcoe_config_mutex);
2319

2320 2321 2322 2323 2324
	/*
	 * destroy_work's may be chained but destroy_workqueue()
	 * can take care of them. Just kill the fcoe_wq.
	 */
	destroy_workqueue(fcoe_wq);
2325

2326 2327 2328 2329 2330
	/*
	 * 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.
	 */
2331
	fcoe_if_exit();
2332 2333 2334

	/* detach from fcoe transport */
	fcoe_transport_detach(&fcoe_sw_transport);
2335 2336
}
module_exit(fcoe_exit);
2337 2338 2339 2340 2341 2342 2343

/**
 * 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
 *
2344
 * This handles MAC address management for FCoE, then passes control on to
2345 2346 2347 2348 2349 2350 2351 2352 2353 2354 2355 2356 2357 2358 2359
 * 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 */
2360
		if (fcoe_ctlr_recv_flogi(fip, lport, fp)) {
2361 2362 2363 2364
			fc_frame_free(fp);
			return;
		}
	}
2365
	fcoe_update_src_mac(lport, mac);
2366 2367 2368 2369 2370 2371 2372 2373 2374 2375
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
 *
2376
 * This handles MAC address management for FCoE, then passes control on to
2377 2378 2379 2380
 * the libfc LOGO response handler.
 */
static void fcoe_logo_resp(struct fc_seq *seq, struct fc_frame *fp, void *arg)
{
2381
	struct fc_lport *lport = arg;
2382 2383 2384
	static u8 zero_mac[ETH_ALEN] = { 0 };

	if (!IS_ERR(fp))
2385
		fcoe_update_src_mac(lport, zero_mac);
2386 2387 2388 2389 2390 2391 2392 2393 2394 2395 2396 2397
	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.
 */
2398 2399 2400 2401 2402 2403
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)
2404 2405
{
	struct fcoe_port *port = lport_priv(lport);
2406
	struct fcoe_interface *fcoe = port->priv;
2407 2408 2409 2410 2411 2412
	struct fcoe_ctlr *fip = &fcoe->ctlr;
	struct fc_frame_header *fh = fc_frame_header_get(fp);

	switch (op) {
	case ELS_FLOGI:
	case ELS_FDISC:
2413 2414
		if (lport->point_to_multipoint)
			break;
2415 2416 2417 2418 2419 2420 2421
		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,
2422
				     lport, timeout);
2423 2424 2425 2426
	}
	return fc_elsct_send(lport, did, fp, op, resp, arg, timeout);
}

2427 2428 2429 2430 2431 2432 2433 2434 2435 2436 2437 2438
/**
 * 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);
2439
	struct fcoe_interface *fcoe = port->priv;
2440 2441
	struct net_device *netdev = fcoe->netdev;
	struct fc_lport *vn_port;
2442 2443 2444 2445 2446 2447 2448 2449 2450 2451 2452
	int rc;
	char buf[32];

	rc = fcoe_validate_vport_create(vport);
	if (rc) {
		wwn_to_str(vport->port_name, buf, sizeof(buf));
		printk(KERN_ERR "fcoe: Failed to create vport, "
			"WWPN (0x%s) already exists\n",
			buf);
		return rc;
	}
2453 2454 2455 2456 2457 2458 2459 2460 2461 2462 2463 2464 2465 2466 2467 2468 2469 2470 2471 2472 2473 2474 2475 2476 2477 2478 2479 2480 2481 2482 2483 2484 2485 2486 2487 2488 2489

	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);
2490
	queue_work(fcoe_wq, &port->destroy_work);
2491 2492 2493 2494 2495 2496 2497 2498 2499 2500 2501 2502 2503 2504 2505 2506 2507 2508 2509 2510 2511 2512 2513 2514
	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;
}

2515 2516 2517 2518 2519 2520 2521 2522 2523 2524 2525 2526 2527 2528 2529 2530 2531 2532 2533 2534 2535 2536 2537 2538 2539 2540 2541 2542
/**
 * 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,
2543
			     NULL, NULL, 3 * lport->r_a_tov);
2544
}
2545 2546 2547 2548 2549 2550 2551 2552 2553 2554 2555 2556 2557

/**
 * 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;
2558
	struct rtnl_link_stats64 temp;
2559 2560 2561 2562 2563 2564 2565 2566 2567 2568 2569 2570 2571 2572 2573 2574
	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);
2575
	lesb->lesb_fcs_error = htonl(dev_get_stats(netdev, &temp)->rx_crc_errors);
2576
}
2577 2578 2579 2580 2581 2582 2583 2584 2585 2586 2587 2588 2589 2590 2591 2592 2593

/**
 * 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);
2594
	struct fcoe_interface *fcoe = port->priv;
2595 2596 2597 2598

	if (fp && fc_frame_payload_op(fp) == ELS_FLOGI)
		fcoe_ctlr_recv_flogi(&fcoe->ctlr, lport, fp);
}
2599 2600 2601 2602 2603 2604 2605 2606 2607 2608 2609 2610 2611 2612 2613 2614 2615 2616 2617 2618 2619 2620 2621 2622 2623 2624 2625 2626 2627 2628 2629 2630 2631 2632 2633 2634 2635 2636 2637 2638 2639 2640 2641 2642 2643 2644

/**
 * fcoe_validate_vport_create() - Validate a vport before creating it
 * @vport: NPIV port to be created
 *
 * This routine is meant to add validation for a vport before creating it
 * via fcoe_vport_create().
 * Current validations are:
 *      - WWPN supplied is unique for given lport
 *
 *
*/
static int fcoe_validate_vport_create(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;
	int rc = 0;
	char buf[32];

	mutex_lock(&n_port->lp_mutex);

	wwn_to_str(vport->port_name, buf, sizeof(buf));
	/* Check if the wwpn is not same as that of the lport */
	if (!memcmp(&n_port->wwpn, &vport->port_name, sizeof(u64))) {
		FCOE_DBG("vport WWPN 0x%s is same as that of the "
			"base port WWPN\n", buf);
		rc = -EINVAL;
		goto out;
	}

	/* Check if there is any existing vport with same wwpn */
	list_for_each_entry(vn_port, &n_port->vports, list) {
		if (!memcmp(&vn_port->wwpn, &vport->port_name, sizeof(u64))) {
			FCOE_DBG("vport with given WWPN 0x%s already "
			"exists\n", buf);
			rc = -EINVAL;
			break;
		}
	}

out:
	mutex_unlock(&n_port->lp_mutex);

	return rc;
}