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