1 /*
2  * Copyright(c) 2008 - 2011 Intel Corporation. All rights reserved.
3  *
4  * This program is free software; you can redistribute it and/or modify it
5  * under the terms and conditions of the GNU General Public License,
6  * version 2, as published by the Free Software Foundation.
7  *
8  * This program is distributed in the hope it will be useful, but WITHOUT
9  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
10  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
11  * more details.
12  *
13  * You should have received a copy of the GNU General Public License along with
14  * this program; if not, write to the Free Software Foundation, Inc.,
15  * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
16  *
17  * Maintained at www.Open-FCoE.org
18  */
19 
20 #include <linux/types.h>
21 #include <linux/module.h>
22 #include <linux/kernel.h>
23 #include <linux/list.h>
24 #include <linux/netdevice.h>
25 #include <linux/errno.h>
26 #include <linux/crc32.h>
27 #include <scsi/libfcoe.h>
28 
29 #include "libfcoe.h"
30 
31 MODULE_AUTHOR("Open-FCoE.org");
32 MODULE_DESCRIPTION("FIP discovery protocol and FCoE transport for FCoE HBAs");
33 MODULE_LICENSE("GPL v2");
34 
35 static int fcoe_transport_create(const char *, struct kernel_param *);
36 static int fcoe_transport_destroy(const char *, struct kernel_param *);
37 static int fcoe_transport_show(char *buffer, const struct kernel_param *kp);
38 static struct fcoe_transport *fcoe_transport_lookup(struct net_device *device);
39 static struct fcoe_transport *fcoe_netdev_map_lookup(struct net_device *device);
40 static int fcoe_transport_enable(const char *, struct kernel_param *);
41 static int fcoe_transport_disable(const char *, struct kernel_param *);
42 static int libfcoe_device_notification(struct notifier_block *notifier,
43 				    ulong event, void *ptr);
44 
45 static LIST_HEAD(fcoe_transports);
46 static DEFINE_MUTEX(ft_mutex);
47 static LIST_HEAD(fcoe_netdevs);
48 static DEFINE_MUTEX(fn_mutex);
49 
50 unsigned int libfcoe_debug_logging;
51 module_param_named(debug_logging, libfcoe_debug_logging, int, S_IRUGO|S_IWUSR);
52 MODULE_PARM_DESC(debug_logging, "a bit mask of logging levels");
53 
54 module_param_call(show, NULL, fcoe_transport_show, NULL, S_IRUSR);
55 __MODULE_PARM_TYPE(show, "string");
56 MODULE_PARM_DESC(show, " Show attached FCoE transports");
57 
58 module_param_call(create, fcoe_transport_create, NULL,
59 		  (void *)FIP_MODE_FABRIC, S_IWUSR);
60 __MODULE_PARM_TYPE(create, "string");
61 MODULE_PARM_DESC(create, " Creates fcoe instance on a ethernet interface");
62 
63 module_param_call(create_vn2vn, fcoe_transport_create, NULL,
64 		  (void *)FIP_MODE_VN2VN, S_IWUSR);
65 __MODULE_PARM_TYPE(create_vn2vn, "string");
66 MODULE_PARM_DESC(create_vn2vn, " Creates a VN_node to VN_node FCoE instance "
67 		 "on an Ethernet interface");
68 
69 module_param_call(destroy, fcoe_transport_destroy, NULL, NULL, S_IWUSR);
70 __MODULE_PARM_TYPE(destroy, "string");
71 MODULE_PARM_DESC(destroy, " Destroys fcoe instance on a ethernet interface");
72 
73 module_param_call(enable, fcoe_transport_enable, NULL, NULL, S_IWUSR);
74 __MODULE_PARM_TYPE(enable, "string");
75 MODULE_PARM_DESC(enable, " Enables fcoe on a ethernet interface.");
76 
77 module_param_call(disable, fcoe_transport_disable, NULL, NULL, S_IWUSR);
78 __MODULE_PARM_TYPE(disable, "string");
79 MODULE_PARM_DESC(disable, " Disables fcoe on a ethernet interface.");
80 
81 /* notification function for packets from net device */
82 static struct notifier_block libfcoe_notifier = {
83 	.notifier_call = libfcoe_device_notification,
84 };
85 
86 /**
87  * fcoe_link_speed_update() - Update the supported and actual link speeds
88  * @lport: The local port to update speeds for
89  *
90  * Returns: 0 if the ethtool query was successful
91  *          -1 if the ethtool query failed
92  */
93 int fcoe_link_speed_update(struct fc_lport *lport)
94 {
95 	struct net_device *netdev = fcoe_get_netdev(lport);
96 	struct ethtool_cmd ecmd;
97 
98 	if (!__ethtool_get_settings(netdev, &ecmd)) {
99 		lport->link_supported_speeds &=
100 			~(FC_PORTSPEED_1GBIT | FC_PORTSPEED_10GBIT);
101 		if (ecmd.supported & (SUPPORTED_1000baseT_Half |
102 				      SUPPORTED_1000baseT_Full))
103 			lport->link_supported_speeds |= FC_PORTSPEED_1GBIT;
104 		if (ecmd.supported & SUPPORTED_10000baseT_Full)
105 			lport->link_supported_speeds |=
106 				FC_PORTSPEED_10GBIT;
107 		switch (ethtool_cmd_speed(&ecmd)) {
108 		case SPEED_1000:
109 			lport->link_speed = FC_PORTSPEED_1GBIT;
110 			break;
111 		case SPEED_10000:
112 			lport->link_speed = FC_PORTSPEED_10GBIT;
113 			break;
114 		}
115 		return 0;
116 	}
117 	return -1;
118 }
119 EXPORT_SYMBOL_GPL(fcoe_link_speed_update);
120 
121 /**
122  * __fcoe_get_lesb() - Get the Link Error Status Block (LESB) for a given lport
123  * @lport: The local port to update speeds for
124  * @fc_lesb: Pointer to the LESB to be filled up
125  * @netdev: Pointer to the netdev that is associated with the lport
126  *
127  * Note, the Link Error Status Block (LESB) for FCoE is defined in FC-BB-6
128  * Clause 7.11 in v1.04.
129  */
130 void __fcoe_get_lesb(struct fc_lport *lport,
131 		     struct fc_els_lesb *fc_lesb,
132 		     struct net_device *netdev)
133 {
134 	unsigned int cpu;
135 	u32 lfc, vlfc, mdac;
136 	struct fc_stats *stats;
137 	struct fcoe_fc_els_lesb *lesb;
138 	struct rtnl_link_stats64 temp;
139 
140 	lfc = 0;
141 	vlfc = 0;
142 	mdac = 0;
143 	lesb = (struct fcoe_fc_els_lesb *)fc_lesb;
144 	memset(lesb, 0, sizeof(*lesb));
145 	for_each_possible_cpu(cpu) {
146 		stats = per_cpu_ptr(lport->stats, cpu);
147 		lfc += stats->LinkFailureCount;
148 		vlfc += stats->VLinkFailureCount;
149 		mdac += stats->MissDiscAdvCount;
150 	}
151 	lesb->lesb_link_fail = htonl(lfc);
152 	lesb->lesb_vlink_fail = htonl(vlfc);
153 	lesb->lesb_miss_fka = htonl(mdac);
154 	lesb->lesb_fcs_error =
155 			htonl(dev_get_stats(netdev, &temp)->rx_crc_errors);
156 }
157 EXPORT_SYMBOL_GPL(__fcoe_get_lesb);
158 
159 /**
160  * fcoe_get_lesb() - Fill the FCoE Link Error Status Block
161  * @lport: the local port
162  * @fc_lesb: the link error status block
163  */
164 void fcoe_get_lesb(struct fc_lport *lport,
165 			 struct fc_els_lesb *fc_lesb)
166 {
167 	struct net_device *netdev = fcoe_get_netdev(lport);
168 
169 	__fcoe_get_lesb(lport, fc_lesb, netdev);
170 }
171 EXPORT_SYMBOL_GPL(fcoe_get_lesb);
172 
173 /**
174  * fcoe_ctlr_get_lesb() - Get the Link Error Status Block (LESB) for a given
175  * fcoe controller device
176  * @ctlr_dev: The given fcoe controller device
177  *
178  */
179 void fcoe_ctlr_get_lesb(struct fcoe_ctlr_device *ctlr_dev)
180 {
181 	struct fcoe_ctlr *fip = fcoe_ctlr_device_priv(ctlr_dev);
182 	struct net_device *netdev = fcoe_get_netdev(fip->lp);
183 	struct fc_els_lesb *fc_lesb;
184 
185 	fc_lesb = (struct fc_els_lesb *)(&ctlr_dev->lesb);
186 	__fcoe_get_lesb(fip->lp, fc_lesb, netdev);
187 }
188 EXPORT_SYMBOL_GPL(fcoe_ctlr_get_lesb);
189 
190 void fcoe_wwn_to_str(u64 wwn, char *buf, int len)
191 {
192 	u8 wwpn[8];
193 
194 	u64_to_wwn(wwn, wwpn);
195 	snprintf(buf, len, "%02x%02x%02x%02x%02x%02x%02x%02x",
196 		 wwpn[0], wwpn[1], wwpn[2], wwpn[3],
197 		 wwpn[4], wwpn[5], wwpn[6], wwpn[7]);
198 }
199 EXPORT_SYMBOL_GPL(fcoe_wwn_to_str);
200 
201 /**
202  * fcoe_validate_vport_create() - Validate a vport before creating it
203  * @vport: NPIV port to be created
204  *
205  * This routine is meant to add validation for a vport before creating it
206  * via fcoe_vport_create().
207  * Current validations are:
208  *      - WWPN supplied is unique for given lport
209  */
210 int fcoe_validate_vport_create(struct fc_vport *vport)
211 {
212 	struct Scsi_Host *shost = vport_to_shost(vport);
213 	struct fc_lport *n_port = shost_priv(shost);
214 	struct fc_lport *vn_port;
215 	int rc = 0;
216 	char buf[32];
217 
218 	mutex_lock(&n_port->lp_mutex);
219 
220 	fcoe_wwn_to_str(vport->port_name, buf, sizeof(buf));
221 	/* Check if the wwpn is not same as that of the lport */
222 	if (!memcmp(&n_port->wwpn, &vport->port_name, sizeof(u64))) {
223 		LIBFCOE_TRANSPORT_DBG("vport WWPN 0x%s is same as that of the "
224 				      "base port WWPN\n", buf);
225 		rc = -EINVAL;
226 		goto out;
227 	}
228 
229 	/* Check if there is any existing vport with same wwpn */
230 	list_for_each_entry(vn_port, &n_port->vports, list) {
231 		if (!memcmp(&vn_port->wwpn, &vport->port_name, sizeof(u64))) {
232 			LIBFCOE_TRANSPORT_DBG("vport with given WWPN 0x%s "
233 					      "already exists\n", buf);
234 			rc = -EINVAL;
235 			break;
236 		}
237 	}
238 out:
239 	mutex_unlock(&n_port->lp_mutex);
240 	return rc;
241 }
242 EXPORT_SYMBOL_GPL(fcoe_validate_vport_create);
243 
244 /**
245  * fcoe_get_wwn() - Get the world wide name from LLD if it supports it
246  * @netdev: the associated net device
247  * @wwn: the output WWN
248  * @type: the type of WWN (WWPN or WWNN)
249  *
250  * Returns: 0 for success
251  */
252 int fcoe_get_wwn(struct net_device *netdev, u64 *wwn, int type)
253 {
254 	const struct net_device_ops *ops = netdev->netdev_ops;
255 
256 	if (ops->ndo_fcoe_get_wwn)
257 		return ops->ndo_fcoe_get_wwn(netdev, wwn, type);
258 	return -EINVAL;
259 }
260 EXPORT_SYMBOL_GPL(fcoe_get_wwn);
261 
262 /**
263  * fcoe_fc_crc() - Calculates the CRC for a given frame
264  * @fp: The frame to be checksumed
265  *
266  * This uses crc32() routine to calculate the CRC for a frame
267  *
268  * Return: The 32 bit CRC value
269  */
270 u32 fcoe_fc_crc(struct fc_frame *fp)
271 {
272 	struct sk_buff *skb = fp_skb(fp);
273 	struct skb_frag_struct *frag;
274 	unsigned char *data;
275 	unsigned long off, len, clen;
276 	u32 crc;
277 	unsigned i;
278 
279 	crc = crc32(~0, skb->data, skb_headlen(skb));
280 
281 	for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
282 		frag = &skb_shinfo(skb)->frags[i];
283 		off = frag->page_offset;
284 		len = skb_frag_size(frag);
285 		while (len > 0) {
286 			clen = min(len, PAGE_SIZE - (off & ~PAGE_MASK));
287 			data = kmap_atomic(
288 				skb_frag_page(frag) + (off >> PAGE_SHIFT));
289 			crc = crc32(crc, data + (off & ~PAGE_MASK), clen);
290 			kunmap_atomic(data);
291 			off += clen;
292 			len -= clen;
293 		}
294 	}
295 	return crc;
296 }
297 EXPORT_SYMBOL_GPL(fcoe_fc_crc);
298 
299 /**
300  * fcoe_start_io() - Start FCoE I/O
301  * @skb: The packet to be transmitted
302  *
303  * This routine is called from the net device to start transmitting
304  * FCoE packets.
305  *
306  * Returns: 0 for success
307  */
308 int fcoe_start_io(struct sk_buff *skb)
309 {
310 	struct sk_buff *nskb;
311 	int rc;
312 
313 	nskb = skb_clone(skb, GFP_ATOMIC);
314 	if (!nskb)
315 		return -ENOMEM;
316 	rc = dev_queue_xmit(nskb);
317 	if (rc != 0)
318 		return rc;
319 	kfree_skb(skb);
320 	return 0;
321 }
322 EXPORT_SYMBOL_GPL(fcoe_start_io);
323 
324 
325 /**
326  * fcoe_clean_pending_queue() - Dequeue a skb and free it
327  * @lport: The local port to dequeue a skb on
328  */
329 void fcoe_clean_pending_queue(struct fc_lport *lport)
330 {
331 	struct fcoe_port  *port = lport_priv(lport);
332 	struct sk_buff *skb;
333 
334 	spin_lock_bh(&port->fcoe_pending_queue.lock);
335 	while ((skb = __skb_dequeue(&port->fcoe_pending_queue)) != NULL) {
336 		spin_unlock_bh(&port->fcoe_pending_queue.lock);
337 		kfree_skb(skb);
338 		spin_lock_bh(&port->fcoe_pending_queue.lock);
339 	}
340 	spin_unlock_bh(&port->fcoe_pending_queue.lock);
341 }
342 EXPORT_SYMBOL_GPL(fcoe_clean_pending_queue);
343 
344 /**
345  * fcoe_check_wait_queue() - Attempt to clear the transmit backlog
346  * @lport: The local port whose backlog is to be cleared
347  *
348  * This empties the wait_queue, dequeues the head of the wait_queue queue
349  * and calls fcoe_start_io() for each packet. If all skb have been
350  * transmitted it returns the qlen. If an error occurs it restores
351  * wait_queue (to try again later) and returns -1.
352  *
353  * The wait_queue is used when the skb transmit fails. The failed skb
354  * will go in the wait_queue which will be emptied by the timer function or
355  * by the next skb transmit.
356  */
357 void fcoe_check_wait_queue(struct fc_lport *lport, struct sk_buff *skb)
358 {
359 	struct fcoe_port *port = lport_priv(lport);
360 	int rc;
361 
362 	spin_lock_bh(&port->fcoe_pending_queue.lock);
363 
364 	if (skb)
365 		__skb_queue_tail(&port->fcoe_pending_queue, skb);
366 
367 	if (port->fcoe_pending_queue_active)
368 		goto out;
369 	port->fcoe_pending_queue_active = 1;
370 
371 	while (port->fcoe_pending_queue.qlen) {
372 		/* keep qlen > 0 until fcoe_start_io succeeds */
373 		port->fcoe_pending_queue.qlen++;
374 		skb = __skb_dequeue(&port->fcoe_pending_queue);
375 
376 		spin_unlock_bh(&port->fcoe_pending_queue.lock);
377 		rc = fcoe_start_io(skb);
378 		spin_lock_bh(&port->fcoe_pending_queue.lock);
379 
380 		if (rc) {
381 			__skb_queue_head(&port->fcoe_pending_queue, skb);
382 			/* undo temporary increment above */
383 			port->fcoe_pending_queue.qlen--;
384 			break;
385 		}
386 		/* undo temporary increment above */
387 		port->fcoe_pending_queue.qlen--;
388 	}
389 
390 	if (port->fcoe_pending_queue.qlen < port->min_queue_depth)
391 		lport->qfull = 0;
392 	if (port->fcoe_pending_queue.qlen && !timer_pending(&port->timer))
393 		mod_timer(&port->timer, jiffies + 2);
394 	port->fcoe_pending_queue_active = 0;
395 out:
396 	if (port->fcoe_pending_queue.qlen > port->max_queue_depth)
397 		lport->qfull = 1;
398 	spin_unlock_bh(&port->fcoe_pending_queue.lock);
399 }
400 EXPORT_SYMBOL_GPL(fcoe_check_wait_queue);
401 
402 /**
403  * fcoe_queue_timer() - The fcoe queue timer
404  * @lport: The local port
405  *
406  * Calls fcoe_check_wait_queue on timeout
407  */
408 void fcoe_queue_timer(ulong lport)
409 {
410 	fcoe_check_wait_queue((struct fc_lport *)lport, NULL);
411 }
412 EXPORT_SYMBOL_GPL(fcoe_queue_timer);
413 
414 /**
415  * fcoe_get_paged_crc_eof() - Allocate a page to be used for the trailer CRC
416  * @skb:  The packet to be transmitted
417  * @tlen: The total length of the trailer
418  * @fps:  The fcoe context
419  *
420  * This routine allocates a page for frame trailers. The page is re-used if
421  * there is enough room left on it for the current trailer. If there isn't
422  * enough buffer left a new page is allocated for the trailer. Reference to
423  * the page from this function as well as the skbs using the page fragments
424  * ensure that the page is freed at the appropriate time.
425  *
426  * Returns: 0 for success
427  */
428 int fcoe_get_paged_crc_eof(struct sk_buff *skb, int tlen,
429 			   struct fcoe_percpu_s *fps)
430 {
431 	struct page *page;
432 
433 	page = fps->crc_eof_page;
434 	if (!page) {
435 		page = alloc_page(GFP_ATOMIC);
436 		if (!page)
437 			return -ENOMEM;
438 
439 		fps->crc_eof_page = page;
440 		fps->crc_eof_offset = 0;
441 	}
442 
443 	get_page(page);
444 	skb_fill_page_desc(skb, skb_shinfo(skb)->nr_frags, page,
445 			   fps->crc_eof_offset, tlen);
446 	skb->len += tlen;
447 	skb->data_len += tlen;
448 	skb->truesize += tlen;
449 	fps->crc_eof_offset += sizeof(struct fcoe_crc_eof);
450 
451 	if (fps->crc_eof_offset >= PAGE_SIZE) {
452 		fps->crc_eof_page = NULL;
453 		fps->crc_eof_offset = 0;
454 		put_page(page);
455 	}
456 
457 	return 0;
458 }
459 EXPORT_SYMBOL_GPL(fcoe_get_paged_crc_eof);
460 
461 /**
462  * fcoe_transport_lookup - find an fcoe transport that matches a netdev
463  * @netdev: The netdev to look for from all attached transports
464  *
465  * Returns : ptr to the fcoe transport that supports this netdev or NULL
466  * if not found.
467  *
468  * The ft_mutex should be held when this is called
469  */
470 static struct fcoe_transport *fcoe_transport_lookup(struct net_device *netdev)
471 {
472 	struct fcoe_transport *ft = NULL;
473 
474 	list_for_each_entry(ft, &fcoe_transports, list)
475 		if (ft->match && ft->match(netdev))
476 			return ft;
477 	return NULL;
478 }
479 
480 /**
481  * fcoe_transport_attach - Attaches an FCoE transport
482  * @ft: The fcoe transport to be attached
483  *
484  * Returns : 0 for success
485  */
486 int fcoe_transport_attach(struct fcoe_transport *ft)
487 {
488 	int rc = 0;
489 
490 	mutex_lock(&ft_mutex);
491 	if (ft->attached) {
492 		LIBFCOE_TRANSPORT_DBG("transport %s already attached\n",
493 				       ft->name);
494 		rc = -EEXIST;
495 		goto out_attach;
496 	}
497 
498 	/* Add default transport to the tail */
499 	if (strcmp(ft->name, FCOE_TRANSPORT_DEFAULT))
500 		list_add(&ft->list, &fcoe_transports);
501 	else
502 		list_add_tail(&ft->list, &fcoe_transports);
503 
504 	ft->attached = true;
505 	LIBFCOE_TRANSPORT_DBG("attaching transport %s\n", ft->name);
506 
507 out_attach:
508 	mutex_unlock(&ft_mutex);
509 	return rc;
510 }
511 EXPORT_SYMBOL(fcoe_transport_attach);
512 
513 /**
514  * fcoe_transport_detach - Detaches an FCoE transport
515  * @ft: The fcoe transport to be attached
516  *
517  * Returns : 0 for success
518  */
519 int fcoe_transport_detach(struct fcoe_transport *ft)
520 {
521 	int rc = 0;
522 	struct fcoe_netdev_mapping *nm = NULL, *tmp;
523 
524 	mutex_lock(&ft_mutex);
525 	if (!ft->attached) {
526 		LIBFCOE_TRANSPORT_DBG("transport %s already detached\n",
527 			ft->name);
528 		rc = -ENODEV;
529 		goto out_attach;
530 	}
531 
532 	/* remove netdev mapping for this transport as it is going away */
533 	mutex_lock(&fn_mutex);
534 	list_for_each_entry_safe(nm, tmp, &fcoe_netdevs, list) {
535 		if (nm->ft == ft) {
536 			LIBFCOE_TRANSPORT_DBG("transport %s going away, "
537 				"remove its netdev mapping for %s\n",
538 				ft->name, nm->netdev->name);
539 			list_del(&nm->list);
540 			kfree(nm);
541 		}
542 	}
543 	mutex_unlock(&fn_mutex);
544 
545 	list_del(&ft->list);
546 	ft->attached = false;
547 	LIBFCOE_TRANSPORT_DBG("detaching transport %s\n", ft->name);
548 
549 out_attach:
550 	mutex_unlock(&ft_mutex);
551 	return rc;
552 
553 }
554 EXPORT_SYMBOL(fcoe_transport_detach);
555 
556 static int fcoe_transport_show(char *buffer, const struct kernel_param *kp)
557 {
558 	int i, j;
559 	struct fcoe_transport *ft = NULL;
560 
561 	i = j = sprintf(buffer, "Attached FCoE transports:");
562 	mutex_lock(&ft_mutex);
563 	list_for_each_entry(ft, &fcoe_transports, list) {
564 		if (i >= PAGE_SIZE - IFNAMSIZ)
565 			break;
566 		i += snprintf(&buffer[i], IFNAMSIZ, "%s ", ft->name);
567 	}
568 	mutex_unlock(&ft_mutex);
569 	if (i == j)
570 		i += snprintf(&buffer[i], IFNAMSIZ, "none");
571 	return i;
572 }
573 
574 static int __init fcoe_transport_init(void)
575 {
576 	register_netdevice_notifier(&libfcoe_notifier);
577 	return 0;
578 }
579 
580 static int fcoe_transport_exit(void)
581 {
582 	struct fcoe_transport *ft;
583 
584 	unregister_netdevice_notifier(&libfcoe_notifier);
585 	mutex_lock(&ft_mutex);
586 	list_for_each_entry(ft, &fcoe_transports, list)
587 		printk(KERN_ERR "FCoE transport %s is still attached!\n",
588 		      ft->name);
589 	mutex_unlock(&ft_mutex);
590 	return 0;
591 }
592 
593 
594 static int fcoe_add_netdev_mapping(struct net_device *netdev,
595 					struct fcoe_transport *ft)
596 {
597 	struct fcoe_netdev_mapping *nm;
598 
599 	nm = kmalloc(sizeof(*nm), GFP_KERNEL);
600 	if (!nm) {
601 		printk(KERN_ERR "Unable to allocate netdev_mapping");
602 		return -ENOMEM;
603 	}
604 
605 	nm->netdev = netdev;
606 	nm->ft = ft;
607 
608 	mutex_lock(&fn_mutex);
609 	list_add(&nm->list, &fcoe_netdevs);
610 	mutex_unlock(&fn_mutex);
611 	return 0;
612 }
613 
614 
615 static void fcoe_del_netdev_mapping(struct net_device *netdev)
616 {
617 	struct fcoe_netdev_mapping *nm = NULL, *tmp;
618 
619 	mutex_lock(&fn_mutex);
620 	list_for_each_entry_safe(nm, tmp, &fcoe_netdevs, list) {
621 		if (nm->netdev == netdev) {
622 			list_del(&nm->list);
623 			kfree(nm);
624 			mutex_unlock(&fn_mutex);
625 			return;
626 		}
627 	}
628 	mutex_unlock(&fn_mutex);
629 }
630 
631 
632 /**
633  * fcoe_netdev_map_lookup - find the fcoe transport that matches the netdev on which
634  * it was created
635  *
636  * Returns : ptr to the fcoe transport that supports this netdev or NULL
637  * if not found.
638  *
639  * The ft_mutex should be held when this is called
640  */
641 static struct fcoe_transport *fcoe_netdev_map_lookup(struct net_device *netdev)
642 {
643 	struct fcoe_transport *ft = NULL;
644 	struct fcoe_netdev_mapping *nm;
645 
646 	mutex_lock(&fn_mutex);
647 	list_for_each_entry(nm, &fcoe_netdevs, list) {
648 		if (netdev == nm->netdev) {
649 			ft = nm->ft;
650 			mutex_unlock(&fn_mutex);
651 			return ft;
652 		}
653 	}
654 
655 	mutex_unlock(&fn_mutex);
656 	return NULL;
657 }
658 
659 /**
660  * fcoe_if_to_netdev() - Parse a name buffer to get a net device
661  * @buffer: The name of the net device
662  *
663  * Returns: NULL or a ptr to net_device
664  */
665 static struct net_device *fcoe_if_to_netdev(const char *buffer)
666 {
667 	char *cp;
668 	char ifname[IFNAMSIZ + 2];
669 
670 	if (buffer) {
671 		strlcpy(ifname, buffer, IFNAMSIZ);
672 		cp = ifname + strlen(ifname);
673 		while (--cp >= ifname && *cp == '\n')
674 			*cp = '\0';
675 		return dev_get_by_name(&init_net, ifname);
676 	}
677 	return NULL;
678 }
679 
680 /**
681  * libfcoe_device_notification() - Handler for net device events
682  * @notifier: The context of the notification
683  * @event:    The type of event
684  * @ptr:      The net device that the event was on
685  *
686  * This function is called by the Ethernet driver in case of link change event.
687  *
688  * Returns: 0 for success
689  */
690 static int libfcoe_device_notification(struct notifier_block *notifier,
691 				    ulong event, void *ptr)
692 {
693 	struct net_device *netdev = netdev_notifier_info_to_dev(ptr);
694 
695 	switch (event) {
696 	case NETDEV_UNREGISTER:
697 		LIBFCOE_TRANSPORT_DBG("NETDEV_UNREGISTER %s\n",
698 				      netdev->name);
699 		fcoe_del_netdev_mapping(netdev);
700 		break;
701 	}
702 	return NOTIFY_OK;
703 }
704 
705 ssize_t fcoe_ctlr_create_store(struct bus_type *bus,
706 			       const char *buf, size_t count)
707 {
708 	struct net_device *netdev = NULL;
709 	struct fcoe_transport *ft = NULL;
710 	int rc = 0;
711 	int err;
712 
713 	mutex_lock(&ft_mutex);
714 
715 	netdev = fcoe_if_to_netdev(buf);
716 	if (!netdev) {
717 		LIBFCOE_TRANSPORT_DBG("Invalid device %s.\n", buf);
718 		rc = -ENODEV;
719 		goto out_nodev;
720 	}
721 
722 	ft = fcoe_netdev_map_lookup(netdev);
723 	if (ft) {
724 		LIBFCOE_TRANSPORT_DBG("transport %s already has existing "
725 				      "FCoE instance on %s.\n",
726 				      ft->name, netdev->name);
727 		rc = -EEXIST;
728 		goto out_putdev;
729 	}
730 
731 	ft = fcoe_transport_lookup(netdev);
732 	if (!ft) {
733 		LIBFCOE_TRANSPORT_DBG("no FCoE transport found for %s.\n",
734 				      netdev->name);
735 		rc = -ENODEV;
736 		goto out_putdev;
737 	}
738 
739 	/* pass to transport create */
740 	err = ft->alloc ? ft->alloc(netdev) : -ENODEV;
741 	if (err) {
742 		fcoe_del_netdev_mapping(netdev);
743 		rc = -ENOMEM;
744 		goto out_putdev;
745 	}
746 
747 	err = fcoe_add_netdev_mapping(netdev, ft);
748 	if (err) {
749 		LIBFCOE_TRANSPORT_DBG("failed to add new netdev mapping "
750 				      "for FCoE transport %s for %s.\n",
751 				      ft->name, netdev->name);
752 		rc = -ENODEV;
753 		goto out_putdev;
754 	}
755 
756 	LIBFCOE_TRANSPORT_DBG("transport %s succeeded to create fcoe on %s.\n",
757 			      ft->name, netdev->name);
758 
759 out_putdev:
760 	dev_put(netdev);
761 out_nodev:
762 	mutex_unlock(&ft_mutex);
763 	if (rc)
764 		return rc;
765 	return count;
766 }
767 
768 ssize_t fcoe_ctlr_destroy_store(struct bus_type *bus,
769 				const char *buf, size_t count)
770 {
771 	int rc = -ENODEV;
772 	struct net_device *netdev = NULL;
773 	struct fcoe_transport *ft = NULL;
774 
775 	mutex_lock(&ft_mutex);
776 
777 	netdev = fcoe_if_to_netdev(buf);
778 	if (!netdev) {
779 		LIBFCOE_TRANSPORT_DBG("invalid device %s.\n", buf);
780 		goto out_nodev;
781 	}
782 
783 	ft = fcoe_netdev_map_lookup(netdev);
784 	if (!ft) {
785 		LIBFCOE_TRANSPORT_DBG("no FCoE transport found for %s.\n",
786 				      netdev->name);
787 		goto out_putdev;
788 	}
789 
790 	/* pass to transport destroy */
791 	rc = ft->destroy(netdev);
792 	if (rc)
793 		goto out_putdev;
794 
795 	fcoe_del_netdev_mapping(netdev);
796 	LIBFCOE_TRANSPORT_DBG("transport %s %s to destroy fcoe on %s.\n",
797 			      ft->name, (rc) ? "failed" : "succeeded",
798 			      netdev->name);
799 	rc = count; /* required for successful return */
800 out_putdev:
801 	dev_put(netdev);
802 out_nodev:
803 	mutex_unlock(&ft_mutex);
804 	return rc;
805 }
806 EXPORT_SYMBOL(fcoe_ctlr_destroy_store);
807 
808 /**
809  * fcoe_transport_create() - Create a fcoe interface
810  * @buffer: The name of the Ethernet interface to create on
811  * @kp:	    The associated kernel param
812  *
813  * Called from sysfs. This holds the ft_mutex while calling the
814  * registered fcoe transport's create function.
815  *
816  * Returns: 0 for success
817  */
818 static int fcoe_transport_create(const char *buffer, struct kernel_param *kp)
819 {
820 	int rc = -ENODEV;
821 	struct net_device *netdev = NULL;
822 	struct fcoe_transport *ft = NULL;
823 	enum fip_state fip_mode = (enum fip_state)(long)kp->arg;
824 
825 	mutex_lock(&ft_mutex);
826 
827 	netdev = fcoe_if_to_netdev(buffer);
828 	if (!netdev) {
829 		LIBFCOE_TRANSPORT_DBG("Invalid device %s.\n", buffer);
830 		goto out_nodev;
831 	}
832 
833 	ft = fcoe_netdev_map_lookup(netdev);
834 	if (ft) {
835 		LIBFCOE_TRANSPORT_DBG("transport %s already has existing "
836 				      "FCoE instance on %s.\n",
837 				      ft->name, netdev->name);
838 		rc = -EEXIST;
839 		goto out_putdev;
840 	}
841 
842 	ft = fcoe_transport_lookup(netdev);
843 	if (!ft) {
844 		LIBFCOE_TRANSPORT_DBG("no FCoE transport found for %s.\n",
845 				      netdev->name);
846 		goto out_putdev;
847 	}
848 
849 	rc = fcoe_add_netdev_mapping(netdev, ft);
850 	if (rc) {
851 		LIBFCOE_TRANSPORT_DBG("failed to add new netdev mapping "
852 				      "for FCoE transport %s for %s.\n",
853 				      ft->name, netdev->name);
854 		goto out_putdev;
855 	}
856 
857 	/* pass to transport create */
858 	rc = ft->create ? ft->create(netdev, fip_mode) : -ENODEV;
859 	if (rc)
860 		fcoe_del_netdev_mapping(netdev);
861 
862 	LIBFCOE_TRANSPORT_DBG("transport %s %s to create fcoe on %s.\n",
863 			      ft->name, (rc) ? "failed" : "succeeded",
864 			      netdev->name);
865 
866 out_putdev:
867 	dev_put(netdev);
868 out_nodev:
869 	mutex_unlock(&ft_mutex);
870 	return rc;
871 }
872 
873 /**
874  * fcoe_transport_destroy() - Destroy a FCoE interface
875  * @buffer: The name of the Ethernet interface to be destroyed
876  * @kp:	    The associated kernel parameter
877  *
878  * Called from sysfs. This holds the ft_mutex while calling the
879  * registered fcoe transport's destroy function.
880  *
881  * Returns: 0 for success
882  */
883 static int fcoe_transport_destroy(const char *buffer, struct kernel_param *kp)
884 {
885 	int rc = -ENODEV;
886 	struct net_device *netdev = NULL;
887 	struct fcoe_transport *ft = NULL;
888 
889 	mutex_lock(&ft_mutex);
890 
891 	netdev = fcoe_if_to_netdev(buffer);
892 	if (!netdev) {
893 		LIBFCOE_TRANSPORT_DBG("invalid device %s.\n", buffer);
894 		goto out_nodev;
895 	}
896 
897 	ft = fcoe_netdev_map_lookup(netdev);
898 	if (!ft) {
899 		LIBFCOE_TRANSPORT_DBG("no FCoE transport found for %s.\n",
900 				      netdev->name);
901 		goto out_putdev;
902 	}
903 
904 	/* pass to transport destroy */
905 	rc = ft->destroy ? ft->destroy(netdev) : -ENODEV;
906 	fcoe_del_netdev_mapping(netdev);
907 	LIBFCOE_TRANSPORT_DBG("transport %s %s to destroy fcoe on %s.\n",
908 			      ft->name, (rc) ? "failed" : "succeeded",
909 			      netdev->name);
910 
911 out_putdev:
912 	dev_put(netdev);
913 out_nodev:
914 	mutex_unlock(&ft_mutex);
915 	return rc;
916 }
917 
918 /**
919  * fcoe_transport_disable() - Disables a FCoE interface
920  * @buffer: The name of the Ethernet interface to be disabled
921  * @kp:	    The associated kernel parameter
922  *
923  * Called from sysfs.
924  *
925  * Returns: 0 for success
926  */
927 static int fcoe_transport_disable(const char *buffer, struct kernel_param *kp)
928 {
929 	int rc = -ENODEV;
930 	struct net_device *netdev = NULL;
931 	struct fcoe_transport *ft = NULL;
932 
933 	mutex_lock(&ft_mutex);
934 
935 	netdev = fcoe_if_to_netdev(buffer);
936 	if (!netdev)
937 		goto out_nodev;
938 
939 	ft = fcoe_netdev_map_lookup(netdev);
940 	if (!ft)
941 		goto out_putdev;
942 
943 	rc = ft->disable ? ft->disable(netdev) : -ENODEV;
944 
945 out_putdev:
946 	dev_put(netdev);
947 out_nodev:
948 	mutex_unlock(&ft_mutex);
949 	return rc;
950 }
951 
952 /**
953  * fcoe_transport_enable() - Enables a FCoE interface
954  * @buffer: The name of the Ethernet interface to be enabled
955  * @kp:     The associated kernel parameter
956  *
957  * Called from sysfs.
958  *
959  * Returns: 0 for success
960  */
961 static int fcoe_transport_enable(const char *buffer, struct kernel_param *kp)
962 {
963 	int rc = -ENODEV;
964 	struct net_device *netdev = NULL;
965 	struct fcoe_transport *ft = NULL;
966 
967 	mutex_lock(&ft_mutex);
968 
969 	netdev = fcoe_if_to_netdev(buffer);
970 	if (!netdev)
971 		goto out_nodev;
972 
973 	ft = fcoe_netdev_map_lookup(netdev);
974 	if (!ft)
975 		goto out_putdev;
976 
977 	rc = ft->enable ? ft->enable(netdev) : -ENODEV;
978 
979 out_putdev:
980 	dev_put(netdev);
981 out_nodev:
982 	mutex_unlock(&ft_mutex);
983 	return rc;
984 }
985 
986 /**
987  * libfcoe_init() - Initialization routine for libfcoe.ko
988  */
989 static int __init libfcoe_init(void)
990 {
991 	int rc = 0;
992 
993 	rc = fcoe_transport_init();
994 	if (rc)
995 		return rc;
996 
997 	rc = fcoe_sysfs_setup();
998 	if (rc)
999 		fcoe_transport_exit();
1000 
1001 	return rc;
1002 }
1003 module_init(libfcoe_init);
1004 
1005 /**
1006  * libfcoe_exit() - Tear down libfcoe.ko
1007  */
1008 static void __exit libfcoe_exit(void)
1009 {
1010 	fcoe_sysfs_teardown();
1011 	fcoe_transport_exit();
1012 }
1013 module_exit(libfcoe_exit);
1014