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
19static struct list_head adapter_list;
20static struct list_head if_list;
21static u32 adapter_count;
22static DEFINE_MUTEX(bnx2fc_dev_lock);
23DEFINE_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
30static char version[] =
31		"QLogic FCoE Driver " DRV_MODULE_NAME \
32		" v" DRV_MODULE_VERSION " (" DRV_MODULE_RELDATE ")\n";
33
34
35MODULE_AUTHOR("Bhanu Prakash Gollapudi <bprakash@broadcom.com>");
36MODULE_DESCRIPTION("QLogic FCoE Driver");
37MODULE_LICENSE("GPL");
38MODULE_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
44static struct scsi_transport_template	*bnx2fc_transport_template;
45static struct scsi_transport_template	*bnx2fc_vport_xport_template;
46
47struct 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 */
52struct fcoe_percpu_s bnx2fc_global;
53static DEFINE_SPINLOCK(bnx2fc_global_lock);
54
55static struct cnic_ulp_ops bnx2fc_cnic_cb;
56static struct libfc_function_template bnx2fc_libfc_fcn_templ;
57static struct scsi_host_template bnx2fc_shost_template;
58static struct fc_function_template bnx2fc_transport_function;
59static struct fcoe_sysfs_function_template bnx2fc_fcoe_sysfs_templ;
60static struct fc_function_template bnx2fc_vport_xport_function;
61static int bnx2fc_create(struct net_device *netdev, enum fip_mode fip_mode);
62static void __bnx2fc_destroy(struct bnx2fc_interface *interface);
63static int bnx2fc_destroy(struct net_device *net_device);
64static int bnx2fc_enable(struct net_device *netdev);
65static int bnx2fc_disable(struct net_device *netdev);
66
67/* fcoe_syfs control interface handlers */
68static int bnx2fc_ctlr_alloc(struct net_device *netdev);
69static int bnx2fc_ctlr_enabled(struct fcoe_ctlr_device *cdev);
70
71static void bnx2fc_recv_frame(struct sk_buff *skb);
72
73static void bnx2fc_start_disc(struct bnx2fc_interface *interface);
74static int bnx2fc_shost_config(struct fc_lport *lport, struct device *dev);
75static int bnx2fc_lport_config(struct fc_lport *lport);
76static int bnx2fc_em_config(struct fc_lport *lport, struct bnx2fc_hba *hba);
77static int bnx2fc_bind_adapter_devices(struct bnx2fc_hba *hba);
78static void bnx2fc_unbind_adapter_devices(struct bnx2fc_hba *hba);
79static int bnx2fc_bind_pcidev(struct bnx2fc_hba *hba);
80static void bnx2fc_unbind_pcidev(struct bnx2fc_hba *hba);
81static struct fc_lport *bnx2fc_if_create(struct bnx2fc_interface *interface,
82				  struct device *parent, int npiv);
83static void bnx2fc_port_destroy(struct fcoe_port *port);
84
85static struct bnx2fc_hba *bnx2fc_hba_lookup(struct net_device *phys_dev);
86static struct bnx2fc_interface *bnx2fc_interface_lookup(struct net_device
87							*phys_dev);
88static inline void bnx2fc_interface_put(struct bnx2fc_interface *interface);
89static struct bnx2fc_hba *bnx2fc_find_hba_for_cnic(struct cnic_dev *cnic);
90
91static int bnx2fc_fw_init(struct bnx2fc_hba *hba);
92static void bnx2fc_fw_destroy(struct bnx2fc_hba *hba);
93
94static void bnx2fc_port_shutdown(struct fc_lport *lport);
95static void bnx2fc_stop(struct bnx2fc_interface *interface);
96static int __init bnx2fc_mod_init(void);
97static void __exit bnx2fc_mod_exit(void);
98
99unsigned int bnx2fc_debug_level;
100module_param_named(debug_logging, bnx2fc_debug_level, int, S_IRUGO|S_IWUSR);
101MODULE_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
111static uint bnx2fc_devloss_tmo;
112module_param_named(devloss_tmo, bnx2fc_devloss_tmo, uint, S_IRUGO);
113MODULE_PARM_DESC(devloss_tmo, " Change devloss_tmo for the remote ports "
114	"attached via bnx2fc.");
115
116static uint bnx2fc_max_luns = BNX2FC_MAX_LUN;
117module_param_named(max_luns, bnx2fc_max_luns, uint, S_IRUGO);
118MODULE_PARM_DESC(max_luns, " Change the default max_lun per SCSI host. Default "
119	"0xffff.");
120
121static uint bnx2fc_queue_depth;
122module_param_named(queue_depth, bnx2fc_queue_depth, uint, S_IRUGO);
123MODULE_PARM_DESC(queue_depth, " Change the default queue depth of SCSI devices "
124	"attached via bnx2fc.");
125
126static uint bnx2fc_log_fka;
127module_param_named(log_fka, bnx2fc_log_fka, uint, S_IRUGO|S_IWUSR);
128MODULE_PARM_DESC(log_fka, " Print message to kernel log when fcoe is "
129	"initiating a FIP keep alive when debug logging is enabled.");
130
131static 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
137static 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
147static 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
167int 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
177static 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
187static 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
214static 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 */
262static 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 */
425static 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
434	interface = container_of(ptype, struct bnx2fc_interface,
435				 fcoe_packet_type);
436	ctlr = bnx2fc_to_ctlr(interface);
437	lport = ctlr->lp;
438
439	if (unlikely(lport == NULL)) {
440		printk(KERN_ERR PFX "bnx2fc_rcv: lport is NULL\n");
441		goto err;
442	}
443
444	skb = skb_share_check(skb, GFP_ATOMIC);
445	if (!skb)
446		return -1;
447
448	if (unlikely(eth_hdr(skb)->h_proto != htons(ETH_P_FCOE))) {
449		printk(KERN_ERR PFX "bnx2fc_rcv: Wrong FC type frame\n");
450		goto err;
451	}
452
453	/*
454	 * Check for minimum frame length, and make sure required FCoE
455	 * and FC headers are pulled into the linear data area.
456	 */
457	if (unlikely((skb->len < FCOE_MIN_FRAME) ||
458	    !pskb_may_pull(skb, FCOE_HEADER_LEN)))
459		goto err;
460
461	skb_set_transport_header(skb, sizeof(struct fcoe_hdr));
462
463	fr = fcoe_dev_from_skb(skb);
464	fr->fr_dev = lport;
465
466	bg = &bnx2fc_global;
467	spin_lock(&bg->fcoe_rx_list.lock);
468
469	__skb_queue_tail(&bg->fcoe_rx_list, skb);
470	if (bg->fcoe_rx_list.qlen == 1)
471		wake_up_process(bg->kthread);
472
473	spin_unlock(&bg->fcoe_rx_list.lock);
474
475	return 0;
476err:
477	kfree_skb(skb);
478	return -1;
479}
480
481static int bnx2fc_l2_rcv_thread(void *arg)
482{
483	struct fcoe_percpu_s *bg = arg;
484	struct sk_buff *skb;
485
486	set_user_nice(current, MIN_NICE);
487	set_current_state(TASK_INTERRUPTIBLE);
488	while (!kthread_should_stop()) {
489		schedule();
490		spin_lock_bh(&bg->fcoe_rx_list.lock);
491		while ((skb = __skb_dequeue(&bg->fcoe_rx_list)) != NULL) {
492			spin_unlock_bh(&bg->fcoe_rx_list.lock);
493			bnx2fc_recv_frame(skb);
494			spin_lock_bh(&bg->fcoe_rx_list.lock);
495		}
496		__set_current_state(TASK_INTERRUPTIBLE);
497		spin_unlock_bh(&bg->fcoe_rx_list.lock);
498	}
499	__set_current_state(TASK_RUNNING);
500	return 0;
501}
502
503
504static void bnx2fc_recv_frame(struct sk_buff *skb)
505{
506	u64 crc_err;
507	u32 fr_len, fr_crc;
508	struct fc_lport *lport;
509	struct fcoe_rcv_info *fr;
510	struct fc_stats *stats;
511	struct fc_frame_header *fh;
512	struct fcoe_crc_eof crc_eof;
513	struct fc_frame *fp;
514	struct fc_lport *vn_port;
515	struct fcoe_port *port, *phys_port;
516	u8 *mac = NULL;
517	u8 *dest_mac = NULL;
518	struct fcoe_hdr *hp;
519	struct bnx2fc_interface *interface;
520	struct fcoe_ctlr *ctlr;
521
522	fr = fcoe_dev_from_skb(skb);
523	lport = fr->fr_dev;
524	if (unlikely(lport == NULL)) {
525		printk(KERN_ERR PFX "Invalid lport struct\n");
526		kfree_skb(skb);
527		return;
528	}
529
530	if (skb_is_nonlinear(skb))
531		skb_linearize(skb);
532	mac = eth_hdr(skb)->h_source;
533	dest_mac = eth_hdr(skb)->h_dest;
534
535	/* Pull the header */
536	hp = (struct fcoe_hdr *) skb_network_header(skb);
537	fh = (struct fc_frame_header *) skb_transport_header(skb);
538	skb_pull(skb, sizeof(struct fcoe_hdr));
539	fr_len = skb->len - sizeof(struct fcoe_crc_eof);
540
541	stats = per_cpu_ptr(lport->stats, get_cpu());
542	stats->RxFrames++;
543	stats->RxWords += fr_len / FCOE_WORD_TO_BYTE;
544	put_cpu();
545
546	fp = (struct fc_frame *)skb;
547	fc_frame_init(fp);
548	fr_dev(fp) = lport;
549	fr_sof(fp) = hp->fcoe_sof;
550	if (skb_copy_bits(skb, fr_len, &crc_eof, sizeof(crc_eof))) {
551		kfree_skb(skb);
552		return;
553	}
554	fr_eof(fp) = crc_eof.fcoe_eof;
555	fr_crc(fp) = crc_eof.fcoe_crc32;
556	if (pskb_trim(skb, fr_len)) {
557		kfree_skb(skb);
558		return;
559	}
560
561	phys_port = lport_priv(lport);
562	interface = phys_port->priv;
563	ctlr = bnx2fc_to_ctlr(interface);
564
565	fh = fc_frame_header_get(fp);
566
567	if (ntoh24(&dest_mac[3]) != ntoh24(fh->fh_d_id)) {
568		BNX2FC_HBA_DBG(lport, "FC frame d_id mismatch with MAC %pM.\n",
569		    dest_mac);
570		kfree_skb(skb);
571		return;
572	}
573
574	vn_port = fc_vport_id_lookup(lport, ntoh24(fh->fh_d_id));
575	if (vn_port) {
576		port = lport_priv(vn_port);
577		if (!ether_addr_equal(port->data_src_addr, dest_mac)) {
578			BNX2FC_HBA_DBG(lport, "fpma mismatch\n");
579			kfree_skb(skb);
580			return;
581		}
582	}
583	if (ctlr->state) {
584		if (!ether_addr_equal(mac, ctlr->dest_addr)) {
585			BNX2FC_HBA_DBG(lport, "Wrong source address: mac:%pM dest_addr:%pM.\n",
586			    mac, ctlr->dest_addr);
587			kfree_skb(skb);
588			return;
589		}
590	}
591	if (fh->fh_r_ctl == FC_RCTL_DD_SOL_DATA &&
592	    fh->fh_type == FC_TYPE_FCP) {
593		/* Drop FCP data. We dont this in L2 path */
594		kfree_skb(skb);
595		return;
596	}
597	if (fh->fh_r_ctl == FC_RCTL_ELS_REQ &&
598	    fh->fh_type == FC_TYPE_ELS) {
599		switch (fc_frame_payload_op(fp)) {
600		case ELS_LOGO:
601			if (ntoh24(fh->fh_s_id) == FC_FID_FLOGI) {
602				/* drop non-FIP LOGO */
603				kfree_skb(skb);
604				return;
605			}
606			break;
607		}
608	}
609
610	if (fh->fh_r_ctl == FC_RCTL_BA_ABTS) {
611		/* Drop incoming ABTS */
612		kfree_skb(skb);
613		return;
614	}
615
616	/*
617	 * If the destination ID from the frame header does not match what we
618	 * have on record for lport and the search for a NPIV port came up
619	 * empty then this is not addressed to our port so simply drop it.
620	 */
621	if (lport->port_id != ntoh24(fh->fh_d_id) && !vn_port) {
622		BNX2FC_HBA_DBG(lport, "Dropping frame due to destination mismatch: lport->port_id=%x fh->d_id=%x.\n",
623		    lport->port_id, ntoh24(fh->fh_d_id));
624		kfree_skb(skb);
625		return;
626	}
627
628	fr_crc = le32_to_cpu(fr_crc(fp));
629
630	if (unlikely(fr_crc != ~crc32(~0, skb->data, fr_len))) {
631		stats = per_cpu_ptr(lport->stats, get_cpu());
632		crc_err = (stats->InvalidCRCCount++);
633		put_cpu();
634		if (crc_err < 5)
635			printk(KERN_WARNING PFX "dropping frame with "
636			       "CRC error\n");
637		kfree_skb(skb);
638		return;
639	}
640	fc_exch_recv(lport, fp);
641}
642
643/**
644 * bnx2fc_percpu_io_thread - thread per cpu for ios
645 *
646 * @arg:	ptr to bnx2fc_percpu_info structure
647 */
648static int bnx2fc_percpu_io_thread(void *arg)
649{
650	struct bnx2fc_percpu_s *p = arg;
651	struct bnx2fc_work *work, *tmp;
652	LIST_HEAD(work_list);
653
654	set_user_nice(current, MIN_NICE);
655	set_current_state(TASK_INTERRUPTIBLE);
656	while (!kthread_should_stop()) {
657		schedule();
658		spin_lock_bh(&p->fp_work_lock);
659		while (!list_empty(&p->work_list)) {
660			list_splice_init(&p->work_list, &work_list);
661			spin_unlock_bh(&p->fp_work_lock);
662
663			list_for_each_entry_safe(work, tmp, &work_list, list) {
664				list_del_init(&work->list);
665				bnx2fc_process_cq_compl(work->tgt, work->wqe,
666							work->rq_data,
667							work->num_rq,
668							work->task);
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
682static 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
729unlock_stats_mutex:
730	mutex_unlock(&hba->hba_stats_mutex);
731	return bnx2fc_stats;
732}
733
734static 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
767static 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 */
791void 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
799static 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
844static 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 */
864static 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
990static 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
1003static 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
1021static 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 */
1057static 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 * @lport: The local port
1074 * @addr: Location of data to copy
1075 *
1076 * Remove any previously-set unicast MAC filter.
1077 * Add secondary FCoE MAC address filter for our OUI.
1078 */
1079static void bnx2fc_update_src_mac(struct fc_lport *lport, u8 *addr)
1080{
1081	struct fcoe_port *port = lport_priv(lport);
1082
1083	memcpy(port->data_src_addr, addr, ETH_ALEN);
1084}
1085
1086/**
1087 * bnx2fc_get_src_mac - return the ethernet source address for an lport
1088 *
1089 * @lport: libfc port
1090 */
1091static u8 *bnx2fc_get_src_mac(struct fc_lport *lport)
1092{
1093	struct fcoe_port *port;
1094
1095	port = (struct fcoe_port *)lport_priv(lport);
1096	return port->data_src_addr;
1097}
1098
1099/**
1100 * bnx2fc_fip_send - send an Ethernet-encapsulated FIP frame.
1101 *
1102 * @fip: FCoE controller.
1103 * @skb: FIP Packet.
1104 */
1105static void bnx2fc_fip_send(struct fcoe_ctlr *fip, struct sk_buff *skb)
1106{
1107	struct fip_header *fiph;
1108	struct ethhdr *eth_hdr;
1109	u16 op;
1110	u8 sub;
1111
1112	fiph = (struct fip_header *) ((void *)skb->data + 2 * ETH_ALEN + 2);
1113	eth_hdr = (struct ethhdr *)skb_mac_header(skb);
1114	op = ntohs(fiph->fip_op);
1115	sub = fiph->fip_subcode;
1116
1117	if (op == FIP_OP_CTRL && sub == FIP_SC_SOL && bnx2fc_log_fka)
1118		BNX2FC_MISC_DBG("Sending FKA from %pM to %pM.\n",
1119		    eth_hdr->h_source, eth_hdr->h_dest);
1120
1121	skb->dev = bnx2fc_from_ctlr(fip)->netdev;
1122	dev_queue_xmit(skb);
1123}
1124
1125static int bnx2fc_vport_create(struct fc_vport *vport, bool disabled)
1126{
1127	struct Scsi_Host *shost = vport_to_shost(vport);
1128	struct fc_lport *n_port = shost_priv(shost);
1129	struct fcoe_port *port = lport_priv(n_port);
1130	struct bnx2fc_interface *interface = port->priv;
1131	struct net_device *netdev = interface->netdev;
1132	struct fc_lport *vn_port;
1133	int rc;
1134	char buf[32];
1135
1136	rc = fcoe_validate_vport_create(vport);
1137	if (rc) {
1138		fcoe_wwn_to_str(vport->port_name, buf, sizeof(buf));
1139		printk(KERN_ERR PFX "Failed to create vport, "
1140		       "WWPN (0x%s) already exists\n",
1141		       buf);
1142		return rc;
1143	}
1144
1145	if (!test_bit(BNX2FC_FLAG_FW_INIT_DONE, &interface->hba->flags)) {
1146		printk(KERN_ERR PFX "vn ports cannot be created on"
1147			"this interface\n");
1148		return -EIO;
1149	}
1150	rtnl_lock();
1151	mutex_lock(&bnx2fc_dev_lock);
1152	vn_port = bnx2fc_if_create(interface, &vport->dev, 1);
1153	mutex_unlock(&bnx2fc_dev_lock);
1154	rtnl_unlock();
1155
1156	if (!vn_port) {
1157		printk(KERN_ERR PFX "bnx2fc_vport_create (%s) failed\n",
1158			netdev->name);
1159		return -EIO;
1160	}
1161
1162	if (bnx2fc_devloss_tmo)
1163		fc_host_dev_loss_tmo(vn_port->host) = bnx2fc_devloss_tmo;
1164
1165	if (disabled) {
1166		fc_vport_set_state(vport, FC_VPORT_DISABLED);
1167	} else {
1168		vn_port->boot_time = jiffies;
1169		fc_lport_init(vn_port);
1170		fc_fabric_login(vn_port);
1171		fc_vport_setlink(vn_port);
1172	}
1173	return 0;
1174}
1175
1176static void bnx2fc_free_vport(struct bnx2fc_hba *hba, struct fc_lport *lport)
1177{
1178	struct bnx2fc_lport *blport, *tmp;
1179
1180	spin_lock_bh(&hba->hba_lock);
1181	list_for_each_entry_safe(blport, tmp, &hba->vports, list) {
1182		if (blport->lport == lport) {
1183			list_del(&blport->list);
1184			kfree(blport);
1185		}
1186	}
1187	spin_unlock_bh(&hba->hba_lock);
1188}
1189
1190static int bnx2fc_vport_destroy(struct fc_vport *vport)
1191{
1192	struct Scsi_Host *shost = vport_to_shost(vport);
1193	struct fc_lport *n_port = shost_priv(shost);
1194	struct fc_lport *vn_port = vport->dd_data;
1195	struct fcoe_port *port = lport_priv(vn_port);
1196	struct bnx2fc_interface *interface = port->priv;
1197	struct fc_lport *v_port;
1198	bool found = false;
1199
1200	mutex_lock(&n_port->lp_mutex);
1201	list_for_each_entry(v_port, &n_port->vports, list)
1202		if (v_port->vport == vport) {
1203			found = true;
1204			break;
1205		}
1206
1207	if (!found) {
1208		mutex_unlock(&n_port->lp_mutex);
1209		return -ENOENT;
1210	}
1211	list_del(&vn_port->list);
1212	mutex_unlock(&n_port->lp_mutex);
1213	bnx2fc_free_vport(interface->hba, port->lport);
1214	bnx2fc_port_shutdown(port->lport);
1215	bnx2fc_port_destroy(port);
1216	bnx2fc_interface_put(interface);
1217	return 0;
1218}
1219
1220static int bnx2fc_vport_disable(struct fc_vport *vport, bool disable)
1221{
1222	struct fc_lport *lport = vport->dd_data;
1223
1224	if (disable) {
1225		fc_vport_set_state(vport, FC_VPORT_DISABLED);
1226		fc_fabric_logoff(lport);
1227	} else {
1228		lport->boot_time = jiffies;
1229		fc_fabric_login(lport);
1230		fc_vport_setlink(lport);
1231	}
1232	return 0;
1233}
1234
1235
1236static int bnx2fc_interface_setup(struct bnx2fc_interface *interface)
1237{
1238	struct net_device *netdev = interface->netdev;
1239	struct net_device *physdev = interface->hba->phys_dev;
1240	struct fcoe_ctlr *ctlr = bnx2fc_to_ctlr(interface);
1241	struct netdev_hw_addr *ha;
1242	int sel_san_mac = 0;
1243
1244	/* setup Source MAC Address */
1245	rcu_read_lock();
1246	for_each_dev_addr(physdev, ha) {
1247		BNX2FC_MISC_DBG("net_config: ha->type = %d, fip_mac = ",
1248				ha->type);
1249		printk(KERN_INFO "%2x:%2x:%2x:%2x:%2x:%2x\n", ha->addr[0],
1250				ha->addr[1], ha->addr[2], ha->addr[3],
1251				ha->addr[4], ha->addr[5]);
1252
1253		if ((ha->type == NETDEV_HW_ADDR_T_SAN) &&
1254		    (is_valid_ether_addr(ha->addr))) {
1255			memcpy(ctlr->ctl_src_addr, ha->addr,
1256			       ETH_ALEN);
1257			sel_san_mac = 1;
1258			BNX2FC_MISC_DBG("Found SAN MAC\n");
1259		}
1260	}
1261	rcu_read_unlock();
1262
1263	if (!sel_san_mac)
1264		return -ENODEV;
1265
1266	interface->fip_packet_type.func = bnx2fc_fip_recv;
1267	interface->fip_packet_type.type = htons(ETH_P_FIP);
1268	interface->fip_packet_type.dev = netdev;
1269	dev_add_pack(&interface->fip_packet_type);
1270
1271	interface->fcoe_packet_type.func = bnx2fc_rcv;
1272	interface->fcoe_packet_type.type = __constant_htons(ETH_P_FCOE);
1273	interface->fcoe_packet_type.dev = netdev;
1274	dev_add_pack(&interface->fcoe_packet_type);
1275
1276	return 0;
1277}
1278
1279static int bnx2fc_attach_transport(void)
1280{
1281	bnx2fc_transport_template =
1282		fc_attach_transport(&bnx2fc_transport_function);
1283
1284	if (bnx2fc_transport_template == NULL) {
1285		printk(KERN_ERR PFX "Failed to attach FC transport\n");
1286		return -ENODEV;
1287	}
1288
1289	bnx2fc_vport_xport_template =
1290		fc_attach_transport(&bnx2fc_vport_xport_function);
1291	if (bnx2fc_vport_xport_template == NULL) {
1292		printk(KERN_ERR PFX
1293		       "Failed to attach FC transport for vport\n");
1294		fc_release_transport(bnx2fc_transport_template);
1295		bnx2fc_transport_template = NULL;
1296		return -ENODEV;
1297	}
1298	return 0;
1299}
1300static void bnx2fc_release_transport(void)
1301{
1302	fc_release_transport(bnx2fc_transport_template);
1303	fc_release_transport(bnx2fc_vport_xport_template);
1304	bnx2fc_transport_template = NULL;
1305	bnx2fc_vport_xport_template = NULL;
1306}
1307
1308static void bnx2fc_interface_release(struct kref *kref)
1309{
1310	struct fcoe_ctlr_device *ctlr_dev;
1311	struct bnx2fc_interface *interface;
1312	struct fcoe_ctlr *ctlr;
1313	struct net_device *netdev;
1314
1315	interface = container_of(kref, struct bnx2fc_interface, kref);
1316	BNX2FC_MISC_DBG("Interface is being released\n");
1317
1318	ctlr = bnx2fc_to_ctlr(interface);
1319	ctlr_dev = fcoe_ctlr_to_ctlr_dev(ctlr);
1320	netdev = interface->netdev;
1321
1322	/* tear-down FIP controller */
1323	if (test_and_clear_bit(BNX2FC_CTLR_INIT_DONE, &interface->if_flags))
1324		fcoe_ctlr_destroy(ctlr);
1325
1326	fcoe_ctlr_device_delete(ctlr_dev);
1327
1328	dev_put(netdev);
1329	module_put(THIS_MODULE);
1330}
1331
1332static inline void bnx2fc_interface_get(struct bnx2fc_interface *interface)
1333{
1334	kref_get(&interface->kref);
1335}
1336
1337static inline void bnx2fc_interface_put(struct bnx2fc_interface *interface)
1338{
1339	kref_put(&interface->kref, bnx2fc_interface_release);
1340}
1341static void bnx2fc_hba_destroy(struct bnx2fc_hba *hba)
1342{
1343	/* Free the command manager */
1344	if (hba->cmd_mgr) {
1345		bnx2fc_cmd_mgr_free(hba->cmd_mgr);
1346		hba->cmd_mgr = NULL;
1347	}
1348	kfree(hba->tgt_ofld_list);
1349	bnx2fc_unbind_pcidev(hba);
1350	kfree(hba);
1351}
1352
1353/**
1354 * bnx2fc_hba_create - create a new bnx2fc hba
1355 *
1356 * @cnic:	pointer to cnic device
1357 *
1358 * Creates a new FCoE hba on the given device.
1359 *
1360 */
1361static struct bnx2fc_hba *bnx2fc_hba_create(struct cnic_dev *cnic)
1362{
1363	struct bnx2fc_hba *hba;
1364	struct fcoe_capabilities *fcoe_cap;
1365	int rc;
1366
1367	hba = kzalloc(sizeof(*hba), GFP_KERNEL);
1368	if (!hba) {
1369		printk(KERN_ERR PFX "Unable to allocate hba structure\n");
1370		return NULL;
1371	}
1372	spin_lock_init(&hba->hba_lock);
1373	mutex_init(&hba->hba_mutex);
1374	mutex_init(&hba->hba_stats_mutex);
1375
1376	hba->cnic = cnic;
1377
1378	hba->max_tasks = cnic->max_fcoe_exchanges;
1379	hba->elstm_xids = (hba->max_tasks / 2);
1380	hba->max_outstanding_cmds = hba->elstm_xids;
1381	hba->max_xid = (hba->max_tasks - 1);
1382
1383	rc = bnx2fc_bind_pcidev(hba);
1384	if (rc) {
1385		printk(KERN_ERR PFX "create_adapter:  bind error\n");
1386		goto bind_err;
1387	}
1388	hba->phys_dev = cnic->netdev;
1389	hba->next_conn_id = 0;
1390
1391	hba->tgt_ofld_list =
1392		kcalloc(BNX2FC_NUM_MAX_SESS, sizeof(struct bnx2fc_rport *),
1393			GFP_KERNEL);
1394	if (!hba->tgt_ofld_list) {
1395		printk(KERN_ERR PFX "Unable to allocate tgt offload list\n");
1396		goto tgtofld_err;
1397	}
1398
1399	hba->num_ofld_sess = 0;
1400
1401	hba->cmd_mgr = bnx2fc_cmd_mgr_alloc(hba);
1402	if (!hba->cmd_mgr) {
1403		printk(KERN_ERR PFX "em_config:bnx2fc_cmd_mgr_alloc failed\n");
1404		goto cmgr_err;
1405	}
1406	fcoe_cap = &hba->fcoe_cap;
1407
1408	fcoe_cap->capability1 = BNX2FC_TM_MAX_SQES <<
1409					FCOE_IOS_PER_CONNECTION_SHIFT;
1410	fcoe_cap->capability1 |= BNX2FC_NUM_MAX_SESS <<
1411					FCOE_LOGINS_PER_PORT_SHIFT;
1412	fcoe_cap->capability2 = hba->max_outstanding_cmds <<
1413					FCOE_NUMBER_OF_EXCHANGES_SHIFT;
1414	fcoe_cap->capability2 |= BNX2FC_MAX_NPIV <<
1415					FCOE_NPIV_WWN_PER_PORT_SHIFT;
1416	fcoe_cap->capability3 = BNX2FC_NUM_MAX_SESS <<
1417					FCOE_TARGETS_SUPPORTED_SHIFT;
1418	fcoe_cap->capability3 |= hba->max_outstanding_cmds <<
1419					FCOE_OUTSTANDING_COMMANDS_SHIFT;
1420	fcoe_cap->capability4 = FCOE_CAPABILITY4_STATEFUL;
1421
1422	init_waitqueue_head(&hba->shutdown_wait);
1423	init_waitqueue_head(&hba->destroy_wait);
1424	INIT_LIST_HEAD(&hba->vports);
1425
1426	return hba;
1427
1428cmgr_err:
1429	kfree(hba->tgt_ofld_list);
1430tgtofld_err:
1431	bnx2fc_unbind_pcidev(hba);
1432bind_err:
1433	kfree(hba);
1434	return NULL;
1435}
1436
1437static struct bnx2fc_interface *
1438bnx2fc_interface_create(struct bnx2fc_hba *hba,
1439			struct net_device *netdev,
1440			enum fip_mode fip_mode)
1441{
1442	struct fcoe_ctlr_device *ctlr_dev;
1443	struct bnx2fc_interface *interface;
1444	struct fcoe_ctlr *ctlr;
1445	int size;
1446	int rc = 0;
1447
1448	size = (sizeof(*interface) + sizeof(struct fcoe_ctlr));
1449	ctlr_dev = fcoe_ctlr_device_add(&netdev->dev, &bnx2fc_fcoe_sysfs_templ,
1450					 size);
1451	if (!ctlr_dev) {
1452		printk(KERN_ERR PFX "Unable to allocate interface structure\n");
1453		return NULL;
1454	}
1455	ctlr = fcoe_ctlr_device_priv(ctlr_dev);
1456	ctlr->cdev = ctlr_dev;
1457	interface = fcoe_ctlr_priv(ctlr);
1458	dev_hold(netdev);
1459	kref_init(&interface->kref);
1460	interface->hba = hba;
1461	interface->netdev = netdev;
1462
1463	/* Initialize FIP */
1464	fcoe_ctlr_init(ctlr, fip_mode);
1465	ctlr->send = bnx2fc_fip_send;
1466	ctlr->update_mac = bnx2fc_update_src_mac;
1467	ctlr->get_src_addr = bnx2fc_get_src_mac;
1468	set_bit(BNX2FC_CTLR_INIT_DONE, &interface->if_flags);
1469
1470	rc = bnx2fc_interface_setup(interface);
1471	if (!rc)
1472		return interface;
1473
1474	fcoe_ctlr_destroy(ctlr);
1475	dev_put(netdev);
1476	fcoe_ctlr_device_delete(ctlr_dev);
1477	return NULL;
1478}
1479
1480/**
1481 * bnx2fc_if_create - Create FCoE instance on a given interface
1482 *
1483 * @interface:	FCoE interface to create a local port on
1484 * @parent:	Device pointer to be the parent in sysfs for the SCSI host
1485 * @npiv:	Indicates if the port is vport or not
1486 *
1487 * Creates a fc_lport instance and a Scsi_Host instance and configure them.
1488 *
1489 * Returns:	Allocated fc_lport or an error pointer
1490 */
1491static struct fc_lport *bnx2fc_if_create(struct bnx2fc_interface *interface,
1492				  struct device *parent, int npiv)
1493{
1494	struct fcoe_ctlr        *ctlr = bnx2fc_to_ctlr(interface);
1495	struct fc_lport		*lport, *n_port;
1496	struct fcoe_port	*port;
1497	struct Scsi_Host	*shost;
1498	struct fc_vport		*vport = dev_to_vport(parent);
1499	struct bnx2fc_lport	*blport;
1500	struct bnx2fc_hba	*hba = interface->hba;
1501	int			rc = 0;
1502
1503	blport = kzalloc(sizeof(struct bnx2fc_lport), GFP_KERNEL);
1504	if (!blport) {
1505		BNX2FC_HBA_DBG(ctlr->lp, "Unable to alloc blport\n");
1506		return NULL;
1507	}
1508
1509	/* Allocate Scsi_Host structure */
1510	bnx2fc_shost_template.can_queue = hba->max_outstanding_cmds;
1511	if (!npiv)
1512		lport = libfc_host_alloc(&bnx2fc_shost_template, sizeof(*port));
1513	else
1514		lport = libfc_vport_create(vport, sizeof(*port));
1515
1516	if (!lport) {
1517		printk(KERN_ERR PFX "could not allocate scsi host structure\n");
1518		goto free_blport;
1519	}
1520	shost = lport->host;
1521	port = lport_priv(lport);
1522	port->lport = lport;
1523	port->priv = interface;
1524	port->get_netdev = bnx2fc_netdev;
1525
1526	/* Configure fcoe_port */
1527	rc = bnx2fc_lport_config(lport);
1528	if (rc)
1529		goto lp_config_err;
1530
1531	if (npiv) {
1532		printk(KERN_ERR PFX "Setting vport names, 0x%llX 0x%llX\n",
1533			vport->node_name, vport->port_name);
1534		fc_set_wwnn(lport, vport->node_name);
1535		fc_set_wwpn(lport, vport->port_name);
1536	}
1537	/* Configure netdev and networking properties of the lport */
1538	rc = bnx2fc_net_config(lport, interface->netdev);
1539	if (rc) {
1540		printk(KERN_ERR PFX "Error on bnx2fc_net_config\n");
1541		goto lp_config_err;
1542	}
1543
1544	rc = bnx2fc_shost_config(lport, parent);
1545	if (rc) {
1546		printk(KERN_ERR PFX "Couldn't configure shost for %s\n",
1547			interface->netdev->name);
1548		goto lp_config_err;
1549	}
1550
1551	/* Initialize the libfc library */
1552	rc = bnx2fc_libfc_config(lport);
1553	if (rc) {
1554		printk(KERN_ERR PFX "Couldn't configure libfc\n");
1555		goto shost_err;
1556	}
1557	fc_host_port_type(lport->host) = FC_PORTTYPE_UNKNOWN;
1558
1559	if (bnx2fc_devloss_tmo)
1560		fc_host_dev_loss_tmo(shost) = bnx2fc_devloss_tmo;
1561
1562	/* Allocate exchange manager */
1563	if (!npiv)
1564		rc = bnx2fc_em_config(lport, hba);
1565	else {
1566		shost = vport_to_shost(vport);
1567		n_port = shost_priv(shost);
1568		rc = fc_exch_mgr_list_clone(n_port, lport);
1569	}
1570
1571	if (rc) {
1572		printk(KERN_ERR PFX "Error on bnx2fc_em_config\n");
1573		goto shost_err;
1574	}
1575
1576	bnx2fc_interface_get(interface);
1577
1578	spin_lock_bh(&hba->hba_lock);
1579	blport->lport = lport;
1580	list_add_tail(&blport->list, &hba->vports);
1581	spin_unlock_bh(&hba->hba_lock);
1582
1583	return lport;
1584
1585shost_err:
1586	scsi_remove_host(shost);
1587lp_config_err:
1588	scsi_host_put(lport->host);
1589free_blport:
1590	kfree(blport);
1591	return NULL;
1592}
1593
1594static void bnx2fc_net_cleanup(struct bnx2fc_interface *interface)
1595{
1596	/* Dont listen for Ethernet packets anymore */
1597	__dev_remove_pack(&interface->fcoe_packet_type);
1598	__dev_remove_pack(&interface->fip_packet_type);
1599	synchronize_net();
1600}
1601
1602static void bnx2fc_interface_cleanup(struct bnx2fc_interface *interface)
1603{
1604	struct fcoe_ctlr *ctlr = bnx2fc_to_ctlr(interface);
1605	struct fc_lport *lport = ctlr->lp;
1606	struct fcoe_port *port = lport_priv(lport);
1607	struct bnx2fc_hba *hba = interface->hba;
1608
1609	/* Stop the transmit retry timer */
1610	del_timer_sync(&port->timer);
1611
1612	/* Free existing transmit skbs */
1613	fcoe_clean_pending_queue(lport);
1614
1615	bnx2fc_net_cleanup(interface);
1616
1617	bnx2fc_free_vport(hba, lport);
1618}
1619
1620static void bnx2fc_if_destroy(struct fc_lport *lport)
1621{
1622
1623	/* Free queued packets for the receive thread */
1624	bnx2fc_clean_rx_queue(lport);
1625
1626	/* Detach from scsi-ml */
1627	fc_remove_host(lport->host);
1628	scsi_remove_host(lport->host);
1629
1630	/*
1631	 * Note that only the physical lport will have the exchange manager.
1632	 * for vports, this function is NOP
1633	 */
1634	fc_exch_mgr_free(lport);
1635
1636	/* Free memory used by statistical counters */
1637	fc_lport_free_stats(lport);
1638
1639	/* Release Scsi_Host */
1640	scsi_host_put(lport->host);
1641}
1642
1643static void __bnx2fc_destroy(struct bnx2fc_interface *interface)
1644{
1645	struct fcoe_ctlr *ctlr = bnx2fc_to_ctlr(interface);
1646	struct fc_lport *lport = ctlr->lp;
1647	struct fcoe_port *port = lport_priv(lport);
1648
1649	bnx2fc_interface_cleanup(interface);
1650	bnx2fc_stop(interface);
1651	list_del(&interface->list);
1652	bnx2fc_port_destroy(port);
1653	bnx2fc_interface_put(interface);
1654}
1655
1656/**
1657 * bnx2fc_destroy - Destroy a bnx2fc FCoE interface
1658 *
1659 * @netdev: The net device that the FCoE interface is on
1660 *
1661 * Called from sysfs.
1662 *
1663 * Returns: 0 for success
1664 */
1665static int bnx2fc_destroy(struct net_device *netdev)
1666{
1667	struct bnx2fc_interface *interface = NULL;
1668	struct workqueue_struct *timer_work_queue;
1669	struct fcoe_ctlr *ctlr;
1670	int rc = 0;
1671
1672	rtnl_lock();
1673	mutex_lock(&bnx2fc_dev_lock);
1674
1675	interface = bnx2fc_interface_lookup(netdev);
1676	ctlr = bnx2fc_to_ctlr(interface);
1677	if (!interface || !ctlr->lp) {
1678		rc = -ENODEV;
1679		printk(KERN_ERR PFX "bnx2fc_destroy: interface or lport not found\n");
1680		goto netdev_err;
1681	}
1682
1683	timer_work_queue = interface->timer_work_queue;
1684	__bnx2fc_destroy(interface);
1685	destroy_workqueue(timer_work_queue);
1686
1687netdev_err:
1688	mutex_unlock(&bnx2fc_dev_lock);
1689	rtnl_unlock();
1690	return rc;
1691}
1692
1693static void bnx2fc_port_destroy(struct fcoe_port *port)
1694{
1695	struct fc_lport *lport;
1696
1697	lport = port->lport;
1698	BNX2FC_HBA_DBG(lport, "Entered %s, destroying lport %p\n", __func__, lport);
1699
1700	bnx2fc_if_destroy(lport);
1701}
1702
1703static void bnx2fc_unbind_adapter_devices(struct bnx2fc_hba *hba)
1704{
1705	bnx2fc_free_fw_resc(hba);
1706	bnx2fc_free_task_ctx(hba);
1707}
1708
1709/**
1710 * bnx2fc_bind_adapter_devices - binds bnx2fc adapter with the associated
1711 *			pci structure
1712 *
1713 * @hba:		Adapter instance
1714 */
1715static int bnx2fc_bind_adapter_devices(struct bnx2fc_hba *hba)
1716{
1717	if (bnx2fc_setup_task_ctx(hba))
1718		goto mem_err;
1719
1720	if (bnx2fc_setup_fw_resc(hba))
1721		goto mem_err;
1722
1723	return 0;
1724mem_err:
1725	bnx2fc_unbind_adapter_devices(hba);
1726	return -ENOMEM;
1727}
1728
1729static int bnx2fc_bind_pcidev(struct bnx2fc_hba *hba)
1730{
1731	struct cnic_dev *cnic;
1732	struct pci_dev *pdev;
1733
1734	if (!hba->cnic) {
1735		printk(KERN_ERR PFX "cnic is NULL\n");
1736		return -ENODEV;
1737	}
1738	cnic = hba->cnic;
1739	pdev = hba->pcidev = cnic->pcidev;
1740	if (!hba->pcidev)
1741		return -ENODEV;
1742
1743	switch (pdev->device) {
1744	case PCI_DEVICE_ID_NX2_57710:
1745		strncpy(hba->chip_num, "BCM57710", BCM_CHIP_LEN);
1746		break;
1747	case PCI_DEVICE_ID_NX2_57711:
1748		strncpy(hba->chip_num, "BCM57711", BCM_CHIP_LEN);
1749		break;
1750	case PCI_DEVICE_ID_NX2_57712:
1751	case PCI_DEVICE_ID_NX2_57712_MF:
1752	case PCI_DEVICE_ID_NX2_57712_VF:
1753		strncpy(hba->chip_num, "BCM57712", BCM_CHIP_LEN);
1754		break;
1755	case PCI_DEVICE_ID_NX2_57800:
1756	case PCI_DEVICE_ID_NX2_57800_MF:
1757	case PCI_DEVICE_ID_NX2_57800_VF:
1758		strncpy(hba->chip_num, "BCM57800", BCM_CHIP_LEN);
1759		break;
1760	case PCI_DEVICE_ID_NX2_57810:
1761	case PCI_DEVICE_ID_NX2_57810_MF:
1762	case PCI_DEVICE_ID_NX2_57810_VF:
1763		strncpy(hba->chip_num, "BCM57810", BCM_CHIP_LEN);
1764		break;
1765	case PCI_DEVICE_ID_NX2_57840:
1766	case PCI_DEVICE_ID_NX2_57840_MF:
1767	case PCI_DEVICE_ID_NX2_57840_VF:
1768	case PCI_DEVICE_ID_NX2_57840_2_20:
1769	case PCI_DEVICE_ID_NX2_57840_4_10:
1770		strncpy(hba->chip_num, "BCM57840", BCM_CHIP_LEN);
1771		break;
1772	default:
1773		pr_err(PFX "Unknown device id 0x%x\n", pdev->device);
1774		break;
1775	}
1776	pci_dev_get(hba->pcidev);
1777	return 0;
1778}
1779
1780static void bnx2fc_unbind_pcidev(struct bnx2fc_hba *hba)
1781{
1782	if (hba->pcidev) {
1783		hba->chip_num[0] = '\0';
1784		pci_dev_put(hba->pcidev);
1785	}
1786	hba->pcidev = NULL;
1787}
1788
1789/**
1790 * bnx2fc_ulp_get_stats - cnic callback to populate FCoE stats
1791 *
1792 * @handle:    transport handle pointing to adapter struture
1793 */
1794static int bnx2fc_ulp_get_stats(void *handle)
1795{
1796	struct bnx2fc_hba *hba = handle;
1797	struct cnic_dev *cnic;
1798	struct fcoe_stats_info *stats_addr;
1799
1800	if (!hba)
1801		return -EINVAL;
1802
1803	cnic = hba->cnic;
1804	stats_addr = &cnic->stats_addr->fcoe_stat;
1805	if (!stats_addr)
1806		return -EINVAL;
1807
1808	strncpy(stats_addr->version, BNX2FC_VERSION,
1809		sizeof(stats_addr->version));
1810	stats_addr->txq_size = BNX2FC_SQ_WQES_MAX;
1811	stats_addr->rxq_size = BNX2FC_CQ_WQES_MAX;
1812
1813	return 0;
1814}
1815
1816
1817/**
1818 * bnx2fc_ulp_start - cnic callback to initialize & start adapter instance
1819 *
1820 * @handle:	transport handle pointing to adapter structure
1821 *
1822 * This function maps adapter structure to pcidev structure and initiates
1823 *	firmware handshake to enable/initialize on-chip FCoE components.
1824 *	This bnx2fc - cnic interface api callback is used after following
1825 *	conditions are met -
1826 *	a) underlying network interface is up (marked by event NETDEV_UP
1827 *		from netdev
1828 *	b) bnx2fc adatper structure is registered.
1829 */
1830static void bnx2fc_ulp_start(void *handle)
1831{
1832	struct bnx2fc_hba *hba = handle;
1833	struct bnx2fc_interface *interface;
1834	struct fcoe_ctlr *ctlr;
1835	struct fc_lport *lport;
1836
1837	mutex_lock(&bnx2fc_dev_lock);
1838
1839	if (!test_bit(BNX2FC_FLAG_FW_INIT_DONE, &hba->flags))
1840		bnx2fc_fw_init(hba);
1841
1842	BNX2FC_MISC_DBG("bnx2fc started.\n");
1843
1844	list_for_each_entry(interface, &if_list, list) {
1845		if (interface->hba == hba) {
1846			ctlr = bnx2fc_to_ctlr(interface);
1847			lport = ctlr->lp;
1848			/* Kick off Fabric discovery*/
1849			printk(KERN_ERR PFX "ulp_init: start discovery\n");
1850			lport->tt.frame_send = bnx2fc_xmit;
1851			bnx2fc_start_disc(interface);
1852		}
1853	}
1854
1855	mutex_unlock(&bnx2fc_dev_lock);
1856}
1857
1858static void bnx2fc_port_shutdown(struct fc_lport *lport)
1859{
1860	BNX2FC_MISC_DBG("Entered %s\n", __func__);
1861	fc_fabric_logoff(lport);
1862	fc_lport_destroy(lport);
1863}
1864
1865static void bnx2fc_stop(struct bnx2fc_interface *interface)
1866{
1867	struct fcoe_ctlr *ctlr = bnx2fc_to_ctlr(interface);
1868	struct fc_lport *lport;
1869	struct fc_lport *vport;
1870
1871	if (!test_bit(BNX2FC_FLAG_FW_INIT_DONE, &interface->hba->flags))
1872		return;
1873
1874	lport = ctlr->lp;
1875	bnx2fc_port_shutdown(lport);
1876
1877	mutex_lock(&lport->lp_mutex);
1878	list_for_each_entry(vport, &lport->vports, list)
1879		fc_host_port_type(vport->host) =
1880					FC_PORTTYPE_UNKNOWN;
1881	mutex_unlock(&lport->lp_mutex);
1882	fc_host_port_type(lport->host) = FC_PORTTYPE_UNKNOWN;
1883	fcoe_ctlr_link_down(ctlr);
1884	fcoe_clean_pending_queue(lport);
1885}
1886
1887static int bnx2fc_fw_init(struct bnx2fc_hba *hba)
1888{
1889#define BNX2FC_INIT_POLL_TIME		(1000 / HZ)
1890	int rc = -1;
1891	int i = HZ;
1892
1893	rc = bnx2fc_bind_adapter_devices(hba);
1894	if (rc) {
1895		printk(KERN_ALERT PFX
1896			"bnx2fc_bind_adapter_devices failed - rc = %d\n", rc);
1897		goto err_out;
1898	}
1899
1900	rc = bnx2fc_send_fw_fcoe_init_msg(hba);
1901	if (rc) {
1902		printk(KERN_ALERT PFX
1903			"bnx2fc_send_fw_fcoe_init_msg failed - rc = %d\n", rc);
1904		goto err_unbind;
1905	}
1906
1907	/*
1908	 * Wait until the adapter init message is complete, and adapter
1909	 * state is UP.
1910	 */
1911	while (!test_bit(ADAPTER_STATE_UP, &hba->adapter_state) && i--)
1912		msleep(BNX2FC_INIT_POLL_TIME);
1913
1914	if (!test_bit(ADAPTER_STATE_UP, &hba->adapter_state)) {
1915		printk(KERN_ERR PFX "bnx2fc_start: %s failed to initialize.  "
1916				"Ignoring...\n",
1917				hba->cnic->netdev->name);
1918		rc = -1;
1919		goto err_unbind;
1920	}
1921
1922
1923	set_bit(BNX2FC_FLAG_FW_INIT_DONE, &hba->flags);
1924	return 0;
1925
1926err_unbind:
1927	bnx2fc_unbind_adapter_devices(hba);
1928err_out:
1929	return rc;
1930}
1931
1932static void bnx2fc_fw_destroy(struct bnx2fc_hba *hba)
1933{
1934	if (test_and_clear_bit(BNX2FC_FLAG_FW_INIT_DONE, &hba->flags)) {
1935		if (bnx2fc_send_fw_fcoe_destroy_msg(hba) == 0) {
1936			timer_setup(&hba->destroy_timer, bnx2fc_destroy_timer,
1937				    0);
1938			hba->destroy_timer.expires = BNX2FC_FW_TIMEOUT +
1939								jiffies;
1940			add_timer(&hba->destroy_timer);
1941			wait_event_interruptible(hba->destroy_wait,
1942					test_bit(BNX2FC_FLAG_DESTROY_CMPL,
1943						 &hba->flags));
1944			clear_bit(BNX2FC_FLAG_DESTROY_CMPL, &hba->flags);
1945			/* This should never happen */
1946			if (signal_pending(current))
1947				flush_signals(current);
1948
1949			del_timer_sync(&hba->destroy_timer);
1950		}
1951		bnx2fc_unbind_adapter_devices(hba);
1952	}
1953}
1954
1955/**
1956 * bnx2fc_ulp_stop - cnic callback to shutdown adapter instance
1957 *
1958 * @handle:	transport handle pointing to adapter structure
1959 *
1960 * Driver checks if adapter is already in shutdown mode, if not start
1961 *	the shutdown process.
1962 */
1963static void bnx2fc_ulp_stop(void *handle)
1964{
1965	struct bnx2fc_hba *hba = handle;
1966	struct bnx2fc_interface *interface;
1967
1968	printk(KERN_ERR "ULP_STOP\n");
1969
1970	mutex_lock(&bnx2fc_dev_lock);
1971	if (!test_bit(BNX2FC_FLAG_FW_INIT_DONE, &hba->flags))
1972		goto exit;
1973	list_for_each_entry(interface, &if_list, list) {
1974		if (interface->hba == hba)
1975			bnx2fc_stop(interface);
1976	}
1977	BUG_ON(hba->num_ofld_sess != 0);
1978
1979	mutex_lock(&hba->hba_mutex);
1980	clear_bit(ADAPTER_STATE_UP, &hba->adapter_state);
1981	clear_bit(ADAPTER_STATE_GOING_DOWN,
1982		  &hba->adapter_state);
1983
1984	clear_bit(ADAPTER_STATE_READY, &hba->adapter_state);
1985	mutex_unlock(&hba->hba_mutex);
1986
1987	bnx2fc_fw_destroy(hba);
1988exit:
1989	mutex_unlock(&bnx2fc_dev_lock);
1990}
1991
1992static void bnx2fc_start_disc(struct bnx2fc_interface *interface)
1993{
1994	struct fcoe_ctlr *ctlr = bnx2fc_to_ctlr(interface);
1995	struct fc_lport *lport;
1996	int wait_cnt = 0;
1997
1998	BNX2FC_MISC_DBG("Entered %s\n", __func__);
1999	/* Kick off FIP/FLOGI */
2000	if (!test_bit(BNX2FC_FLAG_FW_INIT_DONE, &interface->hba->flags)) {
2001		printk(KERN_ERR PFX "Init not done yet\n");
2002		return;
2003	}
2004
2005	lport = ctlr->lp;
2006	BNX2FC_HBA_DBG(lport, "calling fc_fabric_login\n");
2007
2008	if (!bnx2fc_link_ok(lport) && interface->enabled) {
2009		BNX2FC_HBA_DBG(lport, "ctlr_link_up\n");
2010		fcoe_ctlr_link_up(ctlr);
2011		fc_host_port_type(lport->host) = FC_PORTTYPE_NPORT;
2012		set_bit(ADAPTER_STATE_READY, &interface->hba->adapter_state);
2013	}
2014
2015	/* wait for the FCF to be selected before issuing FLOGI */
2016	while (!ctlr->sel_fcf) {
2017		msleep(250);
2018		/* give up after 3 secs */
2019		if (++wait_cnt > 12)
2020			break;
2021	}
2022
2023	/* Reset max receive frame size to default */
2024	if (fc_set_mfs(lport, BNX2FC_MFS))
2025		return;
2026
2027	fc_lport_init(lport);
2028	fc_fabric_login(lport);
2029}
2030
2031
2032/**
2033 * bnx2fc_ulp_init - Initialize an adapter instance
2034 *
2035 * @dev :	cnic device handle
2036 * Called from cnic_register_driver() context to initialize all
2037 *	enumerated cnic devices. This routine allocates adapter structure
2038 *	and other device specific resources.
2039 */
2040static void bnx2fc_ulp_init(struct cnic_dev *dev)
2041{
2042	struct bnx2fc_hba *hba;
2043	int rc = 0;
2044
2045	BNX2FC_MISC_DBG("Entered %s\n", __func__);
2046	/* bnx2fc works only when bnx2x is loaded */
2047	if (!test_bit(CNIC_F_BNX2X_CLASS, &dev->flags) ||
2048	    (dev->max_fcoe_conn == 0)) {
2049		printk(KERN_ERR PFX "bnx2fc FCoE not supported on %s,"
2050				    " flags: %lx fcoe_conn: %d\n",
2051			dev->netdev->name, dev->flags, dev->max_fcoe_conn);
2052		return;
2053	}
2054
2055	hba = bnx2fc_hba_create(dev);
2056	if (!hba) {
2057		printk(KERN_ERR PFX "hba initialization failed\n");
2058		return;
2059	}
2060
2061	pr_info(PFX "FCoE initialized for %s.\n", dev->netdev->name);
2062
2063	/* Add HBA to the adapter list */
2064	mutex_lock(&bnx2fc_dev_lock);
2065	list_add_tail(&hba->list, &adapter_list);
2066	adapter_count++;
2067	mutex_unlock(&bnx2fc_dev_lock);
2068
2069	dev->fcoe_cap = &hba->fcoe_cap;
2070	clear_bit(BNX2FC_CNIC_REGISTERED, &hba->reg_with_cnic);
2071	rc = dev->register_device(dev, CNIC_ULP_FCOE,
2072						(void *) hba);
2073	if (rc)
2074		printk(KERN_ERR PFX "register_device failed, rc = %d\n", rc);
2075	else
2076		set_bit(BNX2FC_CNIC_REGISTERED, &hba->reg_with_cnic);
2077}
2078
2079/* Assumes rtnl_lock and the bnx2fc_dev_lock are already taken */
2080static int __bnx2fc_disable(struct fcoe_ctlr *ctlr)
2081{
2082	struct bnx2fc_interface *interface = fcoe_ctlr_priv(ctlr);
2083
2084	if (interface->enabled == true) {
2085		if (!ctlr->lp) {
2086			pr_err(PFX "__bnx2fc_disable: lport not found\n");
2087			return -ENODEV;
2088		} else {
2089			interface->enabled = false;
2090			fcoe_ctlr_link_down(ctlr);
2091			fcoe_clean_pending_queue(ctlr->lp);
2092		}
2093	}
2094	return 0;
2095}
2096
2097/*
2098 * Deperecated: Use bnx2fc_enabled()
2099 */
2100static int bnx2fc_disable(struct net_device *netdev)
2101{
2102	struct bnx2fc_interface *interface;
2103	struct fcoe_ctlr *ctlr;
2104	int rc = 0;
2105
2106	rtnl_lock();
2107	mutex_lock(&bnx2fc_dev_lock);
2108
2109	interface = bnx2fc_interface_lookup(netdev);
2110	ctlr = bnx2fc_to_ctlr(interface);
2111
2112	if (!interface) {
2113		rc = -ENODEV;
2114		pr_err(PFX "bnx2fc_disable: interface not found\n");
2115	} else {
2116		rc = __bnx2fc_disable(ctlr);
2117	}
2118	mutex_unlock(&bnx2fc_dev_lock);
2119	rtnl_unlock();
2120	return rc;
2121}
2122
2123static uint bnx2fc_npiv_create_vports(struct fc_lport *lport,
2124				      struct cnic_fc_npiv_tbl *npiv_tbl)
2125{
2126	struct fc_vport_identifiers vpid;
2127	uint i, created = 0;
2128	u64 wwnn = 0;
2129	char wwpn_str[32];
2130	char wwnn_str[32];
2131
2132	if (npiv_tbl->count > MAX_NPIV_ENTRIES) {
2133		BNX2FC_HBA_DBG(lport, "Exceeded count max of npiv table\n");
2134		goto done;
2135	}
2136
2137	/* Sanity check the first entry to make sure it's not 0 */
2138	if (wwn_to_u64(npiv_tbl->wwnn[0]) == 0 &&
2139	    wwn_to_u64(npiv_tbl->wwpn[0]) == 0) {
2140		BNX2FC_HBA_DBG(lport, "First NPIV table entries invalid.\n");
2141		goto done;
2142	}
2143
2144	vpid.roles = FC_PORT_ROLE_FCP_INITIATOR;
2145	vpid.vport_type = FC_PORTTYPE_NPIV;
2146	vpid.disable = false;
2147
2148	for (i = 0; i < npiv_tbl->count; i++) {
2149		wwnn = wwn_to_u64(npiv_tbl->wwnn[i]);
2150		if (wwnn == 0) {
2151			/*
2152			 * If we get a 0 element from for the WWNN then assume
2153			 * the WWNN should be the same as the physical port.
2154			 */
2155			wwnn = lport->wwnn;
2156		}
2157		vpid.node_name = wwnn;
2158		vpid.port_name = wwn_to_u64(npiv_tbl->wwpn[i]);
2159		scnprintf(vpid.symbolic_name, sizeof(vpid.symbolic_name),
2160		    "NPIV[%u]:%016llx-%016llx",
2161		    created, vpid.port_name, vpid.node_name);
2162		fcoe_wwn_to_str(vpid.node_name, wwnn_str, sizeof(wwnn_str));
2163		fcoe_wwn_to_str(vpid.port_name, wwpn_str, sizeof(wwpn_str));
2164		BNX2FC_HBA_DBG(lport, "Creating vport %s:%s.\n", wwnn_str,
2165		    wwpn_str);
2166		if (fc_vport_create(lport->host, 0, &vpid))
2167			created++;
2168		else
2169			BNX2FC_HBA_DBG(lport, "Failed to create vport\n");
2170	}
2171done:
2172	return created;
2173}
2174
2175static int __bnx2fc_enable(struct fcoe_ctlr *ctlr)
2176{
2177	struct bnx2fc_interface *interface = fcoe_ctlr_priv(ctlr);
2178	struct bnx2fc_hba *hba;
2179	struct cnic_fc_npiv_tbl *npiv_tbl;
2180	struct fc_lport *lport;
2181
2182	if (interface->enabled == false) {
2183		if (!ctlr->lp) {
2184			pr_err(PFX "__bnx2fc_enable: lport not found\n");
2185			return -ENODEV;
2186		} else if (!bnx2fc_link_ok(ctlr->lp)) {
2187			fcoe_ctlr_link_up(ctlr);
2188			interface->enabled = true;
2189		}
2190	}
2191
2192	/* Create static NPIV ports if any are contained in NVRAM */
2193	hba = interface->hba;
2194	lport = ctlr->lp;
2195
2196	if (!hba)
2197		goto done;
2198
2199	if (!hba->cnic)
2200		goto done;
2201
2202	if (!lport)
2203		goto done;
2204
2205	if (!lport->host)
2206		goto done;
2207
2208	if (!hba->cnic->get_fc_npiv_tbl)
2209		goto done;
2210
2211	npiv_tbl = kzalloc(sizeof(struct cnic_fc_npiv_tbl), GFP_KERNEL);
2212	if (!npiv_tbl)
2213		goto done;
2214
2215	if (hba->cnic->get_fc_npiv_tbl(hba->cnic, npiv_tbl))
2216		goto done_free;
2217
2218	bnx2fc_npiv_create_vports(lport, npiv_tbl);
2219done_free:
2220	kfree(npiv_tbl);
2221done:
2222	return 0;
2223}
2224
2225/*
2226 * Deprecated: Use bnx2fc_enabled()
2227 */
2228static int bnx2fc_enable(struct net_device *netdev)
2229{
2230	struct bnx2fc_interface *interface;
2231	struct fcoe_ctlr *ctlr;
2232	int rc = 0;
2233
2234	rtnl_lock();
2235	mutex_lock(&bnx2fc_dev_lock);
2236
2237	interface = bnx2fc_interface_lookup(netdev);
2238	ctlr = bnx2fc_to_ctlr(interface);
2239	if (!interface) {
2240		rc = -ENODEV;
2241		pr_err(PFX "bnx2fc_enable: interface not found\n");
2242	} else {
2243		rc = __bnx2fc_enable(ctlr);
2244	}
2245
2246	mutex_unlock(&bnx2fc_dev_lock);
2247	rtnl_unlock();
2248	return rc;
2249}
2250
2251/**
2252 * bnx2fc_ctlr_enabled() - Enable or disable an FCoE Controller
2253 * @cdev: The FCoE Controller that is being enabled or disabled
2254 *
2255 * fcoe_sysfs will ensure that the state of 'enabled' has
2256 * changed, so no checking is necessary here. This routine simply
2257 * calls fcoe_enable or fcoe_disable, both of which are deprecated.
2258 * When those routines are removed the functionality can be merged
2259 * here.
2260 */
2261static int bnx2fc_ctlr_enabled(struct fcoe_ctlr_device *cdev)
2262{
2263	struct fcoe_ctlr *ctlr = fcoe_ctlr_device_priv(cdev);
2264
2265	switch (cdev->enabled) {
2266	case FCOE_CTLR_ENABLED:
2267		return __bnx2fc_enable(ctlr);
2268	case FCOE_CTLR_DISABLED:
2269		return __bnx2fc_disable(ctlr);
2270	case FCOE_CTLR_UNUSED:
2271	default:
2272		return -ENOTSUPP;
2273	};
2274}
2275
2276enum bnx2fc_create_link_state {
2277	BNX2FC_CREATE_LINK_DOWN,
2278	BNX2FC_CREATE_LINK_UP,
2279};
2280
2281/**
2282 * _bnx2fc_create() - Create bnx2fc FCoE interface
2283 * @netdev  :   The net_device object the Ethernet interface to create on
2284 * @fip_mode:   The FIP mode for this creation
2285 * @link_state: The ctlr link state on creation
2286 *
2287 * Called from either the libfcoe 'create' module parameter
2288 * via fcoe_create or from fcoe_syfs's ctlr_create file.
2289 *
2290 * libfcoe's 'create' module parameter is deprecated so some
2291 * consolidation of code can be done when that interface is
2292 * removed.
2293 *
2294 * Returns: 0 for success
2295 */
2296static int _bnx2fc_create(struct net_device *netdev,
2297			  enum fip_mode fip_mode,
2298			  enum bnx2fc_create_link_state link_state)
2299{
2300	struct fcoe_ctlr_device *cdev;
2301	struct fcoe_ctlr *ctlr;
2302	struct bnx2fc_interface *interface;
2303	struct bnx2fc_hba *hba;
2304	struct net_device *phys_dev = netdev;
2305	struct fc_lport *lport;
2306	struct ethtool_drvinfo drvinfo;
2307	int rc = 0;
2308	int vlan_id = 0;
2309
2310	BNX2FC_MISC_DBG("Entered bnx2fc_create\n");
2311	if (fip_mode != FIP_MODE_FABRIC) {
2312		printk(KERN_ERR "fip mode not FABRIC\n");
2313		return -EIO;
2314	}
2315
2316	rtnl_lock();
2317
2318	mutex_lock(&bnx2fc_dev_lock);
2319
2320	if (!try_module_get(THIS_MODULE)) {
2321		rc = -EINVAL;
2322		goto mod_err;
2323	}
2324
2325	/* obtain physical netdev */
2326	if (is_vlan_dev(netdev))
2327		phys_dev = vlan_dev_real_dev(netdev);
2328
2329	/* verify if the physical device is a netxtreme2 device */
2330	if (phys_dev->ethtool_ops && phys_dev->ethtool_ops->get_drvinfo) {
2331		memset(&drvinfo, 0, sizeof(drvinfo));
2332		phys_dev->ethtool_ops->get_drvinfo(phys_dev, &drvinfo);
2333		if (strncmp(drvinfo.driver, "bnx2x", strlen("bnx2x"))) {
2334			printk(KERN_ERR PFX "Not a netxtreme2 device\n");
2335			rc = -EINVAL;
2336			goto netdev_err;
2337		}
2338	} else {
2339		printk(KERN_ERR PFX "unable to obtain drv_info\n");
2340		rc = -EINVAL;
2341		goto netdev_err;
2342	}
2343
2344	/* obtain interface and initialize rest of the structure */
2345	hba = bnx2fc_hba_lookup(phys_dev);
2346	if (!hba) {
2347		rc = -ENODEV;
2348		printk(KERN_ERR PFX "bnx2fc_create: hba not found\n");
2349		goto netdev_err;
2350	}
2351
2352	if (bnx2fc_interface_lookup(netdev)) {
2353		rc = -EEXIST;
2354		goto netdev_err;
2355	}
2356
2357	interface = bnx2fc_interface_create(hba, netdev, fip_mode);
2358	if (!interface) {
2359		printk(KERN_ERR PFX "bnx2fc_interface_create failed\n");
2360		rc = -ENOMEM;
2361		goto netdev_err;
2362	}
2363
2364	if (is_vlan_dev(netdev)) {
2365		vlan_id = vlan_dev_vlan_id(netdev);
2366		interface->vlan_enabled = 1;
2367	}
2368
2369	ctlr = bnx2fc_to_ctlr(interface);
2370	cdev = fcoe_ctlr_to_ctlr_dev(ctlr);
2371	interface->vlan_id = vlan_id;
2372	interface->tm_timeout = BNX2FC_TM_TIMEOUT;
2373
2374	interface->timer_work_queue =
2375			create_singlethread_workqueue("bnx2fc_timer_wq");
2376	if (!interface->timer_work_queue) {
2377		printk(KERN_ERR PFX "ulp_init could not create timer_wq\n");
2378		rc = -EINVAL;
2379		goto ifput_err;
2380	}
2381
2382	lport = bnx2fc_if_create(interface, &cdev->dev, 0);
2383	if (!lport) {
2384		printk(KERN_ERR PFX "Failed to create interface (%s)\n",
2385			netdev->name);
2386		rc = -EINVAL;
2387		goto if_create_err;
2388	}
2389
2390	/* Add interface to if_list */
2391	list_add_tail(&interface->list, &if_list);
2392
2393	lport->boot_time = jiffies;
2394
2395	/* Make this master N_port */
2396	ctlr->lp = lport;
2397
2398	if (link_state == BNX2FC_CREATE_LINK_UP)
2399		cdev->enabled = FCOE_CTLR_ENABLED;
2400	else
2401		cdev->enabled = FCOE_CTLR_DISABLED;
2402
2403	if (link_state == BNX2FC_CREATE_LINK_UP &&
2404	    !bnx2fc_link_ok(lport)) {
2405		fcoe_ctlr_link_up(ctlr);
2406		fc_host_port_type(lport->host) = FC_PORTTYPE_NPORT;
2407		set_bit(ADAPTER_STATE_READY, &interface->hba->adapter_state);
2408	}
2409
2410	BNX2FC_HBA_DBG(lport, "create: START DISC\n");
2411	bnx2fc_start_disc(interface);
2412
2413	if (link_state == BNX2FC_CREATE_LINK_UP)
2414		interface->enabled = true;
2415
2416	/*
2417	 * Release from kref_init in bnx2fc_interface_setup, on success
2418	 * lport should be holding a reference taken in bnx2fc_if_create
2419	 */
2420	bnx2fc_interface_put(interface);
2421	/* put netdev that was held while calling dev_get_by_name */
2422	mutex_unlock(&bnx2fc_dev_lock);
2423	rtnl_unlock();
2424	return 0;
2425
2426if_create_err:
2427	destroy_workqueue(interface->timer_work_queue);
2428ifput_err:
2429	bnx2fc_net_cleanup(interface);
2430	bnx2fc_interface_put(interface);
2431	goto mod_err;
2432netdev_err:
2433	module_put(THIS_MODULE);
2434mod_err:
2435	mutex_unlock(&bnx2fc_dev_lock);
2436	rtnl_unlock();
2437	return rc;
2438}
2439
2440/**
2441 * bnx2fc_create() - Create a bnx2fc interface
2442 * @netdev  : The net_device object the Ethernet interface to create on
2443 * @fip_mode: The FIP mode for this creation
2444 *
2445 * Called from fcoe transport
2446 *
2447 * Returns: 0 for success
2448 */
2449static int bnx2fc_create(struct net_device *netdev, enum fip_mode fip_mode)
2450{
2451	return _bnx2fc_create(netdev, fip_mode, BNX2FC_CREATE_LINK_UP);
2452}
2453
2454/**
2455 * bnx2fc_ctlr_alloc() - Allocate a bnx2fc interface from fcoe_sysfs
2456 * @netdev: The net_device to be used by the allocated FCoE Controller
2457 *
2458 * This routine is called from fcoe_sysfs. It will start the fcoe_ctlr
2459 * in a link_down state. The allows the user an opportunity to configure
2460 * the FCoE Controller from sysfs before enabling the FCoE Controller.
2461 *
2462 * Creating in with this routine starts the FCoE Controller in Fabric
2463 * mode. The user can change to VN2VN or another mode before enabling.
2464 */
2465static int bnx2fc_ctlr_alloc(struct net_device *netdev)
2466{
2467	return _bnx2fc_create(netdev, FIP_MODE_FABRIC,
2468			      BNX2FC_CREATE_LINK_DOWN);
2469}
2470
2471/**
2472 * bnx2fc_find_hba_for_cnic - maps cnic instance to bnx2fc hba instance
2473 *
2474 * @cnic:	Pointer to cnic device instance
2475 *
2476 **/
2477static struct bnx2fc_hba *bnx2fc_find_hba_for_cnic(struct cnic_dev *cnic)
2478{
2479	struct bnx2fc_hba *hba;
2480
2481	/* Called with bnx2fc_dev_lock held */
2482	list_for_each_entry(hba, &adapter_list, list) {
2483		if (hba->cnic == cnic)
2484			return hba;
2485	}
2486	return NULL;
2487}
2488
2489static struct bnx2fc_interface *bnx2fc_interface_lookup(struct net_device
2490							*netdev)
2491{
2492	struct bnx2fc_interface *interface;
2493
2494	/* Called with bnx2fc_dev_lock held */
2495	list_for_each_entry(interface, &if_list, list) {
2496		if (interface->netdev == netdev)
2497			return interface;
2498	}
2499	return NULL;
2500}
2501
2502static struct bnx2fc_hba *bnx2fc_hba_lookup(struct net_device
2503						      *phys_dev)
2504{
2505	struct bnx2fc_hba *hba;
2506
2507	/* Called with bnx2fc_dev_lock held */
2508	list_for_each_entry(hba, &adapter_list, list) {
2509		if (hba->phys_dev == phys_dev)
2510			return hba;
2511	}
2512	printk(KERN_ERR PFX "adapter_lookup: hba NULL\n");
2513	return NULL;
2514}
2515
2516/**
2517 * bnx2fc_ulp_exit - shuts down adapter instance and frees all resources
2518 *
2519 * @dev:	cnic device handle
2520 */
2521static void bnx2fc_ulp_exit(struct cnic_dev *dev)
2522{
2523	struct bnx2fc_hba *hba;
2524	struct bnx2fc_interface *interface, *tmp;
2525
2526	BNX2FC_MISC_DBG("Entered bnx2fc_ulp_exit\n");
2527
2528	if (!test_bit(CNIC_F_BNX2X_CLASS, &dev->flags)) {
2529		printk(KERN_ERR PFX "bnx2fc port check: %s, flags: %lx\n",
2530			dev->netdev->name, dev->flags);
2531		return;
2532	}
2533
2534	mutex_lock(&bnx2fc_dev_lock);
2535	hba = bnx2fc_find_hba_for_cnic(dev);
2536	if (!hba) {
2537		printk(KERN_ERR PFX "bnx2fc_ulp_exit: hba not found, dev 0%p\n",
2538		       dev);
2539		mutex_unlock(&bnx2fc_dev_lock);
2540		return;
2541	}
2542
2543	list_del_init(&hba->list);
2544	adapter_count--;
2545
2546	list_for_each_entry_safe(interface, tmp, &if_list, list)
2547		/* destroy not called yet, move to quiesced list */
2548		if (interface->hba == hba)
2549			__bnx2fc_destroy(interface);
2550	mutex_unlock(&bnx2fc_dev_lock);
2551
2552	bnx2fc_ulp_stop(hba);
2553	/* unregister cnic device */
2554	if (test_and_clear_bit(BNX2FC_CNIC_REGISTERED, &hba->reg_with_cnic))
2555		hba->cnic->unregister_device(hba->cnic, CNIC_ULP_FCOE);
2556	bnx2fc_hba_destroy(hba);
2557}
2558
2559static void bnx2fc_rport_terminate_io(struct fc_rport *rport)
2560{
2561	/* This is a no-op */
2562}
2563
2564/**
2565 * bnx2fc_fcoe_reset - Resets the fcoe
2566 *
2567 * @shost: shost the reset is from
2568 *
2569 * Returns: always 0
2570 */
2571static int bnx2fc_fcoe_reset(struct Scsi_Host *shost)
2572{
2573	struct fc_lport *lport = shost_priv(shost);
2574	fc_lport_reset(lport);
2575	return 0;
2576}
2577
2578
2579static bool bnx2fc_match(struct net_device *netdev)
2580{
2581	struct net_device *phys_dev = netdev;
2582
2583	mutex_lock(&bnx2fc_dev_lock);
2584	if (is_vlan_dev(netdev))
2585		phys_dev = vlan_dev_real_dev(netdev);
2586
2587	if (bnx2fc_hba_lookup(phys_dev)) {
2588		mutex_unlock(&bnx2fc_dev_lock);
2589		return true;
2590	}
2591
2592	mutex_unlock(&bnx2fc_dev_lock);
2593	return false;
2594}
2595
2596
2597static struct fcoe_transport bnx2fc_transport = {
2598	.name = {"bnx2fc"},
2599	.attached = false,
2600	.list = LIST_HEAD_INIT(bnx2fc_transport.list),
2601	.alloc = bnx2fc_ctlr_alloc,
2602	.match = bnx2fc_match,
2603	.create = bnx2fc_create,
2604	.destroy = bnx2fc_destroy,
2605	.enable = bnx2fc_enable,
2606	.disable = bnx2fc_disable,
2607};
2608
2609/**
2610 * bnx2fc_cpu_online - Create a receive thread for an  online CPU
2611 *
2612 * @cpu: cpu index for the online cpu
2613 */
2614static int bnx2fc_cpu_online(unsigned int cpu)
2615{
2616	struct bnx2fc_percpu_s *p;
2617	struct task_struct *thread;
2618
2619	p = &per_cpu(bnx2fc_percpu, cpu);
2620
2621	thread = kthread_create_on_node(bnx2fc_percpu_io_thread,
2622					(void *)p, cpu_to_node(cpu),
2623					"bnx2fc_thread/%d", cpu);
2624	if (IS_ERR(thread))
2625		return PTR_ERR(thread);
2626
2627	/* bind thread to the cpu */
2628	kthread_bind(thread, cpu);
2629	p->iothread = thread;
2630	wake_up_process(thread);
2631	return 0;
2632}
2633
2634static int bnx2fc_cpu_offline(unsigned int cpu)
2635{
2636	struct bnx2fc_percpu_s *p;
2637	struct task_struct *thread;
2638	struct bnx2fc_work *work, *tmp;
2639
2640	BNX2FC_MISC_DBG("destroying io thread for CPU %d\n", cpu);
2641
2642	/* Prevent any new work from being queued for this CPU */
2643	p = &per_cpu(bnx2fc_percpu, cpu);
2644	spin_lock_bh(&p->fp_work_lock);
2645	thread = p->iothread;
2646	p->iothread = NULL;
2647
2648	/* Free all work in the list */
2649	list_for_each_entry_safe(work, tmp, &p->work_list, list) {
2650		list_del_init(&work->list);
2651		bnx2fc_process_cq_compl(work->tgt, work->wqe, work->rq_data,
2652					work->num_rq, work->task);
2653		kfree(work);
2654	}
2655
2656	spin_unlock_bh(&p->fp_work_lock);
2657
2658	if (thread)
2659		kthread_stop(thread);
2660	return 0;
2661}
2662
2663static int bnx2fc_slave_configure(struct scsi_device *sdev)
2664{
2665	if (!bnx2fc_queue_depth)
2666		return 0;
2667
2668	scsi_change_queue_depth(sdev, bnx2fc_queue_depth);
2669	return 0;
2670}
2671
2672static enum cpuhp_state bnx2fc_online_state;
2673
2674/**
2675 * bnx2fc_mod_init - module init entry point
2676 *
2677 * Initialize driver wide global data structures, and register
2678 * with cnic module
2679 **/
2680static int __init bnx2fc_mod_init(void)
2681{
2682	struct fcoe_percpu_s *bg;
2683	struct task_struct *l2_thread;
2684	int rc = 0;
2685	unsigned int cpu = 0;
2686	struct bnx2fc_percpu_s *p;
2687
2688	printk(KERN_INFO PFX "%s", version);
2689
2690	/* register as a fcoe transport */
2691	rc = fcoe_transport_attach(&bnx2fc_transport);
2692	if (rc) {
2693		printk(KERN_ERR "failed to register an fcoe transport, check "
2694			"if libfcoe is loaded\n");
2695		goto out;
2696	}
2697
2698	INIT_LIST_HEAD(&adapter_list);
2699	INIT_LIST_HEAD(&if_list);
2700	mutex_init(&bnx2fc_dev_lock);
2701	adapter_count = 0;
2702
2703	/* Attach FC transport template */
2704	rc = bnx2fc_attach_transport();
2705	if (rc)
2706		goto detach_ft;
2707
2708	bnx2fc_wq = alloc_workqueue("bnx2fc", 0, 0);
2709	if (!bnx2fc_wq) {
2710		rc = -ENOMEM;
2711		goto release_bt;
2712	}
2713
2714	bg = &bnx2fc_global;
2715	skb_queue_head_init(&bg->fcoe_rx_list);
2716	l2_thread = kthread_create(bnx2fc_l2_rcv_thread,
2717				   (void *)bg,
2718				   "bnx2fc_l2_thread");
2719	if (IS_ERR(l2_thread)) {
2720		rc = PTR_ERR(l2_thread);
2721		goto free_wq;
2722	}
2723	wake_up_process(l2_thread);
2724	spin_lock_bh(&bg->fcoe_rx_list.lock);
2725	bg->kthread = l2_thread;
2726	spin_unlock_bh(&bg->fcoe_rx_list.lock);
2727
2728	for_each_possible_cpu(cpu) {
2729		p = &per_cpu(bnx2fc_percpu, cpu);
2730		INIT_LIST_HEAD(&p->work_list);
2731		spin_lock_init(&p->fp_work_lock);
2732	}
2733
2734	rc = cpuhp_setup_state(CPUHP_AP_ONLINE_DYN, "scsi/bnx2fc:online",
2735			       bnx2fc_cpu_online, bnx2fc_cpu_offline);
2736	if (rc < 0)
2737		goto stop_thread;
2738	bnx2fc_online_state = rc;
2739
2740	cnic_register_driver(CNIC_ULP_FCOE, &bnx2fc_cnic_cb);
2741	return 0;
2742
2743stop_thread:
2744	kthread_stop(l2_thread);
2745free_wq:
2746	destroy_workqueue(bnx2fc_wq);
2747release_bt:
2748	bnx2fc_release_transport();
2749detach_ft:
2750	fcoe_transport_detach(&bnx2fc_transport);
2751out:
2752	return rc;
2753}
2754
2755static void __exit bnx2fc_mod_exit(void)
2756{
2757	LIST_HEAD(to_be_deleted);
2758	struct bnx2fc_hba *hba, *next;
2759	struct fcoe_percpu_s *bg;
2760	struct task_struct *l2_thread;
2761	struct sk_buff *skb;
2762
2763	/*
2764	 * NOTE: Since cnic calls register_driver routine rtnl_lock,
2765	 * it will have higher precedence than bnx2fc_dev_lock.
2766	 * unregister_device() cannot be called with bnx2fc_dev_lock
2767	 * held.
2768	 */
2769	mutex_lock(&bnx2fc_dev_lock);
2770	list_splice_init(&adapter_list, &to_be_deleted);
2771	adapter_count = 0;
2772	mutex_unlock(&bnx2fc_dev_lock);
2773
2774	/* Unregister with cnic */
2775	list_for_each_entry_safe(hba, next, &to_be_deleted, list) {
2776		list_del_init(&hba->list);
2777		printk(KERN_ERR PFX "MOD_EXIT:destroy hba = 0x%p\n",
2778		       hba);
2779		bnx2fc_ulp_stop(hba);
2780		/* unregister cnic device */
2781		if (test_and_clear_bit(BNX2FC_CNIC_REGISTERED,
2782				       &hba->reg_with_cnic))
2783			hba->cnic->unregister_device(hba->cnic,
2784							 CNIC_ULP_FCOE);
2785		bnx2fc_hba_destroy(hba);
2786	}
2787	cnic_unregister_driver(CNIC_ULP_FCOE);
2788
2789	/* Destroy global thread */
2790	bg = &bnx2fc_global;
2791	spin_lock_bh(&bg->fcoe_rx_list.lock);
2792	l2_thread = bg->kthread;
2793	bg->kthread = NULL;
2794	while ((skb = __skb_dequeue(&bg->fcoe_rx_list)) != NULL)
2795		kfree_skb(skb);
2796
2797	spin_unlock_bh(&bg->fcoe_rx_list.lock);
2798
2799	if (l2_thread)
2800		kthread_stop(l2_thread);
2801
2802	cpuhp_remove_state(bnx2fc_online_state);
2803
2804	destroy_workqueue(bnx2fc_wq);
2805	/*
2806	 * detach from scsi transport
2807	 * must happen after all destroys are done
2808	 */
2809	bnx2fc_release_transport();
2810
2811	/* detach from fcoe transport */
2812	fcoe_transport_detach(&bnx2fc_transport);
2813}
2814
2815module_init(bnx2fc_mod_init);
2816module_exit(bnx2fc_mod_exit);
2817
2818static struct fcoe_sysfs_function_template bnx2fc_fcoe_sysfs_templ = {
2819	.set_fcoe_ctlr_enabled = bnx2fc_ctlr_enabled,
2820	.get_fcoe_ctlr_link_fail = fcoe_ctlr_get_lesb,
2821	.get_fcoe_ctlr_vlink_fail = fcoe_ctlr_get_lesb,
2822	.get_fcoe_ctlr_miss_fka = fcoe_ctlr_get_lesb,
2823	.get_fcoe_ctlr_symb_err = fcoe_ctlr_get_lesb,
2824	.get_fcoe_ctlr_err_block = fcoe_ctlr_get_lesb,
2825	.get_fcoe_ctlr_fcs_error = fcoe_ctlr_get_lesb,
2826
2827	.get_fcoe_fcf_selected = fcoe_fcf_get_selected,
2828	.get_fcoe_fcf_vlan_id = bnx2fc_fcf_get_vlan_id,
2829};
2830
2831static struct fc_function_template bnx2fc_transport_function = {
2832	.show_host_node_name = 1,
2833	.show_host_port_name = 1,
2834	.show_host_supported_classes = 1,
2835	.show_host_supported_fc4s = 1,
2836	.show_host_active_fc4s = 1,
2837	.show_host_maxframe_size = 1,
2838
2839	.show_host_port_id = 1,
2840	.show_host_supported_speeds = 1,
2841	.get_host_speed = fc_get_host_speed,
2842	.show_host_speed = 1,
2843	.show_host_port_type = 1,
2844	.get_host_port_state = fc_get_host_port_state,
2845	.show_host_port_state = 1,
2846	.show_host_symbolic_name = 1,
2847
2848	.dd_fcrport_size = (sizeof(struct fc_rport_libfc_priv) +
2849				sizeof(struct bnx2fc_rport)),
2850	.show_rport_maxframe_size = 1,
2851	.show_rport_supported_classes = 1,
2852
2853	.show_host_fabric_name = 1,
2854	.show_starget_node_name = 1,
2855	.show_starget_port_name = 1,
2856	.show_starget_port_id = 1,
2857	.set_rport_dev_loss_tmo = fc_set_rport_loss_tmo,
2858	.show_rport_dev_loss_tmo = 1,
2859	.get_fc_host_stats = bnx2fc_get_host_stats,
2860
2861	.issue_fc_host_lip = bnx2fc_fcoe_reset,
2862
2863	.terminate_rport_io = bnx2fc_rport_terminate_io,
2864
2865	.vport_create = bnx2fc_vport_create,
2866	.vport_delete = bnx2fc_vport_destroy,
2867	.vport_disable = bnx2fc_vport_disable,
2868	.bsg_request = fc_lport_bsg_request,
2869};
2870
2871static struct fc_function_template bnx2fc_vport_xport_function = {
2872	.show_host_node_name = 1,
2873	.show_host_port_name = 1,
2874	.show_host_supported_classes = 1,
2875	.show_host_supported_fc4s = 1,
2876	.show_host_active_fc4s = 1,
2877	.show_host_maxframe_size = 1,
2878
2879	.show_host_port_id = 1,
2880	.show_host_supported_speeds = 1,
2881	.get_host_speed = fc_get_host_speed,
2882	.show_host_speed = 1,
2883	.show_host_port_type = 1,
2884	.get_host_port_state = fc_get_host_port_state,
2885	.show_host_port_state = 1,
2886	.show_host_symbolic_name = 1,
2887
2888	.dd_fcrport_size = (sizeof(struct fc_rport_libfc_priv) +
2889				sizeof(struct bnx2fc_rport)),
2890	.show_rport_maxframe_size = 1,
2891	.show_rport_supported_classes = 1,
2892
2893	.show_host_fabric_name = 1,
2894	.show_starget_node_name = 1,
2895	.show_starget_port_name = 1,
2896	.show_starget_port_id = 1,
2897	.set_rport_dev_loss_tmo = fc_set_rport_loss_tmo,
2898	.show_rport_dev_loss_tmo = 1,
2899	.get_fc_host_stats = fc_get_host_stats,
2900	.issue_fc_host_lip = bnx2fc_fcoe_reset,
2901	.terminate_rport_io = fc_rport_terminate_io,
2902	.bsg_request = fc_lport_bsg_request,
2903};
2904
2905/*
2906 * Additional scsi_host attributes.
2907 */
2908static ssize_t
2909bnx2fc_tm_timeout_show(struct device *dev, struct device_attribute *attr,
2910	char *buf)
2911{
2912	struct Scsi_Host *shost = class_to_shost(dev);
2913	struct fc_lport *lport = shost_priv(shost);
2914	struct fcoe_port *port = lport_priv(lport);
2915	struct bnx2fc_interface *interface = port->priv;
2916
2917	sprintf(buf, "%u\n", interface->tm_timeout);
2918	return strlen(buf);
2919}
2920
2921static ssize_t
2922bnx2fc_tm_timeout_store(struct device *dev,
2923	struct device_attribute *attr, const char *buf, size_t count)
2924{
2925	struct Scsi_Host *shost = class_to_shost(dev);
2926	struct fc_lport *lport = shost_priv(shost);
2927	struct fcoe_port *port = lport_priv(lport);
2928	struct bnx2fc_interface *interface = port->priv;
2929	int rval, val;
2930
2931	rval = kstrtouint(buf, 10, &val);
2932	if (rval)
2933		return rval;
2934	if (val > 255)
2935		return -ERANGE;
2936
2937	interface->tm_timeout = (u8)val;
2938	return strlen(buf);
2939}
2940
2941static DEVICE_ATTR(tm_timeout, S_IRUGO|S_IWUSR, bnx2fc_tm_timeout_show,
2942	bnx2fc_tm_timeout_store);
2943
2944static struct device_attribute *bnx2fc_host_attrs[] = {
2945	&dev_attr_tm_timeout,
2946	NULL,
2947};
2948
2949/*
2950 * scsi_host_template structure used while registering with SCSI-ml
2951 */
2952static struct scsi_host_template bnx2fc_shost_template = {
2953	.module			= THIS_MODULE,
2954	.name			= "QLogic Offload FCoE Initiator",
2955	.queuecommand		= bnx2fc_queuecommand,
2956	.eh_timed_out		= fc_eh_timed_out,
2957	.eh_abort_handler	= bnx2fc_eh_abort,	  /* abts */
2958	.eh_device_reset_handler = bnx2fc_eh_device_reset, /* lun reset */
2959	.eh_target_reset_handler = bnx2fc_eh_target_reset, /* tgt reset */
2960	.eh_host_reset_handler	= fc_eh_host_reset,
2961	.slave_alloc		= fc_slave_alloc,
2962	.change_queue_depth	= scsi_change_queue_depth,
2963	.this_id		= -1,
2964	.cmd_per_lun		= 3,
2965	.sg_tablesize		= BNX2FC_MAX_BDS_PER_CMD,
2966	.dma_boundary           = 0x7fff,
2967	.max_sectors		= 0x3fbf,
2968	.track_queue_depth	= 1,
2969	.slave_configure	= bnx2fc_slave_configure,
2970	.shost_attrs		= bnx2fc_host_attrs,
2971};
2972
2973static struct libfc_function_template bnx2fc_libfc_fcn_templ = {
2974	.frame_send		= bnx2fc_xmit,
2975	.elsct_send		= bnx2fc_elsct_send,
2976	.fcp_abort_io		= bnx2fc_abort_io,
2977	.fcp_cleanup		= bnx2fc_cleanup,
2978	.get_lesb		= fcoe_get_lesb,
2979	.rport_event_callback	= bnx2fc_rport_event_handler,
2980};
2981
2982/*
2983 * bnx2fc_cnic_cb - global template of bnx2fc - cnic driver interface
2984 *			structure carrying callback function pointers
2985 */
2986static struct cnic_ulp_ops bnx2fc_cnic_cb = {
2987	.owner			= THIS_MODULE,
2988	.cnic_init		= bnx2fc_ulp_init,
2989	.cnic_exit		= bnx2fc_ulp_exit,
2990	.cnic_start		= bnx2fc_ulp_start,
2991	.cnic_stop		= bnx2fc_ulp_stop,
2992	.indicate_kcqes		= bnx2fc_indicate_kcqe,
2993	.indicate_netevent	= bnx2fc_indicate_netevent,
2994	.cnic_get_stats		= bnx2fc_ulp_get_stats,
2995};
2996