]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blame - drivers/scsi/fcoe/fcoe.c
[SCSI] libfcoe, fcoe: libfcoe NPIV support
[mirror_ubuntu-bionic-kernel.git] / drivers / scsi / fcoe / fcoe.c
CommitLineData
85b4aa49 1/*
af7f85d9 2 * Copyright(c) 2007 - 2009 Intel Corporation. All rights reserved.
85b4aa49
RL
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>
85b4aa49 22#include <linux/spinlock.h>
85b4aa49
RL
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>
85b4aa49
RL
28#include <linux/crc32.h>
29#include <linux/cpu.h>
30#include <linux/fs.h>
31#include <linux/sysfs.h>
32#include <linux/ctype.h>
33#include <scsi/scsi_tcq.h>
34#include <scsi/scsicam.h>
35#include <scsi/scsi_transport.h>
36#include <scsi/scsi_transport_fc.h>
37#include <net/rtnetlink.h>
38
39#include <scsi/fc/fc_encaps.h>
97c8389d 40#include <scsi/fc/fc_fip.h>
85b4aa49
RL
41
42#include <scsi/libfc.h>
43#include <scsi/fc_frame.h>
44#include <scsi/libfcoe.h>
85b4aa49 45
fdd78027 46#include "fcoe.h"
7f349142 47
85b4aa49
RL
48MODULE_AUTHOR("Open-FCoE.org");
49MODULE_DESCRIPTION("FCoE");
9b34ecff 50MODULE_LICENSE("GPL v2");
85b4aa49 51
05cc7390
YZ
52/* Performance tuning parameters for fcoe */
53static unsigned int fcoe_ddp_min;
54module_param_named(ddp_min, fcoe_ddp_min, uint, S_IRUGO | S_IWUSR);
55MODULE_PARM_DESC(ddp_min, "Minimum I/O size in bytes for " \
56 "Direct Data Placement (DDP).");
57
dfc1d0fe
CL
58DEFINE_MUTEX(fcoe_config_mutex);
59
e7a51997
JE
60/* fcoe_percpu_clean completion. Waiter protected by fcoe_create_mutex */
61static DECLARE_COMPLETION(fcoe_flush_completion);
62
85b4aa49 63/* fcoe host list */
090eb6c4 64/* must only by accessed under the RTNL mutex */
85b4aa49 65LIST_HEAD(fcoe_hostlist);
5e5e92df 66DEFINE_PER_CPU(struct fcoe_percpu_s, fcoe_percpu);
85b4aa49 67
dd3fd72e 68/* Function Prototypes */
fdd78027
VD
69static int fcoe_reset(struct Scsi_Host *shost);
70static int fcoe_xmit(struct fc_lport *, struct fc_frame *);
71static int fcoe_rcv(struct sk_buff *, struct net_device *,
72 struct packet_type *, struct net_device *);
73static int fcoe_percpu_receive_thread(void *arg);
74static void fcoe_clean_pending_queue(struct fc_lport *lp);
75static void fcoe_percpu_clean(struct fc_lport *lp);
76static int fcoe_link_ok(struct fc_lport *lp);
77
78static struct fc_lport *fcoe_hostlist_lookup(const struct net_device *);
79static int fcoe_hostlist_add(const struct fc_lport *);
fdd78027 80
4bb6b515 81static void fcoe_check_wait_queue(struct fc_lport *, struct sk_buff *);
85b4aa49
RL
82static int fcoe_device_notification(struct notifier_block *, ulong, void *);
83static void fcoe_dev_setup(void);
84static void fcoe_dev_cleanup(void);
2e70e241
CL
85static struct fcoe_interface *
86 fcoe_hostlist_lookup_port(const struct net_device *dev);
85b4aa49
RL
87
88/* notification function from net device */
89static struct notifier_block fcoe_notifier = {
90 .notifier_call = fcoe_device_notification,
91};
92
7f349142
VD
93static struct scsi_transport_template *scsi_transport_fcoe_sw;
94
95struct fc_function_template fcoe_transport_function = {
96 .show_host_node_name = 1,
97 .show_host_port_name = 1,
98 .show_host_supported_classes = 1,
99 .show_host_supported_fc4s = 1,
100 .show_host_active_fc4s = 1,
101 .show_host_maxframe_size = 1,
102
103 .show_host_port_id = 1,
104 .show_host_supported_speeds = 1,
105 .get_host_speed = fc_get_host_speed,
106 .show_host_speed = 1,
107 .show_host_port_type = 1,
108 .get_host_port_state = fc_get_host_port_state,
109 .show_host_port_state = 1,
110 .show_host_symbolic_name = 1,
111
112 .dd_fcrport_size = sizeof(struct fc_rport_libfc_priv),
113 .show_rport_maxframe_size = 1,
114 .show_rport_supported_classes = 1,
115
116 .show_host_fabric_name = 1,
117 .show_starget_node_name = 1,
118 .show_starget_port_name = 1,
119 .show_starget_port_id = 1,
120 .set_rport_dev_loss_tmo = fc_set_rport_loss_tmo,
121 .show_rport_dev_loss_tmo = 1,
122 .get_fc_host_stats = fc_get_host_stats,
123 .issue_fc_host_lip = fcoe_reset,
124
125 .terminate_rport_io = fc_rport_terminate_io,
126};
127
128static struct scsi_host_template fcoe_shost_template = {
129 .module = THIS_MODULE,
130 .name = "FCoE Driver",
131 .proc_name = FCOE_NAME,
132 .queuecommand = fc_queuecommand,
133 .eh_abort_handler = fc_eh_abort,
134 .eh_device_reset_handler = fc_eh_device_reset,
135 .eh_host_reset_handler = fc_eh_host_reset,
136 .slave_alloc = fc_slave_alloc,
137 .change_queue_depth = fc_change_queue_depth,
138 .change_queue_type = fc_change_queue_type,
139 .this_id = -1,
14caf44c 140 .cmd_per_lun = 3,
7f349142
VD
141 .can_queue = FCOE_MAX_OUTSTANDING_COMMANDS,
142 .use_clustering = ENABLE_CLUSTERING,
143 .sg_tablesize = SG_ALL,
144 .max_sectors = 0xffff,
145};
146
54b649f8
CL
147static int fcoe_fip_recv(struct sk_buff *skb, struct net_device *dev,
148 struct packet_type *ptype,
149 struct net_device *orig_dev);
150/**
151 * fcoe_interface_setup()
152 * @fcoe: new fcoe_interface
153 * @netdev : ptr to the associated netdevice struct
154 *
155 * Returns : 0 for success
2e70e241 156 * Locking: must be called with the RTNL mutex held
54b649f8
CL
157 */
158static int fcoe_interface_setup(struct fcoe_interface *fcoe,
159 struct net_device *netdev)
160{
161 struct fcoe_ctlr *fip = &fcoe->ctlr;
162 struct netdev_hw_addr *ha;
163 u8 flogi_maddr[ETH_ALEN];
b7a727f1 164 const struct net_device_ops *ops;
54b649f8
CL
165
166 fcoe->netdev = netdev;
167
b7a727f1
YZ
168 /* Let LLD initialize for FCoE */
169 ops = netdev->netdev_ops;
170 if (ops->ndo_fcoe_enable) {
171 if (ops->ndo_fcoe_enable(netdev))
172 FCOE_NETDEV_DBG(netdev, "Failed to enable FCoE"
173 " specific feature for LLD.\n");
174 }
175
54b649f8
CL
176 /* Do not support for bonding device */
177 if ((netdev->priv_flags & IFF_MASTER_ALB) ||
178 (netdev->priv_flags & IFF_SLAVE_INACTIVE) ||
179 (netdev->priv_flags & IFF_MASTER_8023AD)) {
180 return -EOPNOTSUPP;
181 }
182
183 /* look for SAN MAC address, if multiple SAN MACs exist, only
184 * use the first one for SPMA */
185 rcu_read_lock();
186 for_each_dev_addr(netdev, ha) {
187 if ((ha->type == NETDEV_HW_ADDR_T_SAN) &&
188 (is_valid_ether_addr(fip->ctl_src_addr))) {
189 memcpy(fip->ctl_src_addr, ha->addr, ETH_ALEN);
190 fip->spma = 1;
191 break;
192 }
193 }
194 rcu_read_unlock();
195
196 /* setup Source Mac Address */
197 if (!fip->spma)
198 memcpy(fip->ctl_src_addr, netdev->dev_addr, netdev->addr_len);
199
200 /*
201 * Add FCoE MAC address as second unicast MAC address
202 * or enter promiscuous mode if not capable of listening
203 * for multiple unicast MACs.
204 */
54b649f8
CL
205 memcpy(flogi_maddr, (u8[6]) FC_FCOE_FLOGI_MAC, ETH_ALEN);
206 dev_unicast_add(netdev, flogi_maddr);
207 if (fip->spma)
208 dev_unicast_add(netdev, fip->ctl_src_addr);
209 dev_mc_add(netdev, FIP_ALL_ENODE_MACS, ETH_ALEN, 0);
54b649f8
CL
210
211 /*
212 * setup the receive function from ethernet driver
213 * on the ethertype for the given device
214 */
215 fcoe->fcoe_packet_type.func = fcoe_rcv;
216 fcoe->fcoe_packet_type.type = __constant_htons(ETH_P_FCOE);
217 fcoe->fcoe_packet_type.dev = netdev;
218 dev_add_pack(&fcoe->fcoe_packet_type);
219
220 fcoe->fip_packet_type.func = fcoe_fip_recv;
221 fcoe->fip_packet_type.type = htons(ETH_P_FIP);
222 fcoe->fip_packet_type.dev = netdev;
223 dev_add_pack(&fcoe->fip_packet_type);
224
225 return 0;
226}
227
228static void fcoe_fip_send(struct fcoe_ctlr *fip, struct sk_buff *skb);
11b56188
CL
229static void fcoe_update_src_mac(struct fc_lport *lport, u8 *addr);
230static u8 *fcoe_get_src_mac(struct fc_lport *lport);
2e70e241 231static void fcoe_destroy_work(struct work_struct *work);
54b649f8 232
030f4e00
CL
233/**
234 * fcoe_interface_create()
235 * @netdev: network interface
236 *
237 * Returns: pointer to a struct fcoe_interface or NULL on error
238 */
239static struct fcoe_interface *fcoe_interface_create(struct net_device *netdev)
240{
241 struct fcoe_interface *fcoe;
242
243 fcoe = kzalloc(sizeof(*fcoe), GFP_KERNEL);
244 if (!fcoe) {
245 FCOE_NETDEV_DBG(netdev, "Could not allocate fcoe structure\n");
246 return NULL;
247 }
248
2e70e241 249 dev_hold(netdev);
030f4e00 250 kref_init(&fcoe->kref);
54b649f8
CL
251
252 /*
253 * Initialize FIP.
254 */
255 fcoe_ctlr_init(&fcoe->ctlr);
256 fcoe->ctlr.send = fcoe_fip_send;
257 fcoe->ctlr.update_mac = fcoe_update_src_mac;
11b56188 258 fcoe->ctlr.get_src_addr = fcoe_get_src_mac;
54b649f8
CL
259
260 fcoe_interface_setup(fcoe, netdev);
030f4e00
CL
261
262 return fcoe;
263}
264
54b649f8
CL
265/**
266 * fcoe_interface_cleanup() - clean up netdev configurations
267 * @fcoe:
2e70e241
CL
268 *
269 * Caller must be holding the RTNL mutex
54b649f8
CL
270 */
271void fcoe_interface_cleanup(struct fcoe_interface *fcoe)
272{
273 struct net_device *netdev = fcoe->netdev;
274 struct fcoe_ctlr *fip = &fcoe->ctlr;
275 u8 flogi_maddr[ETH_ALEN];
b7a727f1 276 const struct net_device_ops *ops;
54b649f8
CL
277
278 /*
279 * Don't listen for Ethernet packets anymore.
280 * synchronize_net() ensures that the packet handlers are not running
281 * on another CPU. dev_remove_pack() would do that, this calls the
282 * unsyncronized version __dev_remove_pack() to avoid multiple delays.
283 */
284 __dev_remove_pack(&fcoe->fcoe_packet_type);
285 __dev_remove_pack(&fcoe->fip_packet_type);
286 synchronize_net();
287
54b649f8 288 /* Delete secondary MAC addresses */
54b649f8
CL
289 memcpy(flogi_maddr, (u8[6]) FC_FCOE_FLOGI_MAC, ETH_ALEN);
290 dev_unicast_delete(netdev, flogi_maddr);
54b649f8
CL
291 if (fip->spma)
292 dev_unicast_delete(netdev, fip->ctl_src_addr);
293 dev_mc_delete(netdev, FIP_ALL_ENODE_MACS, ETH_ALEN, 0);
b7a727f1
YZ
294
295 /* Tell the LLD we are done w/ FCoE */
296 ops = netdev->netdev_ops;
297 if (ops->ndo_fcoe_disable) {
298 if (ops->ndo_fcoe_disable(netdev))
299 FCOE_NETDEV_DBG(netdev, "Failed to disable FCoE"
300 " specific feature for LLD.\n");
301 }
54b649f8
CL
302}
303
030f4e00
CL
304/**
305 * fcoe_interface_release() - fcoe_port kref release function
306 * @kref: embedded reference count in an fcoe_interface struct
307 */
308static void fcoe_interface_release(struct kref *kref)
309{
310 struct fcoe_interface *fcoe;
2e70e241 311 struct net_device *netdev;
030f4e00
CL
312
313 fcoe = container_of(kref, struct fcoe_interface, kref);
2e70e241
CL
314 netdev = fcoe->netdev;
315 /* tear-down the FCoE controller */
316 fcoe_ctlr_destroy(&fcoe->ctlr);
030f4e00 317 kfree(fcoe);
2e70e241 318 dev_put(netdev);
030f4e00
CL
319}
320
321/**
322 * fcoe_interface_get()
323 * @fcoe:
324 */
325static inline void fcoe_interface_get(struct fcoe_interface *fcoe)
326{
327 kref_get(&fcoe->kref);
328}
329
330/**
331 * fcoe_interface_put()
332 * @fcoe:
333 */
334static inline void fcoe_interface_put(struct fcoe_interface *fcoe)
335{
336 kref_put(&fcoe->kref, fcoe_interface_release);
337}
338
ab6b85c1
VD
339/**
340 * fcoe_fip_recv - handle a received FIP frame.
341 * @skb: the receive skb
342 * @dev: associated &net_device
343 * @ptype: the &packet_type structure which was used to register this handler.
344 * @orig_dev: original receive &net_device, in case @dev is a bond.
345 *
346 * Returns: 0 for success
347 */
348static int fcoe_fip_recv(struct sk_buff *skb, struct net_device *dev,
349 struct packet_type *ptype,
350 struct net_device *orig_dev)
351{
259ad85d 352 struct fcoe_interface *fcoe;
ab6b85c1 353
259ad85d 354 fcoe = container_of(ptype, struct fcoe_interface, fip_packet_type);
3fe9a0ba 355 fcoe_ctlr_recv(&fcoe->ctlr, skb);
ab6b85c1
VD
356 return 0;
357}
358
359/**
360 * fcoe_fip_send() - send an Ethernet-encapsulated FIP frame.
361 * @fip: FCoE controller.
362 * @skb: FIP Packet.
363 */
364static void fcoe_fip_send(struct fcoe_ctlr *fip, struct sk_buff *skb)
365{
3fe9a0ba 366 skb->dev = fcoe_from_ctlr(fip)->netdev;
ab6b85c1
VD
367 dev_queue_xmit(skb);
368}
369
370/**
371 * fcoe_update_src_mac() - Update Ethernet MAC filters.
11b56188
CL
372 * @lport: libfc lport
373 * @addr: Unicast MAC address to add.
ab6b85c1
VD
374 *
375 * Remove any previously-set unicast MAC filter.
376 * Add secondary FCoE MAC address filter for our OUI.
377 */
11b56188 378static void fcoe_update_src_mac(struct fc_lport *lport, u8 *addr)
ab6b85c1 379{
11b56188
CL
380 struct fcoe_port *port = lport_priv(lport);
381 struct fcoe_interface *fcoe = port->fcoe;
25024989 382
ab6b85c1 383 rtnl_lock();
11b56188
CL
384 if (!is_zero_ether_addr(port->data_src_addr))
385 dev_unicast_delete(fcoe->netdev, port->data_src_addr);
386 if (!is_zero_ether_addr(addr))
387 dev_unicast_add(fcoe->netdev, addr);
388 memcpy(port->data_src_addr, addr, ETH_ALEN);
ab6b85c1
VD
389 rtnl_unlock();
390}
391
11b56188
CL
392/**
393 * fcoe_get_src_mac() - return the Ethernet source address for an lport
394 * @lport: libfc lport
395 */
396static u8 *fcoe_get_src_mac(struct fc_lport *lport)
397{
398 struct fcoe_port *port = lport_priv(lport);
399
400 return port->data_src_addr;
401}
402
7f349142
VD
403/**
404 * fcoe_lport_config() - sets up the fc_lport
405 * @lp: ptr to the fc_lport
7f349142
VD
406 *
407 * Returns: 0 for success
408 */
409static int fcoe_lport_config(struct fc_lport *lp)
410{
411 lp->link_up = 0;
412 lp->qfull = 0;
413 lp->max_retry_count = 3;
a3666955 414 lp->max_rport_retry_count = 3;
7f349142
VD
415 lp->e_d_tov = 2 * 1000; /* FC-FS default */
416 lp->r_a_tov = 2 * 2 * 1000;
417 lp->service_params = (FCP_SPPF_INIT_FCN | FCP_SPPF_RD_XRDY_DIS |
418 FCP_SPPF_RETRY | FCP_SPPF_CONF_COMPL);
419
420 fc_lport_init_stats(lp);
421
422 /* lport fc_lport related configuration */
423 fc_lport_config(lp);
424
425 /* offload related configuration */
426 lp->crc_offload = 0;
427 lp->seq_offload = 0;
428 lp->lro_enabled = 0;
429 lp->lro_xid = 0;
430 lp->lso_max = 0;
431
432 return 0;
433}
434
1047f221
VD
435/**
436 * fcoe_queue_timer() - fcoe queue timer
437 * @lp: the fc_lport pointer
438 *
439 * Calls fcoe_check_wait_queue on timeout
440 *
441 */
442static void fcoe_queue_timer(ulong lp)
443{
444 fcoe_check_wait_queue((struct fc_lport *)lp, NULL);
445}
446
7f349142
VD
447/**
448 * fcoe_netdev_config() - Set up netdev for SW FCoE
449 * @lp : ptr to the fc_lport
450 * @netdev : ptr to the associated netdevice struct
451 *
452 * Must be called after fcoe_lport_config() as it will use lport mutex
453 *
454 * Returns : 0 for success
455 */
456static int fcoe_netdev_config(struct fc_lport *lp, struct net_device *netdev)
457{
458 u32 mfs;
459 u64 wwnn, wwpn;
25024989 460 struct fcoe_interface *fcoe;
014f5c3f 461 struct fcoe_port *port;
7f349142
VD
462
463 /* Setup lport private data to point to fcoe softc */
014f5c3f 464 port = lport_priv(lp);
25024989 465 fcoe = port->fcoe;
7f349142
VD
466
467 /*
468 * Determine max frame size based on underlying device and optional
469 * user-configured limit. If the MFS is too low, fcoe_link_ok()
470 * will return 0, so do this first.
471 */
7221d7e5
YZ
472 mfs = netdev->mtu;
473 if (netdev->features & NETIF_F_FCOE_MTU) {
474 mfs = FCOE_MTU;
475 FCOE_NETDEV_DBG(netdev, "Supports FCOE_MTU of %d bytes\n", mfs);
476 }
477 mfs -= (sizeof(struct fcoe_hdr) + sizeof(struct fcoe_crc_eof));
7f349142
VD
478 if (fc_set_mfs(lp, mfs))
479 return -EINVAL;
480
7f349142 481 /* offload features support */
1d1b88dc 482 if (netdev->features & NETIF_F_SG)
7f349142
VD
483 lp->sg_supp = 1;
484
7f349142
VD
485 if (netdev->features & NETIF_F_FCOE_CRC) {
486 lp->crc_offload = 1;
d5488eb9 487 FCOE_NETDEV_DBG(netdev, "Supports FCCRC offload\n");
7f349142 488 }
7f349142
VD
489 if (netdev->features & NETIF_F_FSO) {
490 lp->seq_offload = 1;
491 lp->lso_max = netdev->gso_max_size;
d5488eb9
RL
492 FCOE_NETDEV_DBG(netdev, "Supports LSO for max len 0x%x\n",
493 lp->lso_max);
7f349142 494 }
7f349142
VD
495 if (netdev->fcoe_ddp_xid) {
496 lp->lro_enabled = 1;
497 lp->lro_xid = netdev->fcoe_ddp_xid;
d5488eb9
RL
498 FCOE_NETDEV_DBG(netdev, "Supports LRO for max xid 0x%x\n",
499 lp->lro_xid);
7f349142 500 }
014f5c3f
CL
501 skb_queue_head_init(&port->fcoe_pending_queue);
502 port->fcoe_pending_queue_active = 0;
503 setup_timer(&port->timer, fcoe_queue_timer, (unsigned long)lp);
7f349142 504
1d1b88dc 505 wwnn = fcoe_wwn_from_mac(netdev->dev_addr, 1, 0);
7f349142
VD
506 fc_set_wwnn(lp, wwnn);
507 /* XXX - 3rd arg needs to be vlan id */
1d1b88dc 508 wwpn = fcoe_wwn_from_mac(netdev->dev_addr, 2, 0);
7f349142
VD
509 fc_set_wwpn(lp, wwpn);
510
7f349142
VD
511 return 0;
512}
513
514/**
515 * fcoe_shost_config() - Sets up fc_lport->host
516 * @lp : ptr to the fc_lport
517 * @shost : ptr to the associated scsi host
518 * @dev : device associated to scsi host
519 *
520 * Must be called after fcoe_lport_config() and fcoe_netdev_config()
521 *
522 * Returns : 0 for success
523 */
524static int fcoe_shost_config(struct fc_lport *lp, struct Scsi_Host *shost,
525 struct device *dev)
526{
527 int rc = 0;
528
529 /* lport scsi host config */
7f349142
VD
530 lp->host->max_lun = FCOE_MAX_LUN;
531 lp->host->max_id = FCOE_MAX_FCP_TARGET;
532 lp->host->max_channel = 0;
533 lp->host->transportt = scsi_transport_fcoe_sw;
534
535 /* add the new host to the SCSI-ml */
536 rc = scsi_add_host(lp->host, dev);
537 if (rc) {
d5488eb9
RL
538 FCOE_NETDEV_DBG(fcoe_netdev(lp), "fcoe_shost_config: "
539 "error on scsi_add_host\n");
7f349142
VD
540 return rc;
541 }
542 sprintf(fc_host_symbolic_name(lp->host), "%s v%s over %s",
543 FCOE_NAME, FCOE_VERSION,
544 fcoe_netdev(lp)->name);
545
546 return 0;
547}
548
d7179680
VD
549/*
550 * fcoe_oem_match() - match for read types IO
551 * @fp: the fc_frame for new IO.
552 *
553 * Returns : true for read types IO, otherwise returns false.
554 */
555bool fcoe_oem_match(struct fc_frame *fp)
556{
05cc7390
YZ
557 return fc_fcp_is_read(fr_fsp(fp)) &&
558 (fr_fsp(fp)->data_len > fcoe_ddp_min);
d7179680
VD
559}
560
7f349142
VD
561/**
562 * fcoe_em_config() - allocates em for this lport
014f5c3f 563 * @lp: the fcoe that em is to allocated for
7f349142
VD
564 *
565 * Returns : 0 on success
566 */
567static inline int fcoe_em_config(struct fc_lport *lp)
568{
014f5c3f 569 struct fcoe_port *port = lport_priv(lp);
25024989
CL
570 struct fcoe_interface *fcoe = port->fcoe;
571 struct fcoe_interface *oldfcoe = NULL;
1d1b88dc 572 struct net_device *old_real_dev, *cur_real_dev;
d7179680
VD
573 u16 min_xid = FCOE_MIN_XID;
574 u16 max_xid = FCOE_MAX_XID;
575
576 /*
577 * Check if need to allocate an em instance for
578 * offload exchange ids to be shared across all VN_PORTs/lport.
579 */
580 if (!lp->lro_enabled || !lp->lro_xid || (lp->lro_xid >= max_xid)) {
581 lp->lro_xid = 0;
582 goto skip_oem;
583 }
584
585 /*
586 * Reuse existing offload em instance in case
1d1b88dc 587 * it is already allocated on real eth device
d7179680 588 */
25024989
CL
589 if (fcoe->netdev->priv_flags & IFF_802_1Q_VLAN)
590 cur_real_dev = vlan_dev_real_dev(fcoe->netdev);
1d1b88dc 591 else
25024989 592 cur_real_dev = fcoe->netdev;
1d1b88dc 593
25024989 594 list_for_each_entry(oldfcoe, &fcoe_hostlist, list) {
25024989
CL
595 if (oldfcoe->netdev->priv_flags & IFF_802_1Q_VLAN)
596 old_real_dev = vlan_dev_real_dev(oldfcoe->netdev);
1d1b88dc 597 else
25024989 598 old_real_dev = oldfcoe->netdev;
1d1b88dc
VD
599
600 if (cur_real_dev == old_real_dev) {
991cbb60 601 fcoe->oem = oldfcoe->oem;
d7179680
VD
602 break;
603 }
604 }
605
991cbb60
CL
606 if (fcoe->oem) {
607 if (!fc_exch_mgr_add(lp, fcoe->oem, fcoe_oem_match)) {
d7179680
VD
608 printk(KERN_ERR "fcoe_em_config: failed to add "
609 "offload em:%p on interface:%s\n",
991cbb60 610 fcoe->oem, fcoe->netdev->name);
d7179680
VD
611 return -ENOMEM;
612 }
613 } else {
991cbb60 614 fcoe->oem = fc_exch_mgr_alloc(lp, FC_CLASS_3,
d7179680
VD
615 FCOE_MIN_XID, lp->lro_xid,
616 fcoe_oem_match);
991cbb60 617 if (!fcoe->oem) {
d7179680
VD
618 printk(KERN_ERR "fcoe_em_config: failed to allocate "
619 "em for offload exches on interface:%s\n",
25024989 620 fcoe->netdev->name);
d7179680
VD
621 return -ENOMEM;
622 }
623 }
624
625 /*
626 * Exclude offload EM xid range from next EM xid range.
627 */
628 min_xid += lp->lro_xid + 1;
629
630skip_oem:
631 if (!fc_exch_mgr_alloc(lp, FC_CLASS_3, min_xid, max_xid, NULL)) {
632 printk(KERN_ERR "fcoe_em_config: failed to "
25024989 633 "allocate em on interface %s\n", fcoe->netdev->name);
7f349142 634 return -ENOMEM;
d7179680 635 }
7f349142
VD
636
637 return 0;
638}
639
640/**
641 * fcoe_if_destroy() - FCoE software HBA tear-down function
af7f85d9 642 * @lport: fc_lport to destroy
7f349142 643 */
af7f85d9 644static void fcoe_if_destroy(struct fc_lport *lport)
7f349142 645{
014f5c3f
CL
646 struct fcoe_port *port = lport_priv(lport);
647 struct fcoe_interface *fcoe = port->fcoe;
25024989 648 struct net_device *netdev = fcoe->netdev;
7f349142 649
d5488eb9 650 FCOE_NETDEV_DBG(netdev, "Destroying interface\n");
7f349142 651
7f349142 652 /* Logout of the fabric */
af7f85d9 653 fc_fabric_logoff(lport);
7f349142 654
54b649f8
CL
655 /* Cleanup the fc_lport */
656 fc_lport_destroy(lport);
657 fc_fcp_destroy(lport);
658
659 /* Stop the transmit retry timer */
660 del_timer_sync(&port->timer);
ab6b85c1 661
54b649f8
CL
662 /* Free existing transmit skbs */
663 fcoe_clean_pending_queue(lport);
664
11b56188
CL
665 rtnl_lock();
666 if (!is_zero_ether_addr(port->data_src_addr))
667 dev_unicast_delete(netdev, port->data_src_addr);
668 rtnl_unlock();
669
54b649f8
CL
670 /* receives may not be stopped until after this */
671 fcoe_interface_put(fcoe);
7f349142 672
f161fb72 673 /* Free queued packets for the per-CPU receive threads */
af7f85d9 674 fcoe_percpu_clean(lport);
f161fb72 675
7f349142 676 /* Detach from the scsi-ml */
af7f85d9
CL
677 fc_remove_host(lport->host);
678 scsi_remove_host(lport->host);
7f349142
VD
679
680 /* There are no more rports or I/O, free the EM */
af7f85d9 681 fc_exch_mgr_free(lport);
7f349142 682
7f349142 683 /* Free memory used by statistical counters */
af7f85d9 684 fc_lport_free_stats(lport);
7f349142 685
2e70e241 686 /* Release the Scsi_Host */
af7f85d9 687 scsi_host_put(lport->host);
7f349142
VD
688}
689
690/*
691 * fcoe_ddp_setup - calls LLD's ddp_setup through net_device
692 * @lp: the corresponding fc_lport
693 * @xid: the exchange id for this ddp transfer
694 * @sgl: the scatterlist describing this transfer
695 * @sgc: number of sg items
696 *
697 * Returns : 0 no ddp
698 */
699static int fcoe_ddp_setup(struct fc_lport *lp, u16 xid,
700 struct scatterlist *sgl, unsigned int sgc)
701{
702 struct net_device *n = fcoe_netdev(lp);
703
b04d023c 704 if (n->netdev_ops->ndo_fcoe_ddp_setup)
7f349142
VD
705 return n->netdev_ops->ndo_fcoe_ddp_setup(n, xid, sgl, sgc);
706
707 return 0;
708}
709
710/*
711 * fcoe_ddp_done - calls LLD's ddp_done through net_device
712 * @lp: the corresponding fc_lport
713 * @xid: the exchange id for this ddp transfer
714 *
715 * Returns : the length of data that have been completed by ddp
716 */
717static int fcoe_ddp_done(struct fc_lport *lp, u16 xid)
718{
719 struct net_device *n = fcoe_netdev(lp);
720
b04d023c 721 if (n->netdev_ops->ndo_fcoe_ddp_done)
7f349142
VD
722 return n->netdev_ops->ndo_fcoe_ddp_done(n, xid);
723 return 0;
724}
725
11b56188
CL
726static struct fc_seq *fcoe_elsct_send(struct fc_lport *lport,
727 u32 did, struct fc_frame *fp, unsigned int op,
728 void (*resp)(struct fc_seq *, struct fc_frame *, void *),
729 void *arg, u32 timeout);
730
7f349142
VD
731static struct libfc_function_template fcoe_libfc_fcn_templ = {
732 .frame_send = fcoe_xmit,
733 .ddp_setup = fcoe_ddp_setup,
734 .ddp_done = fcoe_ddp_done,
11b56188 735 .elsct_send = fcoe_elsct_send,
7f349142
VD
736};
737
738/**
030f4e00
CL
739 * fcoe_if_create() - this function creates the fcoe port
740 * @fcoe: fcoe_interface structure to create an fc_lport instance on
af7f85d9 741 * @parent: device pointer to be the parent in sysfs for the SCSI host
7f349142 742 *
54b649f8 743 * Creates fc_lport struct and scsi_host for lport, configures lport.
7f349142 744 *
af7f85d9 745 * Returns : The allocated fc_lport or an error pointer
7f349142 746 */
030f4e00 747static struct fc_lport *fcoe_if_create(struct fcoe_interface *fcoe,
af7f85d9 748 struct device *parent)
7f349142
VD
749{
750 int rc;
af7f85d9 751 struct fc_lport *lport = NULL;
014f5c3f 752 struct fcoe_port *port;
7f349142 753 struct Scsi_Host *shost;
030f4e00 754 struct net_device *netdev = fcoe->netdev;
7f349142 755
d5488eb9 756 FCOE_NETDEV_DBG(netdev, "Create Interface\n");
7f349142 757
86221969 758 lport = libfc_host_alloc(&fcoe_shost_template,
014f5c3f 759 sizeof(struct fcoe_port));
86221969 760 if (!lport) {
d5488eb9 761 FCOE_NETDEV_DBG(netdev, "Could not allocate host structure\n");
af7f85d9 762 rc = -ENOMEM;
030f4e00 763 goto out;
7f349142 764 }
86221969 765 shost = lport->host;
014f5c3f 766 port = lport_priv(lport);
2e70e241 767 port->lport = lport;
014f5c3f 768 port->fcoe = fcoe;
2e70e241 769 INIT_WORK(&port->destroy_work, fcoe_destroy_work);
7f349142
VD
770
771 /* configure fc_lport, e.g., em */
af7f85d9 772 rc = fcoe_lport_config(lport);
7f349142 773 if (rc) {
d5488eb9
RL
774 FCOE_NETDEV_DBG(netdev, "Could not configure lport for the "
775 "interface\n");
7f349142
VD
776 goto out_host_put;
777 }
778
ab6b85c1 779 /* configure lport network properties */
af7f85d9 780 rc = fcoe_netdev_config(lport, netdev);
ab6b85c1 781 if (rc) {
d5488eb9
RL
782 FCOE_NETDEV_DBG(netdev, "Could not configure netdev for the "
783 "interface\n");
54b649f8 784 goto out_lp_destroy;
ab6b85c1 785 }
97c8389d 786
7f349142 787 /* configure lport scsi host properties */
af7f85d9 788 rc = fcoe_shost_config(lport, shost, parent);
7f349142 789 if (rc) {
d5488eb9
RL
790 FCOE_NETDEV_DBG(netdev, "Could not configure shost for the "
791 "interface\n");
54b649f8 792 goto out_lp_destroy;
7f349142
VD
793 }
794
96316099 795 /* Initialize the library */
af7f85d9 796 rc = fcoe_libfc_config(lport, &fcoe_libfc_fcn_templ);
7f349142 797 if (rc) {
96316099 798 FCOE_NETDEV_DBG(netdev, "Could not configure libfc for the "
d5488eb9 799 "interface\n");
96316099 800 goto out_lp_destroy;
7f349142
VD
801 }
802
e8af4d43
VD
803 /*
804 * fcoe_em_alloc() and fcoe_hostlist_add() both
c863df33 805 * need to be atomic with respect to other changes to the hostlist
e8af4d43
VD
806 * since fcoe_em_alloc() looks for an existing EM
807 * instance on host list updated by fcoe_hostlist_add().
c863df33
CL
808 *
809 * This is currently handled through the fcoe_config_mutex begin held.
e8af4d43 810 */
c863df33 811
96316099 812 /* lport exch manager allocation */
af7f85d9 813 rc = fcoe_em_config(lport);
7f349142 814 if (rc) {
96316099 815 FCOE_NETDEV_DBG(netdev, "Could not configure the EM for the "
d5488eb9 816 "interface\n");
7f349142
VD
817 goto out_lp_destroy;
818 }
819
030f4e00 820 fcoe_interface_get(fcoe);
af7f85d9 821 return lport;
7f349142
VD
822
823out_lp_destroy:
af7f85d9 824 fc_exch_mgr_free(lport);
7f349142 825out_host_put:
af7f85d9
CL
826 scsi_host_put(lport->host);
827out:
828 return ERR_PTR(rc);
7f349142
VD
829}
830
831/**
832 * fcoe_if_init() - attach to scsi transport
833 *
834 * Returns : 0 on success
835 */
836static int __init fcoe_if_init(void)
837{
838 /* attach to scsi transport */
839 scsi_transport_fcoe_sw =
840 fc_attach_transport(&fcoe_transport_function);
841
842 if (!scsi_transport_fcoe_sw) {
d5488eb9 843 printk(KERN_ERR "fcoe: Failed to attach to the FC transport\n");
7f349142
VD
844 return -ENODEV;
845 }
846
847 return 0;
848}
849
850/**
851 * fcoe_if_exit() - detach from scsi transport
852 *
853 * Returns : 0 on success
854 */
855int __exit fcoe_if_exit(void)
856{
857 fc_release_transport(scsi_transport_fcoe_sw);
dfc1d0fe 858 scsi_transport_fcoe_sw = NULL;
7f349142
VD
859 return 0;
860}
861
8976f424
RL
862/**
863 * fcoe_percpu_thread_create() - Create a receive thread for an online cpu
864 * @cpu: cpu index for the online cpu
865 */
866static void fcoe_percpu_thread_create(unsigned int cpu)
867{
868 struct fcoe_percpu_s *p;
869 struct task_struct *thread;
870
871 p = &per_cpu(fcoe_percpu, cpu);
872
873 thread = kthread_create(fcoe_percpu_receive_thread,
874 (void *)p, "fcoethread/%d", cpu);
875
e7a51997 876 if (likely(!IS_ERR(thread))) {
8976f424
RL
877 kthread_bind(thread, cpu);
878 wake_up_process(thread);
879
880 spin_lock_bh(&p->fcoe_rx_list.lock);
881 p->thread = thread;
882 spin_unlock_bh(&p->fcoe_rx_list.lock);
883 }
884}
885
886/**
887 * fcoe_percpu_thread_destroy() - removes the rx thread for the given cpu
888 * @cpu: cpu index the rx thread is to be removed
889 *
890 * Destroys a per-CPU Rx thread. Any pending skbs are moved to the
891 * current CPU's Rx thread. If the thread being destroyed is bound to
892 * the CPU processing this context the skbs will be freed.
893 */
894static void fcoe_percpu_thread_destroy(unsigned int cpu)
895{
896 struct fcoe_percpu_s *p;
897 struct task_struct *thread;
898 struct page *crc_eof;
899 struct sk_buff *skb;
900#ifdef CONFIG_SMP
901 struct fcoe_percpu_s *p0;
902 unsigned targ_cpu = smp_processor_id();
903#endif /* CONFIG_SMP */
904
d5488eb9 905 FCOE_DBG("Destroying receive thread for CPU %d\n", cpu);
8976f424
RL
906
907 /* Prevent any new skbs from being queued for this CPU. */
908 p = &per_cpu(fcoe_percpu, cpu);
909 spin_lock_bh(&p->fcoe_rx_list.lock);
910 thread = p->thread;
911 p->thread = NULL;
912 crc_eof = p->crc_eof_page;
913 p->crc_eof_page = NULL;
914 p->crc_eof_offset = 0;
915 spin_unlock_bh(&p->fcoe_rx_list.lock);
916
917#ifdef CONFIG_SMP
918 /*
919 * Don't bother moving the skb's if this context is running
920 * on the same CPU that is having its thread destroyed. This
921 * can easily happen when the module is removed.
922 */
923 if (cpu != targ_cpu) {
924 p0 = &per_cpu(fcoe_percpu, targ_cpu);
925 spin_lock_bh(&p0->fcoe_rx_list.lock);
926 if (p0->thread) {
d5488eb9
RL
927 FCOE_DBG("Moving frames from CPU %d to CPU %d\n",
928 cpu, targ_cpu);
8976f424
RL
929
930 while ((skb = __skb_dequeue(&p->fcoe_rx_list)) != NULL)
931 __skb_queue_tail(&p0->fcoe_rx_list, skb);
932 spin_unlock_bh(&p0->fcoe_rx_list.lock);
933 } else {
934 /*
935 * The targeted CPU is not initialized and cannot accept
936 * new skbs. Unlock the targeted CPU and drop the skbs
937 * on the CPU that is going offline.
938 */
939 while ((skb = __skb_dequeue(&p->fcoe_rx_list)) != NULL)
940 kfree_skb(skb);
941 spin_unlock_bh(&p0->fcoe_rx_list.lock);
942 }
943 } else {
944 /*
945 * This scenario occurs when the module is being removed
946 * and all threads are being destroyed. skbs will continue
947 * to be shifted from the CPU thread that is being removed
948 * to the CPU thread associated with the CPU that is processing
949 * the module removal. Once there is only one CPU Rx thread it
950 * will reach this case and we will drop all skbs and later
951 * stop the thread.
952 */
953 spin_lock_bh(&p->fcoe_rx_list.lock);
954 while ((skb = __skb_dequeue(&p->fcoe_rx_list)) != NULL)
955 kfree_skb(skb);
956 spin_unlock_bh(&p->fcoe_rx_list.lock);
957 }
958#else
959 /*
dd3fd72e 960 * This a non-SMP scenario where the singular Rx thread is
8976f424
RL
961 * being removed. Free all skbs and stop the thread.
962 */
963 spin_lock_bh(&p->fcoe_rx_list.lock);
964 while ((skb = __skb_dequeue(&p->fcoe_rx_list)) != NULL)
965 kfree_skb(skb);
966 spin_unlock_bh(&p->fcoe_rx_list.lock);
967#endif
968
969 if (thread)
970 kthread_stop(thread);
971
972 if (crc_eof)
973 put_page(crc_eof);
974}
975
976/**
977 * fcoe_cpu_callback() - fcoe cpu hotplug event callback
978 * @nfb: callback data block
979 * @action: event triggering the callback
980 * @hcpu: index for the cpu of this event
981 *
982 * This creates or destroys per cpu data for fcoe
983 *
984 * Returns NOTIFY_OK always.
985 */
986static int fcoe_cpu_callback(struct notifier_block *nfb,
987 unsigned long action, void *hcpu)
988{
989 unsigned cpu = (unsigned long)hcpu;
990
991 switch (action) {
992 case CPU_ONLINE:
993 case CPU_ONLINE_FROZEN:
d5488eb9 994 FCOE_DBG("CPU %x online: Create Rx thread\n", cpu);
8976f424
RL
995 fcoe_percpu_thread_create(cpu);
996 break;
997 case CPU_DEAD:
998 case CPU_DEAD_FROZEN:
d5488eb9 999 FCOE_DBG("CPU %x offline: Remove Rx thread\n", cpu);
8976f424
RL
1000 fcoe_percpu_thread_destroy(cpu);
1001 break;
1002 default:
1003 break;
1004 }
1005 return NOTIFY_OK;
1006}
1007
1008static struct notifier_block fcoe_cpu_notifier = {
1009 .notifier_call = fcoe_cpu_callback,
1010};
1011
85b4aa49 1012/**
34f42a07 1013 * fcoe_rcv() - this is the fcoe receive function called by NET_RX_SOFTIRQ
85b4aa49
RL
1014 * @skb: the receive skb
1015 * @dev: associated net device
1016 * @ptype: context
dd3fd72e 1017 * @olddev: last device
85b4aa49
RL
1018 *
1019 * this function will receive the packet and build fc frame and pass it up
1020 *
1021 * Returns: 0 for success
34f42a07 1022 */
85b4aa49
RL
1023int fcoe_rcv(struct sk_buff *skb, struct net_device *dev,
1024 struct packet_type *ptype, struct net_device *olddev)
1025{
1026 struct fc_lport *lp;
1027 struct fcoe_rcv_info *fr;
259ad85d 1028 struct fcoe_interface *fcoe;
85b4aa49 1029 struct fc_frame_header *fh;
85b4aa49 1030 struct fcoe_percpu_s *fps;
b2f0091f 1031 unsigned int cpu;
85b4aa49 1032
259ad85d 1033 fcoe = container_of(ptype, struct fcoe_interface, fcoe_packet_type);
3fe9a0ba 1034 lp = fcoe->ctlr.lp;
85b4aa49 1035 if (unlikely(lp == NULL)) {
d5488eb9 1036 FCOE_NETDEV_DBG(dev, "Cannot find hba structure");
85b4aa49
RL
1037 goto err2;
1038 }
97c8389d
JE
1039 if (!lp->link_up)
1040 goto err2;
85b4aa49 1041
d5488eb9
RL
1042 FCOE_NETDEV_DBG(dev, "skb_info: len:%d data_len:%d head:%p "
1043 "data:%p tail:%p end:%p sum:%d dev:%s",
1044 skb->len, skb->data_len, skb->head, skb->data,
1045 skb_tail_pointer(skb), skb_end_pointer(skb),
1046 skb->csum, skb->dev ? skb->dev->name : "<NULL>");
85b4aa49
RL
1047
1048 /* check for FCOE packet type */
1049 if (unlikely(eth_hdr(skb)->h_proto != htons(ETH_P_FCOE))) {
d5488eb9 1050 FCOE_NETDEV_DBG(dev, "Wrong FC type frame");
85b4aa49
RL
1051 goto err;
1052 }
1053
1054 /*
1055 * Check for minimum frame length, and make sure required FCoE
1056 * and FC headers are pulled into the linear data area.
1057 */
1058 if (unlikely((skb->len < FCOE_MIN_FRAME) ||
1059 !pskb_may_pull(skb, FCOE_HEADER_LEN)))
1060 goto err;
1061
1062 skb_set_transport_header(skb, sizeof(struct fcoe_hdr));
1063 fh = (struct fc_frame_header *) skb_transport_header(skb);
1064
85b4aa49
RL
1065 fr = fcoe_dev_from_skb(skb);
1066 fr->fr_dev = lp;
1067 fr->ptype = ptype;
5e5e92df 1068
85b4aa49 1069 /*
b2f0091f
VD
1070 * In case the incoming frame's exchange is originated from
1071 * the initiator, then received frame's exchange id is ANDed
1072 * with fc_cpu_mask bits to get the same cpu on which exchange
1073 * was originated, otherwise just use the current cpu.
85b4aa49 1074 */
b2f0091f
VD
1075 if (ntoh24(fh->fh_f_ctl) & FC_FC_EX_CTX)
1076 cpu = ntohs(fh->fh_ox_id) & fc_cpu_mask;
1077 else
1078 cpu = smp_processor_id();
5e5e92df 1079
8976f424 1080 fps = &per_cpu(fcoe_percpu, cpu);
85b4aa49 1081 spin_lock_bh(&fps->fcoe_rx_list.lock);
8976f424
RL
1082 if (unlikely(!fps->thread)) {
1083 /*
1084 * The targeted CPU is not ready, let's target
1085 * the first CPU now. For non-SMP systems this
1086 * will check the same CPU twice.
1087 */
d5488eb9
RL
1088 FCOE_NETDEV_DBG(dev, "CPU is online, but no receive thread "
1089 "ready for incoming skb- using first online "
1090 "CPU.\n");
8976f424
RL
1091
1092 spin_unlock_bh(&fps->fcoe_rx_list.lock);
1093 cpu = first_cpu(cpu_online_map);
1094 fps = &per_cpu(fcoe_percpu, cpu);
1095 spin_lock_bh(&fps->fcoe_rx_list.lock);
1096 if (!fps->thread) {
1097 spin_unlock_bh(&fps->fcoe_rx_list.lock);
1098 goto err;
1099 }
1100 }
1101
1102 /*
1103 * We now have a valid CPU that we're targeting for
1104 * this skb. We also have this receive thread locked,
1105 * so we're free to queue skbs into it's queue.
1106 */
85b4aa49
RL
1107 __skb_queue_tail(&fps->fcoe_rx_list, skb);
1108 if (fps->fcoe_rx_list.qlen == 1)
1109 wake_up_process(fps->thread);
1110
1111 spin_unlock_bh(&fps->fcoe_rx_list.lock);
1112
1113 return 0;
1114err:
582b45bc 1115 fc_lport_get_stats(lp)->ErrorFrames++;
85b4aa49
RL
1116
1117err2:
1118 kfree_skb(skb);
1119 return -1;
1120}
85b4aa49
RL
1121
1122/**
34f42a07 1123 * fcoe_start_io() - pass to netdev to start xmit for fcoe
85b4aa49
RL
1124 * @skb: the skb to be xmitted
1125 *
1126 * Returns: 0 for success
34f42a07 1127 */
85b4aa49
RL
1128static inline int fcoe_start_io(struct sk_buff *skb)
1129{
1130 int rc;
1131
1132 skb_get(skb);
1133 rc = dev_queue_xmit(skb);
1134 if (rc != 0)
1135 return rc;
1136 kfree_skb(skb);
1137 return 0;
1138}
1139
1140/**
dd3fd72e 1141 * fcoe_get_paged_crc_eof() - in case we need to alloc a page for crc_eof
85b4aa49
RL
1142 * @skb: the skb to be xmitted
1143 * @tlen: total len
1144 *
1145 * Returns: 0 for success
34f42a07 1146 */
85b4aa49
RL
1147static int fcoe_get_paged_crc_eof(struct sk_buff *skb, int tlen)
1148{
1149 struct fcoe_percpu_s *fps;
1150 struct page *page;
85b4aa49 1151
5e5e92df 1152 fps = &get_cpu_var(fcoe_percpu);
85b4aa49
RL
1153 page = fps->crc_eof_page;
1154 if (!page) {
1155 page = alloc_page(GFP_ATOMIC);
1156 if (!page) {
5e5e92df 1157 put_cpu_var(fcoe_percpu);
85b4aa49
RL
1158 return -ENOMEM;
1159 }
1160 fps->crc_eof_page = page;
8976f424 1161 fps->crc_eof_offset = 0;
85b4aa49
RL
1162 }
1163
1164 get_page(page);
1165 skb_fill_page_desc(skb, skb_shinfo(skb)->nr_frags, page,
1166 fps->crc_eof_offset, tlen);
1167 skb->len += tlen;
1168 skb->data_len += tlen;
1169 skb->truesize += tlen;
1170 fps->crc_eof_offset += sizeof(struct fcoe_crc_eof);
1171
1172 if (fps->crc_eof_offset >= PAGE_SIZE) {
1173 fps->crc_eof_page = NULL;
1174 fps->crc_eof_offset = 0;
1175 put_page(page);
1176 }
5e5e92df 1177 put_cpu_var(fcoe_percpu);
85b4aa49
RL
1178 return 0;
1179}
1180
1181/**
34f42a07 1182 * fcoe_fc_crc() - calculates FC CRC in this fcoe skb
dd3fd72e 1183 * @fp: the fc_frame containing data to be checksummed
85b4aa49 1184 *
014f5c3f 1185 * This uses crc32() to calculate the crc for port frame
85b4aa49 1186 * Return : 32 bit crc
34f42a07 1187 */
85b4aa49
RL
1188u32 fcoe_fc_crc(struct fc_frame *fp)
1189{
1190 struct sk_buff *skb = fp_skb(fp);
1191 struct skb_frag_struct *frag;
1192 unsigned char *data;
1193 unsigned long off, len, clen;
1194 u32 crc;
1195 unsigned i;
1196
1197 crc = crc32(~0, skb->data, skb_headlen(skb));
1198
1199 for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
1200 frag = &skb_shinfo(skb)->frags[i];
1201 off = frag->page_offset;
1202 len = frag->size;
1203 while (len > 0) {
1204 clen = min(len, PAGE_SIZE - (off & ~PAGE_MASK));
1205 data = kmap_atomic(frag->page + (off >> PAGE_SHIFT),
1206 KM_SKB_DATA_SOFTIRQ);
1207 crc = crc32(crc, data + (off & ~PAGE_MASK), clen);
1208 kunmap_atomic(data, KM_SKB_DATA_SOFTIRQ);
1209 off += clen;
1210 len -= clen;
1211 }
1212 }
1213 return crc;
1214}
85b4aa49
RL
1215
1216/**
34f42a07 1217 * fcoe_xmit() - FCoE frame transmit function
014f5c3f 1218 * @lp: the associated local fcoe
85b4aa49
RL
1219 * @fp: the fc_frame to be transmitted
1220 *
1221 * Return : 0 for success
34f42a07 1222 */
85b4aa49
RL
1223int fcoe_xmit(struct fc_lport *lp, struct fc_frame *fp)
1224{
4bb6b515 1225 int wlen;
85b4aa49
RL
1226 u32 crc;
1227 struct ethhdr *eh;
1228 struct fcoe_crc_eof *cp;
1229 struct sk_buff *skb;
1230 struct fcoe_dev_stats *stats;
1231 struct fc_frame_header *fh;
1232 unsigned int hlen; /* header length implies the version */
1233 unsigned int tlen; /* trailer length */
1234 unsigned int elen; /* eth header, may include vlan */
3fe9a0ba
CL
1235 struct fcoe_port *port = lport_priv(lp);
1236 struct fcoe_interface *fcoe = port->fcoe;
85b4aa49
RL
1237 u8 sof, eof;
1238 struct fcoe_hdr *hp;
1239
1240 WARN_ON((fr_len(fp) % sizeof(u32)) != 0);
1241
85b4aa49 1242 fh = fc_frame_header_get(fp);
97c8389d
JE
1243 skb = fp_skb(fp);
1244 wlen = skb->len / FCOE_WORD_TO_BYTE;
1245
1246 if (!lp->link_up) {
3caf02ee 1247 kfree_skb(skb);
97c8389d 1248 return 0;
85b4aa49
RL
1249 }
1250
97c8389d 1251 if (unlikely(fh->fh_r_ctl == FC_RCTL_ELS_REQ) &&
11b56188 1252 fcoe_ctlr_els_send(&fcoe->ctlr, lp, skb))
97c8389d
JE
1253 return 0;
1254
85b4aa49
RL
1255 sof = fr_sof(fp);
1256 eof = fr_eof(fp);
1257
4e57e1cb 1258 elen = sizeof(struct ethhdr);
85b4aa49
RL
1259 hlen = sizeof(struct fcoe_hdr);
1260 tlen = sizeof(struct fcoe_crc_eof);
1261 wlen = (skb->len - tlen + sizeof(crc)) / FCOE_WORD_TO_BYTE;
1262
1263 /* crc offload */
1264 if (likely(lp->crc_offload)) {
39ca9a06 1265 skb->ip_summed = CHECKSUM_PARTIAL;
85b4aa49
RL
1266 skb->csum_start = skb_headroom(skb);
1267 skb->csum_offset = skb->len;
1268 crc = 0;
1269 } else {
1270 skb->ip_summed = CHECKSUM_NONE;
1271 crc = fcoe_fc_crc(fp);
1272 }
1273
014f5c3f 1274 /* copy port crc and eof to the skb buff */
85b4aa49
RL
1275 if (skb_is_nonlinear(skb)) {
1276 skb_frag_t *frag;
1277 if (fcoe_get_paged_crc_eof(skb, tlen)) {
e9041581 1278 kfree_skb(skb);
85b4aa49
RL
1279 return -ENOMEM;
1280 }
1281 frag = &skb_shinfo(skb)->frags[skb_shinfo(skb)->nr_frags - 1];
1282 cp = kmap_atomic(frag->page, KM_SKB_DATA_SOFTIRQ)
1283 + frag->page_offset;
1284 } else {
1285 cp = (struct fcoe_crc_eof *)skb_put(skb, tlen);
1286 }
1287
1288 memset(cp, 0, sizeof(*cp));
1289 cp->fcoe_eof = eof;
1290 cp->fcoe_crc32 = cpu_to_le32(~crc);
1291
1292 if (skb_is_nonlinear(skb)) {
1293 kunmap_atomic(cp, KM_SKB_DATA_SOFTIRQ);
1294 cp = NULL;
1295 }
1296
014f5c3f 1297 /* adjust skb network/transport offsets to match mac/fcoe/port */
85b4aa49
RL
1298 skb_push(skb, elen + hlen);
1299 skb_reset_mac_header(skb);
1300 skb_reset_network_header(skb);
1301 skb->mac_len = elen;
211c738d 1302 skb->protocol = htons(ETH_P_FCOE);
3fe9a0ba 1303 skb->dev = fcoe->netdev;
85b4aa49
RL
1304
1305 /* fill up mac and fcoe headers */
1306 eh = eth_hdr(skb);
1307 eh->h_proto = htons(ETH_P_FCOE);
3fe9a0ba 1308 if (fcoe->ctlr.map_dest)
85b4aa49
RL
1309 fc_fcoe_set_mac(eh->h_dest, fh->fh_d_id);
1310 else
1311 /* insert GW address */
3fe9a0ba 1312 memcpy(eh->h_dest, fcoe->ctlr.dest_addr, ETH_ALEN);
85b4aa49 1313
3fe9a0ba
CL
1314 if (unlikely(fcoe->ctlr.flogi_oxid != FC_XID_UNKNOWN))
1315 memcpy(eh->h_source, fcoe->ctlr.ctl_src_addr, ETH_ALEN);
85b4aa49 1316 else
11b56188 1317 memcpy(eh->h_source, port->data_src_addr, ETH_ALEN);
85b4aa49
RL
1318
1319 hp = (struct fcoe_hdr *)(eh + 1);
1320 memset(hp, 0, sizeof(*hp));
1321 if (FC_FCOE_VER)
1322 FC_FCOE_ENCAPS_VER(hp, FC_FCOE_VER);
1323 hp->fcoe_sof = sof;
1324
39ca9a06
YZ
1325 /* fcoe lso, mss is in max_payload which is non-zero for FCP data */
1326 if (lp->seq_offload && fr_max_payload(fp)) {
1327 skb_shinfo(skb)->gso_type = SKB_GSO_FCOE;
1328 skb_shinfo(skb)->gso_size = fr_max_payload(fp);
1329 } else {
1330 skb_shinfo(skb)->gso_type = 0;
1331 skb_shinfo(skb)->gso_size = 0;
1332 }
85b4aa49 1333 /* update tx stats: regardless if LLD fails */
582b45bc
RL
1334 stats = fc_lport_get_stats(lp);
1335 stats->TxFrames++;
1336 stats->TxWords += wlen;
85b4aa49
RL
1337
1338 /* send down to lld */
1339 fr_dev(fp) = lp;
014f5c3f 1340 if (port->fcoe_pending_queue.qlen)
4bb6b515
VD
1341 fcoe_check_wait_queue(lp, skb);
1342 else if (fcoe_start_io(skb))
1343 fcoe_check_wait_queue(lp, skb);
85b4aa49
RL
1344
1345 return 0;
1346}
85b4aa49 1347
e7a51997
JE
1348/**
1349 * fcoe_percpu_flush_done() - Indicate percpu queue flush completion.
1350 * @skb: the skb being completed.
1351 */
1352static void fcoe_percpu_flush_done(struct sk_buff *skb)
1353{
1354 complete(&fcoe_flush_completion);
1355}
1356
34f42a07
RL
1357/**
1358 * fcoe_percpu_receive_thread() - recv thread per cpu
85b4aa49
RL
1359 * @arg: ptr to the fcoe per cpu struct
1360 *
1361 * Return: 0 for success
85b4aa49
RL
1362 */
1363int fcoe_percpu_receive_thread(void *arg)
1364{
1365 struct fcoe_percpu_s *p = arg;
1366 u32 fr_len;
1367 struct fc_lport *lp;
1368 struct fcoe_rcv_info *fr;
1369 struct fcoe_dev_stats *stats;
1370 struct fc_frame_header *fh;
1371 struct sk_buff *skb;
1372 struct fcoe_crc_eof crc_eof;
1373 struct fc_frame *fp;
1374 u8 *mac = NULL;
014f5c3f 1375 struct fcoe_port *port;
85b4aa49
RL
1376 struct fcoe_hdr *hp;
1377
4469c195 1378 set_user_nice(current, -20);
85b4aa49
RL
1379
1380 while (!kthread_should_stop()) {
1381
1382 spin_lock_bh(&p->fcoe_rx_list.lock);
1383 while ((skb = __skb_dequeue(&p->fcoe_rx_list)) == NULL) {
1384 set_current_state(TASK_INTERRUPTIBLE);
1385 spin_unlock_bh(&p->fcoe_rx_list.lock);
1386 schedule();
1387 set_current_state(TASK_RUNNING);
1388 if (kthread_should_stop())
1389 return 0;
1390 spin_lock_bh(&p->fcoe_rx_list.lock);
1391 }
1392 spin_unlock_bh(&p->fcoe_rx_list.lock);
1393 fr = fcoe_dev_from_skb(skb);
1394 lp = fr->fr_dev;
1395 if (unlikely(lp == NULL)) {
e7a51997
JE
1396 if (skb->destructor != fcoe_percpu_flush_done)
1397 FCOE_NETDEV_DBG(skb->dev, "NULL lport in skb");
85b4aa49
RL
1398 kfree_skb(skb);
1399 continue;
1400 }
1401
d5488eb9
RL
1402 FCOE_NETDEV_DBG(skb->dev, "skb_info: len:%d data_len:%d "
1403 "head:%p data:%p tail:%p end:%p sum:%d dev:%s",
1404 skb->len, skb->data_len,
1405 skb->head, skb->data, skb_tail_pointer(skb),
1406 skb_end_pointer(skb), skb->csum,
1407 skb->dev ? skb->dev->name : "<NULL>");
85b4aa49
RL
1408
1409 /*
1410 * Save source MAC address before discarding header.
1411 */
014f5c3f 1412 port = lport_priv(lp);
85b4aa49
RL
1413 if (skb_is_nonlinear(skb))
1414 skb_linearize(skb); /* not ideal */
97c8389d 1415 mac = eth_hdr(skb)->h_source;
85b4aa49
RL
1416
1417 /*
1418 * Frame length checks and setting up the header pointers
1419 * was done in fcoe_rcv already.
1420 */
1421 hp = (struct fcoe_hdr *) skb_network_header(skb);
1422 fh = (struct fc_frame_header *) skb_transport_header(skb);
1423
582b45bc 1424 stats = fc_lport_get_stats(lp);
85b4aa49 1425 if (unlikely(FC_FCOE_DECAPS_VER(hp) != FC_FCOE_VER)) {
582b45bc 1426 if (stats->ErrorFrames < 5)
d5488eb9 1427 printk(KERN_WARNING "fcoe: FCoE version "
582b45bc
RL
1428 "mismatch: The frame has "
1429 "version %x, but the "
1430 "initiator supports version "
1431 "%x\n", FC_FCOE_DECAPS_VER(hp),
1432 FC_FCOE_VER);
1433 stats->ErrorFrames++;
85b4aa49
RL
1434 kfree_skb(skb);
1435 continue;
1436 }
1437
1438 skb_pull(skb, sizeof(struct fcoe_hdr));
1439 fr_len = skb->len - sizeof(struct fcoe_crc_eof);
1440
582b45bc
RL
1441 stats->RxFrames++;
1442 stats->RxWords += fr_len / FCOE_WORD_TO_BYTE;
85b4aa49
RL
1443
1444 fp = (struct fc_frame *)skb;
1445 fc_frame_init(fp);
1446 fr_dev(fp) = lp;
1447 fr_sof(fp) = hp->fcoe_sof;
1448
1449 /* Copy out the CRC and EOF trailer for access */
1450 if (skb_copy_bits(skb, fr_len, &crc_eof, sizeof(crc_eof))) {
1451 kfree_skb(skb);
1452 continue;
1453 }
1454 fr_eof(fp) = crc_eof.fcoe_eof;
1455 fr_crc(fp) = crc_eof.fcoe_crc32;
1456 if (pskb_trim(skb, fr_len)) {
1457 kfree_skb(skb);
1458 continue;
1459 }
1460
1461 /*
1462 * We only check CRC if no offload is available and if it is
1463 * it's solicited data, in which case, the FCP layer would
1464 * check it during the copy.
1465 */
07c00ec4 1466 if (lp->crc_offload && skb->ip_summed == CHECKSUM_UNNECESSARY)
85b4aa49
RL
1467 fr_flags(fp) &= ~FCPHF_CRC_UNCHECKED;
1468 else
1469 fr_flags(fp) |= FCPHF_CRC_UNCHECKED;
1470
1471 fh = fc_frame_header_get(fp);
1472 if (fh->fh_r_ctl == FC_RCTL_DD_SOL_DATA &&
1473 fh->fh_type == FC_TYPE_FCP) {
52ff878c 1474 fc_exch_recv(lp, fp);
85b4aa49
RL
1475 continue;
1476 }
1477 if (fr_flags(fp) & FCPHF_CRC_UNCHECKED) {
1478 if (le32_to_cpu(fr_crc(fp)) !=
1479 ~crc32(~0, skb->data, fr_len)) {
d5488eb9 1480 if (stats->InvalidCRCCount < 5)
85b4aa49
RL
1481 printk(KERN_WARNING "fcoe: dropping "
1482 "frame with CRC error\n");
1483 stats->InvalidCRCCount++;
1484 stats->ErrorFrames++;
1485 fc_frame_free(fp);
1486 continue;
1487 }
1488 fr_flags(fp) &= ~FCPHF_CRC_UNCHECKED;
1489 }
52ff878c 1490 fc_exch_recv(lp, fp);
85b4aa49
RL
1491 }
1492 return 0;
1493}
1494
85b4aa49 1495/**
dd3fd72e
CL
1496 * fcoe_check_wait_queue() - attempt to clear the transmit backlog
1497 * @lp: the fc_lport
85b4aa49
RL
1498 *
1499 * This empties the wait_queue, dequeue the head of the wait_queue queue
1500 * and calls fcoe_start_io() for each packet, if all skb have been
c826a314 1501 * transmitted, return qlen or -1 if a error occurs, then restore
dd3fd72e 1502 * wait_queue and try again later.
85b4aa49
RL
1503 *
1504 * The wait_queue is used when the skb transmit fails. skb will go
dd3fd72e 1505 * in the wait_queue which will be emptied by the timer function or
85b4aa49 1506 * by the next skb transmit.
34f42a07 1507 */
4bb6b515 1508static void fcoe_check_wait_queue(struct fc_lport *lp, struct sk_buff *skb)
85b4aa49 1509{
014f5c3f 1510 struct fcoe_port *port = lport_priv(lp);
4bb6b515 1511 int rc;
85b4aa49 1512
014f5c3f 1513 spin_lock_bh(&port->fcoe_pending_queue.lock);
4bb6b515
VD
1514
1515 if (skb)
014f5c3f 1516 __skb_queue_tail(&port->fcoe_pending_queue, skb);
4bb6b515 1517
014f5c3f 1518 if (port->fcoe_pending_queue_active)
c826a314 1519 goto out;
014f5c3f 1520 port->fcoe_pending_queue_active = 1;
55c8bafb 1521
014f5c3f 1522 while (port->fcoe_pending_queue.qlen) {
55c8bafb 1523 /* keep qlen > 0 until fcoe_start_io succeeds */
014f5c3f
CL
1524 port->fcoe_pending_queue.qlen++;
1525 skb = __skb_dequeue(&port->fcoe_pending_queue);
55c8bafb 1526
014f5c3f 1527 spin_unlock_bh(&port->fcoe_pending_queue.lock);
55c8bafb 1528 rc = fcoe_start_io(skb);
014f5c3f 1529 spin_lock_bh(&port->fcoe_pending_queue.lock);
55c8bafb
CL
1530
1531 if (rc) {
014f5c3f 1532 __skb_queue_head(&port->fcoe_pending_queue, skb);
55c8bafb 1533 /* undo temporary increment above */
014f5c3f 1534 port->fcoe_pending_queue.qlen--;
55c8bafb 1535 break;
85b4aa49 1536 }
55c8bafb 1537 /* undo temporary increment above */
014f5c3f 1538 port->fcoe_pending_queue.qlen--;
85b4aa49 1539 }
55c8bafb 1540
014f5c3f 1541 if (port->fcoe_pending_queue.qlen < FCOE_LOW_QUEUE_DEPTH)
55c8bafb 1542 lp->qfull = 0;
014f5c3f
CL
1543 if (port->fcoe_pending_queue.qlen && !timer_pending(&port->timer))
1544 mod_timer(&port->timer, jiffies + 2);
1545 port->fcoe_pending_queue_active = 0;
c826a314 1546out:
014f5c3f 1547 if (port->fcoe_pending_queue.qlen > FCOE_MAX_QUEUE_DEPTH)
4bb6b515 1548 lp->qfull = 1;
014f5c3f 1549 spin_unlock_bh(&port->fcoe_pending_queue.lock);
4bb6b515 1550 return;
85b4aa49
RL
1551}
1552
85b4aa49 1553/**
34f42a07
RL
1554 * fcoe_dev_setup() - setup link change notification interface
1555 */
b0d428ad 1556static void fcoe_dev_setup(void)
85b4aa49 1557{
85b4aa49
RL
1558 register_netdevice_notifier(&fcoe_notifier);
1559}
1560
1561/**
b0d428ad 1562 * fcoe_dev_cleanup() - cleanup link change notification interface
34f42a07 1563 */
85b4aa49
RL
1564static void fcoe_dev_cleanup(void)
1565{
1566 unregister_netdevice_notifier(&fcoe_notifier);
1567}
1568
1569/**
34f42a07 1570 * fcoe_device_notification() - netdev event notification callback
85b4aa49
RL
1571 * @notifier: context of the notification
1572 * @event: type of event
1573 * @ptr: fixed array for output parsed ifname
1574 *
1575 * This function is called by the ethernet driver in case of link change event
1576 *
1577 * Returns: 0 for success
34f42a07 1578 */
85b4aa49
RL
1579static int fcoe_device_notification(struct notifier_block *notifier,
1580 ulong event, void *ptr)
1581{
1582 struct fc_lport *lp = NULL;
1d1b88dc 1583 struct net_device *netdev = ptr;
014f5c3f 1584 struct fcoe_interface *fcoe;
2e70e241 1585 struct fcoe_port *port;
85b4aa49 1586 struct fcoe_dev_stats *stats;
97c8389d 1587 u32 link_possible = 1;
85b4aa49
RL
1588 u32 mfs;
1589 int rc = NOTIFY_OK;
1590
014f5c3f 1591 list_for_each_entry(fcoe, &fcoe_hostlist, list) {
25024989 1592 if (fcoe->netdev == netdev) {
3fe9a0ba 1593 lp = fcoe->ctlr.lp;
85b4aa49
RL
1594 break;
1595 }
1596 }
85b4aa49
RL
1597 if (lp == NULL) {
1598 rc = NOTIFY_DONE;
1599 goto out;
1600 }
1601
85b4aa49
RL
1602 switch (event) {
1603 case NETDEV_DOWN:
1604 case NETDEV_GOING_DOWN:
97c8389d 1605 link_possible = 0;
85b4aa49
RL
1606 break;
1607 case NETDEV_UP:
1608 case NETDEV_CHANGE:
85b4aa49
RL
1609 break;
1610 case NETDEV_CHANGEMTU:
7221d7e5
YZ
1611 if (netdev->features & NETIF_F_FCOE_MTU)
1612 break;
1d1b88dc
VD
1613 mfs = netdev->mtu - (sizeof(struct fcoe_hdr) +
1614 sizeof(struct fcoe_crc_eof));
85b4aa49
RL
1615 if (mfs >= FC_MIN_MAX_FRAME)
1616 fc_set_mfs(lp, mfs);
85b4aa49
RL
1617 break;
1618 case NETDEV_REGISTER:
1619 break;
2e70e241
CL
1620 case NETDEV_UNREGISTER:
1621 list_del(&fcoe->list);
1622 port = lport_priv(fcoe->ctlr.lp);
1623 fcoe_interface_cleanup(fcoe);
1624 schedule_work(&port->destroy_work);
1625 goto out;
1626 break;
85b4aa49 1627 default:
1d1b88dc 1628 FCOE_NETDEV_DBG(netdev, "Unknown event %ld "
d5488eb9 1629 "from netdev netlink\n", event);
85b4aa49 1630 }
97c8389d 1631 if (link_possible && !fcoe_link_ok(lp))
3fe9a0ba
CL
1632 fcoe_ctlr_link_up(&fcoe->ctlr);
1633 else if (fcoe_ctlr_link_down(&fcoe->ctlr)) {
97c8389d
JE
1634 stats = fc_lport_get_stats(lp);
1635 stats->LinkFailureCount++;
1636 fcoe_clean_pending_queue(lp);
85b4aa49
RL
1637 }
1638out:
1639 return rc;
1640}
1641
1642/**
34f42a07 1643 * fcoe_if_to_netdev() - parse a name buffer to get netdev
85b4aa49
RL
1644 * @buffer: incoming buffer to be copied
1645 *
dd3fd72e 1646 * Returns: NULL or ptr to net_device
34f42a07 1647 */
85b4aa49
RL
1648static struct net_device *fcoe_if_to_netdev(const char *buffer)
1649{
1650 char *cp;
1651 char ifname[IFNAMSIZ + 2];
1652
1653 if (buffer) {
1654 strlcpy(ifname, buffer, IFNAMSIZ);
1655 cp = ifname + strlen(ifname);
1656 while (--cp >= ifname && *cp == '\n')
1657 *cp = '\0';
1658 return dev_get_by_name(&init_net, ifname);
1659 }
1660 return NULL;
1661}
1662
85b4aa49 1663/**
34f42a07 1664 * fcoe_destroy() - handles the destroy from sysfs
dd3fd72e 1665 * @buffer: expected to be an eth if name
85b4aa49
RL
1666 * @kp: associated kernel param
1667 *
1668 * Returns: 0 for success
34f42a07 1669 */
85b4aa49
RL
1670static int fcoe_destroy(const char *buffer, struct kernel_param *kp)
1671{
030f4e00 1672 struct fcoe_interface *fcoe;
2e70e241 1673 struct net_device *netdev;
8eca355f 1674 int rc = 0;
85b4aa49 1675
dfc1d0fe
CL
1676 mutex_lock(&fcoe_config_mutex);
1677#ifdef CONFIG_FCOE_MODULE
1678 /*
1679 * Make sure the module has been initialized, and is not about to be
1680 * removed. Module paramter sysfs files are writable before the
1681 * module_init function is called and after module_exit.
1682 */
1683 if (THIS_MODULE->state != MODULE_STATE_LIVE) {
1684 rc = -ENODEV;
1685 goto out_nodev;
1686 }
1687#endif
1688
85b4aa49
RL
1689 netdev = fcoe_if_to_netdev(buffer);
1690 if (!netdev) {
1691 rc = -ENODEV;
1692 goto out_nodev;
1693 }
2e70e241 1694
090eb6c4 1695 rtnl_lock();
2e70e241
CL
1696 fcoe = fcoe_hostlist_lookup_port(netdev);
1697 if (!fcoe) {
090eb6c4 1698 rtnl_unlock();
85b4aa49
RL
1699 rc = -ENODEV;
1700 goto out_putdev;
1701 }
2e70e241 1702 list_del(&fcoe->list);
2e70e241
CL
1703 fcoe_interface_cleanup(fcoe);
1704 rtnl_unlock();
1705 fcoe_if_destroy(fcoe->ctlr.lp);
85b4aa49
RL
1706out_putdev:
1707 dev_put(netdev);
1708out_nodev:
dfc1d0fe 1709 mutex_unlock(&fcoe_config_mutex);
85b4aa49
RL
1710 return rc;
1711}
1712
2e70e241
CL
1713static void fcoe_destroy_work(struct work_struct *work)
1714{
1715 struct fcoe_port *port;
1716
1717 port = container_of(work, struct fcoe_port, destroy_work);
1718 mutex_lock(&fcoe_config_mutex);
1719 fcoe_if_destroy(port->lport);
1720 mutex_unlock(&fcoe_config_mutex);
1721}
1722
85b4aa49 1723/**
34f42a07 1724 * fcoe_create() - Handles the create call from sysfs
dd3fd72e 1725 * @buffer: expected to be an eth if name
85b4aa49
RL
1726 * @kp: associated kernel param
1727 *
1728 * Returns: 0 for success
34f42a07 1729 */
85b4aa49
RL
1730static int fcoe_create(const char *buffer, struct kernel_param *kp)
1731{
1732 int rc;
030f4e00 1733 struct fcoe_interface *fcoe;
af7f85d9 1734 struct fc_lport *lport;
85b4aa49
RL
1735 struct net_device *netdev;
1736
dfc1d0fe
CL
1737 mutex_lock(&fcoe_config_mutex);
1738#ifdef CONFIG_FCOE_MODULE
1739 /*
1740 * Make sure the module has been initialized, and is not about to be
1741 * removed. Module paramter sysfs files are writable before the
1742 * module_init function is called and after module_exit.
1743 */
1744 if (THIS_MODULE->state != MODULE_STATE_LIVE) {
1745 rc = -ENODEV;
1746 goto out_nodev;
1747 }
1748#endif
1749
2e70e241 1750 rtnl_lock();
85b4aa49
RL
1751 netdev = fcoe_if_to_netdev(buffer);
1752 if (!netdev) {
1753 rc = -ENODEV;
1754 goto out_nodev;
1755 }
2e70e241 1756
85b4aa49
RL
1757 /* look for existing lport */
1758 if (fcoe_hostlist_lookup(netdev)) {
1759 rc = -EEXIST;
1760 goto out_putdev;
1761 }
85b4aa49 1762
030f4e00
CL
1763 fcoe = fcoe_interface_create(netdev);
1764 if (!fcoe) {
1765 rc = -ENOMEM;
1766 goto out_putdev;
1767 }
1768
1769 lport = fcoe_if_create(fcoe, &netdev->dev);
af7f85d9 1770 if (IS_ERR(lport)) {
d5488eb9 1771 printk(KERN_ERR "fcoe: Failed to create interface (%s)\n",
85b4aa49 1772 netdev->name);
85b4aa49 1773 rc = -EIO;
2e70e241 1774 fcoe_interface_cleanup(fcoe);
030f4e00 1775 goto out_free;
85b4aa49 1776 }
030f4e00 1777
54b649f8
CL
1778 /* Make this the "master" N_Port */
1779 fcoe->ctlr.lp = lport;
1780
c863df33
CL
1781 /* add to lports list */
1782 fcoe_hostlist_add(lport);
1783
54b649f8
CL
1784 /* start FIP Discovery and FLOGI */
1785 lport->boot_time = jiffies;
1786 fc_fabric_login(lport);
1787 if (!fcoe_link_ok(lport))
1788 fcoe_ctlr_link_up(&fcoe->ctlr);
030f4e00 1789
54b649f8 1790 rc = 0;
030f4e00 1791out_free:
54b649f8
CL
1792 /*
1793 * Release from init in fcoe_interface_create(), on success lport
1794 * should be holding a reference taken in fcoe_if_create().
1795 */
030f4e00 1796 fcoe_interface_put(fcoe);
85b4aa49
RL
1797out_putdev:
1798 dev_put(netdev);
1799out_nodev:
2e70e241 1800 rtnl_unlock();
dfc1d0fe 1801 mutex_unlock(&fcoe_config_mutex);
85b4aa49
RL
1802 return rc;
1803}
1804
1805module_param_call(create, fcoe_create, NULL, NULL, S_IWUSR);
1806__MODULE_PARM_TYPE(create, "string");
014f5c3f 1807MODULE_PARM_DESC(create, "Create fcoe fcoe using net device passed in.");
85b4aa49
RL
1808module_param_call(destroy, fcoe_destroy, NULL, NULL, S_IWUSR);
1809__MODULE_PARM_TYPE(destroy, "string");
014f5c3f 1810MODULE_PARM_DESC(destroy, "Destroy fcoe fcoe");
85b4aa49 1811
34f42a07
RL
1812/**
1813 * fcoe_link_ok() - Check if link is ok for the fc_lport
85b4aa49
RL
1814 * @lp: ptr to the fc_lport
1815 *
1816 * Any permanently-disqualifying conditions have been previously checked.
1817 * This also updates the speed setting, which may change with link for 100/1000.
1818 *
1819 * This function should probably be checking for PAUSE support at some point
1820 * in the future. Currently Per-priority-pause is not determinable using
1821 * ethtool, so we shouldn't be restrictive until that problem is resolved.
1822 *
1823 * Returns: 0 if link is OK for use by FCoE.
1824 *
1825 */
1826int fcoe_link_ok(struct fc_lport *lp)
1827{
014f5c3f 1828 struct fcoe_port *port = lport_priv(lp);
25024989 1829 struct net_device *dev = port->fcoe->netdev;
85b4aa49 1830 struct ethtool_cmd ecmd = { ETHTOOL_GSET };
85b4aa49 1831
2f718d64
YZ
1832 if ((dev->flags & IFF_UP) && netif_carrier_ok(dev) &&
1833 (!dev_ethtool_get_settings(dev, &ecmd))) {
1834 lp->link_supported_speeds &=
1835 ~(FC_PORTSPEED_1GBIT | FC_PORTSPEED_10GBIT);
1836 if (ecmd.supported & (SUPPORTED_1000baseT_Half |
1837 SUPPORTED_1000baseT_Full))
1838 lp->link_supported_speeds |= FC_PORTSPEED_1GBIT;
1839 if (ecmd.supported & SUPPORTED_10000baseT_Full)
1840 lp->link_supported_speeds |=
1841 FC_PORTSPEED_10GBIT;
1842 if (ecmd.speed == SPEED_1000)
1843 lp->link_speed = FC_PORTSPEED_1GBIT;
1844 if (ecmd.speed == SPEED_10000)
1845 lp->link_speed = FC_PORTSPEED_10GBIT;
85b4aa49 1846
2f718d64
YZ
1847 return 0;
1848 }
1849 return -1;
85b4aa49 1850}
85b4aa49 1851
34f42a07
RL
1852/**
1853 * fcoe_percpu_clean() - Clear the pending skbs for an lport
85b4aa49 1854 * @lp: the fc_lport
e7a51997
JE
1855 *
1856 * Must be called with fcoe_create_mutex held to single-thread completion.
1857 *
1858 * This flushes the pending skbs by adding a new skb to each queue and
1859 * waiting until they are all freed. This assures us that not only are
1860 * there no packets that will be handled by the lport, but also that any
1861 * threads already handling packet have returned.
85b4aa49
RL
1862 */
1863void fcoe_percpu_clean(struct fc_lport *lp)
1864{
85b4aa49
RL
1865 struct fcoe_percpu_s *pp;
1866 struct fcoe_rcv_info *fr;
1867 struct sk_buff_head *list;
1868 struct sk_buff *skb, *next;
1869 struct sk_buff *head;
5e5e92df 1870 unsigned int cpu;
85b4aa49 1871
5e5e92df
RL
1872 for_each_possible_cpu(cpu) {
1873 pp = &per_cpu(fcoe_percpu, cpu);
1874 spin_lock_bh(&pp->fcoe_rx_list.lock);
1875 list = &pp->fcoe_rx_list;
1876 head = list->next;
1877 for (skb = head; skb != (struct sk_buff *)list;
1878 skb = next) {
1879 next = skb->next;
1880 fr = fcoe_dev_from_skb(skb);
1881 if (fr->fr_dev == lp) {
1882 __skb_unlink(skb, list);
1883 kfree_skb(skb);
85b4aa49 1884 }
85b4aa49 1885 }
e7a51997
JE
1886
1887 if (!pp->thread || !cpu_online(cpu)) {
1888 spin_unlock_bh(&pp->fcoe_rx_list.lock);
1889 continue;
1890 }
1891
1892 skb = dev_alloc_skb(0);
1893 if (!skb) {
1894 spin_unlock_bh(&pp->fcoe_rx_list.lock);
1895 continue;
1896 }
1897 skb->destructor = fcoe_percpu_flush_done;
1898
1899 __skb_queue_tail(&pp->fcoe_rx_list, skb);
1900 if (pp->fcoe_rx_list.qlen == 1)
1901 wake_up_process(pp->thread);
5e5e92df 1902 spin_unlock_bh(&pp->fcoe_rx_list.lock);
e7a51997
JE
1903
1904 wait_for_completion(&fcoe_flush_completion);
85b4aa49
RL
1905 }
1906}
85b4aa49
RL
1907
1908/**
34f42a07 1909 * fcoe_clean_pending_queue() - Dequeue a skb and free it
85b4aa49
RL
1910 * @lp: the corresponding fc_lport
1911 *
1912 * Returns: none
34f42a07 1913 */
85b4aa49
RL
1914void fcoe_clean_pending_queue(struct fc_lport *lp)
1915{
014f5c3f 1916 struct fcoe_port *port = lport_priv(lp);
85b4aa49
RL
1917 struct sk_buff *skb;
1918
014f5c3f
CL
1919 spin_lock_bh(&port->fcoe_pending_queue.lock);
1920 while ((skb = __skb_dequeue(&port->fcoe_pending_queue)) != NULL) {
1921 spin_unlock_bh(&port->fcoe_pending_queue.lock);
85b4aa49 1922 kfree_skb(skb);
014f5c3f 1923 spin_lock_bh(&port->fcoe_pending_queue.lock);
85b4aa49 1924 }
014f5c3f 1925 spin_unlock_bh(&port->fcoe_pending_queue.lock);
85b4aa49 1926}
85b4aa49 1927
34f42a07
RL
1928/**
1929 * fcoe_reset() - Resets the fcoe
85b4aa49
RL
1930 * @shost: shost the reset is from
1931 *
1932 * Returns: always 0
1933 */
1934int fcoe_reset(struct Scsi_Host *shost)
1935{
1936 struct fc_lport *lport = shost_priv(shost);
1937 fc_lport_reset(lport);
1938 return 0;
1939}
85b4aa49 1940
34f42a07 1941/**
014f5c3f 1942 * fcoe_hostlist_lookup_port() - find the corresponding lport by a given device
dd3fd72e 1943 * @dev: this is currently ptr to net_device
85b4aa49 1944 *
014f5c3f 1945 * Returns: NULL or the located fcoe_port
090eb6c4 1946 * Locking: must be called with the RNL mutex held
85b4aa49 1947 */
014f5c3f
CL
1948static struct fcoe_interface *
1949fcoe_hostlist_lookup_port(const struct net_device *dev)
85b4aa49 1950{
014f5c3f 1951 struct fcoe_interface *fcoe;
85b4aa49 1952
014f5c3f 1953 list_for_each_entry(fcoe, &fcoe_hostlist, list) {
25024989 1954 if (fcoe->netdev == dev)
014f5c3f 1955 return fcoe;
85b4aa49 1956 }
85b4aa49
RL
1957 return NULL;
1958}
1959
34f42a07
RL
1960/**
1961 * fcoe_hostlist_lookup() - Find the corresponding lport by netdev
85b4aa49
RL
1962 * @netdev: ptr to net_device
1963 *
1964 * Returns: 0 for success
090eb6c4 1965 * Locking: must be called with the RTNL mutex held
85b4aa49 1966 */
090eb6c4 1967static struct fc_lport *fcoe_hostlist_lookup(const struct net_device *netdev)
85b4aa49 1968{
014f5c3f 1969 struct fcoe_interface *fcoe;
85b4aa49 1970
014f5c3f 1971 fcoe = fcoe_hostlist_lookup_port(netdev);
3fe9a0ba 1972 return (fcoe) ? fcoe->ctlr.lp : NULL;
85b4aa49 1973}
85b4aa49 1974
34f42a07
RL
1975/**
1976 * fcoe_hostlist_add() - Add a lport to lports list
dd3fd72e 1977 * @lp: ptr to the fc_lport to be added
85b4aa49
RL
1978 *
1979 * Returns: 0 for success
090eb6c4 1980 * Locking: must be called with the RTNL mutex held
85b4aa49 1981 */
090eb6c4 1982static int fcoe_hostlist_add(const struct fc_lport *lport)
85b4aa49 1983{
014f5c3f
CL
1984 struct fcoe_interface *fcoe;
1985 struct fcoe_port *port;
1986
1987 fcoe = fcoe_hostlist_lookup_port(fcoe_netdev(lport));
1988 if (!fcoe) {
1989 port = lport_priv(lport);
1990 fcoe = port->fcoe;
1991 list_add_tail(&fcoe->list, &fcoe_hostlist);
85b4aa49
RL
1992 }
1993 return 0;
1994}
85b4aa49 1995
85b4aa49 1996/**
34f42a07 1997 * fcoe_init() - fcoe module loading initialization
85b4aa49 1998 *
85b4aa49 1999 * Returns 0 on success, negative on failure
34f42a07 2000 */
85b4aa49
RL
2001static int __init fcoe_init(void)
2002{
38eccabd 2003 unsigned int cpu;
8976f424 2004 int rc = 0;
85b4aa49
RL
2005 struct fcoe_percpu_s *p;
2006
dfc1d0fe
CL
2007 mutex_lock(&fcoe_config_mutex);
2008
38eccabd 2009 for_each_possible_cpu(cpu) {
5e5e92df 2010 p = &per_cpu(fcoe_percpu, cpu);
38eccabd
RL
2011 skb_queue_head_init(&p->fcoe_rx_list);
2012 }
2013
8976f424
RL
2014 for_each_online_cpu(cpu)
2015 fcoe_percpu_thread_create(cpu);
85b4aa49 2016
8976f424
RL
2017 /* Initialize per CPU interrupt thread */
2018 rc = register_hotcpu_notifier(&fcoe_cpu_notifier);
2019 if (rc)
2020 goto out_free;
85b4aa49 2021
8976f424 2022 /* Setup link change notification */
85b4aa49
RL
2023 fcoe_dev_setup();
2024
5892c32f
CL
2025 rc = fcoe_if_init();
2026 if (rc)
2027 goto out_free;
85b4aa49 2028
dfc1d0fe 2029 mutex_unlock(&fcoe_config_mutex);
85b4aa49 2030 return 0;
8976f424
RL
2031
2032out_free:
2033 for_each_online_cpu(cpu) {
2034 fcoe_percpu_thread_destroy(cpu);
2035 }
dfc1d0fe 2036 mutex_unlock(&fcoe_config_mutex);
8976f424 2037 return rc;
85b4aa49
RL
2038}
2039module_init(fcoe_init);
2040
2041/**
34f42a07 2042 * fcoe_exit() - fcoe module unloading cleanup
85b4aa49
RL
2043 *
2044 * Returns 0 on success, negative on failure
34f42a07 2045 */
85b4aa49
RL
2046static void __exit fcoe_exit(void)
2047{
5e5e92df 2048 unsigned int cpu;
014f5c3f 2049 struct fcoe_interface *fcoe, *tmp;
2e70e241 2050 struct fcoe_port *port;
85b4aa49 2051
dfc1d0fe
CL
2052 mutex_lock(&fcoe_config_mutex);
2053
85b4aa49
RL
2054 fcoe_dev_cleanup();
2055
5919a595 2056 /* releases the associated fcoe hosts */
090eb6c4
CL
2057 rtnl_lock();
2058 list_for_each_entry_safe(fcoe, tmp, &fcoe_hostlist, list) {
c863df33 2059 list_del(&fcoe->list);
2e70e241 2060 port = lport_priv(fcoe->ctlr.lp);
2e70e241 2061 fcoe_interface_cleanup(fcoe);
2e70e241 2062 schedule_work(&port->destroy_work);
c863df33 2063 }
090eb6c4 2064 rtnl_unlock();
85b4aa49 2065
8976f424
RL
2066 unregister_hotcpu_notifier(&fcoe_cpu_notifier);
2067
014f5c3f 2068 for_each_online_cpu(cpu)
8976f424 2069 fcoe_percpu_thread_destroy(cpu);
85b4aa49 2070
dfc1d0fe 2071 mutex_unlock(&fcoe_config_mutex);
2e70e241
CL
2072
2073 /* flush any asyncronous interface destroys,
2074 * this should happen after the netdev notifier is unregistered */
2075 flush_scheduled_work();
2076
2077 /* detach from scsi transport
2078 * must happen after all destroys are done, therefor after the flush */
2079 fcoe_if_exit();
85b4aa49
RL
2080}
2081module_exit(fcoe_exit);
11b56188
CL
2082
2083/**
2084 * fcoe_flogi_resp() - FCoE specific FLOGI and FDISC response handler
2085 * @seq: active sequence in the FLOGI or FDISC exchange
2086 * @fp: response frame, or error encoded in a pointer (timeout)
2087 * @arg: pointer the the fcoe_ctlr structure
2088 *
2089 * This handles MAC address managment for FCoE, then passes control on to
2090 * the libfc FLOGI response handler.
2091 */
2092static void fcoe_flogi_resp(struct fc_seq *seq, struct fc_frame *fp, void *arg)
2093{
2094 struct fcoe_ctlr *fip = arg;
2095 struct fc_exch *exch = fc_seq_exch(seq);
2096 struct fc_lport *lport = exch->lp;
2097 u8 *mac;
2098
2099 if (IS_ERR(fp))
2100 goto done;
2101
2102 mac = fr_cb(fp)->granted_mac;
2103 if (is_zero_ether_addr(mac)) {
2104 /* pre-FIP */
2105 mac = eth_hdr(&fp->skb)->h_source;
2106 if (fcoe_ctlr_recv_flogi(fip, lport, fp, mac)) {
2107 fc_frame_free(fp);
2108 return;
2109 }
2110 } else {
2111 /* FIP, libfcoe has already seen it */
2112 fip->update_mac(lport, fr_cb(fp)->granted_mac);
2113 }
2114done:
2115 fc_lport_flogi_resp(seq, fp, lport);
2116}
2117
2118/**
2119 * fcoe_logo_resp() - FCoE specific LOGO response handler
2120 * @seq: active sequence in the LOGO exchange
2121 * @fp: response frame, or error encoded in a pointer (timeout)
2122 * @arg: pointer the the fcoe_ctlr structure
2123 *
2124 * This handles MAC address managment for FCoE, then passes control on to
2125 * the libfc LOGO response handler.
2126 */
2127static void fcoe_logo_resp(struct fc_seq *seq, struct fc_frame *fp, void *arg)
2128{
2129 struct fcoe_ctlr *fip = arg;
2130 struct fc_exch *exch = fc_seq_exch(seq);
2131 struct fc_lport *lport = exch->lp;
2132 static u8 zero_mac[ETH_ALEN] = { 0 };
2133
2134 if (!IS_ERR(fp))
2135 fip->update_mac(lport, zero_mac);
2136 fc_lport_logo_resp(seq, fp, lport);
2137}
2138
2139/**
2140 * fcoe_elsct_send - FCoE specific ELS handler
2141 *
2142 * This does special case handling of FIP encapsualted ELS exchanges for FCoE,
2143 * using FCoE specific response handlers and passing the FIP controller as
2144 * the argument (the lport is still available from the exchange).
2145 *
2146 * Most of the work here is just handed off to the libfc routine.
2147 */
2148static struct fc_seq *fcoe_elsct_send(struct fc_lport *lport,
2149 u32 did, struct fc_frame *fp, unsigned int op,
2150 void (*resp)(struct fc_seq *, struct fc_frame *, void *),
2151 void *arg, u32 timeout)
2152{
2153 struct fcoe_port *port = lport_priv(lport);
2154 struct fcoe_interface *fcoe = port->fcoe;
2155 struct fcoe_ctlr *fip = &fcoe->ctlr;
2156 struct fc_frame_header *fh = fc_frame_header_get(fp);
2157
2158 switch (op) {
2159 case ELS_FLOGI:
2160 case ELS_FDISC:
2161 return fc_elsct_send(lport, did, fp, op, fcoe_flogi_resp,
2162 fip, timeout);
2163 case ELS_LOGO:
2164 /* only hook onto fabric logouts, not port logouts */
2165 if (ntoh24(fh->fh_d_id) != FC_FID_FLOGI)
2166 break;
2167 return fc_elsct_send(lport, did, fp, op, fcoe_logo_resp,
2168 fip, timeout);
2169 }
2170 return fc_elsct_send(lport, did, fp, op, resp, arg, timeout);
2171}
2172