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