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