]> Git Repo - linux.git/blob - drivers/scsi/bnx2fc/bnx2fc_fcoe.c
Linux 6.14-rc3
[linux.git] / drivers / scsi / bnx2fc / bnx2fc_fcoe.c
1 /* bnx2fc_fcoe.c: QLogic Linux FCoE offload driver.
2  * This file contains the code that interacts with libfc, libfcoe,
3  * cnic modules to create FCoE instances, send/receive non-offloaded
4  * FIP/FCoE packets, listen to link events etc.
5  *
6  * Copyright (c) 2008-2013 Broadcom Corporation
7  * Copyright (c) 2014-2016 QLogic Corporation
8  * Copyright (c) 2016-2017 Cavium Inc.
9  *
10  * This program is free software; you can redistribute it and/or modify
11  * it under the terms of the GNU General Public License as published by
12  * the Free Software Foundation.
13  *
14  * Written by: Bhanu Prakash Gollapudi ([email protected])
15  */
16
17 #include "bnx2fc.h"
18
19 #include <linux/ethtool.h>
20
21 static struct list_head adapter_list;
22 static struct list_head if_list;
23 static u32 adapter_count;
24 static DEFINE_MUTEX(bnx2fc_dev_lock);
25 DEFINE_PER_CPU(struct bnx2fc_percpu_s, bnx2fc_percpu);
26
27 #define DRV_MODULE_NAME         "bnx2fc"
28 #define DRV_MODULE_VERSION      BNX2FC_VERSION
29 #define DRV_MODULE_RELDATE      "October 15, 2015"
30
31
32 static char version[] =
33                 "QLogic FCoE Driver " DRV_MODULE_NAME \
34                 " v" DRV_MODULE_VERSION " (" DRV_MODULE_RELDATE ")\n";
35
36
37 MODULE_AUTHOR("Bhanu Prakash Gollapudi <[email protected]>");
38 MODULE_DESCRIPTION("QLogic FCoE Driver");
39 MODULE_LICENSE("GPL");
40 MODULE_VERSION(DRV_MODULE_VERSION);
41
42 #define BNX2FC_MAX_QUEUE_DEPTH  256
43 #define BNX2FC_MIN_QUEUE_DEPTH  32
44 #define FCOE_WORD_TO_BYTE  4
45
46 static struct scsi_transport_template   *bnx2fc_transport_template;
47 static struct scsi_transport_template   *bnx2fc_vport_xport_template;
48
49 struct workqueue_struct *bnx2fc_wq;
50
51 /* bnx2fc structure needs only one instance of the fcoe_percpu_s structure.
52  * Here the io threads are per cpu but the l2 thread is just one
53  */
54 struct fcoe_percpu_s bnx2fc_global;
55 static DEFINE_SPINLOCK(bnx2fc_global_lock);
56
57 static struct cnic_ulp_ops bnx2fc_cnic_cb;
58 static struct libfc_function_template bnx2fc_libfc_fcn_templ;
59 static struct scsi_host_template bnx2fc_shost_template;
60 static struct fc_function_template bnx2fc_transport_function;
61 static struct fcoe_sysfs_function_template bnx2fc_fcoe_sysfs_templ;
62 static struct fc_function_template bnx2fc_vport_xport_function;
63 static int bnx2fc_create(struct net_device *netdev, enum fip_mode fip_mode);
64 static void __bnx2fc_destroy(struct bnx2fc_interface *interface);
65 static int bnx2fc_destroy(struct net_device *net_device);
66 static int bnx2fc_enable(struct net_device *netdev);
67 static int bnx2fc_disable(struct net_device *netdev);
68
69 /* fcoe_syfs control interface handlers */
70 static int bnx2fc_ctlr_alloc(struct net_device *netdev);
71 static int bnx2fc_ctlr_enabled(struct fcoe_ctlr_device *cdev);
72
73 static void bnx2fc_recv_frame(struct sk_buff *skb);
74
75 static void bnx2fc_start_disc(struct bnx2fc_interface *interface);
76 static int bnx2fc_shost_config(struct fc_lport *lport, struct device *dev);
77 static int bnx2fc_lport_config(struct fc_lport *lport);
78 static int bnx2fc_em_config(struct fc_lport *lport, struct bnx2fc_hba *hba);
79 static int bnx2fc_bind_adapter_devices(struct bnx2fc_hba *hba);
80 static void bnx2fc_unbind_adapter_devices(struct bnx2fc_hba *hba);
81 static int bnx2fc_bind_pcidev(struct bnx2fc_hba *hba);
82 static void bnx2fc_unbind_pcidev(struct bnx2fc_hba *hba);
83 static struct fc_lport *bnx2fc_if_create(struct bnx2fc_interface *interface,
84                                   struct device *parent, int npiv);
85 static void bnx2fc_port_destroy(struct fcoe_port *port);
86
87 static struct bnx2fc_hba *bnx2fc_hba_lookup(struct net_device *phys_dev);
88 static struct bnx2fc_interface *bnx2fc_interface_lookup(struct net_device
89                                                         *phys_dev);
90 static inline void bnx2fc_interface_put(struct bnx2fc_interface *interface);
91 static struct bnx2fc_hba *bnx2fc_find_hba_for_cnic(struct cnic_dev *cnic);
92
93 static int bnx2fc_fw_init(struct bnx2fc_hba *hba);
94 static void bnx2fc_fw_destroy(struct bnx2fc_hba *hba);
95
96 static void bnx2fc_port_shutdown(struct fc_lport *lport);
97 static void bnx2fc_stop(struct bnx2fc_interface *interface);
98 static int __init bnx2fc_mod_init(void);
99 static void __exit bnx2fc_mod_exit(void);
100
101 unsigned int bnx2fc_debug_level;
102 module_param_named(debug_logging, bnx2fc_debug_level, int, S_IRUGO|S_IWUSR);
103 MODULE_PARM_DESC(debug_logging,
104                 "Option to enable extended logging,\n"
105                 "\t\tDefault is 0 - no logging.\n"
106                 "\t\t0x01 - SCSI cmd error, cleanup.\n"
107                 "\t\t0x02 - Session setup, cleanup, etc.\n"
108                 "\t\t0x04 - lport events, link, mtu, etc.\n"
109                 "\t\t0x08 - ELS logs.\n"
110                 "\t\t0x10 - fcoe L2 fame related logs.\n"
111                 "\t\t0xff - LOG all messages.");
112
113 static uint bnx2fc_devloss_tmo;
114 module_param_named(devloss_tmo, bnx2fc_devloss_tmo, uint, S_IRUGO);
115 MODULE_PARM_DESC(devloss_tmo, " Change devloss_tmo for the remote ports "
116         "attached via bnx2fc.");
117
118 static uint bnx2fc_max_luns = BNX2FC_MAX_LUN;
119 module_param_named(max_luns, bnx2fc_max_luns, uint, S_IRUGO);
120 MODULE_PARM_DESC(max_luns, " Change the default max_lun per SCSI host. Default "
121         "0xffff.");
122
123 static uint bnx2fc_queue_depth;
124 module_param_named(queue_depth, bnx2fc_queue_depth, uint, S_IRUGO);
125 MODULE_PARM_DESC(queue_depth, " Change the default queue depth of SCSI devices "
126         "attached via bnx2fc.");
127
128 static uint bnx2fc_log_fka;
129 module_param_named(log_fka, bnx2fc_log_fka, uint, S_IRUGO|S_IWUSR);
130 MODULE_PARM_DESC(log_fka, " Print message to kernel log when fcoe is "
131         "initiating a FIP keep alive when debug logging is enabled.");
132
133 static inline struct net_device *bnx2fc_netdev(const struct fc_lport *lport)
134 {
135         return ((struct bnx2fc_interface *)
136                 ((struct fcoe_port *)lport_priv(lport))->priv)->netdev;
137 }
138
139 static void bnx2fc_fcf_get_vlan_id(struct fcoe_fcf_device *fcf_dev)
140 {
141         struct fcoe_ctlr_device *ctlr_dev =
142                 fcoe_fcf_dev_to_ctlr_dev(fcf_dev);
143         struct fcoe_ctlr *ctlr = fcoe_ctlr_device_priv(ctlr_dev);
144         struct bnx2fc_interface *fcoe = fcoe_ctlr_priv(ctlr);
145
146         fcf_dev->vlan_id = fcoe->vlan_id;
147 }
148
149 static void bnx2fc_clean_rx_queue(struct fc_lport *lp)
150 {
151         struct fcoe_percpu_s *bg;
152         struct fcoe_rcv_info *fr;
153         struct sk_buff_head *list;
154         struct sk_buff *skb, *next;
155
156         bg = &bnx2fc_global;
157         spin_lock_bh(&bg->fcoe_rx_list.lock);
158         list = &bg->fcoe_rx_list;
159         skb_queue_walk_safe(list, skb, next) {
160                 fr = fcoe_dev_from_skb(skb);
161                 if (fr->fr_dev == lp) {
162                         __skb_unlink(skb, list);
163                         kfree_skb(skb);
164                 }
165         }
166         spin_unlock_bh(&bg->fcoe_rx_list.lock);
167 }
168
169 int bnx2fc_get_paged_crc_eof(struct sk_buff *skb, int tlen)
170 {
171         int rc;
172         spin_lock(&bnx2fc_global_lock);
173         rc = fcoe_get_paged_crc_eof(skb, tlen, &bnx2fc_global);
174         spin_unlock(&bnx2fc_global_lock);
175
176         return rc;
177 }
178
179 static void bnx2fc_abort_io(struct fc_lport *lport)
180 {
181         /*
182          * This function is no-op for bnx2fc, but we do
183          * not want to leave it as NULL either, as libfc
184          * can call the default function which is
185          * fc_fcp_abort_io.
186          */
187 }
188
189 static void bnx2fc_cleanup(struct fc_lport *lport)
190 {
191         struct fcoe_port *port = lport_priv(lport);
192         struct bnx2fc_interface *interface = port->priv;
193         struct bnx2fc_hba *hba = interface->hba;
194         struct bnx2fc_rport *tgt;
195         int i;
196
197         BNX2FC_MISC_DBG("Entered %s\n", __func__);
198         mutex_lock(&hba->hba_mutex);
199         spin_lock_bh(&hba->hba_lock);
200         for (i = 0; i < BNX2FC_NUM_MAX_SESS; i++) {
201                 tgt = hba->tgt_ofld_list[i];
202                 if (tgt) {
203                         /* Cleanup IOs belonging to requested vport */
204                         if (tgt->port == port) {
205                                 spin_unlock_bh(&hba->hba_lock);
206                                 BNX2FC_TGT_DBG(tgt, "flush/cleanup\n");
207                                 bnx2fc_flush_active_ios(tgt);
208                                 spin_lock_bh(&hba->hba_lock);
209                         }
210                 }
211         }
212         spin_unlock_bh(&hba->hba_lock);
213         mutex_unlock(&hba->hba_mutex);
214 }
215
216 static int bnx2fc_xmit_l2_frame(struct bnx2fc_rport *tgt,
217                              struct fc_frame *fp)
218 {
219         struct fc_rport_priv *rdata = tgt->rdata;
220         struct fc_frame_header *fh;
221         int rc = 0;
222
223         fh = fc_frame_header_get(fp);
224         BNX2FC_TGT_DBG(tgt, "Xmit L2 frame rport = 0x%x, oxid = 0x%x, "
225                         "r_ctl = 0x%x\n", rdata->ids.port_id,
226                         ntohs(fh->fh_ox_id), fh->fh_r_ctl);
227         if ((fh->fh_type == FC_TYPE_ELS) &&
228             (fh->fh_r_ctl == FC_RCTL_ELS_REQ)) {
229
230                 switch (fc_frame_payload_op(fp)) {
231                 case ELS_ADISC:
232                         rc = bnx2fc_send_adisc(tgt, fp);
233                         break;
234                 case ELS_LOGO:
235                         rc = bnx2fc_send_logo(tgt, fp);
236                         break;
237                 case ELS_RLS:
238                         rc = bnx2fc_send_rls(tgt, fp);
239                         break;
240                 default:
241                         break;
242                 }
243         } else if ((fh->fh_type ==  FC_TYPE_BLS) &&
244             (fh->fh_r_ctl == FC_RCTL_BA_ABTS))
245                 BNX2FC_TGT_DBG(tgt, "ABTS frame\n");
246         else {
247                 BNX2FC_TGT_DBG(tgt, "Send L2 frame type 0x%x "
248                                 "rctl 0x%x thru non-offload path\n",
249                                 fh->fh_type, fh->fh_r_ctl);
250                 return -ENODEV;
251         }
252         if (rc)
253                 return -ENOMEM;
254         else
255                 return 0;
256 }
257
258 /**
259  * bnx2fc_xmit - bnx2fc's FCoE frame transmit function
260  *
261  * @lport:      the associated local port
262  * @fp: the fc_frame to be transmitted
263  */
264 static int bnx2fc_xmit(struct fc_lport *lport, struct fc_frame *fp)
265 {
266         struct ethhdr           *eh;
267         struct fcoe_crc_eof     *cp;
268         struct sk_buff          *skb;
269         struct fc_frame_header  *fh;
270         struct bnx2fc_interface *interface;
271         struct fcoe_ctlr        *ctlr;
272         struct bnx2fc_hba *hba;
273         struct fcoe_port        *port;
274         struct fcoe_hdr         *hp;
275         struct bnx2fc_rport     *tgt;
276         u8                      sof, eof;
277         u32                     crc;
278         unsigned int            hlen, tlen, elen;
279         int                     wlen, rc = 0;
280
281         port = (struct fcoe_port *)lport_priv(lport);
282         interface = port->priv;
283         ctlr = bnx2fc_to_ctlr(interface);
284         hba = interface->hba;
285
286         fh = fc_frame_header_get(fp);
287
288         skb = fp_skb(fp);
289         if (!lport->link_up) {
290                 BNX2FC_HBA_DBG(lport, "bnx2fc_xmit link down\n");
291                 kfree_skb(skb);
292                 return 0;
293         }
294
295         if (unlikely(fh->fh_r_ctl == FC_RCTL_ELS_REQ)) {
296                 if (!ctlr->sel_fcf) {
297                         BNX2FC_HBA_DBG(lport, "FCF not selected yet!\n");
298                         kfree_skb(skb);
299                         return -EINVAL;
300                 }
301                 if (fcoe_ctlr_els_send(ctlr, lport, skb))
302                         return 0;
303         }
304
305         sof = fr_sof(fp);
306         eof = fr_eof(fp);
307
308         /*
309          * Snoop the frame header to check if the frame is for
310          * an offloaded session
311          */
312         /*
313          * tgt_ofld_list access is synchronized using
314          * both hba mutex and hba lock. Atleast hba mutex or
315          * hba lock needs to be held for read access.
316          */
317
318         spin_lock_bh(&hba->hba_lock);
319         tgt = bnx2fc_tgt_lookup(port, ntoh24(fh->fh_d_id));
320         if (tgt && (test_bit(BNX2FC_FLAG_SESSION_READY, &tgt->flags))) {
321                 /* This frame is for offloaded session */
322                 BNX2FC_HBA_DBG(lport, "xmit: Frame is for offloaded session "
323                                 "port_id = 0x%x\n", ntoh24(fh->fh_d_id));
324                 spin_unlock_bh(&hba->hba_lock);
325                 rc = bnx2fc_xmit_l2_frame(tgt, fp);
326                 if (rc != -ENODEV) {
327                         kfree_skb(skb);
328                         return rc;
329                 }
330         } else {
331                 spin_unlock_bh(&hba->hba_lock);
332         }
333
334         elen = sizeof(struct ethhdr);
335         hlen = sizeof(struct fcoe_hdr);
336         tlen = sizeof(struct fcoe_crc_eof);
337         wlen = (skb->len - tlen + sizeof(crc)) / FCOE_WORD_TO_BYTE;
338
339         skb->ip_summed = CHECKSUM_NONE;
340         crc = fcoe_fc_crc(fp);
341
342         /* copy port crc and eof to the skb buff */
343         if (skb_is_nonlinear(skb)) {
344                 skb_frag_t *frag;
345                 if (bnx2fc_get_paged_crc_eof(skb, tlen)) {
346                         kfree_skb(skb);
347                         return -ENOMEM;
348                 }
349                 frag = &skb_shinfo(skb)->frags[skb_shinfo(skb)->nr_frags - 1];
350                 cp = kmap_atomic(skb_frag_page(frag)) + skb_frag_off(frag);
351         } else {
352                 cp = skb_put(skb, tlen);
353         }
354
355         memset(cp, 0, sizeof(*cp));
356         cp->fcoe_eof = eof;
357         cp->fcoe_crc32 = cpu_to_le32(~crc);
358         if (skb_is_nonlinear(skb)) {
359                 kunmap_atomic(cp);
360                 cp = NULL;
361         }
362
363         /* adjust skb network/transport offsets to match mac/fcoe/port */
364         skb_push(skb, elen + hlen);
365         skb_reset_mac_header(skb);
366         skb_reset_network_header(skb);
367         skb->mac_len = elen;
368         skb->protocol = htons(ETH_P_FCOE);
369         skb->dev = interface->netdev;
370
371         /* fill up mac and fcoe headers */
372         eh = eth_hdr(skb);
373         eh->h_proto = htons(ETH_P_FCOE);
374         if (ctlr->map_dest)
375                 fc_fcoe_set_mac(eh->h_dest, fh->fh_d_id);
376         else
377                 /* insert GW address */
378                 memcpy(eh->h_dest, ctlr->dest_addr, ETH_ALEN);
379
380         if (unlikely(ctlr->flogi_oxid != FC_XID_UNKNOWN))
381                 memcpy(eh->h_source, ctlr->ctl_src_addr, ETH_ALEN);
382         else
383                 memcpy(eh->h_source, port->data_src_addr, ETH_ALEN);
384
385         hp = (struct fcoe_hdr *)(eh + 1);
386         memset(hp, 0, sizeof(*hp));
387         if (FC_FCOE_VER)
388                 FC_FCOE_ENCAPS_VER(hp, FC_FCOE_VER);
389         hp->fcoe_sof = sof;
390
391         /* fcoe lso, mss is in max_payload which is non-zero for FCP data */
392         if (lport->seq_offload && fr_max_payload(fp)) {
393                 skb_shinfo(skb)->gso_type = SKB_GSO_FCOE;
394                 skb_shinfo(skb)->gso_size = fr_max_payload(fp);
395         } else {
396                 skb_shinfo(skb)->gso_type = 0;
397                 skb_shinfo(skb)->gso_size = 0;
398         }
399
400         /*update tx stats */
401         this_cpu_inc(lport->stats->TxFrames);
402         this_cpu_add(lport->stats->TxWords, wlen);
403
404         /* send down to lld */
405         fr_dev(fp) = lport;
406         if (port->fcoe_pending_queue.qlen)
407                 fcoe_check_wait_queue(lport, skb);
408         else if (fcoe_start_io(skb))
409                 fcoe_check_wait_queue(lport, skb);
410
411         return 0;
412 }
413
414 /**
415  * bnx2fc_rcv - This is bnx2fc's receive function called by NET_RX_SOFTIRQ
416  *
417  * @skb:        the receive socket buffer
418  * @dev:        associated net device
419  * @ptype:      context
420  * @olddev:     last device
421  *
422  * This function receives the packet and builds FC frame and passes it up
423  */
424 static int bnx2fc_rcv(struct sk_buff *skb, struct net_device *dev,
425                 struct packet_type *ptype, struct net_device *olddev)
426 {
427         struct fc_lport *lport;
428         struct bnx2fc_interface *interface;
429         struct fcoe_ctlr *ctlr;
430         struct fcoe_rcv_info *fr;
431         struct fcoe_percpu_s *bg;
432
433         interface = container_of(ptype, struct bnx2fc_interface,
434                                  fcoe_packet_type);
435         ctlr = bnx2fc_to_ctlr(interface);
436         lport = ctlr->lp;
437
438         if (unlikely(lport == NULL)) {
439                 printk(KERN_ERR PFX "bnx2fc_rcv: lport is NULL\n");
440                 goto err;
441         }
442
443         skb = skb_share_check(skb, GFP_ATOMIC);
444         if (!skb)
445                 return -1;
446
447         if (unlikely(eth_hdr(skb)->h_proto != htons(ETH_P_FCOE))) {
448                 printk(KERN_ERR PFX "bnx2fc_rcv: Wrong FC type frame\n");
449                 goto err;
450         }
451
452         /*
453          * Check for minimum frame length, and make sure required FCoE
454          * and FC headers are pulled into the linear data area.
455          */
456         if (unlikely((skb->len < FCOE_MIN_FRAME) ||
457             !pskb_may_pull(skb, FCOE_HEADER_LEN)))
458                 goto err;
459
460         skb_set_transport_header(skb, sizeof(struct fcoe_hdr));
461
462         fr = fcoe_dev_from_skb(skb);
463         fr->fr_dev = lport;
464
465         bg = &bnx2fc_global;
466         spin_lock(&bg->fcoe_rx_list.lock);
467
468         __skb_queue_tail(&bg->fcoe_rx_list, skb);
469         if (bg->fcoe_rx_list.qlen == 1)
470                 wake_up_process(bg->kthread);
471
472         spin_unlock(&bg->fcoe_rx_list.lock);
473
474         return 0;
475 err:
476         kfree_skb(skb);
477         return -1;
478 }
479
480 static int bnx2fc_l2_rcv_thread(void *arg)
481 {
482         struct fcoe_percpu_s *bg = arg;
483         struct sk_buff *skb;
484
485         set_user_nice(current, MIN_NICE);
486         set_current_state(TASK_INTERRUPTIBLE);
487         while (!kthread_should_stop()) {
488                 schedule();
489                 spin_lock_bh(&bg->fcoe_rx_list.lock);
490                 while ((skb = __skb_dequeue(&bg->fcoe_rx_list)) != NULL) {
491                         spin_unlock_bh(&bg->fcoe_rx_list.lock);
492                         bnx2fc_recv_frame(skb);
493                         spin_lock_bh(&bg->fcoe_rx_list.lock);
494                 }
495                 __set_current_state(TASK_INTERRUPTIBLE);
496                 spin_unlock_bh(&bg->fcoe_rx_list.lock);
497         }
498         __set_current_state(TASK_RUNNING);
499         return 0;
500 }
501
502
503 static void bnx2fc_recv_frame(struct sk_buff *skb)
504 {
505         u64 crc_err;
506         u32 fr_len, fr_crc;
507         struct fc_lport *lport;
508         struct fcoe_rcv_info *fr;
509         struct fc_frame_header *fh;
510         struct fcoe_crc_eof crc_eof;
511         struct fc_frame *fp;
512         struct fc_lport *vn_port;
513         struct fcoe_port *port, *phys_port;
514         u8 *mac = NULL;
515         u8 *dest_mac = NULL;
516         struct fcoe_hdr *hp;
517         struct bnx2fc_interface *interface;
518         struct fcoe_ctlr *ctlr;
519
520         fr = fcoe_dev_from_skb(skb);
521         lport = fr->fr_dev;
522         if (unlikely(lport == NULL)) {
523                 printk(KERN_ERR PFX "Invalid lport struct\n");
524                 kfree_skb(skb);
525                 return;
526         }
527
528         if (skb_is_nonlinear(skb))
529                 skb_linearize(skb);
530         mac = eth_hdr(skb)->h_source;
531         dest_mac = eth_hdr(skb)->h_dest;
532
533         /* Pull the header */
534         hp = (struct fcoe_hdr *) skb_network_header(skb);
535         fh = (struct fc_frame_header *) skb_transport_header(skb);
536         skb_pull(skb, sizeof(struct fcoe_hdr));
537         fr_len = skb->len - sizeof(struct fcoe_crc_eof);
538
539         this_cpu_inc(lport->stats->RxFrames);
540         this_cpu_add(lport->stats->RxWords, fr_len / FCOE_WORD_TO_BYTE);
541
542         fp = (struct fc_frame *)skb;
543         fc_frame_init(fp);
544         fr_dev(fp) = lport;
545         fr_sof(fp) = hp->fcoe_sof;
546         if (skb_copy_bits(skb, fr_len, &crc_eof, sizeof(crc_eof))) {
547                 kfree_skb(skb);
548                 return;
549         }
550         fr_eof(fp) = crc_eof.fcoe_eof;
551         fr_crc(fp) = crc_eof.fcoe_crc32;
552         if (pskb_trim(skb, fr_len)) {
553                 kfree_skb(skb);
554                 return;
555         }
556
557         phys_port = lport_priv(lport);
558         interface = phys_port->priv;
559         ctlr = bnx2fc_to_ctlr(interface);
560
561         fh = fc_frame_header_get(fp);
562
563         if (ntoh24(&dest_mac[3]) != ntoh24(fh->fh_d_id)) {
564                 BNX2FC_HBA_DBG(lport, "FC frame d_id mismatch with MAC %pM.\n",
565                     dest_mac);
566                 kfree_skb(skb);
567                 return;
568         }
569
570         vn_port = fc_vport_id_lookup(lport, ntoh24(fh->fh_d_id));
571         if (vn_port) {
572                 port = lport_priv(vn_port);
573                 if (!ether_addr_equal(port->data_src_addr, dest_mac)) {
574                         BNX2FC_HBA_DBG(lport, "fpma mismatch\n");
575                         kfree_skb(skb);
576                         return;
577                 }
578         }
579         if (ctlr->state) {
580                 if (!ether_addr_equal(mac, ctlr->dest_addr)) {
581                         BNX2FC_HBA_DBG(lport, "Wrong source address: mac:%pM dest_addr:%pM.\n",
582                             mac, ctlr->dest_addr);
583                         kfree_skb(skb);
584                         return;
585                 }
586         }
587         if (fh->fh_r_ctl == FC_RCTL_DD_SOL_DATA &&
588             fh->fh_type == FC_TYPE_FCP) {
589                 /* Drop FCP data. We dont this in L2 path */
590                 kfree_skb(skb);
591                 return;
592         }
593         if (fh->fh_r_ctl == FC_RCTL_ELS_REQ &&
594             fh->fh_type == FC_TYPE_ELS) {
595                 switch (fc_frame_payload_op(fp)) {
596                 case ELS_LOGO:
597                         if (ntoh24(fh->fh_s_id) == FC_FID_FLOGI) {
598                                 /* drop non-FIP LOGO */
599                                 kfree_skb(skb);
600                                 return;
601                         }
602                         break;
603                 }
604         }
605
606         if (fh->fh_r_ctl == FC_RCTL_BA_ABTS) {
607                 /* Drop incoming ABTS */
608                 kfree_skb(skb);
609                 return;
610         }
611
612         /*
613          * If the destination ID from the frame header does not match what we
614          * have on record for lport and the search for a NPIV port came up
615          * empty then this is not addressed to our port so simply drop it.
616          */
617         if (lport->port_id != ntoh24(fh->fh_d_id) && !vn_port) {
618                 BNX2FC_HBA_DBG(lport, "Dropping frame due to destination mismatch: lport->port_id=%x fh->d_id=%x.\n",
619                     lport->port_id, ntoh24(fh->fh_d_id));
620                 kfree_skb(skb);
621                 return;
622         }
623
624         fr_crc = le32_to_cpu(fr_crc(fp));
625
626         if (unlikely(fr_crc != ~crc32(~0, skb->data, fr_len))) {
627                 crc_err = this_cpu_inc_return(lport->stats->InvalidCRCCount);
628                 if (crc_err < 5)
629                         printk(KERN_WARNING PFX "dropping frame with "
630                                "CRC error\n");
631                 kfree_skb(skb);
632                 return;
633         }
634         fc_exch_recv(lport, fp);
635 }
636
637 /**
638  * bnx2fc_percpu_io_thread - thread per cpu for ios
639  *
640  * @arg:        ptr to bnx2fc_percpu_info structure
641  */
642 static int bnx2fc_percpu_io_thread(void *arg)
643 {
644         struct bnx2fc_percpu_s *p = arg;
645         struct bnx2fc_work *work, *tmp;
646         LIST_HEAD(work_list);
647
648         set_user_nice(current, MIN_NICE);
649         set_current_state(TASK_INTERRUPTIBLE);
650         while (!kthread_should_stop()) {
651                 schedule();
652                 spin_lock_bh(&p->fp_work_lock);
653                 while (!list_empty(&p->work_list)) {
654                         list_splice_init(&p->work_list, &work_list);
655                         spin_unlock_bh(&p->fp_work_lock);
656
657                         list_for_each_entry_safe(work, tmp, &work_list, list) {
658                                 list_del_init(&work->list);
659                                 bnx2fc_process_cq_compl(work->tgt, work->wqe,
660                                                         work->rq_data,
661                                                         work->num_rq,
662                                                         work->task);
663                                 kfree(work);
664                         }
665
666                         spin_lock_bh(&p->fp_work_lock);
667                 }
668                 __set_current_state(TASK_INTERRUPTIBLE);
669                 spin_unlock_bh(&p->fp_work_lock);
670         }
671         __set_current_state(TASK_RUNNING);
672
673         return 0;
674 }
675
676 static struct fc_host_statistics *bnx2fc_get_host_stats(struct Scsi_Host *shost)
677 {
678         struct fc_host_statistics *bnx2fc_stats;
679         struct fc_lport *lport = shost_priv(shost);
680         struct fcoe_port *port = lport_priv(lport);
681         struct bnx2fc_interface *interface = port->priv;
682         struct bnx2fc_hba *hba = interface->hba;
683         struct fcoe_statistics_params *fw_stats;
684         int rc = 0;
685
686         fw_stats = (struct fcoe_statistics_params *)hba->stats_buffer;
687         if (!fw_stats)
688                 return NULL;
689
690         mutex_lock(&hba->hba_stats_mutex);
691
692         bnx2fc_stats = fc_get_host_stats(shost);
693
694         init_completion(&hba->stat_req_done);
695         if (bnx2fc_send_stat_req(hba))
696                 goto unlock_stats_mutex;
697         rc = wait_for_completion_timeout(&hba->stat_req_done, (2 * HZ));
698         if (!rc) {
699                 BNX2FC_HBA_DBG(lport, "FW stat req timed out\n");
700                 goto unlock_stats_mutex;
701         }
702         BNX2FC_STATS(hba, rx_stat2, fc_crc_cnt);
703         bnx2fc_stats->invalid_crc_count += hba->bfw_stats.fc_crc_cnt;
704         BNX2FC_STATS(hba, tx_stat, fcoe_tx_pkt_cnt);
705         bnx2fc_stats->tx_frames += hba->bfw_stats.fcoe_tx_pkt_cnt;
706         BNX2FC_STATS(hba, tx_stat, fcoe_tx_byte_cnt);
707         bnx2fc_stats->tx_words += ((hba->bfw_stats.fcoe_tx_byte_cnt) / 4);
708         BNX2FC_STATS(hba, rx_stat0, fcoe_rx_pkt_cnt);
709         bnx2fc_stats->rx_frames += hba->bfw_stats.fcoe_rx_pkt_cnt;
710         BNX2FC_STATS(hba, rx_stat0, fcoe_rx_byte_cnt);
711         bnx2fc_stats->rx_words += ((hba->bfw_stats.fcoe_rx_byte_cnt) / 4);
712
713         bnx2fc_stats->dumped_frames = 0;
714         bnx2fc_stats->lip_count = 0;
715         bnx2fc_stats->nos_count = 0;
716         bnx2fc_stats->loss_of_sync_count = 0;
717         bnx2fc_stats->loss_of_signal_count = 0;
718         bnx2fc_stats->prim_seq_protocol_err_count = 0;
719
720         memcpy(&hba->prev_stats, hba->stats_buffer,
721                sizeof(struct fcoe_statistics_params));
722
723 unlock_stats_mutex:
724         mutex_unlock(&hba->hba_stats_mutex);
725         return bnx2fc_stats;
726 }
727
728 static int bnx2fc_shost_config(struct fc_lport *lport, struct device *dev)
729 {
730         struct fcoe_port *port = lport_priv(lport);
731         struct bnx2fc_interface *interface = port->priv;
732         struct bnx2fc_hba *hba = interface->hba;
733         struct Scsi_Host *shost = lport->host;
734         int rc = 0;
735
736         shost->max_cmd_len = BNX2FC_MAX_CMD_LEN;
737         shost->max_lun = bnx2fc_max_luns;
738         shost->max_id = BNX2FC_MAX_FCP_TGT;
739         shost->max_channel = 0;
740         if (lport->vport)
741                 shost->transportt = bnx2fc_vport_xport_template;
742         else
743                 shost->transportt = bnx2fc_transport_template;
744
745         /* Add the new host to SCSI-ml */
746         rc = scsi_add_host(lport->host, dev);
747         if (rc) {
748                 printk(KERN_ERR PFX "Error on scsi_add_host\n");
749                 return rc;
750         }
751         if (!lport->vport)
752                 fc_host_max_npiv_vports(lport->host) = USHRT_MAX;
753         snprintf(fc_host_symbolic_name(lport->host), 256,
754                  "%s (QLogic %s) v%s over %s",
755                 BNX2FC_NAME, hba->chip_num, BNX2FC_VERSION,
756                 interface->netdev->name);
757
758         return 0;
759 }
760
761 static int bnx2fc_link_ok(struct fc_lport *lport)
762 {
763         struct fcoe_port *port = lport_priv(lport);
764         struct bnx2fc_interface *interface = port->priv;
765         struct bnx2fc_hba *hba = interface->hba;
766         struct net_device *dev = hba->phys_dev;
767         int rc = 0;
768
769         if ((dev->flags & IFF_UP) && netif_carrier_ok(dev))
770                 clear_bit(ADAPTER_STATE_LINK_DOWN, &hba->adapter_state);
771         else {
772                 set_bit(ADAPTER_STATE_LINK_DOWN, &hba->adapter_state);
773                 rc = -1;
774         }
775         return rc;
776 }
777
778 /**
779  * bnx2fc_get_link_state - get network link state
780  *
781  * @hba:        adapter instance pointer
782  *
783  * updates adapter structure flag based on netdev state
784  */
785 void bnx2fc_get_link_state(struct bnx2fc_hba *hba)
786 {
787         if (test_bit(__LINK_STATE_NOCARRIER, &hba->phys_dev->state))
788                 set_bit(ADAPTER_STATE_LINK_DOWN, &hba->adapter_state);
789         else
790                 clear_bit(ADAPTER_STATE_LINK_DOWN, &hba->adapter_state);
791 }
792
793 static int bnx2fc_net_config(struct fc_lport *lport, struct net_device *netdev)
794 {
795         struct bnx2fc_hba *hba;
796         struct bnx2fc_interface *interface;
797         struct fcoe_ctlr *ctlr;
798         struct fcoe_port *port;
799         u64 wwnn, wwpn;
800
801         port = lport_priv(lport);
802         interface = port->priv;
803         ctlr = bnx2fc_to_ctlr(interface);
804         hba = interface->hba;
805
806         /* require support for get_pauseparam ethtool op. */
807         if (!hba->phys_dev->ethtool_ops ||
808             !hba->phys_dev->ethtool_ops->get_pauseparam)
809                 return -EOPNOTSUPP;
810
811         if (fc_set_mfs(lport, BNX2FC_MFS))
812                 return -EINVAL;
813
814         skb_queue_head_init(&port->fcoe_pending_queue);
815         port->fcoe_pending_queue_active = 0;
816         timer_setup(&port->timer, fcoe_queue_timer, 0);
817
818         fcoe_link_speed_update(lport);
819
820         if (!lport->vport) {
821                 if (fcoe_get_wwn(netdev, &wwnn, NETDEV_FCOE_WWNN))
822                         wwnn = fcoe_wwn_from_mac(ctlr->ctl_src_addr,
823                                                  1, 0);
824                 BNX2FC_HBA_DBG(lport, "WWNN = 0x%llx\n", wwnn);
825                 fc_set_wwnn(lport, wwnn);
826
827                 if (fcoe_get_wwn(netdev, &wwpn, NETDEV_FCOE_WWPN))
828                         wwpn = fcoe_wwn_from_mac(ctlr->ctl_src_addr,
829                                                  2, 0);
830
831                 BNX2FC_HBA_DBG(lport, "WWPN = 0x%llx\n", wwpn);
832                 fc_set_wwpn(lport, wwpn);
833         }
834
835         return 0;
836 }
837
838 static void bnx2fc_destroy_timer(struct timer_list *t)
839 {
840         struct bnx2fc_hba *hba = from_timer(hba, t, destroy_timer);
841
842         printk(KERN_ERR PFX "ERROR:bnx2fc_destroy_timer - "
843                "Destroy compl not received!!\n");
844         set_bit(BNX2FC_FLAG_DESTROY_CMPL, &hba->flags);
845         wake_up_interruptible(&hba->destroy_wait);
846 }
847
848 /**
849  * bnx2fc_indicate_netevent - Generic netdev event handler
850  *
851  * @context:    adapter structure pointer
852  * @event:      event type
853  * @vlan_id:    vlan id - associated vlan id with this event
854  *
855  * Handles NETDEV_UP, NETDEV_DOWN, NETDEV_GOING_DOWN,NETDEV_CHANGE and
856  * NETDEV_CHANGE_MTU events. Handle NETDEV_UNREGISTER only for vlans.
857  */
858 static void bnx2fc_indicate_netevent(void *context, unsigned long event,
859                                      u16 vlan_id)
860 {
861         struct bnx2fc_hba *hba = (struct bnx2fc_hba *)context;
862         struct fcoe_ctlr_device *cdev;
863         struct fc_lport *lport;
864         struct fc_lport *vport;
865         struct bnx2fc_interface *interface, *tmp;
866         struct fcoe_ctlr *ctlr;
867         int wait_for_upload = 0;
868         u32 link_possible = 1;
869
870         if (vlan_id != 0 && event != NETDEV_UNREGISTER)
871                 return;
872
873         switch (event) {
874         case NETDEV_UP:
875                 if (!test_bit(ADAPTER_STATE_UP, &hba->adapter_state))
876                         printk(KERN_ERR "indicate_netevent: "\
877                                         "hba is not UP!!\n");
878                 break;
879
880         case NETDEV_DOWN:
881                 clear_bit(ADAPTER_STATE_GOING_DOWN, &hba->adapter_state);
882                 clear_bit(ADAPTER_STATE_UP, &hba->adapter_state);
883                 link_possible = 0;
884                 break;
885
886         case NETDEV_GOING_DOWN:
887                 set_bit(ADAPTER_STATE_GOING_DOWN, &hba->adapter_state);
888                 link_possible = 0;
889                 break;
890
891         case NETDEV_CHANGE:
892                 break;
893
894         case NETDEV_UNREGISTER:
895                 if (!vlan_id)
896                         return;
897                 mutex_lock(&bnx2fc_dev_lock);
898                 list_for_each_entry_safe(interface, tmp, &if_list, list) {
899                         if (interface->hba == hba &&
900                             interface->vlan_id == (vlan_id & VLAN_VID_MASK))
901                                 __bnx2fc_destroy(interface);
902                 }
903                 mutex_unlock(&bnx2fc_dev_lock);
904                 return;
905
906         default:
907                 return;
908         }
909
910         mutex_lock(&bnx2fc_dev_lock);
911         list_for_each_entry(interface, &if_list, list) {
912
913                 if (interface->hba != hba)
914                         continue;
915
916                 ctlr = bnx2fc_to_ctlr(interface);
917                 lport = ctlr->lp;
918                 BNX2FC_HBA_DBG(lport, "netevent handler - event=%s %ld\n",
919                                 interface->netdev->name, event);
920
921                 fcoe_link_speed_update(lport);
922
923                 cdev = fcoe_ctlr_to_ctlr_dev(ctlr);
924
925                 if (link_possible && !bnx2fc_link_ok(lport)) {
926                         switch (cdev->enabled) {
927                         case FCOE_CTLR_DISABLED:
928                                 pr_info("Link up while interface is disabled.\n");
929                                 break;
930                         case FCOE_CTLR_ENABLED:
931                         case FCOE_CTLR_UNUSED:
932                                 /* Reset max recv frame size to default */
933                                 fc_set_mfs(lport, BNX2FC_MFS);
934                                 /*
935                                  * ctlr link up will only be handled during
936                                  * enable to avoid sending discovery
937                                  * solicitation on a stale vlan
938                                  */
939                                 if (interface->enabled)
940                                         fcoe_ctlr_link_up(ctlr);
941                         }
942                 } else if (fcoe_ctlr_link_down(ctlr)) {
943                         switch (cdev->enabled) {
944                         case FCOE_CTLR_DISABLED:
945                                 pr_info("Link down while interface is disabled.\n");
946                                 break;
947                         case FCOE_CTLR_ENABLED:
948                         case FCOE_CTLR_UNUSED:
949                                 mutex_lock(&lport->lp_mutex);
950                                 list_for_each_entry(vport, &lport->vports, list)
951                                         fc_host_port_type(vport->host) =
952                                         FC_PORTTYPE_UNKNOWN;
953                                 mutex_unlock(&lport->lp_mutex);
954                                 fc_host_port_type(lport->host) =
955                                         FC_PORTTYPE_UNKNOWN;
956                                 this_cpu_inc(lport->stats->LinkFailureCount);
957                                 fcoe_clean_pending_queue(lport);
958                                 wait_for_upload = 1;
959                         }
960                 }
961         }
962         mutex_unlock(&bnx2fc_dev_lock);
963
964         if (wait_for_upload) {
965                 clear_bit(ADAPTER_STATE_READY, &hba->adapter_state);
966                 init_waitqueue_head(&hba->shutdown_wait);
967                 BNX2FC_MISC_DBG("indicate_netevent "
968                                 "num_ofld_sess = %d\n",
969                                 hba->num_ofld_sess);
970                 hba->wait_for_link_down = 1;
971                 wait_event_interruptible(hba->shutdown_wait,
972                                          (hba->num_ofld_sess == 0));
973                 BNX2FC_MISC_DBG("wakeup - num_ofld_sess = %d\n",
974                                 hba->num_ofld_sess);
975                 hba->wait_for_link_down = 0;
976
977                 if (signal_pending(current))
978                         flush_signals(current);
979         }
980 }
981
982 static int bnx2fc_libfc_config(struct fc_lport *lport)
983 {
984
985         /* Set the function pointers set by bnx2fc driver */
986         memcpy(&lport->tt, &bnx2fc_libfc_fcn_templ,
987                 sizeof(struct libfc_function_template));
988         fc_elsct_init(lport);
989         fc_exch_init(lport);
990         fc_disc_init(lport);
991         fc_disc_config(lport, lport);
992         return 0;
993 }
994
995 static int bnx2fc_em_config(struct fc_lport *lport, struct bnx2fc_hba *hba)
996 {
997         int fcoe_min_xid, fcoe_max_xid;
998
999         fcoe_min_xid = hba->max_xid + 1;
1000         if (nr_cpu_ids <= 2)
1001                 fcoe_max_xid = hba->max_xid + FCOE_XIDS_PER_CPU_OFFSET;
1002         else
1003                 fcoe_max_xid = hba->max_xid + FCOE_MAX_XID_OFFSET;
1004         if (!fc_exch_mgr_alloc(lport, FC_CLASS_3, fcoe_min_xid,
1005                                fcoe_max_xid, NULL)) {
1006                 printk(KERN_ERR PFX "em_config:fc_exch_mgr_alloc failed\n");
1007                 return -ENOMEM;
1008         }
1009
1010         return 0;
1011 }
1012
1013 static int bnx2fc_lport_config(struct fc_lport *lport)
1014 {
1015         lport->link_up = 0;
1016         lport->qfull = 0;
1017         lport->max_retry_count = BNX2FC_MAX_RETRY_CNT;
1018         lport->max_rport_retry_count = BNX2FC_MAX_RPORT_RETRY_CNT;
1019         lport->e_d_tov = 2 * 1000;
1020         lport->r_a_tov = 10 * 1000;
1021
1022         lport->service_params = (FCP_SPPF_INIT_FCN | FCP_SPPF_RD_XRDY_DIS |
1023                                 FCP_SPPF_RETRY | FCP_SPPF_CONF_COMPL);
1024         lport->does_npiv = 1;
1025
1026         memset(&lport->rnid_gen, 0, sizeof(struct fc_els_rnid_gen));
1027         lport->rnid_gen.rnid_atype = BNX2FC_RNID_HBA;
1028
1029         /* alloc stats structure */
1030         if (fc_lport_init_stats(lport))
1031                 return -ENOMEM;
1032
1033         /* Finish fc_lport configuration */
1034         fc_lport_config(lport);
1035
1036         return 0;
1037 }
1038
1039 /**
1040  * bnx2fc_fip_recv - handle a received FIP frame.
1041  *
1042  * @skb: the received skb
1043  * @dev: associated &net_device
1044  * @ptype: the &packet_type structure which was used to register this handler.
1045  * @orig_dev: original receive &net_device, in case @ dev is a bond.
1046  *
1047  * Returns: 0 for success
1048  */
1049 static int bnx2fc_fip_recv(struct sk_buff *skb, struct net_device *dev,
1050                            struct packet_type *ptype,
1051                            struct net_device *orig_dev)
1052 {
1053         struct bnx2fc_interface *interface;
1054         struct fcoe_ctlr *ctlr;
1055         interface = container_of(ptype, struct bnx2fc_interface,
1056                                  fip_packet_type);
1057         ctlr = bnx2fc_to_ctlr(interface);
1058         fcoe_ctlr_recv(ctlr, skb);
1059         return 0;
1060 }
1061
1062 /**
1063  * bnx2fc_update_src_mac - Update Ethernet MAC filters.
1064  *
1065  * @lport: The local port
1066  * @addr: Location of data to copy
1067  *
1068  * Remove any previously-set unicast MAC filter.
1069  * Add secondary FCoE MAC address filter for our OUI.
1070  */
1071 static void bnx2fc_update_src_mac(struct fc_lport *lport, u8 *addr)
1072 {
1073         struct fcoe_port *port = lport_priv(lport);
1074
1075         memcpy(port->data_src_addr, addr, ETH_ALEN);
1076 }
1077
1078 /**
1079  * bnx2fc_get_src_mac - return the ethernet source address for an lport
1080  *
1081  * @lport: libfc port
1082  */
1083 static u8 *bnx2fc_get_src_mac(struct fc_lport *lport)
1084 {
1085         struct fcoe_port *port;
1086
1087         port = (struct fcoe_port *)lport_priv(lport);
1088         return port->data_src_addr;
1089 }
1090
1091 /**
1092  * bnx2fc_fip_send - send an Ethernet-encapsulated FIP frame.
1093  *
1094  * @fip: FCoE controller.
1095  * @skb: FIP Packet.
1096  */
1097 static void bnx2fc_fip_send(struct fcoe_ctlr *fip, struct sk_buff *skb)
1098 {
1099         struct fip_header *fiph;
1100         struct ethhdr *eth_hdr;
1101         u16 op;
1102         u8 sub;
1103
1104         fiph = (struct fip_header *) ((void *)skb->data + 2 * ETH_ALEN + 2);
1105         eth_hdr = (struct ethhdr *)skb_mac_header(skb);
1106         op = ntohs(fiph->fip_op);
1107         sub = fiph->fip_subcode;
1108
1109         if (op == FIP_OP_CTRL && sub == FIP_SC_SOL && bnx2fc_log_fka)
1110                 BNX2FC_MISC_DBG("Sending FKA from %pM to %pM.\n",
1111                     eth_hdr->h_source, eth_hdr->h_dest);
1112
1113         skb->dev = bnx2fc_from_ctlr(fip)->netdev;
1114         dev_queue_xmit(skb);
1115 }
1116
1117 static int bnx2fc_vport_create(struct fc_vport *vport, bool disabled)
1118 {
1119         struct Scsi_Host *shost = vport_to_shost(vport);
1120         struct fc_lport *n_port = shost_priv(shost);
1121         struct fcoe_port *port = lport_priv(n_port);
1122         struct bnx2fc_interface *interface = port->priv;
1123         struct net_device *netdev = interface->netdev;
1124         struct fc_lport *vn_port;
1125         int rc;
1126         char buf[32];
1127
1128         rc = fcoe_validate_vport_create(vport);
1129         if (rc) {
1130                 fcoe_wwn_to_str(vport->port_name, buf, sizeof(buf));
1131                 printk(KERN_ERR PFX "Failed to create vport, "
1132                        "WWPN (0x%s) already exists\n",
1133                        buf);
1134                 return rc;
1135         }
1136
1137         if (!test_bit(BNX2FC_FLAG_FW_INIT_DONE, &interface->hba->flags)) {
1138                 printk(KERN_ERR PFX "vn ports cannot be created on"
1139                         "this interface\n");
1140                 return -EIO;
1141         }
1142         rtnl_lock();
1143         mutex_lock(&bnx2fc_dev_lock);
1144         vn_port = bnx2fc_if_create(interface, &vport->dev, 1);
1145         mutex_unlock(&bnx2fc_dev_lock);
1146         rtnl_unlock();
1147
1148         if (!vn_port) {
1149                 printk(KERN_ERR PFX "bnx2fc_vport_create (%s) failed\n",
1150                         netdev->name);
1151                 return -EIO;
1152         }
1153
1154         if (bnx2fc_devloss_tmo)
1155                 fc_host_dev_loss_tmo(vn_port->host) = bnx2fc_devloss_tmo;
1156
1157         if (disabled) {
1158                 fc_vport_set_state(vport, FC_VPORT_DISABLED);
1159         } else {
1160                 vn_port->boot_time = jiffies;
1161                 fc_lport_init(vn_port);
1162                 fc_fabric_login(vn_port);
1163                 fc_vport_setlink(vn_port);
1164         }
1165         return 0;
1166 }
1167
1168 static void bnx2fc_free_vport(struct bnx2fc_hba *hba, struct fc_lport *lport)
1169 {
1170         struct bnx2fc_lport *blport, *tmp;
1171
1172         spin_lock_bh(&hba->hba_lock);
1173         list_for_each_entry_safe(blport, tmp, &hba->vports, list) {
1174                 if (blport->lport == lport) {
1175                         list_del(&blport->list);
1176                         kfree(blport);
1177                 }
1178         }
1179         spin_unlock_bh(&hba->hba_lock);
1180 }
1181
1182 static int bnx2fc_vport_destroy(struct fc_vport *vport)
1183 {
1184         struct Scsi_Host *shost = vport_to_shost(vport);
1185         struct fc_lport *n_port = shost_priv(shost);
1186         struct fc_lport *vn_port = vport->dd_data;
1187         struct fcoe_port *port = lport_priv(vn_port);
1188         struct bnx2fc_interface *interface = port->priv;
1189         struct fc_lport *v_port;
1190         bool found = false;
1191
1192         mutex_lock(&n_port->lp_mutex);
1193         list_for_each_entry(v_port, &n_port->vports, list)
1194                 if (v_port->vport == vport) {
1195                         found = true;
1196                         break;
1197                 }
1198
1199         if (!found) {
1200                 mutex_unlock(&n_port->lp_mutex);
1201                 return -ENOENT;
1202         }
1203         list_del(&vn_port->list);
1204         mutex_unlock(&n_port->lp_mutex);
1205         bnx2fc_free_vport(interface->hba, port->lport);
1206         bnx2fc_port_shutdown(port->lport);
1207         bnx2fc_port_destroy(port);
1208         bnx2fc_interface_put(interface);
1209         return 0;
1210 }
1211
1212 static int bnx2fc_vport_disable(struct fc_vport *vport, bool disable)
1213 {
1214         struct fc_lport *lport = vport->dd_data;
1215
1216         if (disable) {
1217                 fc_vport_set_state(vport, FC_VPORT_DISABLED);
1218                 fc_fabric_logoff(lport);
1219         } else {
1220                 lport->boot_time = jiffies;
1221                 fc_fabric_login(lport);
1222                 fc_vport_setlink(lport);
1223         }
1224         return 0;
1225 }
1226
1227
1228 static int bnx2fc_interface_setup(struct bnx2fc_interface *interface)
1229 {
1230         struct net_device *netdev = interface->netdev;
1231         struct net_device *physdev = interface->hba->phys_dev;
1232         struct fcoe_ctlr *ctlr = bnx2fc_to_ctlr(interface);
1233         struct netdev_hw_addr *ha;
1234         int sel_san_mac = 0;
1235
1236         /* setup Source MAC Address */
1237         rcu_read_lock();
1238         for_each_dev_addr(physdev, ha) {
1239                 BNX2FC_MISC_DBG("net_config: ha->type = %d, fip_mac = ",
1240                                 ha->type);
1241                 printk(KERN_INFO "%2x:%2x:%2x:%2x:%2x:%2x\n", ha->addr[0],
1242                                 ha->addr[1], ha->addr[2], ha->addr[3],
1243                                 ha->addr[4], ha->addr[5]);
1244
1245                 if ((ha->type == NETDEV_HW_ADDR_T_SAN) &&
1246                     (is_valid_ether_addr(ha->addr))) {
1247                         memcpy(ctlr->ctl_src_addr, ha->addr,
1248                                ETH_ALEN);
1249                         sel_san_mac = 1;
1250                         BNX2FC_MISC_DBG("Found SAN MAC\n");
1251                 }
1252         }
1253         rcu_read_unlock();
1254
1255         if (!sel_san_mac)
1256                 return -ENODEV;
1257
1258         interface->fip_packet_type.func = bnx2fc_fip_recv;
1259         interface->fip_packet_type.type = htons(ETH_P_FIP);
1260         interface->fip_packet_type.dev = netdev;
1261         dev_add_pack(&interface->fip_packet_type);
1262
1263         interface->fcoe_packet_type.func = bnx2fc_rcv;
1264         interface->fcoe_packet_type.type = __constant_htons(ETH_P_FCOE);
1265         interface->fcoe_packet_type.dev = netdev;
1266         dev_add_pack(&interface->fcoe_packet_type);
1267
1268         return 0;
1269 }
1270
1271 static int bnx2fc_attach_transport(void)
1272 {
1273         bnx2fc_transport_template =
1274                 fc_attach_transport(&bnx2fc_transport_function);
1275
1276         if (bnx2fc_transport_template == NULL) {
1277                 printk(KERN_ERR PFX "Failed to attach FC transport\n");
1278                 return -ENODEV;
1279         }
1280
1281         bnx2fc_vport_xport_template =
1282                 fc_attach_transport(&bnx2fc_vport_xport_function);
1283         if (bnx2fc_vport_xport_template == NULL) {
1284                 printk(KERN_ERR PFX
1285                        "Failed to attach FC transport for vport\n");
1286                 fc_release_transport(bnx2fc_transport_template);
1287                 bnx2fc_transport_template = NULL;
1288                 return -ENODEV;
1289         }
1290         return 0;
1291 }
1292 static void bnx2fc_release_transport(void)
1293 {
1294         fc_release_transport(bnx2fc_transport_template);
1295         fc_release_transport(bnx2fc_vport_xport_template);
1296         bnx2fc_transport_template = NULL;
1297         bnx2fc_vport_xport_template = NULL;
1298 }
1299
1300 static void bnx2fc_interface_release(struct kref *kref)
1301 {
1302         struct fcoe_ctlr_device *ctlr_dev;
1303         struct bnx2fc_interface *interface;
1304         struct fcoe_ctlr *ctlr;
1305         struct net_device *netdev;
1306
1307         interface = container_of(kref, struct bnx2fc_interface, kref);
1308         BNX2FC_MISC_DBG("Interface is being released\n");
1309
1310         ctlr = bnx2fc_to_ctlr(interface);
1311         ctlr_dev = fcoe_ctlr_to_ctlr_dev(ctlr);
1312         netdev = interface->netdev;
1313
1314         /* tear-down FIP controller */
1315         if (test_and_clear_bit(BNX2FC_CTLR_INIT_DONE, &interface->if_flags))
1316                 fcoe_ctlr_destroy(ctlr);
1317
1318         fcoe_ctlr_device_delete(ctlr_dev);
1319
1320         dev_put(netdev);
1321         module_put(THIS_MODULE);
1322 }
1323
1324 static inline void bnx2fc_interface_get(struct bnx2fc_interface *interface)
1325 {
1326         kref_get(&interface->kref);
1327 }
1328
1329 static inline void bnx2fc_interface_put(struct bnx2fc_interface *interface)
1330 {
1331         kref_put(&interface->kref, bnx2fc_interface_release);
1332 }
1333 static void bnx2fc_hba_destroy(struct bnx2fc_hba *hba)
1334 {
1335         /* Free the command manager */
1336         if (hba->cmd_mgr) {
1337                 bnx2fc_cmd_mgr_free(hba->cmd_mgr);
1338                 hba->cmd_mgr = NULL;
1339         }
1340         kfree(hba->tgt_ofld_list);
1341         bnx2fc_unbind_pcidev(hba);
1342         kfree(hba);
1343 }
1344
1345 /**
1346  * bnx2fc_hba_create - create a new bnx2fc hba
1347  *
1348  * @cnic:       pointer to cnic device
1349  *
1350  * Creates a new FCoE hba on the given device.
1351  *
1352  */
1353 static struct bnx2fc_hba *bnx2fc_hba_create(struct cnic_dev *cnic)
1354 {
1355         struct bnx2fc_hba *hba;
1356         struct fcoe_capabilities *fcoe_cap;
1357         int rc;
1358
1359         hba = kzalloc(sizeof(*hba), GFP_KERNEL);
1360         if (!hba) {
1361                 printk(KERN_ERR PFX "Unable to allocate hba structure\n");
1362                 return NULL;
1363         }
1364         spin_lock_init(&hba->hba_lock);
1365         mutex_init(&hba->hba_mutex);
1366         mutex_init(&hba->hba_stats_mutex);
1367
1368         hba->cnic = cnic;
1369
1370         hba->max_tasks = cnic->max_fcoe_exchanges;
1371         hba->elstm_xids = (hba->max_tasks / 2);
1372         hba->max_outstanding_cmds = hba->elstm_xids;
1373         hba->max_xid = (hba->max_tasks - 1);
1374
1375         rc = bnx2fc_bind_pcidev(hba);
1376         if (rc) {
1377                 printk(KERN_ERR PFX "create_adapter:  bind error\n");
1378                 goto bind_err;
1379         }
1380         hba->phys_dev = cnic->netdev;
1381         hba->next_conn_id = 0;
1382
1383         hba->tgt_ofld_list =
1384                 kcalloc(BNX2FC_NUM_MAX_SESS, sizeof(struct bnx2fc_rport *),
1385                         GFP_KERNEL);
1386         if (!hba->tgt_ofld_list) {
1387                 printk(KERN_ERR PFX "Unable to allocate tgt offload list\n");
1388                 goto tgtofld_err;
1389         }
1390
1391         hba->num_ofld_sess = 0;
1392
1393         hba->cmd_mgr = bnx2fc_cmd_mgr_alloc(hba);
1394         if (!hba->cmd_mgr) {
1395                 printk(KERN_ERR PFX "em_config:bnx2fc_cmd_mgr_alloc failed\n");
1396                 goto cmgr_err;
1397         }
1398         fcoe_cap = &hba->fcoe_cap;
1399
1400         fcoe_cap->capability1 = BNX2FC_TM_MAX_SQES <<
1401                                         FCOE_IOS_PER_CONNECTION_SHIFT;
1402         fcoe_cap->capability1 |= BNX2FC_NUM_MAX_SESS <<
1403                                         FCOE_LOGINS_PER_PORT_SHIFT;
1404         fcoe_cap->capability2 = hba->max_outstanding_cmds <<
1405                                         FCOE_NUMBER_OF_EXCHANGES_SHIFT;
1406         fcoe_cap->capability2 |= BNX2FC_MAX_NPIV <<
1407                                         FCOE_NPIV_WWN_PER_PORT_SHIFT;
1408         fcoe_cap->capability3 = BNX2FC_NUM_MAX_SESS <<
1409                                         FCOE_TARGETS_SUPPORTED_SHIFT;
1410         fcoe_cap->capability3 |= hba->max_outstanding_cmds <<
1411                                         FCOE_OUTSTANDING_COMMANDS_SHIFT;
1412         fcoe_cap->capability4 = FCOE_CAPABILITY4_STATEFUL;
1413
1414         init_waitqueue_head(&hba->shutdown_wait);
1415         init_waitqueue_head(&hba->destroy_wait);
1416         INIT_LIST_HEAD(&hba->vports);
1417
1418         return hba;
1419
1420 cmgr_err:
1421         kfree(hba->tgt_ofld_list);
1422 tgtofld_err:
1423         bnx2fc_unbind_pcidev(hba);
1424 bind_err:
1425         kfree(hba);
1426         return NULL;
1427 }
1428
1429 static struct bnx2fc_interface *
1430 bnx2fc_interface_create(struct bnx2fc_hba *hba,
1431                         struct net_device *netdev,
1432                         enum fip_mode fip_mode)
1433 {
1434         struct fcoe_ctlr_device *ctlr_dev;
1435         struct bnx2fc_interface *interface;
1436         struct fcoe_ctlr *ctlr;
1437         int size;
1438         int rc = 0;
1439
1440         size = (sizeof(*interface) + sizeof(struct fcoe_ctlr));
1441         ctlr_dev = fcoe_ctlr_device_add(&netdev->dev, &bnx2fc_fcoe_sysfs_templ,
1442                                          size);
1443         if (!ctlr_dev) {
1444                 printk(KERN_ERR PFX "Unable to allocate interface structure\n");
1445                 return NULL;
1446         }
1447         ctlr = fcoe_ctlr_device_priv(ctlr_dev);
1448         ctlr->cdev = ctlr_dev;
1449         interface = fcoe_ctlr_priv(ctlr);
1450         dev_hold(netdev);
1451         kref_init(&interface->kref);
1452         interface->hba = hba;
1453         interface->netdev = netdev;
1454
1455         /* Initialize FIP */
1456         fcoe_ctlr_init(ctlr, fip_mode);
1457         ctlr->send = bnx2fc_fip_send;
1458         ctlr->update_mac = bnx2fc_update_src_mac;
1459         ctlr->get_src_addr = bnx2fc_get_src_mac;
1460         set_bit(BNX2FC_CTLR_INIT_DONE, &interface->if_flags);
1461
1462         rc = bnx2fc_interface_setup(interface);
1463         if (!rc)
1464                 return interface;
1465
1466         fcoe_ctlr_destroy(ctlr);
1467         dev_put(netdev);
1468         fcoe_ctlr_device_delete(ctlr_dev);
1469         return NULL;
1470 }
1471
1472 /**
1473  * bnx2fc_if_create - Create FCoE instance on a given interface
1474  *
1475  * @interface:  FCoE interface to create a local port on
1476  * @parent:     Device pointer to be the parent in sysfs for the SCSI host
1477  * @npiv:       Indicates if the port is vport or not
1478  *
1479  * Creates a fc_lport instance and a Scsi_Host instance and configure them.
1480  *
1481  * Returns:     Allocated fc_lport or an error pointer
1482  */
1483 static struct fc_lport *bnx2fc_if_create(struct bnx2fc_interface *interface,
1484                                   struct device *parent, int npiv)
1485 {
1486         struct fcoe_ctlr        *ctlr = bnx2fc_to_ctlr(interface);
1487         struct fc_lport         *lport, *n_port;
1488         struct fcoe_port        *port;
1489         struct Scsi_Host        *shost;
1490         struct fc_vport         *vport = dev_to_vport(parent);
1491         struct bnx2fc_lport     *blport;
1492         struct bnx2fc_hba       *hba = interface->hba;
1493         int                     rc = 0;
1494
1495         blport = kzalloc(sizeof(struct bnx2fc_lport), GFP_KERNEL);
1496         if (!blport) {
1497                 BNX2FC_HBA_DBG(ctlr->lp, "Unable to alloc blport\n");
1498                 return NULL;
1499         }
1500
1501         /* Allocate Scsi_Host structure */
1502         bnx2fc_shost_template.can_queue = hba->max_outstanding_cmds;
1503         if (!npiv)
1504                 lport = libfc_host_alloc(&bnx2fc_shost_template, sizeof(*port));
1505         else
1506                 lport = libfc_vport_create(vport, sizeof(*port));
1507
1508         if (!lport) {
1509                 printk(KERN_ERR PFX "could not allocate scsi host structure\n");
1510                 goto free_blport;
1511         }
1512         shost = lport->host;
1513         port = lport_priv(lport);
1514         port->lport = lport;
1515         port->priv = interface;
1516         port->get_netdev = bnx2fc_netdev;
1517
1518         /* Configure fcoe_port */
1519         rc = bnx2fc_lport_config(lport);
1520         if (rc)
1521                 goto lp_config_err;
1522
1523         if (npiv) {
1524                 printk(KERN_ERR PFX "Setting vport names, 0x%llX 0x%llX\n",
1525                         vport->node_name, vport->port_name);
1526                 fc_set_wwnn(lport, vport->node_name);
1527                 fc_set_wwpn(lport, vport->port_name);
1528         }
1529         /* Configure netdev and networking properties of the lport */
1530         rc = bnx2fc_net_config(lport, interface->netdev);
1531         if (rc) {
1532                 printk(KERN_ERR PFX "Error on bnx2fc_net_config\n");
1533                 goto lp_config_err;
1534         }
1535
1536         rc = bnx2fc_shost_config(lport, parent);
1537         if (rc) {
1538                 printk(KERN_ERR PFX "Couldn't configure shost for %s\n",
1539                         interface->netdev->name);
1540                 goto lp_config_err;
1541         }
1542
1543         /* Initialize the libfc library */
1544         rc = bnx2fc_libfc_config(lport);
1545         if (rc) {
1546                 printk(KERN_ERR PFX "Couldn't configure libfc\n");
1547                 goto shost_err;
1548         }
1549         fc_host_port_type(lport->host) = FC_PORTTYPE_UNKNOWN;
1550
1551         if (bnx2fc_devloss_tmo)
1552                 fc_host_dev_loss_tmo(shost) = bnx2fc_devloss_tmo;
1553
1554         /* Allocate exchange manager */
1555         if (!npiv)
1556                 rc = bnx2fc_em_config(lport, hba);
1557         else {
1558                 shost = vport_to_shost(vport);
1559                 n_port = shost_priv(shost);
1560                 rc = fc_exch_mgr_list_clone(n_port, lport);
1561         }
1562
1563         if (rc) {
1564                 printk(KERN_ERR PFX "Error on bnx2fc_em_config\n");
1565                 goto shost_err;
1566         }
1567
1568         bnx2fc_interface_get(interface);
1569
1570         spin_lock_bh(&hba->hba_lock);
1571         blport->lport = lport;
1572         list_add_tail(&blport->list, &hba->vports);
1573         spin_unlock_bh(&hba->hba_lock);
1574
1575         return lport;
1576
1577 shost_err:
1578         scsi_remove_host(shost);
1579 lp_config_err:
1580         scsi_host_put(lport->host);
1581 free_blport:
1582         kfree(blport);
1583         return NULL;
1584 }
1585
1586 static void bnx2fc_net_cleanup(struct bnx2fc_interface *interface)
1587 {
1588         /* Dont listen for Ethernet packets anymore */
1589         __dev_remove_pack(&interface->fcoe_packet_type);
1590         __dev_remove_pack(&interface->fip_packet_type);
1591         synchronize_net();
1592 }
1593
1594 static void bnx2fc_interface_cleanup(struct bnx2fc_interface *interface)
1595 {
1596         struct fcoe_ctlr *ctlr = bnx2fc_to_ctlr(interface);
1597         struct fc_lport *lport = ctlr->lp;
1598         struct fcoe_port *port = lport_priv(lport);
1599         struct bnx2fc_hba *hba = interface->hba;
1600
1601         /* Stop the transmit retry timer */
1602         del_timer_sync(&port->timer);
1603
1604         /* Free existing transmit skbs */
1605         fcoe_clean_pending_queue(lport);
1606
1607         bnx2fc_net_cleanup(interface);
1608
1609         bnx2fc_free_vport(hba, lport);
1610 }
1611
1612 static void bnx2fc_if_destroy(struct fc_lport *lport)
1613 {
1614
1615         /* Free queued packets for the receive thread */
1616         bnx2fc_clean_rx_queue(lport);
1617
1618         /* Detach from scsi-ml */
1619         fc_remove_host(lport->host);
1620         scsi_remove_host(lport->host);
1621
1622         /*
1623          * Note that only the physical lport will have the exchange manager.
1624          * for vports, this function is NOP
1625          */
1626         fc_exch_mgr_free(lport);
1627
1628         /* Free memory used by statistical counters */
1629         fc_lport_free_stats(lport);
1630
1631         /* Release Scsi_Host */
1632         scsi_host_put(lport->host);
1633 }
1634
1635 static void __bnx2fc_destroy(struct bnx2fc_interface *interface)
1636 {
1637         struct fcoe_ctlr *ctlr = bnx2fc_to_ctlr(interface);
1638         struct fc_lport *lport = ctlr->lp;
1639         struct fcoe_port *port = lport_priv(lport);
1640
1641         bnx2fc_interface_cleanup(interface);
1642         bnx2fc_stop(interface);
1643         list_del(&interface->list);
1644         bnx2fc_port_destroy(port);
1645         bnx2fc_interface_put(interface);
1646 }
1647
1648 /**
1649  * bnx2fc_destroy - Destroy a bnx2fc FCoE interface
1650  *
1651  * @netdev: The net device that the FCoE interface is on
1652  *
1653  * Called from sysfs.
1654  *
1655  * Returns: 0 for success
1656  */
1657 static int bnx2fc_destroy(struct net_device *netdev)
1658 {
1659         struct bnx2fc_interface *interface = NULL;
1660         struct workqueue_struct *timer_work_queue;
1661         struct fcoe_ctlr *ctlr;
1662         int rc = 0;
1663
1664         rtnl_lock();
1665         mutex_lock(&bnx2fc_dev_lock);
1666
1667         interface = bnx2fc_interface_lookup(netdev);
1668         ctlr = bnx2fc_to_ctlr(interface);
1669         if (!interface || !ctlr->lp) {
1670                 rc = -ENODEV;
1671                 printk(KERN_ERR PFX "bnx2fc_destroy: interface or lport not found\n");
1672                 goto netdev_err;
1673         }
1674
1675         timer_work_queue = interface->timer_work_queue;
1676         __bnx2fc_destroy(interface);
1677         destroy_workqueue(timer_work_queue);
1678
1679 netdev_err:
1680         mutex_unlock(&bnx2fc_dev_lock);
1681         rtnl_unlock();
1682         return rc;
1683 }
1684
1685 static void bnx2fc_port_destroy(struct fcoe_port *port)
1686 {
1687         struct fc_lport *lport;
1688
1689         lport = port->lport;
1690         BNX2FC_HBA_DBG(lport, "Entered %s, destroying lport %p\n", __func__, lport);
1691
1692         bnx2fc_if_destroy(lport);
1693 }
1694
1695 static void bnx2fc_unbind_adapter_devices(struct bnx2fc_hba *hba)
1696 {
1697         bnx2fc_free_fw_resc(hba);
1698         bnx2fc_free_task_ctx(hba);
1699 }
1700
1701 /**
1702  * bnx2fc_bind_adapter_devices - binds bnx2fc adapter with the associated
1703  *                      pci structure
1704  *
1705  * @hba:                Adapter instance
1706  */
1707 static int bnx2fc_bind_adapter_devices(struct bnx2fc_hba *hba)
1708 {
1709         if (bnx2fc_setup_task_ctx(hba))
1710                 goto mem_err;
1711
1712         if (bnx2fc_setup_fw_resc(hba))
1713                 goto mem_err;
1714
1715         return 0;
1716 mem_err:
1717         bnx2fc_unbind_adapter_devices(hba);
1718         return -ENOMEM;
1719 }
1720
1721 static int bnx2fc_bind_pcidev(struct bnx2fc_hba *hba)
1722 {
1723         struct cnic_dev *cnic;
1724         struct pci_dev *pdev;
1725
1726         if (!hba->cnic) {
1727                 printk(KERN_ERR PFX "cnic is NULL\n");
1728                 return -ENODEV;
1729         }
1730         cnic = hba->cnic;
1731         pdev = hba->pcidev = cnic->pcidev;
1732         if (!hba->pcidev)
1733                 return -ENODEV;
1734
1735         switch (pdev->device) {
1736         case PCI_DEVICE_ID_NX2_57710:
1737                 strscpy(hba->chip_num, "BCM57710", sizeof(hba->chip_num));
1738                 break;
1739         case PCI_DEVICE_ID_NX2_57711:
1740                 strscpy(hba->chip_num, "BCM57711", sizeof(hba->chip_num));
1741                 break;
1742         case PCI_DEVICE_ID_NX2_57712:
1743         case PCI_DEVICE_ID_NX2_57712_MF:
1744         case PCI_DEVICE_ID_NX2_57712_VF:
1745                 strscpy(hba->chip_num, "BCM57712", sizeof(hba->chip_num));
1746                 break;
1747         case PCI_DEVICE_ID_NX2_57800:
1748         case PCI_DEVICE_ID_NX2_57800_MF:
1749         case PCI_DEVICE_ID_NX2_57800_VF:
1750                 strscpy(hba->chip_num, "BCM57800", sizeof(hba->chip_num));
1751                 break;
1752         case PCI_DEVICE_ID_NX2_57810:
1753         case PCI_DEVICE_ID_NX2_57810_MF:
1754         case PCI_DEVICE_ID_NX2_57810_VF:
1755                 strscpy(hba->chip_num, "BCM57810", sizeof(hba->chip_num));
1756                 break;
1757         case PCI_DEVICE_ID_NX2_57840:
1758         case PCI_DEVICE_ID_NX2_57840_MF:
1759         case PCI_DEVICE_ID_NX2_57840_VF:
1760         case PCI_DEVICE_ID_NX2_57840_2_20:
1761         case PCI_DEVICE_ID_NX2_57840_4_10:
1762                 strscpy(hba->chip_num, "BCM57840", sizeof(hba->chip_num));
1763                 break;
1764         default:
1765                 pr_err(PFX "Unknown device id 0x%x\n", pdev->device);
1766                 break;
1767         }
1768         pci_dev_get(hba->pcidev);
1769         return 0;
1770 }
1771
1772 static void bnx2fc_unbind_pcidev(struct bnx2fc_hba *hba)
1773 {
1774         if (hba->pcidev) {
1775                 hba->chip_num[0] = '\0';
1776                 pci_dev_put(hba->pcidev);
1777         }
1778         hba->pcidev = NULL;
1779 }
1780
1781 /**
1782  * bnx2fc_ulp_get_stats - cnic callback to populate FCoE stats
1783  *
1784  * @handle:    transport handle pointing to adapter structure
1785  */
1786 static int bnx2fc_ulp_get_stats(void *handle)
1787 {
1788         struct bnx2fc_hba *hba = handle;
1789         struct cnic_dev *cnic;
1790         struct fcoe_stats_info *stats_addr;
1791
1792         if (!hba)
1793                 return -EINVAL;
1794
1795         cnic = hba->cnic;
1796         stats_addr = &cnic->stats_addr->fcoe_stat;
1797         if (!stats_addr)
1798                 return -EINVAL;
1799
1800         strscpy(stats_addr->version, BNX2FC_VERSION,
1801                 sizeof(stats_addr->version));
1802         stats_addr->txq_size = BNX2FC_SQ_WQES_MAX;
1803         stats_addr->rxq_size = BNX2FC_CQ_WQES_MAX;
1804
1805         return 0;
1806 }
1807
1808
1809 /**
1810  * bnx2fc_ulp_start - cnic callback to initialize & start adapter instance
1811  *
1812  * @handle:     transport handle pointing to adapter structure
1813  *
1814  * This function maps adapter structure to pcidev structure and initiates
1815  *      firmware handshake to enable/initialize on-chip FCoE components.
1816  *      This bnx2fc - cnic interface api callback is used after following
1817  *      conditions are met -
1818  *      a) underlying network interface is up (marked by event NETDEV_UP
1819  *              from netdev
1820  *      b) bnx2fc adatper structure is registered.
1821  */
1822 static void bnx2fc_ulp_start(void *handle)
1823 {
1824         struct bnx2fc_hba *hba = handle;
1825         struct bnx2fc_interface *interface;
1826         struct fcoe_ctlr *ctlr;
1827         struct fc_lport *lport;
1828
1829         mutex_lock(&bnx2fc_dev_lock);
1830
1831         if (!test_bit(BNX2FC_FLAG_FW_INIT_DONE, &hba->flags))
1832                 bnx2fc_fw_init(hba);
1833
1834         BNX2FC_MISC_DBG("bnx2fc started.\n");
1835
1836         list_for_each_entry(interface, &if_list, list) {
1837                 if (interface->hba == hba) {
1838                         ctlr = bnx2fc_to_ctlr(interface);
1839                         lport = ctlr->lp;
1840                         /* Kick off Fabric discovery*/
1841                         printk(KERN_ERR PFX "ulp_init: start discovery\n");
1842                         lport->tt.frame_send = bnx2fc_xmit;
1843                         bnx2fc_start_disc(interface);
1844                 }
1845         }
1846
1847         mutex_unlock(&bnx2fc_dev_lock);
1848 }
1849
1850 static void bnx2fc_port_shutdown(struct fc_lport *lport)
1851 {
1852         BNX2FC_MISC_DBG("Entered %s\n", __func__);
1853         fc_fabric_logoff(lport);
1854         fc_lport_destroy(lport);
1855 }
1856
1857 static void bnx2fc_stop(struct bnx2fc_interface *interface)
1858 {
1859         struct fcoe_ctlr *ctlr = bnx2fc_to_ctlr(interface);
1860         struct fc_lport *lport;
1861         struct fc_lport *vport;
1862
1863         if (!test_bit(BNX2FC_FLAG_FW_INIT_DONE, &interface->hba->flags))
1864                 return;
1865
1866         lport = ctlr->lp;
1867         bnx2fc_port_shutdown(lport);
1868
1869         mutex_lock(&lport->lp_mutex);
1870         list_for_each_entry(vport, &lport->vports, list)
1871                 fc_host_port_type(vport->host) =
1872                                         FC_PORTTYPE_UNKNOWN;
1873         mutex_unlock(&lport->lp_mutex);
1874         fc_host_port_type(lport->host) = FC_PORTTYPE_UNKNOWN;
1875         fcoe_ctlr_link_down(ctlr);
1876         fcoe_clean_pending_queue(lport);
1877 }
1878
1879 static int bnx2fc_fw_init(struct bnx2fc_hba *hba)
1880 {
1881 #define BNX2FC_INIT_POLL_TIME           (1000 / HZ)
1882         int rc = -1;
1883         int i = HZ;
1884
1885         rc = bnx2fc_bind_adapter_devices(hba);
1886         if (rc) {
1887                 printk(KERN_ALERT PFX
1888                         "bnx2fc_bind_adapter_devices failed - rc = %d\n", rc);
1889                 goto err_out;
1890         }
1891
1892         rc = bnx2fc_send_fw_fcoe_init_msg(hba);
1893         if (rc) {
1894                 printk(KERN_ALERT PFX
1895                         "bnx2fc_send_fw_fcoe_init_msg failed - rc = %d\n", rc);
1896                 goto err_unbind;
1897         }
1898
1899         /*
1900          * Wait until the adapter init message is complete, and adapter
1901          * state is UP.
1902          */
1903         while (!test_bit(ADAPTER_STATE_UP, &hba->adapter_state) && i--)
1904                 msleep(BNX2FC_INIT_POLL_TIME);
1905
1906         if (!test_bit(ADAPTER_STATE_UP, &hba->adapter_state)) {
1907                 printk(KERN_ERR PFX "bnx2fc_start: %s failed to initialize.  "
1908                                 "Ignoring...\n",
1909                                 hba->cnic->netdev->name);
1910                 rc = -1;
1911                 goto err_unbind;
1912         }
1913
1914
1915         set_bit(BNX2FC_FLAG_FW_INIT_DONE, &hba->flags);
1916         return 0;
1917
1918 err_unbind:
1919         bnx2fc_unbind_adapter_devices(hba);
1920 err_out:
1921         return rc;
1922 }
1923
1924 static void bnx2fc_fw_destroy(struct bnx2fc_hba *hba)
1925 {
1926         if (test_and_clear_bit(BNX2FC_FLAG_FW_INIT_DONE, &hba->flags)) {
1927                 if (bnx2fc_send_fw_fcoe_destroy_msg(hba) == 0) {
1928                         timer_setup(&hba->destroy_timer, bnx2fc_destroy_timer,
1929                                     0);
1930                         hba->destroy_timer.expires = BNX2FC_FW_TIMEOUT +
1931                                                                 jiffies;
1932                         add_timer(&hba->destroy_timer);
1933                         wait_event_interruptible(hba->destroy_wait,
1934                                         test_bit(BNX2FC_FLAG_DESTROY_CMPL,
1935                                                  &hba->flags));
1936                         clear_bit(BNX2FC_FLAG_DESTROY_CMPL, &hba->flags);
1937                         /* This should never happen */
1938                         if (signal_pending(current))
1939                                 flush_signals(current);
1940
1941                         del_timer_sync(&hba->destroy_timer);
1942                 }
1943                 bnx2fc_unbind_adapter_devices(hba);
1944         }
1945 }
1946
1947 /**
1948  * bnx2fc_ulp_stop - cnic callback to shutdown adapter instance
1949  *
1950  * @handle:     transport handle pointing to adapter structure
1951  *
1952  * Driver checks if adapter is already in shutdown mode, if not start
1953  *      the shutdown process.
1954  */
1955 static void bnx2fc_ulp_stop(void *handle)
1956 {
1957         struct bnx2fc_hba *hba = handle;
1958         struct bnx2fc_interface *interface;
1959
1960         printk(KERN_ERR "ULP_STOP\n");
1961
1962         mutex_lock(&bnx2fc_dev_lock);
1963         if (!test_bit(BNX2FC_FLAG_FW_INIT_DONE, &hba->flags))
1964                 goto exit;
1965         list_for_each_entry(interface, &if_list, list) {
1966                 if (interface->hba == hba)
1967                         bnx2fc_stop(interface);
1968         }
1969         BUG_ON(hba->num_ofld_sess != 0);
1970
1971         mutex_lock(&hba->hba_mutex);
1972         clear_bit(ADAPTER_STATE_UP, &hba->adapter_state);
1973         clear_bit(ADAPTER_STATE_GOING_DOWN,
1974                   &hba->adapter_state);
1975
1976         clear_bit(ADAPTER_STATE_READY, &hba->adapter_state);
1977         mutex_unlock(&hba->hba_mutex);
1978
1979         bnx2fc_fw_destroy(hba);
1980 exit:
1981         mutex_unlock(&bnx2fc_dev_lock);
1982 }
1983
1984 static void bnx2fc_start_disc(struct bnx2fc_interface *interface)
1985 {
1986         struct fcoe_ctlr *ctlr = bnx2fc_to_ctlr(interface);
1987         struct fc_lport *lport;
1988         int wait_cnt = 0;
1989
1990         BNX2FC_MISC_DBG("Entered %s\n", __func__);
1991         /* Kick off FIP/FLOGI */
1992         if (!test_bit(BNX2FC_FLAG_FW_INIT_DONE, &interface->hba->flags)) {
1993                 printk(KERN_ERR PFX "Init not done yet\n");
1994                 return;
1995         }
1996
1997         lport = ctlr->lp;
1998         BNX2FC_HBA_DBG(lport, "calling fc_fabric_login\n");
1999
2000         if (!bnx2fc_link_ok(lport) && interface->enabled) {
2001                 BNX2FC_HBA_DBG(lport, "ctlr_link_up\n");
2002                 fcoe_ctlr_link_up(ctlr);
2003                 fc_host_port_type(lport->host) = FC_PORTTYPE_NPORT;
2004                 set_bit(ADAPTER_STATE_READY, &interface->hba->adapter_state);
2005         }
2006
2007         /* wait for the FCF to be selected before issuing FLOGI */
2008         while (!ctlr->sel_fcf) {
2009                 msleep(250);
2010                 /* give up after 3 secs */
2011                 if (++wait_cnt > 12)
2012                         break;
2013         }
2014
2015         /* Reset max receive frame size to default */
2016         if (fc_set_mfs(lport, BNX2FC_MFS))
2017                 return;
2018
2019         fc_lport_init(lport);
2020         fc_fabric_login(lport);
2021 }
2022
2023
2024 /**
2025  * bnx2fc_ulp_init - Initialize an adapter instance
2026  *
2027  * @dev :       cnic device handle
2028  * Called from cnic_register_driver() context to initialize all
2029  *      enumerated cnic devices. This routine allocates adapter structure
2030  *      and other device specific resources.
2031  */
2032 static void bnx2fc_ulp_init(struct cnic_dev *dev)
2033 {
2034         struct bnx2fc_hba *hba;
2035         int rc = 0;
2036
2037         BNX2FC_MISC_DBG("Entered %s\n", __func__);
2038         /* bnx2fc works only when bnx2x is loaded */
2039         if (!test_bit(CNIC_F_BNX2X_CLASS, &dev->flags) ||
2040             (dev->max_fcoe_conn == 0)) {
2041                 printk(KERN_ERR PFX "bnx2fc FCoE not supported on %s,"
2042                                     " flags: %lx fcoe_conn: %d\n",
2043                         dev->netdev->name, dev->flags, dev->max_fcoe_conn);
2044                 return;
2045         }
2046
2047         hba = bnx2fc_hba_create(dev);
2048         if (!hba) {
2049                 printk(KERN_ERR PFX "hba initialization failed\n");
2050                 return;
2051         }
2052
2053         pr_info(PFX "FCoE initialized for %s.\n", dev->netdev->name);
2054
2055         /* Add HBA to the adapter list */
2056         mutex_lock(&bnx2fc_dev_lock);
2057         list_add_tail(&hba->list, &adapter_list);
2058         adapter_count++;
2059         mutex_unlock(&bnx2fc_dev_lock);
2060
2061         dev->fcoe_cap = &hba->fcoe_cap;
2062         clear_bit(BNX2FC_CNIC_REGISTERED, &hba->reg_with_cnic);
2063         rc = dev->register_device(dev, CNIC_ULP_FCOE,
2064                                                 (void *) hba);
2065         if (rc)
2066                 printk(KERN_ERR PFX "register_device failed, rc = %d\n", rc);
2067         else
2068                 set_bit(BNX2FC_CNIC_REGISTERED, &hba->reg_with_cnic);
2069 }
2070
2071 /* Assumes rtnl_lock and the bnx2fc_dev_lock are already taken */
2072 static int __bnx2fc_disable(struct fcoe_ctlr *ctlr)
2073 {
2074         struct bnx2fc_interface *interface = fcoe_ctlr_priv(ctlr);
2075
2076         if (interface->enabled) {
2077                 if (!ctlr->lp) {
2078                         pr_err(PFX "__bnx2fc_disable: lport not found\n");
2079                         return -ENODEV;
2080                 } else {
2081                         interface->enabled = false;
2082                         fcoe_ctlr_link_down(ctlr);
2083                         fcoe_clean_pending_queue(ctlr->lp);
2084                 }
2085         }
2086         return 0;
2087 }
2088
2089 /*
2090  * Deperecated: Use bnx2fc_enabled()
2091  */
2092 static int bnx2fc_disable(struct net_device *netdev)
2093 {
2094         struct bnx2fc_interface *interface;
2095         struct fcoe_ctlr *ctlr;
2096         int rc = 0;
2097
2098         rtnl_lock();
2099         mutex_lock(&bnx2fc_dev_lock);
2100
2101         interface = bnx2fc_interface_lookup(netdev);
2102         ctlr = bnx2fc_to_ctlr(interface);
2103
2104         if (!interface) {
2105                 rc = -ENODEV;
2106                 pr_err(PFX "bnx2fc_disable: interface not found\n");
2107         } else {
2108                 rc = __bnx2fc_disable(ctlr);
2109         }
2110         mutex_unlock(&bnx2fc_dev_lock);
2111         rtnl_unlock();
2112         return rc;
2113 }
2114
2115 static uint bnx2fc_npiv_create_vports(struct fc_lport *lport,
2116                                       struct cnic_fc_npiv_tbl *npiv_tbl)
2117 {
2118         struct fc_vport_identifiers vpid;
2119         uint i, created = 0;
2120         u64 wwnn = 0;
2121         char wwpn_str[32];
2122         char wwnn_str[32];
2123
2124         if (npiv_tbl->count > MAX_NPIV_ENTRIES) {
2125                 BNX2FC_HBA_DBG(lport, "Exceeded count max of npiv table\n");
2126                 goto done;
2127         }
2128
2129         /* Sanity check the first entry to make sure it's not 0 */
2130         if (wwn_to_u64(npiv_tbl->wwnn[0]) == 0 &&
2131             wwn_to_u64(npiv_tbl->wwpn[0]) == 0) {
2132                 BNX2FC_HBA_DBG(lport, "First NPIV table entries invalid.\n");
2133                 goto done;
2134         }
2135
2136         vpid.roles = FC_PORT_ROLE_FCP_INITIATOR;
2137         vpid.vport_type = FC_PORTTYPE_NPIV;
2138         vpid.disable = false;
2139
2140         for (i = 0; i < npiv_tbl->count; i++) {
2141                 wwnn = wwn_to_u64(npiv_tbl->wwnn[i]);
2142                 if (wwnn == 0) {
2143                         /*
2144                          * If we get a 0 element from for the WWNN then assume
2145                          * the WWNN should be the same as the physical port.
2146                          */
2147                         wwnn = lport->wwnn;
2148                 }
2149                 vpid.node_name = wwnn;
2150                 vpid.port_name = wwn_to_u64(npiv_tbl->wwpn[i]);
2151                 scnprintf(vpid.symbolic_name, sizeof(vpid.symbolic_name),
2152                     "NPIV[%u]:%016llx-%016llx",
2153                     created, vpid.port_name, vpid.node_name);
2154                 fcoe_wwn_to_str(vpid.node_name, wwnn_str, sizeof(wwnn_str));
2155                 fcoe_wwn_to_str(vpid.port_name, wwpn_str, sizeof(wwpn_str));
2156                 BNX2FC_HBA_DBG(lport, "Creating vport %s:%s.\n", wwnn_str,
2157                     wwpn_str);
2158                 if (fc_vport_create(lport->host, 0, &vpid))
2159                         created++;
2160                 else
2161                         BNX2FC_HBA_DBG(lport, "Failed to create vport\n");
2162         }
2163 done:
2164         return created;
2165 }
2166
2167 static int __bnx2fc_enable(struct fcoe_ctlr *ctlr)
2168 {
2169         struct bnx2fc_interface *interface = fcoe_ctlr_priv(ctlr);
2170         struct bnx2fc_hba *hba;
2171         struct cnic_fc_npiv_tbl *npiv_tbl;
2172         struct fc_lport *lport;
2173
2174         if (!interface->enabled) {
2175                 if (!ctlr->lp) {
2176                         pr_err(PFX "__bnx2fc_enable: lport not found\n");
2177                         return -ENODEV;
2178                 } else if (!bnx2fc_link_ok(ctlr->lp)) {
2179                         fcoe_ctlr_link_up(ctlr);
2180                         interface->enabled = true;
2181                 }
2182         }
2183
2184         /* Create static NPIV ports if any are contained in NVRAM */
2185         hba = interface->hba;
2186         lport = ctlr->lp;
2187
2188         if (!hba)
2189                 goto done;
2190
2191         if (!hba->cnic)
2192                 goto done;
2193
2194         if (!lport)
2195                 goto done;
2196
2197         if (!lport->host)
2198                 goto done;
2199
2200         if (!hba->cnic->get_fc_npiv_tbl)
2201                 goto done;
2202
2203         npiv_tbl = kzalloc(sizeof(struct cnic_fc_npiv_tbl), GFP_KERNEL);
2204         if (!npiv_tbl)
2205                 goto done;
2206
2207         if (hba->cnic->get_fc_npiv_tbl(hba->cnic, npiv_tbl))
2208                 goto done_free;
2209
2210         bnx2fc_npiv_create_vports(lport, npiv_tbl);
2211 done_free:
2212         kfree(npiv_tbl);
2213 done:
2214         return 0;
2215 }
2216
2217 /*
2218  * Deprecated: Use bnx2fc_enabled()
2219  */
2220 static int bnx2fc_enable(struct net_device *netdev)
2221 {
2222         struct bnx2fc_interface *interface;
2223         struct fcoe_ctlr *ctlr;
2224         int rc = 0;
2225
2226         rtnl_lock();
2227         mutex_lock(&bnx2fc_dev_lock);
2228
2229         interface = bnx2fc_interface_lookup(netdev);
2230         ctlr = bnx2fc_to_ctlr(interface);
2231         if (!interface) {
2232                 rc = -ENODEV;
2233                 pr_err(PFX "bnx2fc_enable: interface not found\n");
2234         } else {
2235                 rc = __bnx2fc_enable(ctlr);
2236         }
2237
2238         mutex_unlock(&bnx2fc_dev_lock);
2239         rtnl_unlock();
2240         return rc;
2241 }
2242
2243 /**
2244  * bnx2fc_ctlr_enabled() - Enable or disable an FCoE Controller
2245  * @cdev: The FCoE Controller that is being enabled or disabled
2246  *
2247  * fcoe_sysfs will ensure that the state of 'enabled' has
2248  * changed, so no checking is necessary here. This routine simply
2249  * calls fcoe_enable or fcoe_disable, both of which are deprecated.
2250  * When those routines are removed the functionality can be merged
2251  * here.
2252  */
2253 static int bnx2fc_ctlr_enabled(struct fcoe_ctlr_device *cdev)
2254 {
2255         struct fcoe_ctlr *ctlr = fcoe_ctlr_device_priv(cdev);
2256
2257         switch (cdev->enabled) {
2258         case FCOE_CTLR_ENABLED:
2259                 return __bnx2fc_enable(ctlr);
2260         case FCOE_CTLR_DISABLED:
2261                 return __bnx2fc_disable(ctlr);
2262         case FCOE_CTLR_UNUSED:
2263         default:
2264                 return -ENOTSUPP;
2265         }
2266 }
2267
2268 enum bnx2fc_create_link_state {
2269         BNX2FC_CREATE_LINK_DOWN,
2270         BNX2FC_CREATE_LINK_UP,
2271 };
2272
2273 /**
2274  * _bnx2fc_create() - Create bnx2fc FCoE interface
2275  * @netdev  :   The net_device object the Ethernet interface to create on
2276  * @fip_mode:   The FIP mode for this creation
2277  * @link_state: The ctlr link state on creation
2278  *
2279  * Called from either the libfcoe 'create' module parameter
2280  * via fcoe_create or from fcoe_syfs's ctlr_create file.
2281  *
2282  * libfcoe's 'create' module parameter is deprecated so some
2283  * consolidation of code can be done when that interface is
2284  * removed.
2285  *
2286  * Returns: 0 for success
2287  */
2288 static int _bnx2fc_create(struct net_device *netdev,
2289                           enum fip_mode fip_mode,
2290                           enum bnx2fc_create_link_state link_state)
2291 {
2292         struct fcoe_ctlr_device *cdev;
2293         struct fcoe_ctlr *ctlr;
2294         struct bnx2fc_interface *interface;
2295         struct bnx2fc_hba *hba;
2296         struct net_device *phys_dev = netdev;
2297         struct fc_lport *lport;
2298         struct ethtool_drvinfo drvinfo;
2299         int rc = 0;
2300         int vlan_id = 0;
2301
2302         BNX2FC_MISC_DBG("Entered bnx2fc_create\n");
2303         if (fip_mode != FIP_MODE_FABRIC) {
2304                 printk(KERN_ERR "fip mode not FABRIC\n");
2305                 return -EIO;
2306         }
2307
2308         rtnl_lock();
2309
2310         mutex_lock(&bnx2fc_dev_lock);
2311
2312         if (!try_module_get(THIS_MODULE)) {
2313                 rc = -EINVAL;
2314                 goto mod_err;
2315         }
2316
2317         /* obtain physical netdev */
2318         if (is_vlan_dev(netdev))
2319                 phys_dev = vlan_dev_real_dev(netdev);
2320
2321         /* verify if the physical device is a netxtreme2 device */
2322         if (phys_dev->ethtool_ops && phys_dev->ethtool_ops->get_drvinfo) {
2323                 memset(&drvinfo, 0, sizeof(drvinfo));
2324                 phys_dev->ethtool_ops->get_drvinfo(phys_dev, &drvinfo);
2325                 if (strncmp(drvinfo.driver, "bnx2x", strlen("bnx2x"))) {
2326                         printk(KERN_ERR PFX "Not a netxtreme2 device\n");
2327                         rc = -EINVAL;
2328                         goto netdev_err;
2329                 }
2330         } else {
2331                 printk(KERN_ERR PFX "unable to obtain drv_info\n");
2332                 rc = -EINVAL;
2333                 goto netdev_err;
2334         }
2335
2336         /* obtain interface and initialize rest of the structure */
2337         hba = bnx2fc_hba_lookup(phys_dev);
2338         if (!hba) {
2339                 rc = -ENODEV;
2340                 printk(KERN_ERR PFX "bnx2fc_create: hba not found\n");
2341                 goto netdev_err;
2342         }
2343
2344         if (bnx2fc_interface_lookup(netdev)) {
2345                 rc = -EEXIST;
2346                 goto netdev_err;
2347         }
2348
2349         interface = bnx2fc_interface_create(hba, netdev, fip_mode);
2350         if (!interface) {
2351                 printk(KERN_ERR PFX "bnx2fc_interface_create failed\n");
2352                 rc = -ENOMEM;
2353                 goto netdev_err;
2354         }
2355
2356         if (is_vlan_dev(netdev)) {
2357                 vlan_id = vlan_dev_vlan_id(netdev);
2358                 interface->vlan_enabled = 1;
2359         }
2360
2361         ctlr = bnx2fc_to_ctlr(interface);
2362         cdev = fcoe_ctlr_to_ctlr_dev(ctlr);
2363         interface->vlan_id = vlan_id;
2364         interface->tm_timeout = BNX2FC_TM_TIMEOUT;
2365
2366         interface->timer_work_queue = alloc_ordered_workqueue(
2367                 "%s", WQ_MEM_RECLAIM, "bnx2fc_timer_wq");
2368         if (!interface->timer_work_queue) {
2369                 printk(KERN_ERR PFX "ulp_init could not create timer_wq\n");
2370                 rc = -EINVAL;
2371                 goto ifput_err;
2372         }
2373
2374         lport = bnx2fc_if_create(interface, &cdev->dev, 0);
2375         if (!lport) {
2376                 printk(KERN_ERR PFX "Failed to create interface (%s)\n",
2377                         netdev->name);
2378                 rc = -EINVAL;
2379                 goto if_create_err;
2380         }
2381
2382         /* Add interface to if_list */
2383         list_add_tail(&interface->list, &if_list);
2384
2385         lport->boot_time = jiffies;
2386
2387         /* Make this master N_port */
2388         ctlr->lp = lport;
2389
2390         if (link_state == BNX2FC_CREATE_LINK_UP)
2391                 cdev->enabled = FCOE_CTLR_ENABLED;
2392         else
2393                 cdev->enabled = FCOE_CTLR_DISABLED;
2394
2395         if (link_state == BNX2FC_CREATE_LINK_UP &&
2396             !bnx2fc_link_ok(lport)) {
2397                 fcoe_ctlr_link_up(ctlr);
2398                 fc_host_port_type(lport->host) = FC_PORTTYPE_NPORT;
2399                 set_bit(ADAPTER_STATE_READY, &interface->hba->adapter_state);
2400         }
2401
2402         BNX2FC_HBA_DBG(lport, "create: START DISC\n");
2403         bnx2fc_start_disc(interface);
2404
2405         if (link_state == BNX2FC_CREATE_LINK_UP)
2406                 interface->enabled = true;
2407
2408         /*
2409          * Release from kref_init in bnx2fc_interface_setup, on success
2410          * lport should be holding a reference taken in bnx2fc_if_create
2411          */
2412         bnx2fc_interface_put(interface);
2413         /* put netdev that was held while calling dev_get_by_name */
2414         mutex_unlock(&bnx2fc_dev_lock);
2415         rtnl_unlock();
2416         return 0;
2417
2418 if_create_err:
2419         destroy_workqueue(interface->timer_work_queue);
2420 ifput_err:
2421         bnx2fc_net_cleanup(interface);
2422         bnx2fc_interface_put(interface);
2423         goto mod_err;
2424 netdev_err:
2425         module_put(THIS_MODULE);
2426 mod_err:
2427         mutex_unlock(&bnx2fc_dev_lock);
2428         rtnl_unlock();
2429         return rc;
2430 }
2431
2432 /**
2433  * bnx2fc_create() - Create a bnx2fc interface
2434  * @netdev  : The net_device object the Ethernet interface to create on
2435  * @fip_mode: The FIP mode for this creation
2436  *
2437  * Called from fcoe transport
2438  *
2439  * Returns: 0 for success
2440  */
2441 static int bnx2fc_create(struct net_device *netdev, enum fip_mode fip_mode)
2442 {
2443         return _bnx2fc_create(netdev, fip_mode, BNX2FC_CREATE_LINK_UP);
2444 }
2445
2446 /**
2447  * bnx2fc_ctlr_alloc() - Allocate a bnx2fc interface from fcoe_sysfs
2448  * @netdev: The net_device to be used by the allocated FCoE Controller
2449  *
2450  * This routine is called from fcoe_sysfs. It will start the fcoe_ctlr
2451  * in a link_down state. The allows the user an opportunity to configure
2452  * the FCoE Controller from sysfs before enabling the FCoE Controller.
2453  *
2454  * Creating in with this routine starts the FCoE Controller in Fabric
2455  * mode. The user can change to VN2VN or another mode before enabling.
2456  */
2457 static int bnx2fc_ctlr_alloc(struct net_device *netdev)
2458 {
2459         return _bnx2fc_create(netdev, FIP_MODE_FABRIC,
2460                               BNX2FC_CREATE_LINK_DOWN);
2461 }
2462
2463 /**
2464  * bnx2fc_find_hba_for_cnic - maps cnic instance to bnx2fc hba instance
2465  *
2466  * @cnic:       Pointer to cnic device instance
2467  *
2468  **/
2469 static struct bnx2fc_hba *bnx2fc_find_hba_for_cnic(struct cnic_dev *cnic)
2470 {
2471         struct bnx2fc_hba *hba;
2472
2473         /* Called with bnx2fc_dev_lock held */
2474         list_for_each_entry(hba, &adapter_list, list) {
2475                 if (hba->cnic == cnic)
2476                         return hba;
2477         }
2478         return NULL;
2479 }
2480
2481 static struct bnx2fc_interface *bnx2fc_interface_lookup(struct net_device
2482                                                         *netdev)
2483 {
2484         struct bnx2fc_interface *interface;
2485
2486         /* Called with bnx2fc_dev_lock held */
2487         list_for_each_entry(interface, &if_list, list) {
2488                 if (interface->netdev == netdev)
2489                         return interface;
2490         }
2491         return NULL;
2492 }
2493
2494 static struct bnx2fc_hba *bnx2fc_hba_lookup(struct net_device
2495                                                       *phys_dev)
2496 {
2497         struct bnx2fc_hba *hba;
2498
2499         /* Called with bnx2fc_dev_lock held */
2500         list_for_each_entry(hba, &adapter_list, list) {
2501                 if (hba->phys_dev == phys_dev)
2502                         return hba;
2503         }
2504         printk(KERN_ERR PFX "adapter_lookup: hba NULL\n");
2505         return NULL;
2506 }
2507
2508 /**
2509  * bnx2fc_ulp_exit - shuts down adapter instance and frees all resources
2510  *
2511  * @dev:        cnic device handle
2512  */
2513 static void bnx2fc_ulp_exit(struct cnic_dev *dev)
2514 {
2515         struct bnx2fc_hba *hba;
2516         struct bnx2fc_interface *interface, *tmp;
2517
2518         BNX2FC_MISC_DBG("Entered bnx2fc_ulp_exit\n");
2519
2520         if (!test_bit(CNIC_F_BNX2X_CLASS, &dev->flags)) {
2521                 printk(KERN_ERR PFX "bnx2fc port check: %s, flags: %lx\n",
2522                         dev->netdev->name, dev->flags);
2523                 return;
2524         }
2525
2526         mutex_lock(&bnx2fc_dev_lock);
2527         hba = bnx2fc_find_hba_for_cnic(dev);
2528         if (!hba) {
2529                 printk(KERN_ERR PFX "bnx2fc_ulp_exit: hba not found, dev 0%p\n",
2530                        dev);
2531                 mutex_unlock(&bnx2fc_dev_lock);
2532                 return;
2533         }
2534
2535         list_del_init(&hba->list);
2536         adapter_count--;
2537
2538         list_for_each_entry_safe(interface, tmp, &if_list, list)
2539                 /* destroy not called yet, move to quiesced list */
2540                 if (interface->hba == hba)
2541                         __bnx2fc_destroy(interface);
2542         mutex_unlock(&bnx2fc_dev_lock);
2543
2544         bnx2fc_ulp_stop(hba);
2545         /* unregister cnic device */
2546         if (test_and_clear_bit(BNX2FC_CNIC_REGISTERED, &hba->reg_with_cnic))
2547                 hba->cnic->unregister_device(hba->cnic, CNIC_ULP_FCOE);
2548         bnx2fc_hba_destroy(hba);
2549 }
2550
2551 static void bnx2fc_rport_terminate_io(struct fc_rport *rport)
2552 {
2553         /* This is a no-op */
2554 }
2555
2556 /**
2557  * bnx2fc_fcoe_reset - Resets the fcoe
2558  *
2559  * @shost: shost the reset is from
2560  *
2561  * Returns: always 0
2562  */
2563 static int bnx2fc_fcoe_reset(struct Scsi_Host *shost)
2564 {
2565         struct fc_lport *lport = shost_priv(shost);
2566         fc_lport_reset(lport);
2567         return 0;
2568 }
2569
2570
2571 static bool bnx2fc_match(struct net_device *netdev)
2572 {
2573         struct net_device *phys_dev = netdev;
2574
2575         mutex_lock(&bnx2fc_dev_lock);
2576         if (is_vlan_dev(netdev))
2577                 phys_dev = vlan_dev_real_dev(netdev);
2578
2579         if (bnx2fc_hba_lookup(phys_dev)) {
2580                 mutex_unlock(&bnx2fc_dev_lock);
2581                 return true;
2582         }
2583
2584         mutex_unlock(&bnx2fc_dev_lock);
2585         return false;
2586 }
2587
2588
2589 static struct fcoe_transport bnx2fc_transport = {
2590         .name = {"bnx2fc"},
2591         .attached = false,
2592         .list = LIST_HEAD_INIT(bnx2fc_transport.list),
2593         .alloc = bnx2fc_ctlr_alloc,
2594         .match = bnx2fc_match,
2595         .create = bnx2fc_create,
2596         .destroy = bnx2fc_destroy,
2597         .enable = bnx2fc_enable,
2598         .disable = bnx2fc_disable,
2599 };
2600
2601 /**
2602  * bnx2fc_cpu_online - Create a receive thread for an  online CPU
2603  *
2604  * @cpu: cpu index for the online cpu
2605  */
2606 static int bnx2fc_cpu_online(unsigned int cpu)
2607 {
2608         struct bnx2fc_percpu_s *p;
2609         struct task_struct *thread;
2610
2611         p = &per_cpu(bnx2fc_percpu, cpu);
2612
2613         thread = kthread_create_on_cpu(bnx2fc_percpu_io_thread,
2614                                        (void *)p, cpu, "bnx2fc_thread/%d");
2615         if (IS_ERR(thread))
2616                 return PTR_ERR(thread);
2617
2618         p->iothread = thread;
2619         wake_up_process(thread);
2620         return 0;
2621 }
2622
2623 static int bnx2fc_cpu_offline(unsigned int cpu)
2624 {
2625         struct bnx2fc_percpu_s *p;
2626         struct task_struct *thread;
2627         struct bnx2fc_work *work, *tmp;
2628
2629         BNX2FC_MISC_DBG("destroying io thread for CPU %d\n", cpu);
2630
2631         /* Prevent any new work from being queued for this CPU */
2632         p = &per_cpu(bnx2fc_percpu, cpu);
2633         spin_lock_bh(&p->fp_work_lock);
2634         thread = p->iothread;
2635         p->iothread = NULL;
2636
2637         /* Free all work in the list */
2638         list_for_each_entry_safe(work, tmp, &p->work_list, list) {
2639                 list_del_init(&work->list);
2640                 bnx2fc_process_cq_compl(work->tgt, work->wqe, work->rq_data,
2641                                         work->num_rq, work->task);
2642                 kfree(work);
2643         }
2644
2645         spin_unlock_bh(&p->fp_work_lock);
2646
2647         if (thread)
2648                 kthread_stop(thread);
2649         return 0;
2650 }
2651
2652 static int bnx2fc_sdev_configure(struct scsi_device *sdev,
2653                                  struct queue_limits *lim)
2654 {
2655         if (!bnx2fc_queue_depth)
2656                 return 0;
2657
2658         scsi_change_queue_depth(sdev, bnx2fc_queue_depth);
2659         return 0;
2660 }
2661
2662 static enum cpuhp_state bnx2fc_online_state;
2663
2664 /**
2665  * bnx2fc_mod_init - module init entry point
2666  *
2667  * Initialize driver wide global data structures, and register
2668  * with cnic module
2669  **/
2670 static int __init bnx2fc_mod_init(void)
2671 {
2672         struct fcoe_percpu_s *bg;
2673         struct task_struct *l2_thread;
2674         int rc = 0;
2675         unsigned int cpu = 0;
2676         struct bnx2fc_percpu_s *p;
2677
2678         printk(KERN_INFO PFX "%s", version);
2679
2680         /* register as a fcoe transport */
2681         rc = fcoe_transport_attach(&bnx2fc_transport);
2682         if (rc) {
2683                 printk(KERN_ERR "failed to register an fcoe transport, check "
2684                         "if libfcoe is loaded\n");
2685                 goto out;
2686         }
2687
2688         INIT_LIST_HEAD(&adapter_list);
2689         INIT_LIST_HEAD(&if_list);
2690         mutex_init(&bnx2fc_dev_lock);
2691         adapter_count = 0;
2692
2693         /* Attach FC transport template */
2694         rc = bnx2fc_attach_transport();
2695         if (rc)
2696                 goto detach_ft;
2697
2698         bnx2fc_wq = alloc_workqueue("bnx2fc", 0, 0);
2699         if (!bnx2fc_wq) {
2700                 rc = -ENOMEM;
2701                 goto release_bt;
2702         }
2703
2704         bg = &bnx2fc_global;
2705         skb_queue_head_init(&bg->fcoe_rx_list);
2706         l2_thread = kthread_run(bnx2fc_l2_rcv_thread,
2707                                 (void *)bg,
2708                                 "bnx2fc_l2_thread");
2709         if (IS_ERR(l2_thread)) {
2710                 rc = PTR_ERR(l2_thread);
2711                 goto free_wq;
2712         }
2713         spin_lock_bh(&bg->fcoe_rx_list.lock);
2714         bg->kthread = l2_thread;
2715         spin_unlock_bh(&bg->fcoe_rx_list.lock);
2716
2717         for_each_possible_cpu(cpu) {
2718                 p = &per_cpu(bnx2fc_percpu, cpu);
2719                 INIT_LIST_HEAD(&p->work_list);
2720                 spin_lock_init(&p->fp_work_lock);
2721         }
2722
2723         rc = cpuhp_setup_state(CPUHP_AP_ONLINE_DYN, "scsi/bnx2fc:online",
2724                                bnx2fc_cpu_online, bnx2fc_cpu_offline);
2725         if (rc < 0)
2726                 goto stop_thread;
2727         bnx2fc_online_state = rc;
2728
2729         cnic_register_driver(CNIC_ULP_FCOE, &bnx2fc_cnic_cb);
2730         return 0;
2731
2732 stop_thread:
2733         kthread_stop(l2_thread);
2734 free_wq:
2735         destroy_workqueue(bnx2fc_wq);
2736 release_bt:
2737         bnx2fc_release_transport();
2738 detach_ft:
2739         fcoe_transport_detach(&bnx2fc_transport);
2740 out:
2741         return rc;
2742 }
2743
2744 static void __exit bnx2fc_mod_exit(void)
2745 {
2746         LIST_HEAD(to_be_deleted);
2747         struct bnx2fc_hba *hba, *next;
2748         struct fcoe_percpu_s *bg;
2749         struct task_struct *l2_thread;
2750         struct sk_buff *skb;
2751
2752         /*
2753          * NOTE: Since cnic calls register_driver routine rtnl_lock,
2754          * it will have higher precedence than bnx2fc_dev_lock.
2755          * unregister_device() cannot be called with bnx2fc_dev_lock
2756          * held.
2757          */
2758         mutex_lock(&bnx2fc_dev_lock);
2759         list_splice_init(&adapter_list, &to_be_deleted);
2760         adapter_count = 0;
2761         mutex_unlock(&bnx2fc_dev_lock);
2762
2763         /* Unregister with cnic */
2764         list_for_each_entry_safe(hba, next, &to_be_deleted, list) {
2765                 list_del_init(&hba->list);
2766                 printk(KERN_ERR PFX "MOD_EXIT:destroy hba = 0x%p\n",
2767                        hba);
2768                 bnx2fc_ulp_stop(hba);
2769                 /* unregister cnic device */
2770                 if (test_and_clear_bit(BNX2FC_CNIC_REGISTERED,
2771                                        &hba->reg_with_cnic))
2772                         hba->cnic->unregister_device(hba->cnic,
2773                                                          CNIC_ULP_FCOE);
2774                 bnx2fc_hba_destroy(hba);
2775         }
2776         cnic_unregister_driver(CNIC_ULP_FCOE);
2777
2778         /* Destroy global thread */
2779         bg = &bnx2fc_global;
2780         spin_lock_bh(&bg->fcoe_rx_list.lock);
2781         l2_thread = bg->kthread;
2782         bg->kthread = NULL;
2783         while ((skb = __skb_dequeue(&bg->fcoe_rx_list)) != NULL)
2784                 kfree_skb(skb);
2785
2786         spin_unlock_bh(&bg->fcoe_rx_list.lock);
2787
2788         if (l2_thread)
2789                 kthread_stop(l2_thread);
2790
2791         cpuhp_remove_state(bnx2fc_online_state);
2792
2793         destroy_workqueue(bnx2fc_wq);
2794         /*
2795          * detach from scsi transport
2796          * must happen after all destroys are done
2797          */
2798         bnx2fc_release_transport();
2799
2800         /* detach from fcoe transport */
2801         fcoe_transport_detach(&bnx2fc_transport);
2802 }
2803
2804 module_init(bnx2fc_mod_init);
2805 module_exit(bnx2fc_mod_exit);
2806
2807 static struct fcoe_sysfs_function_template bnx2fc_fcoe_sysfs_templ = {
2808         .set_fcoe_ctlr_enabled = bnx2fc_ctlr_enabled,
2809         .get_fcoe_ctlr_link_fail = fcoe_ctlr_get_lesb,
2810         .get_fcoe_ctlr_vlink_fail = fcoe_ctlr_get_lesb,
2811         .get_fcoe_ctlr_miss_fka = fcoe_ctlr_get_lesb,
2812         .get_fcoe_ctlr_symb_err = fcoe_ctlr_get_lesb,
2813         .get_fcoe_ctlr_err_block = fcoe_ctlr_get_lesb,
2814         .get_fcoe_ctlr_fcs_error = fcoe_ctlr_get_lesb,
2815
2816         .get_fcoe_fcf_selected = fcoe_fcf_get_selected,
2817         .get_fcoe_fcf_vlan_id = bnx2fc_fcf_get_vlan_id,
2818 };
2819
2820 static struct fc_function_template bnx2fc_transport_function = {
2821         .show_host_node_name = 1,
2822         .show_host_port_name = 1,
2823         .show_host_supported_classes = 1,
2824         .show_host_supported_fc4s = 1,
2825         .show_host_active_fc4s = 1,
2826         .show_host_maxframe_size = 1,
2827
2828         .show_host_port_id = 1,
2829         .show_host_supported_speeds = 1,
2830         .get_host_speed = fc_get_host_speed,
2831         .show_host_speed = 1,
2832         .show_host_port_type = 1,
2833         .get_host_port_state = fc_get_host_port_state,
2834         .show_host_port_state = 1,
2835         .show_host_symbolic_name = 1,
2836
2837         .dd_fcrport_size = (sizeof(struct fc_rport_libfc_priv) +
2838                                 sizeof(struct bnx2fc_rport)),
2839         .show_rport_maxframe_size = 1,
2840         .show_rport_supported_classes = 1,
2841
2842         .show_host_fabric_name = 1,
2843         .show_starget_node_name = 1,
2844         .show_starget_port_name = 1,
2845         .show_starget_port_id = 1,
2846         .set_rport_dev_loss_tmo = fc_set_rport_loss_tmo,
2847         .show_rport_dev_loss_tmo = 1,
2848         .get_fc_host_stats = bnx2fc_get_host_stats,
2849
2850         .issue_fc_host_lip = bnx2fc_fcoe_reset,
2851
2852         .terminate_rport_io = bnx2fc_rport_terminate_io,
2853
2854         .vport_create = bnx2fc_vport_create,
2855         .vport_delete = bnx2fc_vport_destroy,
2856         .vport_disable = bnx2fc_vport_disable,
2857         .bsg_request = fc_lport_bsg_request,
2858 };
2859
2860 static struct fc_function_template bnx2fc_vport_xport_function = {
2861         .show_host_node_name = 1,
2862         .show_host_port_name = 1,
2863         .show_host_supported_classes = 1,
2864         .show_host_supported_fc4s = 1,
2865         .show_host_active_fc4s = 1,
2866         .show_host_maxframe_size = 1,
2867
2868         .show_host_port_id = 1,
2869         .show_host_supported_speeds = 1,
2870         .get_host_speed = fc_get_host_speed,
2871         .show_host_speed = 1,
2872         .show_host_port_type = 1,
2873         .get_host_port_state = fc_get_host_port_state,
2874         .show_host_port_state = 1,
2875         .show_host_symbolic_name = 1,
2876
2877         .dd_fcrport_size = (sizeof(struct fc_rport_libfc_priv) +
2878                                 sizeof(struct bnx2fc_rport)),
2879         .show_rport_maxframe_size = 1,
2880         .show_rport_supported_classes = 1,
2881
2882         .show_host_fabric_name = 1,
2883         .show_starget_node_name = 1,
2884         .show_starget_port_name = 1,
2885         .show_starget_port_id = 1,
2886         .set_rport_dev_loss_tmo = fc_set_rport_loss_tmo,
2887         .show_rport_dev_loss_tmo = 1,
2888         .get_fc_host_stats = fc_get_host_stats,
2889         .issue_fc_host_lip = bnx2fc_fcoe_reset,
2890         .terminate_rport_io = fc_rport_terminate_io,
2891         .bsg_request = fc_lport_bsg_request,
2892 };
2893
2894 /*
2895  * Additional scsi_host attributes.
2896  */
2897 static ssize_t
2898 bnx2fc_tm_timeout_show(struct device *dev, struct device_attribute *attr,
2899         char *buf)
2900 {
2901         struct Scsi_Host *shost = class_to_shost(dev);
2902         struct fc_lport *lport = shost_priv(shost);
2903         struct fcoe_port *port = lport_priv(lport);
2904         struct bnx2fc_interface *interface = port->priv;
2905
2906         sprintf(buf, "%u\n", interface->tm_timeout);
2907         return strlen(buf);
2908 }
2909
2910 static ssize_t
2911 bnx2fc_tm_timeout_store(struct device *dev,
2912         struct device_attribute *attr, const char *buf, size_t count)
2913 {
2914         struct Scsi_Host *shost = class_to_shost(dev);
2915         struct fc_lport *lport = shost_priv(shost);
2916         struct fcoe_port *port = lport_priv(lport);
2917         struct bnx2fc_interface *interface = port->priv;
2918         int rval, val;
2919
2920         rval = kstrtouint(buf, 10, &val);
2921         if (rval)
2922                 return rval;
2923         if (val > 255)
2924                 return -ERANGE;
2925
2926         interface->tm_timeout = (u8)val;
2927         return strlen(buf);
2928 }
2929
2930 static DEVICE_ATTR(tm_timeout, S_IRUGO|S_IWUSR, bnx2fc_tm_timeout_show,
2931         bnx2fc_tm_timeout_store);
2932
2933 static struct attribute *bnx2fc_host_attrs[] = {
2934         &dev_attr_tm_timeout.attr,
2935         NULL,
2936 };
2937
2938 ATTRIBUTE_GROUPS(bnx2fc_host);
2939
2940 /*
2941  * scsi_host_template structure used while registering with SCSI-ml
2942  */
2943 static struct scsi_host_template bnx2fc_shost_template = {
2944         .module                 = THIS_MODULE,
2945         .name                   = "QLogic Offload FCoE Initiator",
2946         .queuecommand           = bnx2fc_queuecommand,
2947         .eh_timed_out           = fc_eh_timed_out,
2948         .eh_abort_handler       = bnx2fc_eh_abort,        /* abts */
2949         .eh_device_reset_handler = bnx2fc_eh_device_reset, /* lun reset */
2950         .eh_target_reset_handler = bnx2fc_eh_target_reset, /* tgt reset */
2951         .eh_host_reset_handler  = fc_eh_host_reset,
2952         .sdev_init              = fc_sdev_init,
2953         .change_queue_depth     = scsi_change_queue_depth,
2954         .this_id                = -1,
2955         .cmd_per_lun            = 3,
2956         .sg_tablesize           = BNX2FC_MAX_BDS_PER_CMD,
2957         .dma_boundary           = 0x7fff,
2958         .max_sectors            = 0x3fbf,
2959         .track_queue_depth      = 1,
2960         .sdev_configure         = bnx2fc_sdev_configure,
2961         .shost_groups           = bnx2fc_host_groups,
2962         .cmd_size               = sizeof(struct bnx2fc_priv),
2963 };
2964
2965 static struct libfc_function_template bnx2fc_libfc_fcn_templ = {
2966         .frame_send             = bnx2fc_xmit,
2967         .elsct_send             = bnx2fc_elsct_send,
2968         .fcp_abort_io           = bnx2fc_abort_io,
2969         .fcp_cleanup            = bnx2fc_cleanup,
2970         .get_lesb               = fcoe_get_lesb,
2971         .rport_event_callback   = bnx2fc_rport_event_handler,
2972 };
2973
2974 /*
2975  * bnx2fc_cnic_cb - global template of bnx2fc - cnic driver interface
2976  *                      structure carrying callback function pointers
2977  */
2978 static struct cnic_ulp_ops bnx2fc_cnic_cb = {
2979         .owner                  = THIS_MODULE,
2980         .cnic_init              = bnx2fc_ulp_init,
2981         .cnic_exit              = bnx2fc_ulp_exit,
2982         .cnic_start             = bnx2fc_ulp_start,
2983         .cnic_stop              = bnx2fc_ulp_stop,
2984         .indicate_kcqes         = bnx2fc_indicate_kcqe,
2985         .indicate_netevent      = bnx2fc_indicate_netevent,
2986         .cnic_get_stats         = bnx2fc_ulp_get_stats,
2987 };
This page took 0.199601 seconds and 4 git commands to generate.