1/* 2 * Copyright(c) 2007 - 2009 Intel Corporation. All rights reserved. 3 * 4 * This program is free software; you can redistribute it and/or modify it 5 * under the terms and conditions of the GNU General Public License, 6 * version 2, as published by the Free Software Foundation. 7 * 8 * This program is distributed in the hope it will be useful, but WITHOUT 9 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or 10 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for 11 * more details. 12 * 13 * You should have received a copy of the GNU General Public License along with 14 * this program; if not, write to the Free Software Foundation, Inc., 15 * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA. 16 * 17 * Maintained at www.Open-FCoE.org 18 */ 19 20#include <linux/module.h> 21#include <linux/version.h> 22#include <linux/spinlock.h> 23#include <linux/netdevice.h> 24#include <linux/etherdevice.h> 25#include <linux/ethtool.h> 26#include <linux/if_ether.h> 27#include <linux/if_vlan.h> 28#include <linux/crc32.h> 29#include <linux/slab.h> 30#include <linux/cpu.h> 31#include <linux/fs.h> 32#include <linux/sysfs.h> 33#include <linux/ctype.h> 34#include <scsi/scsi_tcq.h> 35#include <scsi/scsicam.h> 36#include <scsi/scsi_transport.h> 37#include <scsi/scsi_transport_fc.h> 38#include <net/rtnetlink.h> 39 40#include <scsi/fc/fc_encaps.h> 41#include <scsi/fc/fc_fip.h> 42 43#include <scsi/libfc.h> 44#include <scsi/fc_frame.h> 45#include <scsi/libfcoe.h> 46 47#include "fcoe.h" 48 49MODULE_AUTHOR("Open-FCoE.org"); 50MODULE_DESCRIPTION("FCoE"); 51MODULE_LICENSE("GPL v2"); 52 53/* Performance tuning parameters for fcoe */ 54static unsigned int fcoe_ddp_min; 55module_param_named(ddp_min, fcoe_ddp_min, uint, S_IRUGO | S_IWUSR); 56MODULE_PARM_DESC(ddp_min, "Minimum I/O size in bytes for " \ 57 "Direct Data Placement (DDP)."); 58 59DEFINE_MUTEX(fcoe_config_mutex); 60 61/* fcoe_percpu_clean completion. Waiter protected by fcoe_create_mutex */ 62static DECLARE_COMPLETION(fcoe_flush_completion); 63 64/* fcoe host list */ 65/* must only by accessed under the RTNL mutex */ 66LIST_HEAD(fcoe_hostlist); 67DEFINE_PER_CPU(struct fcoe_percpu_s, fcoe_percpu); 68 69/* Function Prototypes */ 70static int fcoe_reset(struct Scsi_Host *); 71static int fcoe_xmit(struct fc_lport *, struct fc_frame *); 72static int fcoe_rcv(struct sk_buff *, struct net_device *, 73 struct packet_type *, struct net_device *); 74static int fcoe_percpu_receive_thread(void *); 75static void fcoe_clean_pending_queue(struct fc_lport *); 76static void fcoe_percpu_clean(struct fc_lport *); 77static int fcoe_link_speed_update(struct fc_lport *); 78static int fcoe_link_ok(struct fc_lport *); 79 80static struct fc_lport *fcoe_hostlist_lookup(const struct net_device *); 81static int fcoe_hostlist_add(const struct fc_lport *); 82 83static void fcoe_check_wait_queue(struct fc_lport *, struct sk_buff *); 84static int fcoe_device_notification(struct notifier_block *, ulong, void *); 85static void fcoe_dev_setup(void); 86static void fcoe_dev_cleanup(void); 87static struct fcoe_interface 88*fcoe_hostlist_lookup_port(const struct net_device *); 89 90static int fcoe_fip_recv(struct sk_buff *, struct net_device *, 91 struct packet_type *, struct net_device *); 92 93static void fcoe_fip_send(struct fcoe_ctlr *, struct sk_buff *); 94static void fcoe_update_src_mac(struct fc_lport *, u8 *); 95static u8 *fcoe_get_src_mac(struct fc_lport *); 96static void fcoe_destroy_work(struct work_struct *); 97 98static int fcoe_ddp_setup(struct fc_lport *, u16, struct scatterlist *, 99 unsigned int); 100static int fcoe_ddp_done(struct fc_lport *, u16); 101 102static int fcoe_cpu_callback(struct notifier_block *, unsigned long, void *); 103 104static int fcoe_create(const char *, struct kernel_param *); 105static int fcoe_destroy(const char *, struct kernel_param *); 106static int fcoe_enable(const char *, struct kernel_param *); 107static int fcoe_disable(const char *, struct kernel_param *); 108 109static struct fc_seq *fcoe_elsct_send(struct fc_lport *, 110 u32 did, struct fc_frame *, 111 unsigned int op, 112 void (*resp)(struct fc_seq *, 113 struct fc_frame *, 114 void *), 115 void *, u32 timeout); 116static void fcoe_recv_frame(struct sk_buff *skb); 117 118static void fcoe_get_lesb(struct fc_lport *, struct fc_els_lesb *); 119 120module_param_call(create, fcoe_create, NULL, (void *)FIP_MODE_AUTO, S_IWUSR); 121__MODULE_PARM_TYPE(create, "string"); 122MODULE_PARM_DESC(create, " Creates fcoe instance on a ethernet interface"); 123module_param_call(create_vn2vn, fcoe_create, NULL, 124 (void *)FIP_MODE_VN2VN, S_IWUSR); 125__MODULE_PARM_TYPE(create_vn2vn, "string"); 126MODULE_PARM_DESC(create_vn2vn, " Creates a VN_node to VN_node FCoE instance " 127 "on an Ethernet interface"); 128module_param_call(destroy, fcoe_destroy, NULL, NULL, S_IWUSR); 129__MODULE_PARM_TYPE(destroy, "string"); 130MODULE_PARM_DESC(destroy, " Destroys fcoe instance on a ethernet interface"); 131module_param_call(enable, fcoe_enable, NULL, NULL, S_IWUSR); 132__MODULE_PARM_TYPE(enable, "string"); 133MODULE_PARM_DESC(enable, " Enables fcoe on a ethernet interface."); 134module_param_call(disable, fcoe_disable, NULL, NULL, S_IWUSR); 135__MODULE_PARM_TYPE(disable, "string"); 136MODULE_PARM_DESC(disable, " Disables fcoe on a ethernet interface."); 137 138/* notification function for packets from net device */ 139static struct notifier_block fcoe_notifier = { 140 .notifier_call = fcoe_device_notification, 141}; 142 143/* notification function for CPU hotplug events */ 144static struct notifier_block fcoe_cpu_notifier = { 145 .notifier_call = fcoe_cpu_callback, 146}; 147 148static struct scsi_transport_template *fcoe_transport_template; 149static struct scsi_transport_template *fcoe_vport_transport_template; 150 151static int fcoe_vport_destroy(struct fc_vport *); 152static int fcoe_vport_create(struct fc_vport *, bool disabled); 153static int fcoe_vport_disable(struct fc_vport *, bool disable); 154static void fcoe_set_vport_symbolic_name(struct fc_vport *); 155static void fcoe_set_port_id(struct fc_lport *, u32, struct fc_frame *); 156 157static struct libfc_function_template fcoe_libfc_fcn_templ = { 158 .frame_send = fcoe_xmit, 159 .ddp_setup = fcoe_ddp_setup, 160 .ddp_done = fcoe_ddp_done, 161 .elsct_send = fcoe_elsct_send, 162 .get_lesb = fcoe_get_lesb, 163 .lport_set_port_id = fcoe_set_port_id, 164}; 165 166struct fc_function_template fcoe_transport_function = { 167 .show_host_node_name = 1, 168 .show_host_port_name = 1, 169 .show_host_supported_classes = 1, 170 .show_host_supported_fc4s = 1, 171 .show_host_active_fc4s = 1, 172 .show_host_maxframe_size = 1, 173 174 .show_host_port_id = 1, 175 .show_host_supported_speeds = 1, 176 .get_host_speed = fc_get_host_speed, 177 .show_host_speed = 1, 178 .show_host_port_type = 1, 179 .get_host_port_state = fc_get_host_port_state, 180 .show_host_port_state = 1, 181 .show_host_symbolic_name = 1, 182 183 .dd_fcrport_size = sizeof(struct fc_rport_libfc_priv), 184 .show_rport_maxframe_size = 1, 185 .show_rport_supported_classes = 1, 186 187 .show_host_fabric_name = 1, 188 .show_starget_node_name = 1, 189 .show_starget_port_name = 1, 190 .show_starget_port_id = 1, 191 .set_rport_dev_loss_tmo = fc_set_rport_loss_tmo, 192 .show_rport_dev_loss_tmo = 1, 193 .get_fc_host_stats = fc_get_host_stats, 194 .issue_fc_host_lip = fcoe_reset, 195 196 .terminate_rport_io = fc_rport_terminate_io, 197 198 .vport_create = fcoe_vport_create, 199 .vport_delete = fcoe_vport_destroy, 200 .vport_disable = fcoe_vport_disable, 201 .set_vport_symbolic_name = fcoe_set_vport_symbolic_name, 202 203 .bsg_request = fc_lport_bsg_request, 204}; 205 206struct fc_function_template fcoe_vport_transport_function = { 207 .show_host_node_name = 1, 208 .show_host_port_name = 1, 209 .show_host_supported_classes = 1, 210 .show_host_supported_fc4s = 1, 211 .show_host_active_fc4s = 1, 212 .show_host_maxframe_size = 1, 213 214 .show_host_port_id = 1, 215 .show_host_supported_speeds = 1, 216 .get_host_speed = fc_get_host_speed, 217 .show_host_speed = 1, 218 .show_host_port_type = 1, 219 .get_host_port_state = fc_get_host_port_state, 220 .show_host_port_state = 1, 221 .show_host_symbolic_name = 1, 222 223 .dd_fcrport_size = sizeof(struct fc_rport_libfc_priv), 224 .show_rport_maxframe_size = 1, 225 .show_rport_supported_classes = 1, 226 227 .show_host_fabric_name = 1, 228 .show_starget_node_name = 1, 229 .show_starget_port_name = 1, 230 .show_starget_port_id = 1, 231 .set_rport_dev_loss_tmo = fc_set_rport_loss_tmo, 232 .show_rport_dev_loss_tmo = 1, 233 .get_fc_host_stats = fc_get_host_stats, 234 .issue_fc_host_lip = fcoe_reset, 235 236 .terminate_rport_io = fc_rport_terminate_io, 237 238 .bsg_request = fc_lport_bsg_request, 239}; 240 241static struct scsi_host_template fcoe_shost_template = { 242 .module = THIS_MODULE, 243 .name = "FCoE Driver", 244 .proc_name = FCOE_NAME, 245 .queuecommand = fc_queuecommand, 246 .eh_abort_handler = fc_eh_abort, 247 .eh_device_reset_handler = fc_eh_device_reset, 248 .eh_host_reset_handler = fc_eh_host_reset, 249 .slave_alloc = fc_slave_alloc, 250 .change_queue_depth = fc_change_queue_depth, 251 .change_queue_type = fc_change_queue_type, 252 .this_id = -1, 253 .cmd_per_lun = 3, 254 .can_queue = FCOE_MAX_OUTSTANDING_COMMANDS, 255 .use_clustering = ENABLE_CLUSTERING, 256 .sg_tablesize = SG_ALL, 257 .max_sectors = 0xffff, 258}; 259 260/** 261 * fcoe_interface_setup() - Setup a FCoE interface 262 * @fcoe: The new FCoE interface 263 * @netdev: The net device that the fcoe interface is on 264 * 265 * Returns : 0 for success 266 * Locking: must be called with the RTNL mutex held 267 */ 268static int fcoe_interface_setup(struct fcoe_interface *fcoe, 269 struct net_device *netdev) 270{ 271 struct fcoe_ctlr *fip = &fcoe->ctlr; 272 struct netdev_hw_addr *ha; 273 struct net_device *real_dev; 274 u8 flogi_maddr[ETH_ALEN]; 275 const struct net_device_ops *ops; 276 277 fcoe->netdev = netdev; 278 279 /* Let LLD initialize for FCoE */ 280 ops = netdev->netdev_ops; 281 if (ops->ndo_fcoe_enable) { 282 if (ops->ndo_fcoe_enable(netdev)) 283 FCOE_NETDEV_DBG(netdev, "Failed to enable FCoE" 284 " specific feature for LLD.\n"); 285 } 286 287 /* Do not support for bonding device */ 288 if ((netdev->priv_flags & IFF_MASTER_ALB) || 289 (netdev->priv_flags & IFF_SLAVE_INACTIVE) || 290 (netdev->priv_flags & IFF_MASTER_8023AD)) { 291 FCOE_NETDEV_DBG(netdev, "Bonded interfaces not supported\n"); 292 return -EOPNOTSUPP; 293 } 294 295 /* look for SAN MAC address, if multiple SAN MACs exist, only 296 * use the first one for SPMA */ 297 real_dev = (netdev->priv_flags & IFF_802_1Q_VLAN) ? 298 vlan_dev_real_dev(netdev) : netdev; 299 rcu_read_lock(); 300 for_each_dev_addr(real_dev, ha) { 301 if ((ha->type == NETDEV_HW_ADDR_T_SAN) && 302 (is_valid_ether_addr(ha->addr))) { 303 memcpy(fip->ctl_src_addr, ha->addr, ETH_ALEN); 304 fip->spma = 1; 305 break; 306 } 307 } 308 rcu_read_unlock(); 309 310 /* setup Source Mac Address */ 311 if (!fip->spma) 312 memcpy(fip->ctl_src_addr, netdev->dev_addr, netdev->addr_len); 313 314 /* 315 * Add FCoE MAC address as second unicast MAC address 316 * or enter promiscuous mode if not capable of listening 317 * for multiple unicast MACs. 318 */ 319 memcpy(flogi_maddr, (u8[6]) FC_FCOE_FLOGI_MAC, ETH_ALEN); 320 dev_uc_add(netdev, flogi_maddr); 321 if (fip->spma) 322 dev_uc_add(netdev, fip->ctl_src_addr); 323 if (fip->mode == FIP_MODE_VN2VN) { 324 dev_mc_add(netdev, FIP_ALL_VN2VN_MACS); 325 dev_mc_add(netdev, FIP_ALL_P2P_MACS); 326 } else 327 dev_mc_add(netdev, FIP_ALL_ENODE_MACS); 328 329 /* 330 * setup the receive function from ethernet driver 331 * on the ethertype for the given device 332 */ 333 fcoe->fcoe_packet_type.func = fcoe_rcv; 334 fcoe->fcoe_packet_type.type = __constant_htons(ETH_P_FCOE); 335 fcoe->fcoe_packet_type.dev = netdev; 336 dev_add_pack(&fcoe->fcoe_packet_type); 337 338 fcoe->fip_packet_type.func = fcoe_fip_recv; 339 fcoe->fip_packet_type.type = htons(ETH_P_FIP); 340 fcoe->fip_packet_type.dev = netdev; 341 dev_add_pack(&fcoe->fip_packet_type); 342 343 return 0; 344} 345 346/** 347 * fcoe_interface_create() - Create a FCoE interface on a net device 348 * @netdev: The net device to create the FCoE interface on 349 * @fip_mode: The mode to use for FIP 350 * 351 * Returns: pointer to a struct fcoe_interface or NULL on error 352 */ 353static struct fcoe_interface *fcoe_interface_create(struct net_device *netdev, 354 enum fip_state fip_mode) 355{ 356 struct fcoe_interface *fcoe; 357 int err; 358 359 fcoe = kzalloc(sizeof(*fcoe), GFP_KERNEL); 360 if (!fcoe) { 361 FCOE_NETDEV_DBG(netdev, "Could not allocate fcoe structure\n"); 362 return NULL; 363 } 364 365 dev_hold(netdev); 366 kref_init(&fcoe->kref); 367 368 /* 369 * Initialize FIP. 370 */ 371 fcoe_ctlr_init(&fcoe->ctlr, fip_mode); 372 fcoe->ctlr.send = fcoe_fip_send; 373 fcoe->ctlr.update_mac = fcoe_update_src_mac; 374 fcoe->ctlr.get_src_addr = fcoe_get_src_mac; 375 376 err = fcoe_interface_setup(fcoe, netdev); 377 if (err) { 378 fcoe_ctlr_destroy(&fcoe->ctlr); 379 kfree(fcoe); 380 dev_put(netdev); 381 return NULL; 382 } 383 384 return fcoe; 385} 386 387/** 388 * fcoe_interface_cleanup() - Clean up a FCoE interface 389 * @fcoe: The FCoE interface to be cleaned up 390 * 391 * Caller must be holding the RTNL mutex 392 */ 393void fcoe_interface_cleanup(struct fcoe_interface *fcoe) 394{ 395 struct net_device *netdev = fcoe->netdev; 396 struct fcoe_ctlr *fip = &fcoe->ctlr; 397 u8 flogi_maddr[ETH_ALEN]; 398 const struct net_device_ops *ops; 399 400 /* 401 * Don't listen for Ethernet packets anymore. 402 * synchronize_net() ensures that the packet handlers are not running 403 * on another CPU. dev_remove_pack() would do that, this calls the 404 * unsyncronized version __dev_remove_pack() to avoid multiple delays. 405 */ 406 __dev_remove_pack(&fcoe->fcoe_packet_type); 407 __dev_remove_pack(&fcoe->fip_packet_type); 408 synchronize_net(); 409 410 /* Delete secondary MAC addresses */ 411 memcpy(flogi_maddr, (u8[6]) FC_FCOE_FLOGI_MAC, ETH_ALEN); 412 dev_uc_del(netdev, flogi_maddr); 413 if (fip->spma) 414 dev_uc_del(netdev, fip->ctl_src_addr); 415 if (fip->mode == FIP_MODE_VN2VN) { 416 dev_mc_del(netdev, FIP_ALL_VN2VN_MACS); 417 dev_mc_del(netdev, FIP_ALL_P2P_MACS); 418 } else 419 dev_mc_del(netdev, FIP_ALL_ENODE_MACS); 420 421 /* Tell the LLD we are done w/ FCoE */ 422 ops = netdev->netdev_ops; 423 if (ops->ndo_fcoe_disable) { 424 if (ops->ndo_fcoe_disable(netdev)) 425 FCOE_NETDEV_DBG(netdev, "Failed to disable FCoE" 426 " specific feature for LLD.\n"); 427 } 428} 429 430/** 431 * fcoe_interface_release() - fcoe_port kref release function 432 * @kref: Embedded reference count in an fcoe_interface struct 433 */ 434static void fcoe_interface_release(struct kref *kref) 435{ 436 struct fcoe_interface *fcoe; 437 struct net_device *netdev; 438 439 fcoe = container_of(kref, struct fcoe_interface, kref); 440 netdev = fcoe->netdev; 441 /* tear-down the FCoE controller */ 442 fcoe_ctlr_destroy(&fcoe->ctlr); 443 kfree(fcoe); 444 dev_put(netdev); 445} 446 447/** 448 * fcoe_interface_get() - Get a reference to a FCoE interface 449 * @fcoe: The FCoE interface to be held 450 */ 451static inline void fcoe_interface_get(struct fcoe_interface *fcoe) 452{ 453 kref_get(&fcoe->kref); 454} 455 456/** 457 * fcoe_interface_put() - Put a reference to a FCoE interface 458 * @fcoe: The FCoE interface to be released 459 */ 460static inline void fcoe_interface_put(struct fcoe_interface *fcoe) 461{ 462 kref_put(&fcoe->kref, fcoe_interface_release); 463} 464 465/** 466 * fcoe_fip_recv() - Handler for received FIP frames 467 * @skb: The receive skb 468 * @netdev: The associated net device 469 * @ptype: The packet_type structure which was used to register this handler 470 * @orig_dev: The original net_device the the skb was received on. 471 * (in case dev is a bond) 472 * 473 * Returns: 0 for success 474 */ 475static int fcoe_fip_recv(struct sk_buff *skb, struct net_device *netdev, 476 struct packet_type *ptype, 477 struct net_device *orig_dev) 478{ 479 struct fcoe_interface *fcoe; 480 481 fcoe = container_of(ptype, struct fcoe_interface, fip_packet_type); 482 fcoe_ctlr_recv(&fcoe->ctlr, skb); 483 return 0; 484} 485 486/** 487 * fcoe_fip_send() - Send an Ethernet-encapsulated FIP frame 488 * @fip: The FCoE controller 489 * @skb: The FIP packet to be sent 490 */ 491static void fcoe_fip_send(struct fcoe_ctlr *fip, struct sk_buff *skb) 492{ 493 skb->dev = fcoe_from_ctlr(fip)->netdev; 494 dev_queue_xmit(skb); 495} 496 497/** 498 * fcoe_update_src_mac() - Update the Ethernet MAC filters 499 * @lport: The local port to update the source MAC on 500 * @addr: Unicast MAC address to add 501 * 502 * Remove any previously-set unicast MAC filter. 503 * Add secondary FCoE MAC address filter for our OUI. 504 */ 505static void fcoe_update_src_mac(struct fc_lport *lport, u8 *addr) 506{ 507 struct fcoe_port *port = lport_priv(lport); 508 struct fcoe_interface *fcoe = port->fcoe; 509 510 rtnl_lock(); 511 if (!is_zero_ether_addr(port->data_src_addr)) 512 dev_uc_del(fcoe->netdev, port->data_src_addr); 513 if (!is_zero_ether_addr(addr)) 514 dev_uc_add(fcoe->netdev, addr); 515 memcpy(port->data_src_addr, addr, ETH_ALEN); 516 rtnl_unlock(); 517} 518 519/** 520 * fcoe_get_src_mac() - return the Ethernet source address for an lport 521 * @lport: libfc lport 522 */ 523static u8 *fcoe_get_src_mac(struct fc_lport *lport) 524{ 525 struct fcoe_port *port = lport_priv(lport); 526 527 return port->data_src_addr; 528} 529 530/** 531 * fcoe_lport_config() - Set up a local port 532 * @lport: The local port to be setup 533 * 534 * Returns: 0 for success 535 */ 536static int fcoe_lport_config(struct fc_lport *lport) 537{ 538 lport->link_up = 0; 539 lport->qfull = 0; 540 lport->max_retry_count = 3; 541 lport->max_rport_retry_count = 3; 542 lport->e_d_tov = 2 * 1000; /* FC-FS default */ 543 lport->r_a_tov = 2 * 2 * 1000; 544 lport->service_params = (FCP_SPPF_INIT_FCN | FCP_SPPF_RD_XRDY_DIS | 545 FCP_SPPF_RETRY | FCP_SPPF_CONF_COMPL); 546 lport->does_npiv = 1; 547 548 fc_lport_init_stats(lport); 549 550 /* lport fc_lport related configuration */ 551 fc_lport_config(lport); 552 553 /* offload related configuration */ 554 lport->crc_offload = 0; 555 lport->seq_offload = 0; 556 lport->lro_enabled = 0; 557 lport->lro_xid = 0; 558 lport->lso_max = 0; 559 560 return 0; 561} 562 563/** 564 * fcoe_queue_timer() - The fcoe queue timer 565 * @lport: The local port 566 * 567 * Calls fcoe_check_wait_queue on timeout 568 */ 569static void fcoe_queue_timer(ulong lport) 570{ 571 fcoe_check_wait_queue((struct fc_lport *)lport, NULL); 572} 573 574/** 575 * fcoe_get_wwn() - Get the world wide name from LLD if it supports it 576 * @netdev: the associated net device 577 * @wwn: the output WWN 578 * @type: the type of WWN (WWPN or WWNN) 579 * 580 * Returns: 0 for success 581 */ 582static int fcoe_get_wwn(struct net_device *netdev, u64 *wwn, int type) 583{ 584 const struct net_device_ops *ops = netdev->netdev_ops; 585 586 if (ops->ndo_fcoe_get_wwn) 587 return ops->ndo_fcoe_get_wwn(netdev, wwn, type); 588 return -EINVAL; 589} 590 591/** 592 * fcoe_netdev_features_change - Updates the lport's offload flags based 593 * on the LLD netdev's FCoE feature flags 594 */ 595static void fcoe_netdev_features_change(struct fc_lport *lport, 596 struct net_device *netdev) 597{ 598 mutex_lock(&lport->lp_mutex); 599 600 if (netdev->features & NETIF_F_SG) 601 lport->sg_supp = 1; 602 else 603 lport->sg_supp = 0; 604 605 if (netdev->features & NETIF_F_FCOE_CRC) { 606 lport->crc_offload = 1; 607 FCOE_NETDEV_DBG(netdev, "Supports FCCRC offload\n"); 608 } else { 609 lport->crc_offload = 0; 610 } 611 612 if (netdev->features & NETIF_F_FSO) { 613 lport->seq_offload = 1; 614 lport->lso_max = netdev->gso_max_size; 615 FCOE_NETDEV_DBG(netdev, "Supports LSO for max len 0x%x\n", 616 lport->lso_max); 617 } else { 618 lport->seq_offload = 0; 619 lport->lso_max = 0; 620 } 621 622 if (netdev->fcoe_ddp_xid) { 623 lport->lro_enabled = 1; 624 lport->lro_xid = netdev->fcoe_ddp_xid; 625 FCOE_NETDEV_DBG(netdev, "Supports LRO for max xid 0x%x\n", 626 lport->lro_xid); 627 } else { 628 lport->lro_enabled = 0; 629 lport->lro_xid = 0; 630 } 631 632 mutex_unlock(&lport->lp_mutex); 633} 634 635/** 636 * fcoe_netdev_config() - Set up net devive for SW FCoE 637 * @lport: The local port that is associated with the net device 638 * @netdev: The associated net device 639 * 640 * Must be called after fcoe_lport_config() as it will use local port mutex 641 * 642 * Returns: 0 for success 643 */ 644static int fcoe_netdev_config(struct fc_lport *lport, struct net_device *netdev) 645{ 646 u32 mfs; 647 u64 wwnn, wwpn; 648 struct fcoe_interface *fcoe; 649 struct fcoe_port *port; 650 651 /* Setup lport private data to point to fcoe softc */ 652 port = lport_priv(lport); 653 fcoe = port->fcoe; 654 655 /* 656 * Determine max frame size based on underlying device and optional 657 * user-configured limit. If the MFS is too low, fcoe_link_ok() 658 * will return 0, so do this first. 659 */ 660 mfs = netdev->mtu; 661 if (netdev->features & NETIF_F_FCOE_MTU) { 662 mfs = FCOE_MTU; 663 FCOE_NETDEV_DBG(netdev, "Supports FCOE_MTU of %d bytes\n", mfs); 664 } 665 mfs -= (sizeof(struct fcoe_hdr) + sizeof(struct fcoe_crc_eof)); 666 if (fc_set_mfs(lport, mfs)) 667 return -EINVAL; 668 669 /* offload features support */ 670 fcoe_netdev_features_change(lport, netdev); 671 672 skb_queue_head_init(&port->fcoe_pending_queue); 673 port->fcoe_pending_queue_active = 0; 674 setup_timer(&port->timer, fcoe_queue_timer, (unsigned long)lport); 675 676 fcoe_link_speed_update(lport); 677 678 if (!lport->vport) { 679 if (fcoe_get_wwn(netdev, &wwnn, NETDEV_FCOE_WWNN)) 680 wwnn = fcoe_wwn_from_mac(fcoe->ctlr.ctl_src_addr, 1, 0); 681 fc_set_wwnn(lport, wwnn); 682 if (fcoe_get_wwn(netdev, &wwpn, NETDEV_FCOE_WWPN)) 683 wwpn = fcoe_wwn_from_mac(fcoe->ctlr.ctl_src_addr, 684 2, 0); 685 fc_set_wwpn(lport, wwpn); 686 } 687 688 return 0; 689} 690 691/** 692 * fcoe_shost_config() - Set up the SCSI host associated with a local port 693 * @lport: The local port 694 * @dev: The device associated with the SCSI host 695 * 696 * Must be called after fcoe_lport_config() and fcoe_netdev_config() 697 * 698 * Returns: 0 for success 699 */ 700static int fcoe_shost_config(struct fc_lport *lport, struct device *dev) 701{ 702 int rc = 0; 703 704 /* lport scsi host config */ 705 lport->host->max_lun = FCOE_MAX_LUN; 706 lport->host->max_id = FCOE_MAX_FCP_TARGET; 707 lport->host->max_channel = 0; 708 lport->host->max_cmd_len = FCOE_MAX_CMD_LEN; 709 710 if (lport->vport) 711 lport->host->transportt = fcoe_vport_transport_template; 712 else 713 lport->host->transportt = fcoe_transport_template; 714 715 /* add the new host to the SCSI-ml */ 716 rc = scsi_add_host(lport->host, dev); 717 if (rc) { 718 FCOE_NETDEV_DBG(fcoe_netdev(lport), "fcoe_shost_config: " 719 "error on scsi_add_host\n"); 720 return rc; 721 } 722 723 if (!lport->vport) 724 fc_host_max_npiv_vports(lport->host) = USHRT_MAX; 725 726 snprintf(fc_host_symbolic_name(lport->host), FC_SYMBOLIC_NAME_SIZE, 727 "%s v%s over %s", FCOE_NAME, FCOE_VERSION, 728 fcoe_netdev(lport)->name); 729 730 return 0; 731} 732 733/** 734 * fcoe_oem_match() - The match routine for the offloaded exchange manager 735 * @fp: The I/O frame 736 * 737 * This routine will be associated with an exchange manager (EM). When 738 * the libfc exchange handling code is looking for an EM to use it will 739 * call this routine and pass it the frame that it wishes to send. This 740 * routine will return True if the associated EM is to be used and False 741 * if the echange code should continue looking for an EM. 742 * 743 * The offload EM that this routine is associated with will handle any 744 * packets that are for SCSI read requests. 745 * 746 * Returns: True for read types I/O, otherwise returns false. 747 */ 748bool fcoe_oem_match(struct fc_frame *fp) 749{ 750 return fc_fcp_is_read(fr_fsp(fp)) && 751 (fr_fsp(fp)->data_len > fcoe_ddp_min); 752} 753 754/** 755 * fcoe_em_config() - Allocate and configure an exchange manager 756 * @lport: The local port that the new EM will be associated with 757 * 758 * Returns: 0 on success 759 */ 760static inline int fcoe_em_config(struct fc_lport *lport) 761{ 762 struct fcoe_port *port = lport_priv(lport); 763 struct fcoe_interface *fcoe = port->fcoe; 764 struct fcoe_interface *oldfcoe = NULL; 765 struct net_device *old_real_dev, *cur_real_dev; 766 u16 min_xid = FCOE_MIN_XID; 767 u16 max_xid = FCOE_MAX_XID; 768 769 /* 770 * Check if need to allocate an em instance for 771 * offload exchange ids to be shared across all VN_PORTs/lport. 772 */ 773 if (!lport->lro_enabled || !lport->lro_xid || 774 (lport->lro_xid >= max_xid)) { 775 lport->lro_xid = 0; 776 goto skip_oem; 777 } 778 779 /* 780 * Reuse existing offload em instance in case 781 * it is already allocated on real eth device 782 */ 783 if (fcoe->netdev->priv_flags & IFF_802_1Q_VLAN) 784 cur_real_dev = vlan_dev_real_dev(fcoe->netdev); 785 else 786 cur_real_dev = fcoe->netdev; 787 788 list_for_each_entry(oldfcoe, &fcoe_hostlist, list) { 789 if (oldfcoe->netdev->priv_flags & IFF_802_1Q_VLAN) 790 old_real_dev = vlan_dev_real_dev(oldfcoe->netdev); 791 else 792 old_real_dev = oldfcoe->netdev; 793 794 if (cur_real_dev == old_real_dev) { 795 fcoe->oem = oldfcoe->oem; 796 break; 797 } 798 } 799 800 if (fcoe->oem) { 801 if (!fc_exch_mgr_add(lport, fcoe->oem, fcoe_oem_match)) { 802 printk(KERN_ERR "fcoe_em_config: failed to add " 803 "offload em:%p on interface:%s\n", 804 fcoe->oem, fcoe->netdev->name); 805 return -ENOMEM; 806 } 807 } else { 808 fcoe->oem = fc_exch_mgr_alloc(lport, FC_CLASS_3, 809 FCOE_MIN_XID, lport->lro_xid, 810 fcoe_oem_match); 811 if (!fcoe->oem) { 812 printk(KERN_ERR "fcoe_em_config: failed to allocate " 813 "em for offload exches on interface:%s\n", 814 fcoe->netdev->name); 815 return -ENOMEM; 816 } 817 } 818 819 /* 820 * Exclude offload EM xid range from next EM xid range. 821 */ 822 min_xid += lport->lro_xid + 1; 823 824skip_oem: 825 if (!fc_exch_mgr_alloc(lport, FC_CLASS_3, min_xid, max_xid, NULL)) { 826 printk(KERN_ERR "fcoe_em_config: failed to " 827 "allocate em on interface %s\n", fcoe->netdev->name); 828 return -ENOMEM; 829 } 830 831 return 0; 832} 833 834/** 835 * fcoe_if_destroy() - Tear down a SW FCoE instance 836 * @lport: The local port to be destroyed 837 * 838 * Locking: must be called with the RTNL mutex held and RTNL mutex 839 * needed to be dropped by this function since not dropping RTNL 840 * would cause circular locking warning on synchronous fip worker 841 * cancelling thru fcoe_interface_put invoked by this function. 842 * 843 */ 844static void fcoe_if_destroy(struct fc_lport *lport) 845{ 846 struct fcoe_port *port = lport_priv(lport); 847 struct fcoe_interface *fcoe = port->fcoe; 848 struct net_device *netdev = fcoe->netdev; 849 850 FCOE_NETDEV_DBG(netdev, "Destroying interface\n"); 851 852 /* Logout of the fabric */ 853 fc_fabric_logoff(lport); 854 855 /* Cleanup the fc_lport */ 856 fc_lport_destroy(lport); 857 fc_fcp_destroy(lport); 858 859 /* Stop the transmit retry timer */ 860 del_timer_sync(&port->timer); 861 862 /* Free existing transmit skbs */ 863 fcoe_clean_pending_queue(lport); 864 865 if (!is_zero_ether_addr(port->data_src_addr)) 866 dev_uc_del(netdev, port->data_src_addr); 867 rtnl_unlock(); 868 869 /* receives may not be stopped until after this */ 870 fcoe_interface_put(fcoe); 871 872 /* Free queued packets for the per-CPU receive threads */ 873 fcoe_percpu_clean(lport); 874 875 /* Detach from the scsi-ml */ 876 fc_remove_host(lport->host); 877 scsi_remove_host(lport->host); 878 879 /* There are no more rports or I/O, free the EM */ 880 fc_exch_mgr_free(lport); 881 882 /* Free memory used by statistical counters */ 883 fc_lport_free_stats(lport); 884 885 /* Release the Scsi_Host */ 886 scsi_host_put(lport->host); 887 module_put(THIS_MODULE); 888} 889 890/** 891 * fcoe_ddp_setup() - Call a LLD's ddp_setup through the net device 892 * @lport: The local port to setup DDP for 893 * @xid: The exchange ID for this DDP transfer 894 * @sgl: The scatterlist describing this transfer 895 * @sgc: The number of sg items 896 * 897 * Returns: 0 if the DDP context was not configured 898 */ 899static int fcoe_ddp_setup(struct fc_lport *lport, u16 xid, 900 struct scatterlist *sgl, unsigned int sgc) 901{ 902 struct net_device *netdev = fcoe_netdev(lport); 903 904 if (netdev->netdev_ops->ndo_fcoe_ddp_setup) 905 return netdev->netdev_ops->ndo_fcoe_ddp_setup(netdev, 906 xid, sgl, 907 sgc); 908 909 return 0; 910} 911 912/** 913 * fcoe_ddp_done() - Call a LLD's ddp_done through the net device 914 * @lport: The local port to complete DDP on 915 * @xid: The exchange ID for this DDP transfer 916 * 917 * Returns: the length of data that have been completed by DDP 918 */ 919static int fcoe_ddp_done(struct fc_lport *lport, u16 xid) 920{ 921 struct net_device *netdev = fcoe_netdev(lport); 922 923 if (netdev->netdev_ops->ndo_fcoe_ddp_done) 924 return netdev->netdev_ops->ndo_fcoe_ddp_done(netdev, xid); 925 return 0; 926} 927 928/** 929 * fcoe_if_create() - Create a FCoE instance on an interface 930 * @fcoe: The FCoE interface to create a local port on 931 * @parent: The device pointer to be the parent in sysfs for the SCSI host 932 * @npiv: Indicates if the port is a vport or not 933 * 934 * Creates a fc_lport instance and a Scsi_Host instance and configure them. 935 * 936 * Returns: The allocated fc_lport or an error pointer 937 */ 938static struct fc_lport *fcoe_if_create(struct fcoe_interface *fcoe, 939 struct device *parent, int npiv) 940{ 941 struct net_device *netdev = fcoe->netdev; 942 struct fc_lport *lport = NULL; 943 struct fcoe_port *port; 944 int rc; 945 /* 946 * parent is only a vport if npiv is 1, 947 * but we'll only use vport in that case so go ahead and set it 948 */ 949 struct fc_vport *vport = dev_to_vport(parent); 950 951 FCOE_NETDEV_DBG(netdev, "Create Interface\n"); 952 953 if (!npiv) { 954 lport = libfc_host_alloc(&fcoe_shost_template, 955 sizeof(struct fcoe_port)); 956 } else { 957 lport = libfc_vport_create(vport, 958 sizeof(struct fcoe_port)); 959 } 960 if (!lport) { 961 FCOE_NETDEV_DBG(netdev, "Could not allocate host structure\n"); 962 rc = -ENOMEM; 963 goto out; 964 } 965 port = lport_priv(lport); 966 port->lport = lport; 967 port->fcoe = fcoe; 968 INIT_WORK(&port->destroy_work, fcoe_destroy_work); 969 970 /* configure a fc_lport including the exchange manager */ 971 rc = fcoe_lport_config(lport); 972 if (rc) { 973 FCOE_NETDEV_DBG(netdev, "Could not configure lport for the " 974 "interface\n"); 975 goto out_host_put; 976 } 977 978 if (npiv) { 979 FCOE_NETDEV_DBG(netdev, "Setting vport names, " 980 "%16.16llx %16.16llx\n", 981 vport->node_name, vport->port_name); 982 fc_set_wwnn(lport, vport->node_name); 983 fc_set_wwpn(lport, vport->port_name); 984 } 985 986 /* configure lport network properties */ 987 rc = fcoe_netdev_config(lport, netdev); 988 if (rc) { 989 FCOE_NETDEV_DBG(netdev, "Could not configure netdev for the " 990 "interface\n"); 991 goto out_lp_destroy; 992 } 993 994 /* configure lport scsi host properties */ 995 rc = fcoe_shost_config(lport, parent); 996 if (rc) { 997 FCOE_NETDEV_DBG(netdev, "Could not configure shost for the " 998 "interface\n"); 999 goto out_lp_destroy; 1000 } 1001 1002 /* Initialize the library */ 1003 rc = fcoe_libfc_config(lport, &fcoe->ctlr, &fcoe_libfc_fcn_templ, 1); 1004 if (rc) { 1005 FCOE_NETDEV_DBG(netdev, "Could not configure libfc for the " 1006 "interface\n"); 1007 goto out_lp_destroy; 1008 } 1009 1010 if (!npiv) { 1011 /* 1012 * fcoe_em_alloc() and fcoe_hostlist_add() both 1013 * need to be atomic with respect to other changes to the 1014 * hostlist since fcoe_em_alloc() looks for an existing EM 1015 * instance on host list updated by fcoe_hostlist_add(). 1016 * 1017 * This is currently handled through the fcoe_config_mutex 1018 * begin held. 1019 */ 1020 1021 /* lport exch manager allocation */ 1022 rc = fcoe_em_config(lport); 1023 if (rc) { 1024 FCOE_NETDEV_DBG(netdev, "Could not configure the EM " 1025 "for the interface\n"); 1026 goto out_lp_destroy; 1027 } 1028 } 1029 1030 fcoe_interface_get(fcoe); 1031 return lport; 1032 1033out_lp_destroy: 1034 fc_exch_mgr_free(lport); 1035out_host_put: 1036 scsi_host_put(lport->host); 1037out: 1038 return ERR_PTR(rc); 1039} 1040 1041/** 1042 * fcoe_if_init() - Initialization routine for fcoe.ko 1043 * 1044 * Attaches the SW FCoE transport to the FC transport 1045 * 1046 * Returns: 0 on success 1047 */ 1048static int __init fcoe_if_init(void) 1049{ 1050 /* attach to scsi transport */ 1051 fcoe_transport_template = fc_attach_transport(&fcoe_transport_function); 1052 fcoe_vport_transport_template = 1053 fc_attach_transport(&fcoe_vport_transport_function); 1054 1055 if (!fcoe_transport_template) { 1056 printk(KERN_ERR "fcoe: Failed to attach to the FC transport\n"); 1057 return -ENODEV; 1058 } 1059 1060 return 0; 1061} 1062 1063/** 1064 * fcoe_if_exit() - Tear down fcoe.ko 1065 * 1066 * Detaches the SW FCoE transport from the FC transport 1067 * 1068 * Returns: 0 on success 1069 */ 1070int __exit fcoe_if_exit(void) 1071{ 1072 fc_release_transport(fcoe_transport_template); 1073 fc_release_transport(fcoe_vport_transport_template); 1074 fcoe_transport_template = NULL; 1075 fcoe_vport_transport_template = NULL; 1076 return 0; 1077} 1078 1079/** 1080 * fcoe_percpu_thread_create() - Create a receive thread for an online CPU 1081 * @cpu: The CPU index of the CPU to create a receive thread for 1082 */ 1083static void fcoe_percpu_thread_create(unsigned int cpu) 1084{ 1085 struct fcoe_percpu_s *p; 1086 struct task_struct *thread; 1087 1088 p = &per_cpu(fcoe_percpu, cpu); 1089 1090 thread = kthread_create(fcoe_percpu_receive_thread, 1091 (void *)p, "fcoethread/%d", cpu); 1092 1093 if (likely(!IS_ERR(thread))) { 1094 kthread_bind(thread, cpu); 1095 wake_up_process(thread); 1096 1097 spin_lock_bh(&p->fcoe_rx_list.lock); 1098 p->thread = thread; 1099 spin_unlock_bh(&p->fcoe_rx_list.lock); 1100 } 1101} 1102 1103/** 1104 * fcoe_percpu_thread_destroy() - Remove the receive thread of a CPU 1105 * @cpu: The CPU index of the CPU whose receive thread is to be destroyed 1106 * 1107 * Destroys a per-CPU Rx thread. Any pending skbs are moved to the 1108 * current CPU's Rx thread. If the thread being destroyed is bound to 1109 * the CPU processing this context the skbs will be freed. 1110 */ 1111static void fcoe_percpu_thread_destroy(unsigned int cpu) 1112{ 1113 struct fcoe_percpu_s *p; 1114 struct task_struct *thread; 1115 struct page *crc_eof; 1116 struct sk_buff *skb; 1117#ifdef CONFIG_SMP 1118 struct fcoe_percpu_s *p0; 1119 unsigned targ_cpu = get_cpu(); 1120#endif /* CONFIG_SMP */ 1121 1122 FCOE_DBG("Destroying receive thread for CPU %d\n", cpu); 1123 1124 /* Prevent any new skbs from being queued for this CPU. */ 1125 p = &per_cpu(fcoe_percpu, cpu); 1126 spin_lock_bh(&p->fcoe_rx_list.lock); 1127 thread = p->thread; 1128 p->thread = NULL; 1129 crc_eof = p->crc_eof_page; 1130 p->crc_eof_page = NULL; 1131 p->crc_eof_offset = 0; 1132 spin_unlock_bh(&p->fcoe_rx_list.lock); 1133 1134#ifdef CONFIG_SMP 1135 /* 1136 * Don't bother moving the skb's if this context is running 1137 * on the same CPU that is having its thread destroyed. This 1138 * can easily happen when the module is removed. 1139 */ 1140 if (cpu != targ_cpu) { 1141 p0 = &per_cpu(fcoe_percpu, targ_cpu); 1142 spin_lock_bh(&p0->fcoe_rx_list.lock); 1143 if (p0->thread) { 1144 FCOE_DBG("Moving frames from CPU %d to CPU %d\n", 1145 cpu, targ_cpu); 1146 1147 while ((skb = __skb_dequeue(&p->fcoe_rx_list)) != NULL) 1148 __skb_queue_tail(&p0->fcoe_rx_list, skb); 1149 spin_unlock_bh(&p0->fcoe_rx_list.lock); 1150 } else { 1151 /* 1152 * The targeted CPU is not initialized and cannot accept 1153 * new skbs. Unlock the targeted CPU and drop the skbs 1154 * on the CPU that is going offline. 1155 */ 1156 while ((skb = __skb_dequeue(&p->fcoe_rx_list)) != NULL) 1157 kfree_skb(skb); 1158 spin_unlock_bh(&p0->fcoe_rx_list.lock); 1159 } 1160 } else { 1161 /* 1162 * This scenario occurs when the module is being removed 1163 * and all threads are being destroyed. skbs will continue 1164 * to be shifted from the CPU thread that is being removed 1165 * to the CPU thread associated with the CPU that is processing 1166 * the module removal. Once there is only one CPU Rx thread it 1167 * will reach this case and we will drop all skbs and later 1168 * stop the thread. 1169 */ 1170 spin_lock_bh(&p->fcoe_rx_list.lock); 1171 while ((skb = __skb_dequeue(&p->fcoe_rx_list)) != NULL) 1172 kfree_skb(skb); 1173 spin_unlock_bh(&p->fcoe_rx_list.lock); 1174 } 1175 put_cpu(); 1176#else 1177 /* 1178 * This a non-SMP scenario where the singular Rx thread is 1179 * being removed. Free all skbs and stop the thread. 1180 */ 1181 spin_lock_bh(&p->fcoe_rx_list.lock); 1182 while ((skb = __skb_dequeue(&p->fcoe_rx_list)) != NULL) 1183 kfree_skb(skb); 1184 spin_unlock_bh(&p->fcoe_rx_list.lock); 1185#endif 1186 1187 if (thread) 1188 kthread_stop(thread); 1189 1190 if (crc_eof) 1191 put_page(crc_eof); 1192} 1193 1194/** 1195 * fcoe_cpu_callback() - Handler for CPU hotplug events 1196 * @nfb: The callback data block 1197 * @action: The event triggering the callback 1198 * @hcpu: The index of the CPU that the event is for 1199 * 1200 * This creates or destroys per-CPU data for fcoe 1201 * 1202 * Returns NOTIFY_OK always. 1203 */ 1204static int fcoe_cpu_callback(struct notifier_block *nfb, 1205 unsigned long action, void *hcpu) 1206{ 1207 unsigned cpu = (unsigned long)hcpu; 1208 1209 switch (action) { 1210 case CPU_ONLINE: 1211 case CPU_ONLINE_FROZEN: 1212 FCOE_DBG("CPU %x online: Create Rx thread\n", cpu); 1213 fcoe_percpu_thread_create(cpu); 1214 break; 1215 case CPU_DEAD: 1216 case CPU_DEAD_FROZEN: 1217 FCOE_DBG("CPU %x offline: Remove Rx thread\n", cpu); 1218 fcoe_percpu_thread_destroy(cpu); 1219 break; 1220 default: 1221 break; 1222 } 1223 return NOTIFY_OK; 1224} 1225 1226/** 1227 * fcoe_rcv() - Receive packets from a net device 1228 * @skb: The received packet 1229 * @netdev: The net device that the packet was received on 1230 * @ptype: The packet type context 1231 * @olddev: The last device net device 1232 * 1233 * This routine is called by NET_RX_SOFTIRQ. It receives a packet, builds a 1234 * FC frame and passes the frame to libfc. 1235 * 1236 * Returns: 0 for success 1237 */ 1238int fcoe_rcv(struct sk_buff *skb, struct net_device *netdev, 1239 struct packet_type *ptype, struct net_device *olddev) 1240{ 1241 struct fc_lport *lport; 1242 struct fcoe_rcv_info *fr; 1243 struct fcoe_interface *fcoe; 1244 struct fc_frame_header *fh; 1245 struct fcoe_percpu_s *fps; 1246 struct fcoe_port *port; 1247 struct ethhdr *eh; 1248 unsigned int cpu; 1249 1250 fcoe = container_of(ptype, struct fcoe_interface, fcoe_packet_type); 1251 lport = fcoe->ctlr.lp; 1252 if (unlikely(!lport)) { 1253 FCOE_NETDEV_DBG(netdev, "Cannot find hba structure"); 1254 goto err2; 1255 } 1256 if (!lport->link_up) 1257 goto err2; 1258 1259 FCOE_NETDEV_DBG(netdev, "skb_info: len:%d data_len:%d head:%p " 1260 "data:%p tail:%p end:%p sum:%d dev:%s", 1261 skb->len, skb->data_len, skb->head, skb->data, 1262 skb_tail_pointer(skb), skb_end_pointer(skb), 1263 skb->csum, skb->dev ? skb->dev->name : "<NULL>"); 1264 1265 /* check for mac addresses */ 1266 eh = eth_hdr(skb); 1267 port = lport_priv(lport); 1268 if (compare_ether_addr(eh->h_dest, port->data_src_addr) && 1269 compare_ether_addr(eh->h_dest, fcoe->ctlr.ctl_src_addr) && 1270 compare_ether_addr(eh->h_dest, (u8[6])FC_FCOE_FLOGI_MAC)) { 1271 FCOE_NETDEV_DBG(netdev, "wrong destination mac address:%pM\n", 1272 eh->h_dest); 1273 goto err; 1274 } 1275 1276 if (is_fip_mode(&fcoe->ctlr) && 1277 compare_ether_addr(eh->h_source, fcoe->ctlr.dest_addr)) { 1278 FCOE_NETDEV_DBG(netdev, "wrong source mac address:%pM\n", 1279 eh->h_source); 1280 goto err; 1281 } 1282 1283 /* 1284 * Check for minimum frame length, and make sure required FCoE 1285 * and FC headers are pulled into the linear data area. 1286 */ 1287 if (unlikely((skb->len < FCOE_MIN_FRAME) || 1288 !pskb_may_pull(skb, FCOE_HEADER_LEN))) 1289 goto err; 1290 1291 skb_set_transport_header(skb, sizeof(struct fcoe_hdr)); 1292 fh = (struct fc_frame_header *) skb_transport_header(skb); 1293 1294 fr = fcoe_dev_from_skb(skb); 1295 fr->fr_dev = lport; 1296 fr->ptype = ptype; 1297 1298 /* 1299 * In case the incoming frame's exchange is originated from 1300 * the initiator, then received frame's exchange id is ANDed 1301 * with fc_cpu_mask bits to get the same cpu on which exchange 1302 * was originated, otherwise just use the current cpu. 1303 */ 1304 if (ntoh24(fh->fh_f_ctl) & FC_FC_EX_CTX) 1305 cpu = ntohs(fh->fh_ox_id) & fc_cpu_mask; 1306 else 1307 cpu = smp_processor_id(); 1308 1309 fps = &per_cpu(fcoe_percpu, cpu); 1310 spin_lock_bh(&fps->fcoe_rx_list.lock); 1311 if (unlikely(!fps->thread)) { 1312 /* 1313 * The targeted CPU is not ready, let's target 1314 * the first CPU now. For non-SMP systems this 1315 * will check the same CPU twice. 1316 */ 1317 FCOE_NETDEV_DBG(netdev, "CPU is online, but no receive thread " 1318 "ready for incoming skb- using first online " 1319 "CPU.\n"); 1320 1321 spin_unlock_bh(&fps->fcoe_rx_list.lock); 1322 cpu = cpumask_first(cpu_online_mask); 1323 fps = &per_cpu(fcoe_percpu, cpu); 1324 spin_lock_bh(&fps->fcoe_rx_list.lock); 1325 if (!fps->thread) { 1326 spin_unlock_bh(&fps->fcoe_rx_list.lock); 1327 goto err; 1328 } 1329 } 1330 1331 /* 1332 * We now have a valid CPU that we're targeting for 1333 * this skb. We also have this receive thread locked, 1334 * so we're free to queue skbs into it's queue. 1335 */ 1336 1337 /* If this is a SCSI-FCP frame, and this is already executing on the 1338 * correct CPU, and the queue for this CPU is empty, then go ahead 1339 * and process the frame directly in the softirq context. 1340 * This lets us process completions without context switching from the 1341 * NET_RX softirq, to our receive processing thread, and then back to 1342 * BLOCK softirq context. 1343 */ 1344 if (fh->fh_type == FC_TYPE_FCP && 1345 cpu == smp_processor_id() && 1346 skb_queue_empty(&fps->fcoe_rx_list)) { 1347 spin_unlock_bh(&fps->fcoe_rx_list.lock); 1348 fcoe_recv_frame(skb); 1349 } else { 1350 __skb_queue_tail(&fps->fcoe_rx_list, skb); 1351 if (fps->fcoe_rx_list.qlen == 1) 1352 wake_up_process(fps->thread); 1353 spin_unlock_bh(&fps->fcoe_rx_list.lock); 1354 } 1355 1356 return 0; 1357err: 1358 per_cpu_ptr(lport->dev_stats, get_cpu())->ErrorFrames++; 1359 put_cpu(); 1360err2: 1361 kfree_skb(skb); 1362 return -1; 1363} 1364 1365/** 1366 * fcoe_start_io() - Start FCoE I/O 1367 * @skb: The packet to be transmitted 1368 * 1369 * This routine is called from the net device to start transmitting 1370 * FCoE packets. 1371 * 1372 * Returns: 0 for success 1373 */ 1374static inline int fcoe_start_io(struct sk_buff *skb) 1375{ 1376 struct sk_buff *nskb; 1377 int rc; 1378 1379 nskb = skb_clone(skb, GFP_ATOMIC); 1380 rc = dev_queue_xmit(nskb); 1381 if (rc != 0) 1382 return rc; 1383 kfree_skb(skb); 1384 return 0; 1385} 1386 1387/** 1388 * fcoe_get_paged_crc_eof() - Allocate a page to be used for the trailer CRC 1389 * @skb: The packet to be transmitted 1390 * @tlen: The total length of the trailer 1391 * 1392 * This routine allocates a page for frame trailers. The page is re-used if 1393 * there is enough room left on it for the current trailer. If there isn't 1394 * enough buffer left a new page is allocated for the trailer. Reference to 1395 * the page from this function as well as the skbs using the page fragments 1396 * ensure that the page is freed at the appropriate time. 1397 * 1398 * Returns: 0 for success 1399 */ 1400static int fcoe_get_paged_crc_eof(struct sk_buff *skb, int tlen) 1401{ 1402 struct fcoe_percpu_s *fps; 1403 struct page *page; 1404 1405 fps = &get_cpu_var(fcoe_percpu); 1406 page = fps->crc_eof_page; 1407 if (!page) { 1408 page = alloc_page(GFP_ATOMIC); 1409 if (!page) { 1410 put_cpu_var(fcoe_percpu); 1411 return -ENOMEM; 1412 } 1413 fps->crc_eof_page = page; 1414 fps->crc_eof_offset = 0; 1415 } 1416 1417 get_page(page); 1418 skb_fill_page_desc(skb, skb_shinfo(skb)->nr_frags, page, 1419 fps->crc_eof_offset, tlen); 1420 skb->len += tlen; 1421 skb->data_len += tlen; 1422 skb->truesize += tlen; 1423 fps->crc_eof_offset += sizeof(struct fcoe_crc_eof); 1424 1425 if (fps->crc_eof_offset >= PAGE_SIZE) { 1426 fps->crc_eof_page = NULL; 1427 fps->crc_eof_offset = 0; 1428 put_page(page); 1429 } 1430 put_cpu_var(fcoe_percpu); 1431 return 0; 1432} 1433 1434/** 1435 * fcoe_fc_crc() - Calculates the CRC for a given frame 1436 * @fp: The frame to be checksumed 1437 * 1438 * This uses crc32() routine to calculate the CRC for a frame 1439 * 1440 * Return: The 32 bit CRC value 1441 */ 1442u32 fcoe_fc_crc(struct fc_frame *fp) 1443{ 1444 struct sk_buff *skb = fp_skb(fp); 1445 struct skb_frag_struct *frag; 1446 unsigned char *data; 1447 unsigned long off, len, clen; 1448 u32 crc; 1449 unsigned i; 1450 1451 crc = crc32(~0, skb->data, skb_headlen(skb)); 1452 1453 for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) { 1454 frag = &skb_shinfo(skb)->frags[i]; 1455 off = frag->page_offset; 1456 len = frag->size; 1457 while (len > 0) { 1458 clen = min(len, PAGE_SIZE - (off & ~PAGE_MASK)); 1459 data = kmap_atomic(frag->page + (off >> PAGE_SHIFT), 1460 KM_SKB_DATA_SOFTIRQ); 1461 crc = crc32(crc, data + (off & ~PAGE_MASK), clen); 1462 kunmap_atomic(data, KM_SKB_DATA_SOFTIRQ); 1463 off += clen; 1464 len -= clen; 1465 } 1466 } 1467 return crc; 1468} 1469 1470/** 1471 * fcoe_xmit() - Transmit a FCoE frame 1472 * @lport: The local port that the frame is to be transmitted for 1473 * @fp: The frame to be transmitted 1474 * 1475 * Return: 0 for success 1476 */ 1477int fcoe_xmit(struct fc_lport *lport, struct fc_frame *fp) 1478{ 1479 int wlen; 1480 u32 crc; 1481 struct ethhdr *eh; 1482 struct fcoe_crc_eof *cp; 1483 struct sk_buff *skb; 1484 struct fcoe_dev_stats *stats; 1485 struct fc_frame_header *fh; 1486 unsigned int hlen; /* header length implies the version */ 1487 unsigned int tlen; /* trailer length */ 1488 unsigned int elen; /* eth header, may include vlan */ 1489 struct fcoe_port *port = lport_priv(lport); 1490 struct fcoe_interface *fcoe = port->fcoe; 1491 u8 sof, eof; 1492 struct fcoe_hdr *hp; 1493 1494 WARN_ON((fr_len(fp) % sizeof(u32)) != 0); 1495 1496 fh = fc_frame_header_get(fp); 1497 skb = fp_skb(fp); 1498 wlen = skb->len / FCOE_WORD_TO_BYTE; 1499 1500 if (!lport->link_up) { 1501 kfree_skb(skb); 1502 return 0; 1503 } 1504 1505 if (unlikely(fh->fh_type == FC_TYPE_ELS) && 1506 fcoe_ctlr_els_send(&fcoe->ctlr, lport, skb)) 1507 return 0; 1508 1509 sof = fr_sof(fp); 1510 eof = fr_eof(fp); 1511 1512 elen = sizeof(struct ethhdr); 1513 hlen = sizeof(struct fcoe_hdr); 1514 tlen = sizeof(struct fcoe_crc_eof); 1515 wlen = (skb->len - tlen + sizeof(crc)) / FCOE_WORD_TO_BYTE; 1516 1517 /* crc offload */ 1518 if (likely(lport->crc_offload)) { 1519 skb->ip_summed = CHECKSUM_PARTIAL; 1520 skb->csum_start = skb_headroom(skb); 1521 skb->csum_offset = skb->len; 1522 crc = 0; 1523 } else { 1524 skb->ip_summed = CHECKSUM_NONE; 1525 crc = fcoe_fc_crc(fp); 1526 } 1527 1528 /* copy port crc and eof to the skb buff */ 1529 if (skb_is_nonlinear(skb)) { 1530 skb_frag_t *frag; 1531 if (fcoe_get_paged_crc_eof(skb, tlen)) { 1532 kfree_skb(skb); 1533 return -ENOMEM; 1534 } 1535 frag = &skb_shinfo(skb)->frags[skb_shinfo(skb)->nr_frags - 1]; 1536 cp = kmap_atomic(frag->page, KM_SKB_DATA_SOFTIRQ) 1537 + frag->page_offset; 1538 } else { 1539 cp = (struct fcoe_crc_eof *)skb_put(skb, tlen); 1540 } 1541 1542 memset(cp, 0, sizeof(*cp)); 1543 cp->fcoe_eof = eof; 1544 cp->fcoe_crc32 = cpu_to_le32(~crc); 1545 1546 if (skb_is_nonlinear(skb)) { 1547 kunmap_atomic(cp, KM_SKB_DATA_SOFTIRQ); 1548 cp = NULL; 1549 } 1550 1551 /* adjust skb network/transport offsets to match mac/fcoe/port */ 1552 skb_push(skb, elen + hlen); 1553 skb_reset_mac_header(skb); 1554 skb_reset_network_header(skb); 1555 skb->mac_len = elen; 1556 skb->protocol = htons(ETH_P_FCOE); 1557 skb->dev = fcoe->netdev; 1558 1559 /* fill up mac and fcoe headers */ 1560 eh = eth_hdr(skb); 1561 eh->h_proto = htons(ETH_P_FCOE); 1562 memcpy(eh->h_dest, fcoe->ctlr.dest_addr, ETH_ALEN); 1563 if (fcoe->ctlr.map_dest) 1564 memcpy(eh->h_dest + 3, fh->fh_d_id, 3); 1565 1566 if (unlikely(fcoe->ctlr.flogi_oxid != FC_XID_UNKNOWN)) 1567 memcpy(eh->h_source, fcoe->ctlr.ctl_src_addr, ETH_ALEN); 1568 else 1569 memcpy(eh->h_source, port->data_src_addr, ETH_ALEN); 1570 1571 hp = (struct fcoe_hdr *)(eh + 1); 1572 memset(hp, 0, sizeof(*hp)); 1573 if (FC_FCOE_VER) 1574 FC_FCOE_ENCAPS_VER(hp, FC_FCOE_VER); 1575 hp->fcoe_sof = sof; 1576 1577 /* fcoe lso, mss is in max_payload which is non-zero for FCP data */ 1578 if (lport->seq_offload && fr_max_payload(fp)) { 1579 skb_shinfo(skb)->gso_type = SKB_GSO_FCOE; 1580 skb_shinfo(skb)->gso_size = fr_max_payload(fp); 1581 } else { 1582 skb_shinfo(skb)->gso_type = 0; 1583 skb_shinfo(skb)->gso_size = 0; 1584 } 1585 /* update tx stats: regardless if LLD fails */ 1586 stats = per_cpu_ptr(lport->dev_stats, get_cpu()); 1587 stats->TxFrames++; 1588 stats->TxWords += wlen; 1589 put_cpu(); 1590 1591 /* send down to lld */ 1592 fr_dev(fp) = lport; 1593 if (port->fcoe_pending_queue.qlen) 1594 fcoe_check_wait_queue(lport, skb); 1595 else if (fcoe_start_io(skb)) 1596 fcoe_check_wait_queue(lport, skb); 1597 1598 return 0; 1599} 1600 1601/** 1602 * fcoe_percpu_flush_done() - Indicate per-CPU queue flush completion 1603 * @skb: The completed skb (argument required by destructor) 1604 */ 1605static void fcoe_percpu_flush_done(struct sk_buff *skb) 1606{ 1607 complete(&fcoe_flush_completion); 1608} 1609 1610/** 1611 * fcoe_recv_frame() - process a single received frame 1612 * @skb: frame to process 1613 */ 1614static void fcoe_recv_frame(struct sk_buff *skb) 1615{ 1616 u32 fr_len; 1617 struct fc_lport *lport; 1618 struct fcoe_rcv_info *fr; 1619 struct fcoe_dev_stats *stats; 1620 struct fc_frame_header *fh; 1621 struct fcoe_crc_eof crc_eof; 1622 struct fc_frame *fp; 1623 struct fcoe_port *port; 1624 struct fcoe_hdr *hp; 1625 1626 fr = fcoe_dev_from_skb(skb); 1627 lport = fr->fr_dev; 1628 if (unlikely(!lport)) { 1629 if (skb->destructor != fcoe_percpu_flush_done) 1630 FCOE_NETDEV_DBG(skb->dev, "NULL lport in skb"); 1631 kfree_skb(skb); 1632 return; 1633 } 1634 1635 FCOE_NETDEV_DBG(skb->dev, "skb_info: len:%d data_len:%d " 1636 "head:%p data:%p tail:%p end:%p sum:%d dev:%s", 1637 skb->len, skb->data_len, 1638 skb->head, skb->data, skb_tail_pointer(skb), 1639 skb_end_pointer(skb), skb->csum, 1640 skb->dev ? skb->dev->name : "<NULL>"); 1641 1642 port = lport_priv(lport); 1643 if (skb_is_nonlinear(skb)) 1644 skb_linearize(skb); /* not ideal */ 1645 1646 /* 1647 * Frame length checks and setting up the header pointers 1648 * was done in fcoe_rcv already. 1649 */ 1650 hp = (struct fcoe_hdr *) skb_network_header(skb); 1651 fh = (struct fc_frame_header *) skb_transport_header(skb); 1652 1653 stats = per_cpu_ptr(lport->dev_stats, get_cpu()); 1654 if (unlikely(FC_FCOE_DECAPS_VER(hp) != FC_FCOE_VER)) { 1655 if (stats->ErrorFrames < 5) 1656 printk(KERN_WARNING "fcoe: FCoE version " 1657 "mismatch: The frame has " 1658 "version %x, but the " 1659 "initiator supports version " 1660 "%x\n", FC_FCOE_DECAPS_VER(hp), 1661 FC_FCOE_VER); 1662 goto drop; 1663 } 1664 1665 skb_pull(skb, sizeof(struct fcoe_hdr)); 1666 fr_len = skb->len - sizeof(struct fcoe_crc_eof); 1667 1668 stats->RxFrames++; 1669 stats->RxWords += fr_len / FCOE_WORD_TO_BYTE; 1670 1671 fp = (struct fc_frame *)skb; 1672 fc_frame_init(fp); 1673 fr_dev(fp) = lport; 1674 fr_sof(fp) = hp->fcoe_sof; 1675 1676 /* Copy out the CRC and EOF trailer for access */ 1677 if (skb_copy_bits(skb, fr_len, &crc_eof, sizeof(crc_eof))) 1678 goto drop; 1679 fr_eof(fp) = crc_eof.fcoe_eof; 1680 fr_crc(fp) = crc_eof.fcoe_crc32; 1681 if (pskb_trim(skb, fr_len)) 1682 goto drop; 1683 1684 /* 1685 * We only check CRC if no offload is available and if it is 1686 * it's solicited data, in which case, the FCP layer would 1687 * check it during the copy. 1688 */ 1689 if (lport->crc_offload && 1690 skb->ip_summed == CHECKSUM_UNNECESSARY) 1691 fr_flags(fp) &= ~FCPHF_CRC_UNCHECKED; 1692 else 1693 fr_flags(fp) |= FCPHF_CRC_UNCHECKED; 1694 1695 fh = fc_frame_header_get(fp); 1696 if ((fh->fh_r_ctl != FC_RCTL_DD_SOL_DATA || 1697 fh->fh_type != FC_TYPE_FCP) && 1698 (fr_flags(fp) & FCPHF_CRC_UNCHECKED)) { 1699 if (le32_to_cpu(fr_crc(fp)) != 1700 ~crc32(~0, skb->data, fr_len)) { 1701 if (stats->InvalidCRCCount < 5) 1702 printk(KERN_WARNING "fcoe: dropping " 1703 "frame with CRC error\n"); 1704 stats->InvalidCRCCount++; 1705 goto drop; 1706 } 1707 fr_flags(fp) &= ~FCPHF_CRC_UNCHECKED; 1708 } 1709 put_cpu(); 1710 fc_exch_recv(lport, fp); 1711 return; 1712 1713drop: 1714 stats->ErrorFrames++; 1715 put_cpu(); 1716 kfree_skb(skb); 1717} 1718 1719/** 1720 * fcoe_percpu_receive_thread() - The per-CPU packet receive thread 1721 * @arg: The per-CPU context 1722 * 1723 * Return: 0 for success 1724 */ 1725int fcoe_percpu_receive_thread(void *arg) 1726{ 1727 struct fcoe_percpu_s *p = arg; 1728 struct sk_buff *skb; 1729 1730 set_user_nice(current, -20); 1731 1732 while (!kthread_should_stop()) { 1733 1734 spin_lock_bh(&p->fcoe_rx_list.lock); 1735 while ((skb = __skb_dequeue(&p->fcoe_rx_list)) == NULL) { 1736 set_current_state(TASK_INTERRUPTIBLE); 1737 spin_unlock_bh(&p->fcoe_rx_list.lock); 1738 schedule(); 1739 set_current_state(TASK_RUNNING); 1740 if (kthread_should_stop()) 1741 return 0; 1742 spin_lock_bh(&p->fcoe_rx_list.lock); 1743 } 1744 spin_unlock_bh(&p->fcoe_rx_list.lock); 1745 fcoe_recv_frame(skb); 1746 } 1747 return 0; 1748} 1749 1750/** 1751 * fcoe_check_wait_queue() - Attempt to clear the transmit backlog 1752 * @lport: The local port whose backlog is to be cleared 1753 * 1754 * This empties the wait_queue, dequeues the head of the wait_queue queue 1755 * and calls fcoe_start_io() for each packet. If all skb have been 1756 * transmitted it returns the qlen. If an error occurs it restores 1757 * wait_queue (to try again later) and returns -1. 1758 * 1759 * The wait_queue is used when the skb transmit fails. The failed skb 1760 * will go in the wait_queue which will be emptied by the timer function or 1761 * by the next skb transmit. 1762 */ 1763static void fcoe_check_wait_queue(struct fc_lport *lport, struct sk_buff *skb) 1764{ 1765 struct fcoe_port *port = lport_priv(lport); 1766 int rc; 1767 1768 spin_lock_bh(&port->fcoe_pending_queue.lock); 1769 1770 if (skb) 1771 __skb_queue_tail(&port->fcoe_pending_queue, skb); 1772 1773 if (port->fcoe_pending_queue_active) 1774 goto out; 1775 port->fcoe_pending_queue_active = 1; 1776 1777 while (port->fcoe_pending_queue.qlen) { 1778 /* keep qlen > 0 until fcoe_start_io succeeds */ 1779 port->fcoe_pending_queue.qlen++; 1780 skb = __skb_dequeue(&port->fcoe_pending_queue); 1781 1782 spin_unlock_bh(&port->fcoe_pending_queue.lock); 1783 rc = fcoe_start_io(skb); 1784 spin_lock_bh(&port->fcoe_pending_queue.lock); 1785 1786 if (rc) { 1787 __skb_queue_head(&port->fcoe_pending_queue, skb); 1788 /* undo temporary increment above */ 1789 port->fcoe_pending_queue.qlen--; 1790 break; 1791 } 1792 /* undo temporary increment above */ 1793 port->fcoe_pending_queue.qlen--; 1794 } 1795 1796 if (port->fcoe_pending_queue.qlen < FCOE_LOW_QUEUE_DEPTH) 1797 lport->qfull = 0; 1798 if (port->fcoe_pending_queue.qlen && !timer_pending(&port->timer)) 1799 mod_timer(&port->timer, jiffies + 2); 1800 port->fcoe_pending_queue_active = 0; 1801out: 1802 if (port->fcoe_pending_queue.qlen > FCOE_MAX_QUEUE_DEPTH) 1803 lport->qfull = 1; 1804 spin_unlock_bh(&port->fcoe_pending_queue.lock); 1805 return; 1806} 1807 1808/** 1809 * fcoe_dev_setup() - Setup the link change notification interface 1810 */ 1811static void fcoe_dev_setup(void) 1812{ 1813 register_netdevice_notifier(&fcoe_notifier); 1814} 1815 1816/** 1817 * fcoe_dev_cleanup() - Cleanup the link change notification interface 1818 */ 1819static void fcoe_dev_cleanup(void) 1820{ 1821 unregister_netdevice_notifier(&fcoe_notifier); 1822} 1823 1824/** 1825 * fcoe_device_notification() - Handler for net device events 1826 * @notifier: The context of the notification 1827 * @event: The type of event 1828 * @ptr: The net device that the event was on 1829 * 1830 * This function is called by the Ethernet driver in case of link change event. 1831 * 1832 * Returns: 0 for success 1833 */ 1834static int fcoe_device_notification(struct notifier_block *notifier, 1835 ulong event, void *ptr) 1836{ 1837 struct fc_lport *lport = NULL; 1838 struct net_device *netdev = ptr; 1839 struct fcoe_interface *fcoe; 1840 struct fcoe_port *port; 1841 struct fcoe_dev_stats *stats; 1842 u32 link_possible = 1; 1843 u32 mfs; 1844 int rc = NOTIFY_OK; 1845 1846 list_for_each_entry(fcoe, &fcoe_hostlist, list) { 1847 if (fcoe->netdev == netdev) { 1848 lport = fcoe->ctlr.lp; 1849 break; 1850 } 1851 } 1852 if (!lport) { 1853 rc = NOTIFY_DONE; 1854 goto out; 1855 } 1856 1857 switch (event) { 1858 case NETDEV_DOWN: 1859 case NETDEV_GOING_DOWN: 1860 link_possible = 0; 1861 break; 1862 case NETDEV_UP: 1863 case NETDEV_CHANGE: 1864 break; 1865 case NETDEV_CHANGEMTU: 1866 if (netdev->features & NETIF_F_FCOE_MTU) 1867 break; 1868 mfs = netdev->mtu - (sizeof(struct fcoe_hdr) + 1869 sizeof(struct fcoe_crc_eof)); 1870 if (mfs >= FC_MIN_MAX_FRAME) 1871 fc_set_mfs(lport, mfs); 1872 break; 1873 case NETDEV_REGISTER: 1874 break; 1875 case NETDEV_UNREGISTER: 1876 list_del(&fcoe->list); 1877 port = lport_priv(fcoe->ctlr.lp); 1878 fcoe_interface_cleanup(fcoe); 1879 schedule_work(&port->destroy_work); 1880 goto out; 1881 break; 1882 case NETDEV_FEAT_CHANGE: 1883 fcoe_netdev_features_change(lport, netdev); 1884 break; 1885 default: 1886 FCOE_NETDEV_DBG(netdev, "Unknown event %ld " 1887 "from netdev netlink\n", event); 1888 } 1889 1890 fcoe_link_speed_update(lport); 1891 1892 if (link_possible && !fcoe_link_ok(lport)) 1893 fcoe_ctlr_link_up(&fcoe->ctlr); 1894 else if (fcoe_ctlr_link_down(&fcoe->ctlr)) { 1895 stats = per_cpu_ptr(lport->dev_stats, get_cpu()); 1896 stats->LinkFailureCount++; 1897 put_cpu(); 1898 fcoe_clean_pending_queue(lport); 1899 } 1900out: 1901 return rc; 1902} 1903 1904/** 1905 * fcoe_if_to_netdev() - Parse a name buffer to get a net device 1906 * @buffer: The name of the net device 1907 * 1908 * Returns: NULL or a ptr to net_device 1909 */ 1910static struct net_device *fcoe_if_to_netdev(const char *buffer) 1911{ 1912 char *cp; 1913 char ifname[IFNAMSIZ + 2]; 1914 1915 if (buffer) { 1916 strlcpy(ifname, buffer, IFNAMSIZ); 1917 cp = ifname + strlen(ifname); 1918 while (--cp >= ifname && *cp == '\n') 1919 *cp = '\0'; 1920 return dev_get_by_name(&init_net, ifname); 1921 } 1922 return NULL; 1923} 1924 1925/** 1926 * fcoe_disable() - Disables a FCoE interface 1927 * @buffer: The name of the Ethernet interface to be disabled 1928 * @kp: The associated kernel parameter 1929 * 1930 * Called from sysfs. 1931 * 1932 * Returns: 0 for success 1933 */ 1934static int fcoe_disable(const char *buffer, struct kernel_param *kp) 1935{ 1936 struct fcoe_interface *fcoe; 1937 struct net_device *netdev; 1938 int rc = 0; 1939 1940 mutex_lock(&fcoe_config_mutex); 1941#ifdef CONFIG_FCOE_MODULE 1942 /* 1943 * Make sure the module has been initialized, and is not about to be 1944 * removed. Module paramter sysfs files are writable before the 1945 * module_init function is called and after module_exit. 1946 */ 1947 if (THIS_MODULE->state != MODULE_STATE_LIVE) { 1948 rc = -ENODEV; 1949 goto out_nodev; 1950 } 1951#endif 1952 1953 netdev = fcoe_if_to_netdev(buffer); 1954 if (!netdev) { 1955 rc = -ENODEV; 1956 goto out_nodev; 1957 } 1958 1959 if (!rtnl_trylock()) { 1960 dev_put(netdev); 1961 mutex_unlock(&fcoe_config_mutex); 1962 return restart_syscall(); 1963 } 1964 1965 fcoe = fcoe_hostlist_lookup_port(netdev); 1966 rtnl_unlock(); 1967 1968 if (fcoe) { 1969 fcoe_ctlr_link_down(&fcoe->ctlr); 1970 fcoe_clean_pending_queue(fcoe->ctlr.lp); 1971 } else 1972 rc = -ENODEV; 1973 1974 dev_put(netdev); 1975out_nodev: 1976 mutex_unlock(&fcoe_config_mutex); 1977 return rc; 1978} 1979 1980/** 1981 * fcoe_enable() - Enables a FCoE interface 1982 * @buffer: The name of the Ethernet interface to be enabled 1983 * @kp: The associated kernel parameter 1984 * 1985 * Called from sysfs. 1986 * 1987 * Returns: 0 for success 1988 */ 1989static int fcoe_enable(const char *buffer, struct kernel_param *kp) 1990{ 1991 struct fcoe_interface *fcoe; 1992 struct net_device *netdev; 1993 int rc = 0; 1994 1995 mutex_lock(&fcoe_config_mutex); 1996#ifdef CONFIG_FCOE_MODULE 1997 /* 1998 * Make sure the module has been initialized, and is not about to be 1999 * removed. Module paramter sysfs files are writable before the 2000 * module_init function is called and after module_exit. 2001 */ 2002 if (THIS_MODULE->state != MODULE_STATE_LIVE) { 2003 rc = -ENODEV; 2004 goto out_nodev; 2005 } 2006#endif 2007 2008 netdev = fcoe_if_to_netdev(buffer); 2009 if (!netdev) { 2010 rc = -ENODEV; 2011 goto out_nodev; 2012 } 2013 2014 if (!rtnl_trylock()) { 2015 dev_put(netdev); 2016 mutex_unlock(&fcoe_config_mutex); 2017 return restart_syscall(); 2018 } 2019 2020 fcoe = fcoe_hostlist_lookup_port(netdev); 2021 rtnl_unlock(); 2022 2023 if (!fcoe) 2024 rc = -ENODEV; 2025 else if (!fcoe_link_ok(fcoe->ctlr.lp)) 2026 fcoe_ctlr_link_up(&fcoe->ctlr); 2027 2028 dev_put(netdev); 2029out_nodev: 2030 mutex_unlock(&fcoe_config_mutex); 2031 return rc; 2032} 2033 2034/** 2035 * fcoe_destroy() - Destroy a FCoE interface 2036 * @buffer: The name of the Ethernet interface to be destroyed 2037 * @kp: The associated kernel parameter 2038 * 2039 * Called from sysfs. 2040 * 2041 * Returns: 0 for success 2042 */ 2043static int fcoe_destroy(const char *buffer, struct kernel_param *kp) 2044{ 2045 struct fcoe_interface *fcoe; 2046 struct net_device *netdev; 2047 int rc = 0; 2048 2049 mutex_lock(&fcoe_config_mutex); 2050#ifdef CONFIG_FCOE_MODULE 2051 /* 2052 * Make sure the module has been initialized, and is not about to be 2053 * removed. Module paramter sysfs files are writable before the 2054 * module_init function is called and after module_exit. 2055 */ 2056 if (THIS_MODULE->state != MODULE_STATE_LIVE) { 2057 rc = -ENODEV; 2058 goto out_nodev; 2059 } 2060#endif 2061 2062 netdev = fcoe_if_to_netdev(buffer); 2063 if (!netdev) { 2064 rc = -ENODEV; 2065 goto out_nodev; 2066 } 2067 2068 if (!rtnl_trylock()) { 2069 dev_put(netdev); 2070 mutex_unlock(&fcoe_config_mutex); 2071 return restart_syscall(); 2072 } 2073 2074 fcoe = fcoe_hostlist_lookup_port(netdev); 2075 if (!fcoe) { 2076 rtnl_unlock(); 2077 rc = -ENODEV; 2078 goto out_putdev; 2079 } 2080 fcoe_interface_cleanup(fcoe); 2081 list_del(&fcoe->list); 2082 /* RTNL mutex is dropped by fcoe_if_destroy */ 2083 fcoe_if_destroy(fcoe->ctlr.lp); 2084 2085out_putdev: 2086 dev_put(netdev); 2087out_nodev: 2088 mutex_unlock(&fcoe_config_mutex); 2089 return rc; 2090} 2091 2092/** 2093 * fcoe_destroy_work() - Destroy a FCoE port in a deferred work context 2094 * @work: Handle to the FCoE port to be destroyed 2095 */ 2096static void fcoe_destroy_work(struct work_struct *work) 2097{ 2098 struct fcoe_port *port; 2099 2100 port = container_of(work, struct fcoe_port, destroy_work); 2101 mutex_lock(&fcoe_config_mutex); 2102 rtnl_lock(); 2103 /* RTNL mutex is dropped by fcoe_if_destroy */ 2104 fcoe_if_destroy(port->lport); 2105 mutex_unlock(&fcoe_config_mutex); 2106} 2107 2108/** 2109 * fcoe_create() - Create a fcoe interface 2110 * @buffer: The name of the Ethernet interface to create on 2111 * @kp: The associated kernel param 2112 * 2113 * Called from sysfs. 2114 * 2115 * Returns: 0 for success 2116 */ 2117static int fcoe_create(const char *buffer, struct kernel_param *kp) 2118{ 2119 enum fip_state fip_mode = (enum fip_state)(long)kp->arg; 2120 int rc; 2121 struct fcoe_interface *fcoe; 2122 struct fc_lport *lport; 2123 struct net_device *netdev; 2124 2125 mutex_lock(&fcoe_config_mutex); 2126 2127 if (!rtnl_trylock()) { 2128 mutex_unlock(&fcoe_config_mutex); 2129 return restart_syscall(); 2130 } 2131 2132#ifdef CONFIG_FCOE_MODULE 2133 /* 2134 * Make sure the module has been initialized, and is not about to be 2135 * removed. Module paramter sysfs files are writable before the 2136 * module_init function is called and after module_exit. 2137 */ 2138 if (THIS_MODULE->state != MODULE_STATE_LIVE) { 2139 rc = -ENODEV; 2140 goto out_nomod; 2141 } 2142#endif 2143 2144 if (!try_module_get(THIS_MODULE)) { 2145 rc = -EINVAL; 2146 goto out_nomod; 2147 } 2148 2149 netdev = fcoe_if_to_netdev(buffer); 2150 if (!netdev) { 2151 rc = -ENODEV; 2152 goto out_nodev; 2153 } 2154 2155 /* look for existing lport */ 2156 if (fcoe_hostlist_lookup(netdev)) { 2157 rc = -EEXIST; 2158 goto out_putdev; 2159 } 2160 2161 fcoe = fcoe_interface_create(netdev, fip_mode); 2162 if (!fcoe) { 2163 rc = -ENOMEM; 2164 goto out_putdev; 2165 } 2166 2167 lport = fcoe_if_create(fcoe, &netdev->dev, 0); 2168 if (IS_ERR(lport)) { 2169 printk(KERN_ERR "fcoe: Failed to create interface (%s)\n", 2170 netdev->name); 2171 rc = -EIO; 2172 fcoe_interface_cleanup(fcoe); 2173 goto out_free; 2174 } 2175 2176 /* Make this the "master" N_Port */ 2177 fcoe->ctlr.lp = lport; 2178 2179 /* add to lports list */ 2180 fcoe_hostlist_add(lport); 2181 2182 /* start FIP Discovery and FLOGI */ 2183 lport->boot_time = jiffies; 2184 fc_fabric_login(lport); 2185 if (!fcoe_link_ok(lport)) 2186 fcoe_ctlr_link_up(&fcoe->ctlr); 2187 2188 /* 2189 * Release from init in fcoe_interface_create(), on success lport 2190 * should be holding a reference taken in fcoe_if_create(). 2191 */ 2192 fcoe_interface_put(fcoe); 2193 dev_put(netdev); 2194 rtnl_unlock(); 2195 mutex_unlock(&fcoe_config_mutex); 2196 2197 return 0; 2198out_free: 2199 fcoe_interface_put(fcoe); 2200out_putdev: 2201 dev_put(netdev); 2202out_nodev: 2203 module_put(THIS_MODULE); 2204out_nomod: 2205 rtnl_unlock(); 2206 mutex_unlock(&fcoe_config_mutex); 2207 return rc; 2208} 2209 2210/** 2211 * fcoe_link_speed_update() - Update the supported and actual link speeds 2212 * @lport: The local port to update speeds for 2213 * 2214 * Returns: 0 if the ethtool query was successful 2215 * -1 if the ethtool query failed 2216 */ 2217int fcoe_link_speed_update(struct fc_lport *lport) 2218{ 2219 struct fcoe_port *port = lport_priv(lport); 2220 struct net_device *netdev = port->fcoe->netdev; 2221 struct ethtool_cmd ecmd = { ETHTOOL_GSET }; 2222 2223 if (!dev_ethtool_get_settings(netdev, &ecmd)) { 2224 lport->link_supported_speeds &= 2225 ~(FC_PORTSPEED_1GBIT | FC_PORTSPEED_10GBIT); 2226 if (ecmd.supported & (SUPPORTED_1000baseT_Half | 2227 SUPPORTED_1000baseT_Full)) 2228 lport->link_supported_speeds |= FC_PORTSPEED_1GBIT; 2229 if (ecmd.supported & SUPPORTED_10000baseT_Full) 2230 lport->link_supported_speeds |= 2231 FC_PORTSPEED_10GBIT; 2232 if (ecmd.speed == SPEED_1000) 2233 lport->link_speed = FC_PORTSPEED_1GBIT; 2234 if (ecmd.speed == SPEED_10000) 2235 lport->link_speed = FC_PORTSPEED_10GBIT; 2236 2237 return 0; 2238 } 2239 return -1; 2240} 2241 2242/** 2243 * fcoe_link_ok() - Check if the link is OK for a local port 2244 * @lport: The local port to check link on 2245 * 2246 * Returns: 0 if link is UP and OK, -1 if not 2247 * 2248 */ 2249int fcoe_link_ok(struct fc_lport *lport) 2250{ 2251 struct fcoe_port *port = lport_priv(lport); 2252 struct net_device *netdev = port->fcoe->netdev; 2253 2254 if (netif_oper_up(netdev)) 2255 return 0; 2256 return -1; 2257} 2258 2259/** 2260 * fcoe_percpu_clean() - Clear all pending skbs for an local port 2261 * @lport: The local port whose skbs are to be cleared 2262 * 2263 * Must be called with fcoe_create_mutex held to single-thread completion. 2264 * 2265 * This flushes the pending skbs by adding a new skb to each queue and 2266 * waiting until they are all freed. This assures us that not only are 2267 * there no packets that will be handled by the lport, but also that any 2268 * threads already handling packet have returned. 2269 */ 2270void fcoe_percpu_clean(struct fc_lport *lport) 2271{ 2272 struct fcoe_percpu_s *pp; 2273 struct fcoe_rcv_info *fr; 2274 struct sk_buff_head *list; 2275 struct sk_buff *skb, *next; 2276 struct sk_buff *head; 2277 unsigned int cpu; 2278 2279 for_each_possible_cpu(cpu) { 2280 pp = &per_cpu(fcoe_percpu, cpu); 2281 spin_lock_bh(&pp->fcoe_rx_list.lock); 2282 list = &pp->fcoe_rx_list; 2283 head = list->next; 2284 for (skb = head; skb != (struct sk_buff *)list; 2285 skb = next) { 2286 next = skb->next; 2287 fr = fcoe_dev_from_skb(skb); 2288 if (fr->fr_dev == lport) { 2289 __skb_unlink(skb, list); 2290 kfree_skb(skb); 2291 } 2292 } 2293 2294 if (!pp->thread || !cpu_online(cpu)) { 2295 spin_unlock_bh(&pp->fcoe_rx_list.lock); 2296 continue; 2297 } 2298 2299 skb = dev_alloc_skb(0); 2300 if (!skb) { 2301 spin_unlock_bh(&pp->fcoe_rx_list.lock); 2302 continue; 2303 } 2304 skb->destructor = fcoe_percpu_flush_done; 2305 2306 __skb_queue_tail(&pp->fcoe_rx_list, skb); 2307 if (pp->fcoe_rx_list.qlen == 1) 2308 wake_up_process(pp->thread); 2309 spin_unlock_bh(&pp->fcoe_rx_list.lock); 2310 2311 wait_for_completion(&fcoe_flush_completion); 2312 } 2313} 2314 2315/** 2316 * fcoe_clean_pending_queue() - Dequeue a skb and free it 2317 * @lport: The local port to dequeue a skb on 2318 */ 2319void fcoe_clean_pending_queue(struct fc_lport *lport) 2320{ 2321 struct fcoe_port *port = lport_priv(lport); 2322 struct sk_buff *skb; 2323 2324 spin_lock_bh(&port->fcoe_pending_queue.lock); 2325 while ((skb = __skb_dequeue(&port->fcoe_pending_queue)) != NULL) { 2326 spin_unlock_bh(&port->fcoe_pending_queue.lock); 2327 kfree_skb(skb); 2328 spin_lock_bh(&port->fcoe_pending_queue.lock); 2329 } 2330 spin_unlock_bh(&port->fcoe_pending_queue.lock); 2331} 2332 2333/** 2334 * fcoe_reset() - Reset a local port 2335 * @shost: The SCSI host associated with the local port to be reset 2336 * 2337 * Returns: Always 0 (return value required by FC transport template) 2338 */ 2339int fcoe_reset(struct Scsi_Host *shost) 2340{ 2341 struct fc_lport *lport = shost_priv(shost); 2342 fc_lport_reset(lport); 2343 return 0; 2344} 2345 2346/** 2347 * fcoe_hostlist_lookup_port() - Find the FCoE interface associated with a net device 2348 * @netdev: The net device used as a key 2349 * 2350 * Locking: Must be called with the RNL mutex held. 2351 * 2352 * Returns: NULL or the FCoE interface 2353 */ 2354static struct fcoe_interface * 2355fcoe_hostlist_lookup_port(const struct net_device *netdev) 2356{ 2357 struct fcoe_interface *fcoe; 2358 2359 list_for_each_entry(fcoe, &fcoe_hostlist, list) { 2360 if (fcoe->netdev == netdev) 2361 return fcoe; 2362 } 2363 return NULL; 2364} 2365 2366/** 2367 * fcoe_hostlist_lookup() - Find the local port associated with a 2368 * given net device 2369 * @netdev: The netdevice used as a key 2370 * 2371 * Locking: Must be called with the RTNL mutex held 2372 * 2373 * Returns: NULL or the local port 2374 */ 2375static struct fc_lport *fcoe_hostlist_lookup(const struct net_device *netdev) 2376{ 2377 struct fcoe_interface *fcoe; 2378 2379 fcoe = fcoe_hostlist_lookup_port(netdev); 2380 return (fcoe) ? fcoe->ctlr.lp : NULL; 2381} 2382 2383/** 2384 * fcoe_hostlist_add() - Add the FCoE interface identified by a local 2385 * port to the hostlist 2386 * @lport: The local port that identifies the FCoE interface to be added 2387 * 2388 * Locking: must be called with the RTNL mutex held 2389 * 2390 * Returns: 0 for success 2391 */ 2392static int fcoe_hostlist_add(const struct fc_lport *lport) 2393{ 2394 struct fcoe_interface *fcoe; 2395 struct fcoe_port *port; 2396 2397 fcoe = fcoe_hostlist_lookup_port(fcoe_netdev(lport)); 2398 if (!fcoe) { 2399 port = lport_priv(lport); 2400 fcoe = port->fcoe; 2401 list_add_tail(&fcoe->list, &fcoe_hostlist); 2402 } 2403 return 0; 2404} 2405 2406/** 2407 * fcoe_init() - Initialize fcoe.ko 2408 * 2409 * Returns: 0 on success, or a negative value on failure 2410 */ 2411static int __init fcoe_init(void) 2412{ 2413 struct fcoe_percpu_s *p; 2414 unsigned int cpu; 2415 int rc = 0; 2416 2417 mutex_lock(&fcoe_config_mutex); 2418 2419 for_each_possible_cpu(cpu) { 2420 p = &per_cpu(fcoe_percpu, cpu); 2421 skb_queue_head_init(&p->fcoe_rx_list); 2422 } 2423 2424 for_each_online_cpu(cpu) 2425 fcoe_percpu_thread_create(cpu); 2426 2427 /* Initialize per CPU interrupt thread */ 2428 rc = register_hotcpu_notifier(&fcoe_cpu_notifier); 2429 if (rc) 2430 goto out_free; 2431 2432 /* Setup link change notification */ 2433 fcoe_dev_setup(); 2434 2435 rc = fcoe_if_init(); 2436 if (rc) 2437 goto out_free; 2438 2439 mutex_unlock(&fcoe_config_mutex); 2440 return 0; 2441 2442out_free: 2443 for_each_online_cpu(cpu) { 2444 fcoe_percpu_thread_destroy(cpu); 2445 } 2446 mutex_unlock(&fcoe_config_mutex); 2447 return rc; 2448} 2449module_init(fcoe_init); 2450 2451/** 2452 * fcoe_exit() - Clean up fcoe.ko 2453 * 2454 * Returns: 0 on success or a negative value on failure 2455 */ 2456static void __exit fcoe_exit(void) 2457{ 2458 struct fcoe_interface *fcoe, *tmp; 2459 struct fcoe_port *port; 2460 unsigned int cpu; 2461 2462 mutex_lock(&fcoe_config_mutex); 2463 2464 fcoe_dev_cleanup(); 2465 2466 /* releases the associated fcoe hosts */ 2467 rtnl_lock(); 2468 list_for_each_entry_safe(fcoe, tmp, &fcoe_hostlist, list) { 2469 list_del(&fcoe->list); 2470 port = lport_priv(fcoe->ctlr.lp); 2471 fcoe_interface_cleanup(fcoe); 2472 schedule_work(&port->destroy_work); 2473 } 2474 rtnl_unlock(); 2475 2476 unregister_hotcpu_notifier(&fcoe_cpu_notifier); 2477 2478 for_each_online_cpu(cpu) 2479 fcoe_percpu_thread_destroy(cpu); 2480 2481 mutex_unlock(&fcoe_config_mutex); 2482 2483 /* flush any asyncronous interface destroys, 2484 * this should happen after the netdev notifier is unregistered */ 2485 flush_scheduled_work(); 2486 /* That will flush out all the N_Ports on the hostlist, but now we 2487 * may have NPIV VN_Ports scheduled for destruction */ 2488 flush_scheduled_work(); 2489 2490 /* detach from scsi transport 2491 * must happen after all destroys are done, therefor after the flush */ 2492 fcoe_if_exit(); 2493} 2494module_exit(fcoe_exit); 2495 2496/** 2497 * fcoe_flogi_resp() - FCoE specific FLOGI and FDISC response handler 2498 * @seq: active sequence in the FLOGI or FDISC exchange 2499 * @fp: response frame, or error encoded in a pointer (timeout) 2500 * @arg: pointer the the fcoe_ctlr structure 2501 * 2502 * This handles MAC address management for FCoE, then passes control on to 2503 * the libfc FLOGI response handler. 2504 */ 2505static void fcoe_flogi_resp(struct fc_seq *seq, struct fc_frame *fp, void *arg) 2506{ 2507 struct fcoe_ctlr *fip = arg; 2508 struct fc_exch *exch = fc_seq_exch(seq); 2509 struct fc_lport *lport = exch->lp; 2510 u8 *mac; 2511 2512 if (IS_ERR(fp)) 2513 goto done; 2514 2515 mac = fr_cb(fp)->granted_mac; 2516 if (is_zero_ether_addr(mac)) { 2517 /* pre-FIP */ 2518 if (fcoe_ctlr_recv_flogi(fip, lport, fp)) { 2519 fc_frame_free(fp); 2520 return; 2521 } 2522 } 2523 fcoe_update_src_mac(lport, mac); 2524done: 2525 fc_lport_flogi_resp(seq, fp, lport); 2526} 2527 2528/** 2529 * fcoe_logo_resp() - FCoE specific LOGO response handler 2530 * @seq: active sequence in the LOGO exchange 2531 * @fp: response frame, or error encoded in a pointer (timeout) 2532 * @arg: pointer the the fcoe_ctlr structure 2533 * 2534 * This handles MAC address management for FCoE, then passes control on to 2535 * the libfc LOGO response handler. 2536 */ 2537static void fcoe_logo_resp(struct fc_seq *seq, struct fc_frame *fp, void *arg) 2538{ 2539 struct fc_lport *lport = arg; 2540 static u8 zero_mac[ETH_ALEN] = { 0 }; 2541 2542 if (!IS_ERR(fp)) 2543 fcoe_update_src_mac(lport, zero_mac); 2544 fc_lport_logo_resp(seq, fp, lport); 2545} 2546 2547/** 2548 * fcoe_elsct_send - FCoE specific ELS handler 2549 * 2550 * This does special case handling of FIP encapsualted ELS exchanges for FCoE, 2551 * using FCoE specific response handlers and passing the FIP controller as 2552 * the argument (the lport is still available from the exchange). 2553 * 2554 * Most of the work here is just handed off to the libfc routine. 2555 */ 2556static struct fc_seq *fcoe_elsct_send(struct fc_lport *lport, u32 did, 2557 struct fc_frame *fp, unsigned int op, 2558 void (*resp)(struct fc_seq *, 2559 struct fc_frame *, 2560 void *), 2561 void *arg, u32 timeout) 2562{ 2563 struct fcoe_port *port = lport_priv(lport); 2564 struct fcoe_interface *fcoe = port->fcoe; 2565 struct fcoe_ctlr *fip = &fcoe->ctlr; 2566 struct fc_frame_header *fh = fc_frame_header_get(fp); 2567 2568 switch (op) { 2569 case ELS_FLOGI: 2570 case ELS_FDISC: 2571 if (lport->point_to_multipoint) 2572 break; 2573 return fc_elsct_send(lport, did, fp, op, fcoe_flogi_resp, 2574 fip, timeout); 2575 case ELS_LOGO: 2576 /* only hook onto fabric logouts, not port logouts */ 2577 if (ntoh24(fh->fh_d_id) != FC_FID_FLOGI) 2578 break; 2579 return fc_elsct_send(lport, did, fp, op, fcoe_logo_resp, 2580 lport, timeout); 2581 } 2582 return fc_elsct_send(lport, did, fp, op, resp, arg, timeout); 2583} 2584 2585/** 2586 * fcoe_vport_create() - create an fc_host/scsi_host for a vport 2587 * @vport: fc_vport object to create a new fc_host for 2588 * @disabled: start the new fc_host in a disabled state by default? 2589 * 2590 * Returns: 0 for success 2591 */ 2592static int fcoe_vport_create(struct fc_vport *vport, bool disabled) 2593{ 2594 struct Scsi_Host *shost = vport_to_shost(vport); 2595 struct fc_lport *n_port = shost_priv(shost); 2596 struct fcoe_port *port = lport_priv(n_port); 2597 struct fcoe_interface *fcoe = port->fcoe; 2598 struct net_device *netdev = fcoe->netdev; 2599 struct fc_lport *vn_port; 2600 2601 mutex_lock(&fcoe_config_mutex); 2602 vn_port = fcoe_if_create(fcoe, &vport->dev, 1); 2603 mutex_unlock(&fcoe_config_mutex); 2604 2605 if (IS_ERR(vn_port)) { 2606 printk(KERN_ERR "fcoe: fcoe_vport_create(%s) failed\n", 2607 netdev->name); 2608 return -EIO; 2609 } 2610 2611 if (disabled) { 2612 fc_vport_set_state(vport, FC_VPORT_DISABLED); 2613 } else { 2614 vn_port->boot_time = jiffies; 2615 fc_fabric_login(vn_port); 2616 fc_vport_setlink(vn_port); 2617 } 2618 return 0; 2619} 2620 2621/** 2622 * fcoe_vport_destroy() - destroy the fc_host/scsi_host for a vport 2623 * @vport: fc_vport object that is being destroyed 2624 * 2625 * Returns: 0 for success 2626 */ 2627static int fcoe_vport_destroy(struct fc_vport *vport) 2628{ 2629 struct Scsi_Host *shost = vport_to_shost(vport); 2630 struct fc_lport *n_port = shost_priv(shost); 2631 struct fc_lport *vn_port = vport->dd_data; 2632 struct fcoe_port *port = lport_priv(vn_port); 2633 2634 mutex_lock(&n_port->lp_mutex); 2635 list_del(&vn_port->list); 2636 mutex_unlock(&n_port->lp_mutex); 2637 schedule_work(&port->destroy_work); 2638 return 0; 2639} 2640 2641/** 2642 * fcoe_vport_disable() - change vport state 2643 * @vport: vport to bring online/offline 2644 * @disable: should the vport be disabled? 2645 */ 2646static int fcoe_vport_disable(struct fc_vport *vport, bool disable) 2647{ 2648 struct fc_lport *lport = vport->dd_data; 2649 2650 if (disable) { 2651 fc_vport_set_state(vport, FC_VPORT_DISABLED); 2652 fc_fabric_logoff(lport); 2653 } else { 2654 lport->boot_time = jiffies; 2655 fc_fabric_login(lport); 2656 fc_vport_setlink(lport); 2657 } 2658 2659 return 0; 2660} 2661 2662/** 2663 * fcoe_vport_set_symbolic_name() - append vport string to symbolic name 2664 * @vport: fc_vport with a new symbolic name string 2665 * 2666 * After generating a new symbolic name string, a new RSPN_ID request is 2667 * sent to the name server. There is no response handler, so if it fails 2668 * for some reason it will not be retried. 2669 */ 2670static void fcoe_set_vport_symbolic_name(struct fc_vport *vport) 2671{ 2672 struct fc_lport *lport = vport->dd_data; 2673 struct fc_frame *fp; 2674 size_t len; 2675 2676 snprintf(fc_host_symbolic_name(lport->host), FC_SYMBOLIC_NAME_SIZE, 2677 "%s v%s over %s : %s", FCOE_NAME, FCOE_VERSION, 2678 fcoe_netdev(lport)->name, vport->symbolic_name); 2679 2680 if (lport->state != LPORT_ST_READY) 2681 return; 2682 2683 len = strnlen(fc_host_symbolic_name(lport->host), 255); 2684 fp = fc_frame_alloc(lport, 2685 sizeof(struct fc_ct_hdr) + 2686 sizeof(struct fc_ns_rspn) + len); 2687 if (!fp) 2688 return; 2689 lport->tt.elsct_send(lport, FC_FID_DIR_SERV, fp, FC_NS_RSPN_ID, 2690 NULL, NULL, 3 * lport->r_a_tov); 2691} 2692 2693/** 2694 * fcoe_get_lesb() - Fill the FCoE Link Error Status Block 2695 * @lport: the local port 2696 * @fc_lesb: the link error status block 2697 */ 2698static void fcoe_get_lesb(struct fc_lport *lport, 2699 struct fc_els_lesb *fc_lesb) 2700{ 2701 unsigned int cpu; 2702 u32 lfc, vlfc, mdac; 2703 struct fcoe_dev_stats *devst; 2704 struct fcoe_fc_els_lesb *lesb; 2705 struct rtnl_link_stats64 temp; 2706 struct net_device *netdev = fcoe_netdev(lport); 2707 2708 lfc = 0; 2709 vlfc = 0; 2710 mdac = 0; 2711 lesb = (struct fcoe_fc_els_lesb *)fc_lesb; 2712 memset(lesb, 0, sizeof(*lesb)); 2713 for_each_possible_cpu(cpu) { 2714 devst = per_cpu_ptr(lport->dev_stats, cpu); 2715 lfc += devst->LinkFailureCount; 2716 vlfc += devst->VLinkFailureCount; 2717 mdac += devst->MissDiscAdvCount; 2718 } 2719 lesb->lesb_link_fail = htonl(lfc); 2720 lesb->lesb_vlink_fail = htonl(vlfc); 2721 lesb->lesb_miss_fka = htonl(mdac); 2722 lesb->lesb_fcs_error = htonl(dev_get_stats(netdev, &temp)->rx_crc_errors); 2723} 2724 2725/** 2726 * fcoe_set_port_id() - Callback from libfc when Port_ID is set. 2727 * @lport: the local port 2728 * @port_id: the port ID 2729 * @fp: the received frame, if any, that caused the port_id to be set. 2730 * 2731 * This routine handles the case where we received a FLOGI and are 2732 * entering point-to-point mode. We need to call fcoe_ctlr_recv_flogi() 2733 * so it can set the non-mapped mode and gateway address. 2734 * 2735 * The FLOGI LS_ACC is handled by fcoe_flogi_resp(). 2736 */ 2737static void fcoe_set_port_id(struct fc_lport *lport, 2738 u32 port_id, struct fc_frame *fp) 2739{ 2740 struct fcoe_port *port = lport_priv(lport); 2741 struct fcoe_interface *fcoe = port->fcoe; 2742 2743 if (fp && fc_frame_payload_op(fp) == ELS_FLOGI) 2744 fcoe_ctlr_recv_flogi(&fcoe->ctlr, lport, fp); 2745} 2746