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