Linux 4.18.10
[linux/fpc-iii.git] / drivers / scsi / qedf / qedf_main.c
blob0a5dd5595dd3c42179543d8453e9d3afc98ba3f7
1 /*
2 * QLogic FCoE Offload Driver
3 * Copyright (c) 2016-2018 Cavium Inc.
5 * This software is available under the terms of the GNU General Public License
6 * (GPL) Version 2, available from the file COPYING in the main directory of
7 * this source tree.
8 */
9 #include <linux/init.h>
10 #include <linux/kernel.h>
11 #include <linux/module.h>
12 #include <linux/pci.h>
13 #include <linux/device.h>
14 #include <linux/highmem.h>
15 #include <linux/crc32.h>
16 #include <linux/interrupt.h>
17 #include <linux/list.h>
18 #include <linux/kthread.h>
19 #include <scsi/libfc.h>
20 #include <scsi/scsi_host.h>
21 #include <scsi/fc_frame.h>
22 #include <linux/if_ether.h>
23 #include <linux/if_vlan.h>
24 #include <linux/cpu.h>
25 #include "qedf.h"
26 #include "qedf_dbg.h"
27 #include <uapi/linux/pci_regs.h>
29 const struct qed_fcoe_ops *qed_ops;
31 static int qedf_probe(struct pci_dev *pdev, const struct pci_device_id *id);
32 static void qedf_remove(struct pci_dev *pdev);
35 * Driver module parameters.
37 static unsigned int qedf_dev_loss_tmo = 60;
38 module_param_named(dev_loss_tmo, qedf_dev_loss_tmo, int, S_IRUGO);
39 MODULE_PARM_DESC(dev_loss_tmo, " dev_loss_tmo setting for attached "
40 "remote ports (default 60)");
42 uint qedf_debug = QEDF_LOG_INFO;
43 module_param_named(debug, qedf_debug, uint, S_IRUGO);
44 MODULE_PARM_DESC(debug, " Debug mask. Pass '1' to enable default debugging"
45 " mask");
47 static uint qedf_fipvlan_retries = 60;
48 module_param_named(fipvlan_retries, qedf_fipvlan_retries, int, S_IRUGO);
49 MODULE_PARM_DESC(fipvlan_retries, " Number of FIP VLAN requests to attempt "
50 "before giving up (default 60)");
52 static uint qedf_fallback_vlan = QEDF_FALLBACK_VLAN;
53 module_param_named(fallback_vlan, qedf_fallback_vlan, int, S_IRUGO);
54 MODULE_PARM_DESC(fallback_vlan, " VLAN ID to try if fip vlan request fails "
55 "(default 1002).");
57 static int qedf_default_prio = -1;
58 module_param_named(default_prio, qedf_default_prio, int, S_IRUGO);
59 MODULE_PARM_DESC(default_prio, " Override 802.1q priority for FIP and FCoE"
60 " traffic (value between 0 and 7, default 3).");
62 uint qedf_dump_frames;
63 module_param_named(dump_frames, qedf_dump_frames, int, S_IRUGO | S_IWUSR);
64 MODULE_PARM_DESC(dump_frames, " Print the skb data of FIP and FCoE frames "
65 "(default off)");
67 static uint qedf_queue_depth;
68 module_param_named(queue_depth, qedf_queue_depth, int, S_IRUGO);
69 MODULE_PARM_DESC(queue_depth, " Sets the queue depth for all LUNs discovered "
70 "by the qedf driver. Default is 0 (use OS default).");
72 uint qedf_io_tracing;
73 module_param_named(io_tracing, qedf_io_tracing, int, S_IRUGO | S_IWUSR);
74 MODULE_PARM_DESC(io_tracing, " Enable logging of SCSI requests/completions "
75 "into trace buffer. (default off).");
77 static uint qedf_max_lun = MAX_FIBRE_LUNS;
78 module_param_named(max_lun, qedf_max_lun, int, S_IRUGO);
79 MODULE_PARM_DESC(max_lun, " Sets the maximum luns per target that the driver "
80 "supports. (default 0xffffffff)");
82 uint qedf_link_down_tmo;
83 module_param_named(link_down_tmo, qedf_link_down_tmo, int, S_IRUGO);
84 MODULE_PARM_DESC(link_down_tmo, " Delays informing the fcoe transport that the "
85 "link is down by N seconds.");
87 bool qedf_retry_delay;
88 module_param_named(retry_delay, qedf_retry_delay, bool, S_IRUGO | S_IWUSR);
89 MODULE_PARM_DESC(retry_delay, " Enable/disable handling of FCP_RSP IU retry "
90 "delay handling (default off).");
92 static bool qedf_dcbx_no_wait;
93 module_param_named(dcbx_no_wait, qedf_dcbx_no_wait, bool, S_IRUGO | S_IWUSR);
94 MODULE_PARM_DESC(dcbx_no_wait, " Do not wait for DCBX convergence to start "
95 "sending FIP VLAN requests on link up (Default: off).");
97 static uint qedf_dp_module;
98 module_param_named(dp_module, qedf_dp_module, uint, S_IRUGO);
99 MODULE_PARM_DESC(dp_module, " bit flags control for verbose printk passed "
100 "qed module during probe.");
102 static uint qedf_dp_level = QED_LEVEL_NOTICE;
103 module_param_named(dp_level, qedf_dp_level, uint, S_IRUGO);
104 MODULE_PARM_DESC(dp_level, " printk verbosity control passed to qed module "
105 "during probe (0-3: 0 more verbose).");
107 struct workqueue_struct *qedf_io_wq;
109 static struct fcoe_percpu_s qedf_global;
110 static DEFINE_SPINLOCK(qedf_global_lock);
112 static struct kmem_cache *qedf_io_work_cache;
114 void qedf_set_vlan_id(struct qedf_ctx *qedf, int vlan_id)
116 qedf->vlan_id = vlan_id;
117 qedf->vlan_id |= qedf->prio << VLAN_PRIO_SHIFT;
118 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "Setting vlan_id=%04x "
119 "prio=%d.\n", vlan_id, qedf->prio);
122 /* Returns true if we have a valid vlan, false otherwise */
123 static bool qedf_initiate_fipvlan_req(struct qedf_ctx *qedf)
125 int rc;
127 if (atomic_read(&qedf->link_state) != QEDF_LINK_UP) {
128 QEDF_ERR(&(qedf->dbg_ctx), "Link not up.\n");
129 return false;
132 while (qedf->fipvlan_retries--) {
133 if (qedf->vlan_id > 0)
134 return true;
135 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
136 "Retry %d.\n", qedf->fipvlan_retries);
137 init_completion(&qedf->fipvlan_compl);
138 qedf_fcoe_send_vlan_req(qedf);
139 rc = wait_for_completion_timeout(&qedf->fipvlan_compl,
140 1 * HZ);
141 if (rc > 0) {
142 fcoe_ctlr_link_up(&qedf->ctlr);
143 return true;
147 return false;
150 static void qedf_handle_link_update(struct work_struct *work)
152 struct qedf_ctx *qedf =
153 container_of(work, struct qedf_ctx, link_update.work);
154 int rc;
156 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "Entered.\n");
158 if (atomic_read(&qedf->link_state) == QEDF_LINK_UP) {
159 rc = qedf_initiate_fipvlan_req(qedf);
160 if (rc)
161 return;
163 * If we get here then we never received a repsonse to our
164 * fip vlan request so set the vlan_id to the default and
165 * tell FCoE that the link is up
167 QEDF_WARN(&(qedf->dbg_ctx), "Did not receive FIP VLAN "
168 "response, falling back to default VLAN %d.\n",
169 qedf_fallback_vlan);
170 qedf_set_vlan_id(qedf, qedf_fallback_vlan);
173 * Zero out data_src_addr so we'll update it with the new
174 * lport port_id
176 eth_zero_addr(qedf->data_src_addr);
177 fcoe_ctlr_link_up(&qedf->ctlr);
178 } else if (atomic_read(&qedf->link_state) == QEDF_LINK_DOWN) {
180 * If we hit here and link_down_tmo_valid is still 1 it means
181 * that link_down_tmo timed out so set it to 0 to make sure any
182 * other readers have accurate state.
184 atomic_set(&qedf->link_down_tmo_valid, 0);
185 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
186 "Calling fcoe_ctlr_link_down().\n");
187 fcoe_ctlr_link_down(&qedf->ctlr);
188 qedf_wait_for_upload(qedf);
189 /* Reset the number of FIP VLAN retries */
190 qedf->fipvlan_retries = qedf_fipvlan_retries;
194 #define QEDF_FCOE_MAC_METHOD_GRANGED_MAC 1
195 #define QEDF_FCOE_MAC_METHOD_FCF_MAP 2
196 #define QEDF_FCOE_MAC_METHOD_FCOE_SET_MAC 3
197 static void qedf_set_data_src_addr(struct qedf_ctx *qedf, struct fc_frame *fp)
199 u8 *granted_mac;
200 struct fc_frame_header *fh = fc_frame_header_get(fp);
201 u8 fc_map[3];
202 int method = 0;
204 /* Get granted MAC address from FIP FLOGI payload */
205 granted_mac = fr_cb(fp)->granted_mac;
208 * We set the source MAC for FCoE traffic based on the Granted MAC
209 * address from the switch.
211 * If granted_mac is non-zero, we used that.
212 * If the granted_mac is zeroed out, created the FCoE MAC based on
213 * the sel_fcf->fc_map and the d_id fo the FLOGI frame.
214 * If sel_fcf->fc_map is 0 then we use the default FCF-MAC plus the
215 * d_id of the FLOGI frame.
217 if (!is_zero_ether_addr(granted_mac)) {
218 ether_addr_copy(qedf->data_src_addr, granted_mac);
219 method = QEDF_FCOE_MAC_METHOD_GRANGED_MAC;
220 } else if (qedf->ctlr.sel_fcf->fc_map != 0) {
221 hton24(fc_map, qedf->ctlr.sel_fcf->fc_map);
222 qedf->data_src_addr[0] = fc_map[0];
223 qedf->data_src_addr[1] = fc_map[1];
224 qedf->data_src_addr[2] = fc_map[2];
225 qedf->data_src_addr[3] = fh->fh_d_id[0];
226 qedf->data_src_addr[4] = fh->fh_d_id[1];
227 qedf->data_src_addr[5] = fh->fh_d_id[2];
228 method = QEDF_FCOE_MAC_METHOD_FCF_MAP;
229 } else {
230 fc_fcoe_set_mac(qedf->data_src_addr, fh->fh_d_id);
231 method = QEDF_FCOE_MAC_METHOD_FCOE_SET_MAC;
234 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
235 "QEDF data_src_mac=%pM method=%d.\n", qedf->data_src_addr, method);
238 static void qedf_flogi_resp(struct fc_seq *seq, struct fc_frame *fp,
239 void *arg)
241 struct fc_exch *exch = fc_seq_exch(seq);
242 struct fc_lport *lport = exch->lp;
243 struct qedf_ctx *qedf = lport_priv(lport);
245 if (!qedf) {
246 QEDF_ERR(NULL, "qedf is NULL.\n");
247 return;
251 * If ERR_PTR is set then don't try to stat anything as it will cause
252 * a crash when we access fp.
254 if (IS_ERR(fp)) {
255 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_ELS,
256 "fp has IS_ERR() set.\n");
257 goto skip_stat;
260 /* Log stats for FLOGI reject */
261 if (fc_frame_payload_op(fp) == ELS_LS_RJT)
262 qedf->flogi_failed++;
263 else if (fc_frame_payload_op(fp) == ELS_LS_ACC) {
264 /* Set the source MAC we will use for FCoE traffic */
265 qedf_set_data_src_addr(qedf, fp);
268 /* Complete flogi_compl so we can proceed to sending ADISCs */
269 complete(&qedf->flogi_compl);
271 skip_stat:
272 /* Report response to libfc */
273 fc_lport_flogi_resp(seq, fp, lport);
276 static struct fc_seq *qedf_elsct_send(struct fc_lport *lport, u32 did,
277 struct fc_frame *fp, unsigned int op,
278 void (*resp)(struct fc_seq *,
279 struct fc_frame *,
280 void *),
281 void *arg, u32 timeout)
283 struct qedf_ctx *qedf = lport_priv(lport);
286 * Intercept FLOGI for statistic purposes. Note we use the resp
287 * callback to tell if this is really a flogi.
289 if (resp == fc_lport_flogi_resp) {
290 qedf->flogi_cnt++;
291 return fc_elsct_send(lport, did, fp, op, qedf_flogi_resp,
292 arg, timeout);
295 return fc_elsct_send(lport, did, fp, op, resp, arg, timeout);
298 int qedf_send_flogi(struct qedf_ctx *qedf)
300 struct fc_lport *lport;
301 struct fc_frame *fp;
303 lport = qedf->lport;
305 if (!lport->tt.elsct_send)
306 return -EINVAL;
308 fp = fc_frame_alloc(lport, sizeof(struct fc_els_flogi));
309 if (!fp) {
310 QEDF_ERR(&(qedf->dbg_ctx), "fc_frame_alloc failed.\n");
311 return -ENOMEM;
314 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_ELS,
315 "Sending FLOGI to reestablish session with switch.\n");
316 lport->tt.elsct_send(lport, FC_FID_FLOGI, fp,
317 ELS_FLOGI, qedf_flogi_resp, lport, lport->r_a_tov);
319 init_completion(&qedf->flogi_compl);
321 return 0;
324 struct qedf_tmp_rdata_item {
325 struct fc_rport_priv *rdata;
326 struct list_head list;
330 * This function is called if link_down_tmo is in use. If we get a link up and
331 * link_down_tmo has not expired then use just FLOGI/ADISC to recover our
332 * sessions with targets. Otherwise, just call fcoe_ctlr_link_up().
334 static void qedf_link_recovery(struct work_struct *work)
336 struct qedf_ctx *qedf =
337 container_of(work, struct qedf_ctx, link_recovery.work);
338 struct qedf_rport *fcport;
339 struct fc_rport_priv *rdata;
340 struct qedf_tmp_rdata_item *rdata_item, *tmp_rdata_item;
341 bool rc;
342 int retries = 30;
343 int rval, i;
344 struct list_head rdata_login_list;
346 INIT_LIST_HEAD(&rdata_login_list);
348 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
349 "Link down tmo did not expire.\n");
352 * Essentially reset the fcoe_ctlr here without affecting the state
353 * of the libfc structs.
355 qedf->ctlr.state = FIP_ST_LINK_WAIT;
356 fcoe_ctlr_link_down(&qedf->ctlr);
359 * Bring the link up before we send the fipvlan request so libfcoe
360 * can select a new fcf in parallel
362 fcoe_ctlr_link_up(&qedf->ctlr);
364 /* Since the link when down and up to verify which vlan we're on */
365 qedf->fipvlan_retries = qedf_fipvlan_retries;
366 rc = qedf_initiate_fipvlan_req(qedf);
367 /* If getting the VLAN fails, set the VLAN to the fallback one */
368 if (!rc)
369 qedf_set_vlan_id(qedf, qedf_fallback_vlan);
372 * We need to wait for an FCF to be selected due to the
373 * fcoe_ctlr_link_up other the FLOGI will be rejected.
375 while (retries > 0) {
376 if (qedf->ctlr.sel_fcf) {
377 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
378 "FCF reselected, proceeding with FLOGI.\n");
379 break;
381 msleep(500);
382 retries--;
385 if (retries < 1) {
386 QEDF_ERR(&(qedf->dbg_ctx), "Exhausted retries waiting for "
387 "FCF selection.\n");
388 return;
391 rval = qedf_send_flogi(qedf);
392 if (rval)
393 return;
395 /* Wait for FLOGI completion before proceeding with sending ADISCs */
396 i = wait_for_completion_timeout(&qedf->flogi_compl,
397 qedf->lport->r_a_tov);
398 if (i == 0) {
399 QEDF_ERR(&(qedf->dbg_ctx), "FLOGI timed out.\n");
400 return;
404 * Call lport->tt.rport_login which will cause libfc to send an
405 * ADISC since the rport is in state ready.
407 rcu_read_lock();
408 list_for_each_entry_rcu(fcport, &qedf->fcports, peers) {
409 rdata = fcport->rdata;
410 if (rdata == NULL)
411 continue;
412 rdata_item = kzalloc(sizeof(struct qedf_tmp_rdata_item),
413 GFP_ATOMIC);
414 if (!rdata_item)
415 continue;
416 if (kref_get_unless_zero(&rdata->kref)) {
417 rdata_item->rdata = rdata;
418 list_add(&rdata_item->list, &rdata_login_list);
419 } else
420 kfree(rdata_item);
422 rcu_read_unlock();
424 * Do the fc_rport_login outside of the rcu lock so we don't take a
425 * mutex in an atomic context.
427 list_for_each_entry_safe(rdata_item, tmp_rdata_item, &rdata_login_list,
428 list) {
429 list_del(&rdata_item->list);
430 fc_rport_login(rdata_item->rdata);
431 kref_put(&rdata_item->rdata->kref, fc_rport_destroy);
432 kfree(rdata_item);
436 static void qedf_update_link_speed(struct qedf_ctx *qedf,
437 struct qed_link_output *link)
439 struct fc_lport *lport = qedf->lport;
441 lport->link_speed = FC_PORTSPEED_UNKNOWN;
442 lport->link_supported_speeds = FC_PORTSPEED_UNKNOWN;
444 /* Set fc_host link speed */
445 switch (link->speed) {
446 case 10000:
447 lport->link_speed = FC_PORTSPEED_10GBIT;
448 break;
449 case 25000:
450 lport->link_speed = FC_PORTSPEED_25GBIT;
451 break;
452 case 40000:
453 lport->link_speed = FC_PORTSPEED_40GBIT;
454 break;
455 case 50000:
456 lport->link_speed = FC_PORTSPEED_50GBIT;
457 break;
458 case 100000:
459 lport->link_speed = FC_PORTSPEED_100GBIT;
460 break;
461 default:
462 lport->link_speed = FC_PORTSPEED_UNKNOWN;
463 break;
467 * Set supported link speed by querying the supported
468 * capabilities of the link.
470 if (link->supported_caps & SUPPORTED_10000baseKR_Full)
471 lport->link_supported_speeds |= FC_PORTSPEED_10GBIT;
472 if (link->supported_caps & SUPPORTED_25000baseKR_Full)
473 lport->link_supported_speeds |= FC_PORTSPEED_25GBIT;
474 if (link->supported_caps & SUPPORTED_40000baseLR4_Full)
475 lport->link_supported_speeds |= FC_PORTSPEED_40GBIT;
476 if (link->supported_caps & SUPPORTED_50000baseKR2_Full)
477 lport->link_supported_speeds |= FC_PORTSPEED_50GBIT;
478 if (link->supported_caps & SUPPORTED_100000baseKR4_Full)
479 lport->link_supported_speeds |= FC_PORTSPEED_100GBIT;
480 fc_host_supported_speeds(lport->host) = lport->link_supported_speeds;
483 static void qedf_link_update(void *dev, struct qed_link_output *link)
485 struct qedf_ctx *qedf = (struct qedf_ctx *)dev;
487 if (link->link_up) {
488 if (atomic_read(&qedf->link_state) == QEDF_LINK_UP) {
489 QEDF_INFO((&qedf->dbg_ctx), QEDF_LOG_DISC,
490 "Ignoring link up event as link is already up.\n");
491 return;
493 QEDF_ERR(&(qedf->dbg_ctx), "LINK UP (%d GB/s).\n",
494 link->speed / 1000);
496 /* Cancel any pending link down work */
497 cancel_delayed_work(&qedf->link_update);
499 atomic_set(&qedf->link_state, QEDF_LINK_UP);
500 qedf_update_link_speed(qedf, link);
502 if (atomic_read(&qedf->dcbx) == QEDF_DCBX_DONE ||
503 qedf_dcbx_no_wait) {
504 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
505 "DCBx done.\n");
506 if (atomic_read(&qedf->link_down_tmo_valid) > 0)
507 queue_delayed_work(qedf->link_update_wq,
508 &qedf->link_recovery, 0);
509 else
510 queue_delayed_work(qedf->link_update_wq,
511 &qedf->link_update, 0);
512 atomic_set(&qedf->link_down_tmo_valid, 0);
515 } else {
516 QEDF_ERR(&(qedf->dbg_ctx), "LINK DOWN.\n");
518 atomic_set(&qedf->link_state, QEDF_LINK_DOWN);
519 atomic_set(&qedf->dcbx, QEDF_DCBX_PENDING);
521 * Flag that we're waiting for the link to come back up before
522 * informing the fcoe layer of the event.
524 if (qedf_link_down_tmo > 0) {
525 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
526 "Starting link down tmo.\n");
527 atomic_set(&qedf->link_down_tmo_valid, 1);
529 qedf->vlan_id = 0;
530 qedf_update_link_speed(qedf, link);
531 queue_delayed_work(qedf->link_update_wq, &qedf->link_update,
532 qedf_link_down_tmo * HZ);
537 static void qedf_dcbx_handler(void *dev, struct qed_dcbx_get *get, u32 mib_type)
539 struct qedf_ctx *qedf = (struct qedf_ctx *)dev;
540 u8 tmp_prio;
542 QEDF_ERR(&(qedf->dbg_ctx), "DCBx event valid=%d enabled=%d fcoe "
543 "prio=%d.\n", get->operational.valid, get->operational.enabled,
544 get->operational.app_prio.fcoe);
546 if (get->operational.enabled && get->operational.valid) {
547 /* If DCBX was already negotiated on link up then just exit */
548 if (atomic_read(&qedf->dcbx) == QEDF_DCBX_DONE) {
549 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
550 "DCBX already set on link up.\n");
551 return;
554 atomic_set(&qedf->dcbx, QEDF_DCBX_DONE);
557 * Set the 8021q priority in the following manner:
559 * 1. If a modparam is set use that
560 * 2. If the value is not between 0..7 use the default
561 * 3. Use the priority we get from the DCBX app tag
563 tmp_prio = get->operational.app_prio.fcoe;
564 if (qedf_default_prio > -1)
565 qedf->prio = qedf_default_prio;
566 else if (tmp_prio < 0 || tmp_prio > 7) {
567 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
568 "FIP/FCoE prio %d out of range, setting to %d.\n",
569 tmp_prio, QEDF_DEFAULT_PRIO);
570 qedf->prio = QEDF_DEFAULT_PRIO;
571 } else
572 qedf->prio = tmp_prio;
574 if (atomic_read(&qedf->link_state) == QEDF_LINK_UP &&
575 !qedf_dcbx_no_wait) {
576 if (atomic_read(&qedf->link_down_tmo_valid) > 0)
577 queue_delayed_work(qedf->link_update_wq,
578 &qedf->link_recovery, 0);
579 else
580 queue_delayed_work(qedf->link_update_wq,
581 &qedf->link_update, 0);
582 atomic_set(&qedf->link_down_tmo_valid, 0);
588 static u32 qedf_get_login_failures(void *cookie)
590 struct qedf_ctx *qedf;
592 qedf = (struct qedf_ctx *)cookie;
593 return qedf->flogi_failed;
596 static struct qed_fcoe_cb_ops qedf_cb_ops = {
598 .link_update = qedf_link_update,
599 .dcbx_aen = qedf_dcbx_handler,
600 .get_generic_tlv_data = qedf_get_generic_tlv_data,
601 .get_protocol_tlv_data = qedf_get_protocol_tlv_data,
606 * Various transport templates.
609 static struct scsi_transport_template *qedf_fc_transport_template;
610 static struct scsi_transport_template *qedf_fc_vport_transport_template;
613 * SCSI EH handlers
615 static int qedf_eh_abort(struct scsi_cmnd *sc_cmd)
617 struct fc_rport *rport = starget_to_rport(scsi_target(sc_cmd->device));
618 struct fc_rport_libfc_priv *rp = rport->dd_data;
619 struct qedf_rport *fcport;
620 struct fc_lport *lport;
621 struct qedf_ctx *qedf;
622 struct qedf_ioreq *io_req;
623 int rc = FAILED;
624 int rval;
626 if (fc_remote_port_chkready(rport)) {
627 QEDF_ERR(NULL, "rport not ready\n");
628 goto out;
631 lport = shost_priv(sc_cmd->device->host);
632 qedf = (struct qedf_ctx *)lport_priv(lport);
634 if ((lport->state != LPORT_ST_READY) || !(lport->link_up)) {
635 QEDF_ERR(&(qedf->dbg_ctx), "link not ready.\n");
636 goto out;
639 fcport = (struct qedf_rport *)&rp[1];
641 io_req = (struct qedf_ioreq *)sc_cmd->SCp.ptr;
642 if (!io_req) {
643 QEDF_ERR(&(qedf->dbg_ctx), "io_req is NULL.\n");
644 rc = SUCCESS;
645 goto out;
648 QEDF_ERR(&(qedf->dbg_ctx), "Aborting io_req sc_cmd=%p xid=0x%x "
649 "fp_idx=%d.\n", sc_cmd, io_req->xid, io_req->fp_idx);
651 if (qedf->stop_io_on_error) {
652 qedf_stop_all_io(qedf);
653 rc = SUCCESS;
654 goto out;
657 init_completion(&io_req->abts_done);
658 rval = qedf_initiate_abts(io_req, true);
659 if (rval) {
660 QEDF_ERR(&(qedf->dbg_ctx), "Failed to queue ABTS.\n");
661 goto out;
664 wait_for_completion(&io_req->abts_done);
666 if (io_req->event == QEDF_IOREQ_EV_ABORT_SUCCESS ||
667 io_req->event == QEDF_IOREQ_EV_ABORT_FAILED ||
668 io_req->event == QEDF_IOREQ_EV_CLEANUP_SUCCESS) {
670 * If we get a reponse to the abort this is success from
671 * the perspective that all references to the command have
672 * been removed from the driver and firmware
674 rc = SUCCESS;
675 } else {
676 /* If the abort and cleanup failed then return a failure */
677 rc = FAILED;
680 if (rc == SUCCESS)
681 QEDF_ERR(&(qedf->dbg_ctx), "ABTS succeeded, xid=0x%x.\n",
682 io_req->xid);
683 else
684 QEDF_ERR(&(qedf->dbg_ctx), "ABTS failed, xid=0x%x.\n",
685 io_req->xid);
687 out:
688 return rc;
691 static int qedf_eh_target_reset(struct scsi_cmnd *sc_cmd)
693 QEDF_ERR(NULL, "TARGET RESET Issued...");
694 return qedf_initiate_tmf(sc_cmd, FCP_TMF_TGT_RESET);
697 static int qedf_eh_device_reset(struct scsi_cmnd *sc_cmd)
699 QEDF_ERR(NULL, "LUN RESET Issued...\n");
700 return qedf_initiate_tmf(sc_cmd, FCP_TMF_LUN_RESET);
703 void qedf_wait_for_upload(struct qedf_ctx *qedf)
705 while (1) {
706 if (atomic_read(&qedf->num_offloads))
707 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
708 "Waiting for all uploads to complete.\n");
709 else
710 break;
711 msleep(500);
715 /* Performs soft reset of qedf_ctx by simulating a link down/up */
716 static void qedf_ctx_soft_reset(struct fc_lport *lport)
718 struct qedf_ctx *qedf;
720 if (lport->vport) {
721 QEDF_ERR(NULL, "Cannot issue host reset on NPIV port.\n");
722 return;
725 qedf = lport_priv(lport);
727 /* For host reset, essentially do a soft link up/down */
728 atomic_set(&qedf->link_state, QEDF_LINK_DOWN);
729 queue_delayed_work(qedf->link_update_wq, &qedf->link_update,
731 qedf_wait_for_upload(qedf);
732 atomic_set(&qedf->link_state, QEDF_LINK_UP);
733 qedf->vlan_id = 0;
734 queue_delayed_work(qedf->link_update_wq, &qedf->link_update,
738 /* Reset the host by gracefully logging out and then logging back in */
739 static int qedf_eh_host_reset(struct scsi_cmnd *sc_cmd)
741 struct fc_lport *lport;
742 struct qedf_ctx *qedf;
743 struct fc_rport *rport = starget_to_rport(scsi_target(sc_cmd->device));
744 struct fc_rport_libfc_priv *rp = rport->dd_data;
745 struct qedf_rport *fcport = (struct qedf_rport *)&rp[1];
746 int rval;
748 rval = fc_remote_port_chkready(rport);
750 if (rval) {
751 QEDF_ERR(NULL, "device_reset rport not ready\n");
752 return FAILED;
755 if (fcport == NULL) {
756 QEDF_ERR(NULL, "device_reset: rport is NULL\n");
757 return FAILED;
760 lport = shost_priv(sc_cmd->device->host);
761 qedf = lport_priv(lport);
763 if (atomic_read(&qedf->link_state) == QEDF_LINK_DOWN ||
764 test_bit(QEDF_UNLOADING, &qedf->flags))
765 return FAILED;
767 QEDF_ERR(&(qedf->dbg_ctx), "HOST RESET Issued...");
769 qedf_ctx_soft_reset(lport);
771 return SUCCESS;
774 static int qedf_slave_configure(struct scsi_device *sdev)
776 if (qedf_queue_depth) {
777 scsi_change_queue_depth(sdev, qedf_queue_depth);
780 return 0;
783 static struct scsi_host_template qedf_host_template = {
784 .module = THIS_MODULE,
785 .name = QEDF_MODULE_NAME,
786 .this_id = -1,
787 .cmd_per_lun = 32,
788 .use_clustering = ENABLE_CLUSTERING,
789 .max_sectors = 0xffff,
790 .queuecommand = qedf_queuecommand,
791 .shost_attrs = qedf_host_attrs,
792 .eh_abort_handler = qedf_eh_abort,
793 .eh_device_reset_handler = qedf_eh_device_reset, /* lun reset */
794 .eh_target_reset_handler = qedf_eh_target_reset, /* target reset */
795 .eh_host_reset_handler = qedf_eh_host_reset,
796 .slave_configure = qedf_slave_configure,
797 .dma_boundary = QED_HW_DMA_BOUNDARY,
798 .sg_tablesize = QEDF_MAX_BDS_PER_CMD,
799 .can_queue = FCOE_PARAMS_NUM_TASKS,
800 .change_queue_depth = scsi_change_queue_depth,
803 static int qedf_get_paged_crc_eof(struct sk_buff *skb, int tlen)
805 int rc;
807 spin_lock(&qedf_global_lock);
808 rc = fcoe_get_paged_crc_eof(skb, tlen, &qedf_global);
809 spin_unlock(&qedf_global_lock);
811 return rc;
814 static struct qedf_rport *qedf_fcport_lookup(struct qedf_ctx *qedf, u32 port_id)
816 struct qedf_rport *fcport;
817 struct fc_rport_priv *rdata;
819 rcu_read_lock();
820 list_for_each_entry_rcu(fcport, &qedf->fcports, peers) {
821 rdata = fcport->rdata;
822 if (rdata == NULL)
823 continue;
824 if (rdata->ids.port_id == port_id) {
825 rcu_read_unlock();
826 return fcport;
829 rcu_read_unlock();
831 /* Return NULL to caller to let them know fcport was not found */
832 return NULL;
835 /* Transmits an ELS frame over an offloaded session */
836 static int qedf_xmit_l2_frame(struct qedf_rport *fcport, struct fc_frame *fp)
838 struct fc_frame_header *fh;
839 int rc = 0;
841 fh = fc_frame_header_get(fp);
842 if ((fh->fh_type == FC_TYPE_ELS) &&
843 (fh->fh_r_ctl == FC_RCTL_ELS_REQ)) {
844 switch (fc_frame_payload_op(fp)) {
845 case ELS_ADISC:
846 qedf_send_adisc(fcport, fp);
847 rc = 1;
848 break;
852 return rc;
856 * qedf_xmit - qedf FCoE frame transmit function
859 static int qedf_xmit(struct fc_lport *lport, struct fc_frame *fp)
861 struct fc_lport *base_lport;
862 struct qedf_ctx *qedf;
863 struct ethhdr *eh;
864 struct fcoe_crc_eof *cp;
865 struct sk_buff *skb;
866 struct fc_frame_header *fh;
867 struct fcoe_hdr *hp;
868 u8 sof, eof;
869 u32 crc;
870 unsigned int hlen, tlen, elen;
871 int wlen;
872 struct fc_stats *stats;
873 struct fc_lport *tmp_lport;
874 struct fc_lport *vn_port = NULL;
875 struct qedf_rport *fcport;
876 int rc;
877 u16 vlan_tci = 0;
879 qedf = (struct qedf_ctx *)lport_priv(lport);
881 fh = fc_frame_header_get(fp);
882 skb = fp_skb(fp);
884 /* Filter out traffic to other NPIV ports on the same host */
885 if (lport->vport)
886 base_lport = shost_priv(vport_to_shost(lport->vport));
887 else
888 base_lport = lport;
890 /* Flag if the destination is the base port */
891 if (base_lport->port_id == ntoh24(fh->fh_d_id)) {
892 vn_port = base_lport;
893 } else {
894 /* Got through the list of vports attached to the base_lport
895 * and see if we have a match with the destination address.
897 list_for_each_entry(tmp_lport, &base_lport->vports, list) {
898 if (tmp_lport->port_id == ntoh24(fh->fh_d_id)) {
899 vn_port = tmp_lport;
900 break;
904 if (vn_port && ntoh24(fh->fh_d_id) != FC_FID_FLOGI) {
905 struct fc_rport_priv *rdata = NULL;
907 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_LL2,
908 "Dropping FCoE frame to %06x.\n", ntoh24(fh->fh_d_id));
909 kfree_skb(skb);
910 rdata = fc_rport_lookup(lport, ntoh24(fh->fh_d_id));
911 if (rdata)
912 rdata->retries = lport->max_rport_retry_count;
913 return -EINVAL;
915 /* End NPIV filtering */
917 if (!qedf->ctlr.sel_fcf) {
918 kfree_skb(skb);
919 return 0;
922 if (!test_bit(QEDF_LL2_STARTED, &qedf->flags)) {
923 QEDF_WARN(&(qedf->dbg_ctx), "LL2 not started\n");
924 kfree_skb(skb);
925 return 0;
928 if (atomic_read(&qedf->link_state) != QEDF_LINK_UP) {
929 QEDF_WARN(&(qedf->dbg_ctx), "qedf link down\n");
930 kfree_skb(skb);
931 return 0;
934 if (unlikely(fh->fh_r_ctl == FC_RCTL_ELS_REQ)) {
935 if (fcoe_ctlr_els_send(&qedf->ctlr, lport, skb))
936 return 0;
939 /* Check to see if this needs to be sent on an offloaded session */
940 fcport = qedf_fcport_lookup(qedf, ntoh24(fh->fh_d_id));
942 if (fcport && test_bit(QEDF_RPORT_SESSION_READY, &fcport->flags)) {
943 rc = qedf_xmit_l2_frame(fcport, fp);
945 * If the frame was successfully sent over the middle path
946 * then do not try to also send it over the LL2 path
948 if (rc)
949 return 0;
952 sof = fr_sof(fp);
953 eof = fr_eof(fp);
955 elen = sizeof(struct ethhdr);
956 hlen = sizeof(struct fcoe_hdr);
957 tlen = sizeof(struct fcoe_crc_eof);
958 wlen = (skb->len - tlen + sizeof(crc)) / FCOE_WORD_TO_BYTE;
960 skb->ip_summed = CHECKSUM_NONE;
961 crc = fcoe_fc_crc(fp);
963 /* copy port crc and eof to the skb buff */
964 if (skb_is_nonlinear(skb)) {
965 skb_frag_t *frag;
967 if (qedf_get_paged_crc_eof(skb, tlen)) {
968 kfree_skb(skb);
969 return -ENOMEM;
971 frag = &skb_shinfo(skb)->frags[skb_shinfo(skb)->nr_frags - 1];
972 cp = kmap_atomic(skb_frag_page(frag)) + frag->page_offset;
973 } else {
974 cp = skb_put(skb, tlen);
977 memset(cp, 0, sizeof(*cp));
978 cp->fcoe_eof = eof;
979 cp->fcoe_crc32 = cpu_to_le32(~crc);
980 if (skb_is_nonlinear(skb)) {
981 kunmap_atomic(cp);
982 cp = NULL;
986 /* adjust skb network/transport offsets to match mac/fcoe/port */
987 skb_push(skb, elen + hlen);
988 skb_reset_mac_header(skb);
989 skb_reset_network_header(skb);
990 skb->mac_len = elen;
991 skb->protocol = htons(ETH_P_FCOE);
994 * Add VLAN tag to non-offload FCoE frame based on current stored VLAN
995 * for FIP/FCoE traffic.
997 __vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), qedf->vlan_id);
999 /* fill up mac and fcoe headers */
1000 eh = eth_hdr(skb);
1001 eh->h_proto = htons(ETH_P_FCOE);
1002 if (qedf->ctlr.map_dest)
1003 fc_fcoe_set_mac(eh->h_dest, fh->fh_d_id);
1004 else
1005 /* insert GW address */
1006 ether_addr_copy(eh->h_dest, qedf->ctlr.dest_addr);
1008 /* Set the source MAC address */
1009 ether_addr_copy(eh->h_source, qedf->data_src_addr);
1011 hp = (struct fcoe_hdr *)(eh + 1);
1012 memset(hp, 0, sizeof(*hp));
1013 if (FC_FCOE_VER)
1014 FC_FCOE_ENCAPS_VER(hp, FC_FCOE_VER);
1015 hp->fcoe_sof = sof;
1017 /*update tx stats */
1018 stats = per_cpu_ptr(lport->stats, get_cpu());
1019 stats->TxFrames++;
1020 stats->TxWords += wlen;
1021 put_cpu();
1023 /* Get VLAN ID from skb for printing purposes */
1024 __vlan_hwaccel_get_tag(skb, &vlan_tci);
1026 /* send down to lld */
1027 fr_dev(fp) = lport;
1028 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_LL2, "FCoE frame send: "
1029 "src=%06x dest=%06x r_ctl=%x type=%x vlan=%04x.\n",
1030 ntoh24(fh->fh_s_id), ntoh24(fh->fh_d_id), fh->fh_r_ctl, fh->fh_type,
1031 vlan_tci);
1032 if (qedf_dump_frames)
1033 print_hex_dump(KERN_WARNING, "fcoe: ", DUMP_PREFIX_OFFSET, 16,
1034 1, skb->data, skb->len, false);
1035 qed_ops->ll2->start_xmit(qedf->cdev, skb, 0);
1037 return 0;
1040 static int qedf_alloc_sq(struct qedf_ctx *qedf, struct qedf_rport *fcport)
1042 int rval = 0;
1043 u32 *pbl;
1044 dma_addr_t page;
1045 int num_pages;
1047 /* Calculate appropriate queue and PBL sizes */
1048 fcport->sq_mem_size = SQ_NUM_ENTRIES * sizeof(struct fcoe_wqe);
1049 fcport->sq_mem_size = ALIGN(fcport->sq_mem_size, QEDF_PAGE_SIZE);
1050 fcport->sq_pbl_size = (fcport->sq_mem_size / QEDF_PAGE_SIZE) *
1051 sizeof(void *);
1052 fcport->sq_pbl_size = fcport->sq_pbl_size + QEDF_PAGE_SIZE;
1054 fcport->sq = dma_zalloc_coherent(&qedf->pdev->dev,
1055 fcport->sq_mem_size, &fcport->sq_dma, GFP_KERNEL);
1056 if (!fcport->sq) {
1057 QEDF_WARN(&(qedf->dbg_ctx), "Could not allocate send queue.\n");
1058 rval = 1;
1059 goto out;
1062 fcport->sq_pbl = dma_zalloc_coherent(&qedf->pdev->dev,
1063 fcport->sq_pbl_size, &fcport->sq_pbl_dma, GFP_KERNEL);
1064 if (!fcport->sq_pbl) {
1065 QEDF_WARN(&(qedf->dbg_ctx), "Could not allocate send queue PBL.\n");
1066 rval = 1;
1067 goto out_free_sq;
1070 /* Create PBL */
1071 num_pages = fcport->sq_mem_size / QEDF_PAGE_SIZE;
1072 page = fcport->sq_dma;
1073 pbl = (u32 *)fcport->sq_pbl;
1075 while (num_pages--) {
1076 *pbl = U64_LO(page);
1077 pbl++;
1078 *pbl = U64_HI(page);
1079 pbl++;
1080 page += QEDF_PAGE_SIZE;
1083 return rval;
1085 out_free_sq:
1086 dma_free_coherent(&qedf->pdev->dev, fcport->sq_mem_size, fcport->sq,
1087 fcport->sq_dma);
1088 out:
1089 return rval;
1092 static void qedf_free_sq(struct qedf_ctx *qedf, struct qedf_rport *fcport)
1094 if (fcport->sq_pbl)
1095 dma_free_coherent(&qedf->pdev->dev, fcport->sq_pbl_size,
1096 fcport->sq_pbl, fcport->sq_pbl_dma);
1097 if (fcport->sq)
1098 dma_free_coherent(&qedf->pdev->dev, fcport->sq_mem_size,
1099 fcport->sq, fcport->sq_dma);
1102 static int qedf_offload_connection(struct qedf_ctx *qedf,
1103 struct qedf_rport *fcport)
1105 struct qed_fcoe_params_offload conn_info;
1106 u32 port_id;
1107 int rval;
1108 uint16_t total_sqe = (fcport->sq_mem_size / sizeof(struct fcoe_wqe));
1110 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_CONN, "Offloading connection "
1111 "portid=%06x.\n", fcport->rdata->ids.port_id);
1112 rval = qed_ops->acquire_conn(qedf->cdev, &fcport->handle,
1113 &fcport->fw_cid, &fcport->p_doorbell);
1114 if (rval) {
1115 QEDF_WARN(&(qedf->dbg_ctx), "Could not acquire connection "
1116 "for portid=%06x.\n", fcport->rdata->ids.port_id);
1117 rval = 1; /* For some reason qed returns 0 on failure here */
1118 goto out;
1121 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_CONN, "portid=%06x "
1122 "fw_cid=%08x handle=%d.\n", fcport->rdata->ids.port_id,
1123 fcport->fw_cid, fcport->handle);
1125 memset(&conn_info, 0, sizeof(struct qed_fcoe_params_offload));
1127 /* Fill in the offload connection info */
1128 conn_info.sq_pbl_addr = fcport->sq_pbl_dma;
1130 conn_info.sq_curr_page_addr = (dma_addr_t)(*(u64 *)fcport->sq_pbl);
1131 conn_info.sq_next_page_addr =
1132 (dma_addr_t)(*(u64 *)(fcport->sq_pbl + 8));
1134 /* Need to use our FCoE MAC for the offload session */
1135 ether_addr_copy(conn_info.src_mac, qedf->data_src_addr);
1137 ether_addr_copy(conn_info.dst_mac, qedf->ctlr.dest_addr);
1139 conn_info.tx_max_fc_pay_len = fcport->rdata->maxframe_size;
1140 conn_info.e_d_tov_timer_val = qedf->lport->e_d_tov / 20;
1141 conn_info.rec_tov_timer_val = 3; /* I think this is what E3 was */
1142 conn_info.rx_max_fc_pay_len = fcport->rdata->maxframe_size;
1144 /* Set VLAN data */
1145 conn_info.vlan_tag = qedf->vlan_id <<
1146 FCOE_CONN_OFFLOAD_RAMROD_DATA_VLAN_ID_SHIFT;
1147 conn_info.vlan_tag |=
1148 qedf->prio << FCOE_CONN_OFFLOAD_RAMROD_DATA_PRIORITY_SHIFT;
1149 conn_info.flags |= (FCOE_CONN_OFFLOAD_RAMROD_DATA_B_VLAN_FLAG_MASK <<
1150 FCOE_CONN_OFFLOAD_RAMROD_DATA_B_VLAN_FLAG_SHIFT);
1152 /* Set host port source id */
1153 port_id = fc_host_port_id(qedf->lport->host);
1154 fcport->sid = port_id;
1155 conn_info.s_id.addr_hi = (port_id & 0x000000FF);
1156 conn_info.s_id.addr_mid = (port_id & 0x0000FF00) >> 8;
1157 conn_info.s_id.addr_lo = (port_id & 0x00FF0000) >> 16;
1159 conn_info.max_conc_seqs_c3 = fcport->rdata->max_seq;
1161 /* Set remote port destination id */
1162 port_id = fcport->rdata->rport->port_id;
1163 conn_info.d_id.addr_hi = (port_id & 0x000000FF);
1164 conn_info.d_id.addr_mid = (port_id & 0x0000FF00) >> 8;
1165 conn_info.d_id.addr_lo = (port_id & 0x00FF0000) >> 16;
1167 conn_info.def_q_idx = 0; /* Default index for send queue? */
1169 /* Set FC-TAPE specific flags if needed */
1170 if (fcport->dev_type == QEDF_RPORT_TYPE_TAPE) {
1171 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_CONN,
1172 "Enable CONF, REC for portid=%06x.\n",
1173 fcport->rdata->ids.port_id);
1174 conn_info.flags |= 1 <<
1175 FCOE_CONN_OFFLOAD_RAMROD_DATA_B_CONF_REQ_SHIFT;
1176 conn_info.flags |=
1177 ((fcport->rdata->sp_features & FC_SP_FT_SEQC) ? 1 : 0) <<
1178 FCOE_CONN_OFFLOAD_RAMROD_DATA_B_REC_VALID_SHIFT;
1181 rval = qed_ops->offload_conn(qedf->cdev, fcport->handle, &conn_info);
1182 if (rval) {
1183 QEDF_WARN(&(qedf->dbg_ctx), "Could not offload connection "
1184 "for portid=%06x.\n", fcport->rdata->ids.port_id);
1185 goto out_free_conn;
1186 } else
1187 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_CONN, "Offload "
1188 "succeeded portid=%06x total_sqe=%d.\n",
1189 fcport->rdata->ids.port_id, total_sqe);
1191 spin_lock_init(&fcport->rport_lock);
1192 atomic_set(&fcport->free_sqes, total_sqe);
1193 return 0;
1194 out_free_conn:
1195 qed_ops->release_conn(qedf->cdev, fcport->handle);
1196 out:
1197 return rval;
1200 #define QEDF_TERM_BUFF_SIZE 10
1201 static void qedf_upload_connection(struct qedf_ctx *qedf,
1202 struct qedf_rport *fcport)
1204 void *term_params;
1205 dma_addr_t term_params_dma;
1207 /* Term params needs to be a DMA coherent buffer as qed shared the
1208 * physical DMA address with the firmware. The buffer may be used in
1209 * the receive path so we may eventually have to move this.
1211 term_params = dma_alloc_coherent(&qedf->pdev->dev, QEDF_TERM_BUFF_SIZE,
1212 &term_params_dma, GFP_KERNEL);
1214 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_CONN, "Uploading connection "
1215 "port_id=%06x.\n", fcport->rdata->ids.port_id);
1217 qed_ops->destroy_conn(qedf->cdev, fcport->handle, term_params_dma);
1218 qed_ops->release_conn(qedf->cdev, fcport->handle);
1220 dma_free_coherent(&qedf->pdev->dev, QEDF_TERM_BUFF_SIZE, term_params,
1221 term_params_dma);
1224 static void qedf_cleanup_fcport(struct qedf_ctx *qedf,
1225 struct qedf_rport *fcport)
1227 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_CONN, "Cleaning up portid=%06x.\n",
1228 fcport->rdata->ids.port_id);
1230 /* Flush any remaining i/o's before we upload the connection */
1231 qedf_flush_active_ios(fcport, -1);
1233 if (test_and_clear_bit(QEDF_RPORT_SESSION_READY, &fcport->flags))
1234 qedf_upload_connection(qedf, fcport);
1235 qedf_free_sq(qedf, fcport);
1236 fcport->rdata = NULL;
1237 fcport->qedf = NULL;
1241 * This event_callback is called after successful completion of libfc
1242 * initiated target login. qedf can proceed with initiating the session
1243 * establishment.
1245 static void qedf_rport_event_handler(struct fc_lport *lport,
1246 struct fc_rport_priv *rdata,
1247 enum fc_rport_event event)
1249 struct qedf_ctx *qedf = lport_priv(lport);
1250 struct fc_rport *rport = rdata->rport;
1251 struct fc_rport_libfc_priv *rp;
1252 struct qedf_rport *fcport;
1253 u32 port_id;
1254 int rval;
1255 unsigned long flags;
1257 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "event = %d, "
1258 "port_id = 0x%x\n", event, rdata->ids.port_id);
1260 switch (event) {
1261 case RPORT_EV_READY:
1262 if (!rport) {
1263 QEDF_WARN(&(qedf->dbg_ctx), "rport is NULL.\n");
1264 break;
1267 rp = rport->dd_data;
1268 fcport = (struct qedf_rport *)&rp[1];
1269 fcport->qedf = qedf;
1271 if (atomic_read(&qedf->num_offloads) >= QEDF_MAX_SESSIONS) {
1272 QEDF_ERR(&(qedf->dbg_ctx), "Not offloading "
1273 "portid=0x%x as max number of offloaded sessions "
1274 "reached.\n", rdata->ids.port_id);
1275 return;
1279 * Don't try to offload the session again. Can happen when we
1280 * get an ADISC
1282 if (test_bit(QEDF_RPORT_SESSION_READY, &fcport->flags)) {
1283 QEDF_WARN(&(qedf->dbg_ctx), "Session already "
1284 "offloaded, portid=0x%x.\n",
1285 rdata->ids.port_id);
1286 return;
1289 if (rport->port_id == FC_FID_DIR_SERV) {
1291 * qedf_rport structure doesn't exist for
1292 * directory server.
1293 * We should not come here, as lport will
1294 * take care of fabric login
1296 QEDF_WARN(&(qedf->dbg_ctx), "rport struct does not "
1297 "exist for dir server port_id=%x\n",
1298 rdata->ids.port_id);
1299 break;
1302 if (rdata->spp_type != FC_TYPE_FCP) {
1303 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
1304 "Not offloading since spp type isn't FCP\n");
1305 break;
1307 if (!(rdata->ids.roles & FC_RPORT_ROLE_FCP_TARGET)) {
1308 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
1309 "Not FCP target so not offloading\n");
1310 break;
1313 fcport->rdata = rdata;
1314 fcport->rport = rport;
1316 rval = qedf_alloc_sq(qedf, fcport);
1317 if (rval) {
1318 qedf_cleanup_fcport(qedf, fcport);
1319 break;
1322 /* Set device type */
1323 if (rdata->flags & FC_RP_FLAGS_RETRY &&
1324 rdata->ids.roles & FC_RPORT_ROLE_FCP_TARGET &&
1325 !(rdata->ids.roles & FC_RPORT_ROLE_FCP_INITIATOR)) {
1326 fcport->dev_type = QEDF_RPORT_TYPE_TAPE;
1327 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
1328 "portid=%06x is a TAPE device.\n",
1329 rdata->ids.port_id);
1330 } else {
1331 fcport->dev_type = QEDF_RPORT_TYPE_DISK;
1334 rval = qedf_offload_connection(qedf, fcport);
1335 if (rval) {
1336 qedf_cleanup_fcport(qedf, fcport);
1337 break;
1340 /* Add fcport to list of qedf_ctx list of offloaded ports */
1341 spin_lock_irqsave(&qedf->hba_lock, flags);
1342 list_add_rcu(&fcport->peers, &qedf->fcports);
1343 spin_unlock_irqrestore(&qedf->hba_lock, flags);
1346 * Set the session ready bit to let everyone know that this
1347 * connection is ready for I/O
1349 set_bit(QEDF_RPORT_SESSION_READY, &fcport->flags);
1350 atomic_inc(&qedf->num_offloads);
1352 break;
1353 case RPORT_EV_LOGO:
1354 case RPORT_EV_FAILED:
1355 case RPORT_EV_STOP:
1356 port_id = rdata->ids.port_id;
1357 if (port_id == FC_FID_DIR_SERV)
1358 break;
1360 if (!rport) {
1361 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
1362 "port_id=%x - rport notcreated Yet!!\n", port_id);
1363 break;
1365 rp = rport->dd_data;
1367 * Perform session upload. Note that rdata->peers is already
1368 * removed from disc->rports list before we get this event.
1370 fcport = (struct qedf_rport *)&rp[1];
1372 /* Only free this fcport if it is offloaded already */
1373 if (test_bit(QEDF_RPORT_SESSION_READY, &fcport->flags)) {
1374 set_bit(QEDF_RPORT_UPLOADING_CONNECTION, &fcport->flags);
1375 qedf_cleanup_fcport(qedf, fcport);
1378 * Remove fcport to list of qedf_ctx list of offloaded
1379 * ports
1381 spin_lock_irqsave(&qedf->hba_lock, flags);
1382 list_del_rcu(&fcport->peers);
1383 spin_unlock_irqrestore(&qedf->hba_lock, flags);
1385 clear_bit(QEDF_RPORT_UPLOADING_CONNECTION,
1386 &fcport->flags);
1387 atomic_dec(&qedf->num_offloads);
1390 break;
1392 case RPORT_EV_NONE:
1393 break;
1397 static void qedf_abort_io(struct fc_lport *lport)
1399 /* NO-OP but need to fill in the template */
1402 static void qedf_fcp_cleanup(struct fc_lport *lport)
1405 * NO-OP but need to fill in template to prevent a NULL
1406 * function pointer dereference during link down. I/Os
1407 * will be flushed when port is uploaded.
1411 static struct libfc_function_template qedf_lport_template = {
1412 .frame_send = qedf_xmit,
1413 .fcp_abort_io = qedf_abort_io,
1414 .fcp_cleanup = qedf_fcp_cleanup,
1415 .rport_event_callback = qedf_rport_event_handler,
1416 .elsct_send = qedf_elsct_send,
1419 static void qedf_fcoe_ctlr_setup(struct qedf_ctx *qedf)
1421 fcoe_ctlr_init(&qedf->ctlr, FIP_ST_AUTO);
1423 qedf->ctlr.send = qedf_fip_send;
1424 qedf->ctlr.get_src_addr = qedf_get_src_mac;
1425 ether_addr_copy(qedf->ctlr.ctl_src_addr, qedf->mac);
1428 static void qedf_setup_fdmi(struct qedf_ctx *qedf)
1430 struct fc_lport *lport = qedf->lport;
1431 struct fc_host_attrs *fc_host = shost_to_fc_host(lport->host);
1432 u8 buf[8];
1433 int i, pos;
1436 * fdmi_enabled needs to be set for libfc to execute FDMI registration.
1438 lport->fdmi_enabled = 1;
1441 * Setup the necessary fc_host attributes to that will be used to fill
1442 * in the FDMI information.
1445 /* Get the PCI-e Device Serial Number Capability */
1446 pos = pci_find_ext_capability(qedf->pdev, PCI_EXT_CAP_ID_DSN);
1447 if (pos) {
1448 pos += 4;
1449 for (i = 0; i < 8; i++)
1450 pci_read_config_byte(qedf->pdev, pos + i, &buf[i]);
1452 snprintf(fc_host->serial_number,
1453 sizeof(fc_host->serial_number),
1454 "%02X%02X%02X%02X%02X%02X%02X%02X",
1455 buf[7], buf[6], buf[5], buf[4],
1456 buf[3], buf[2], buf[1], buf[0]);
1457 } else
1458 snprintf(fc_host->serial_number,
1459 sizeof(fc_host->serial_number), "Unknown");
1461 snprintf(fc_host->manufacturer,
1462 sizeof(fc_host->manufacturer), "%s", "Cavium Inc.");
1464 snprintf(fc_host->model, sizeof(fc_host->model), "%s", "QL41000");
1466 snprintf(fc_host->model_description, sizeof(fc_host->model_description),
1467 "%s", "QLogic FastLinQ QL41000 Series 10/25/40/50GGbE Controller"
1468 "(FCoE)");
1470 snprintf(fc_host->hardware_version, sizeof(fc_host->hardware_version),
1471 "Rev %d", qedf->pdev->revision);
1473 snprintf(fc_host->driver_version, sizeof(fc_host->driver_version),
1474 "%s", QEDF_VERSION);
1476 snprintf(fc_host->firmware_version, sizeof(fc_host->firmware_version),
1477 "%d.%d.%d.%d", FW_MAJOR_VERSION, FW_MINOR_VERSION,
1478 FW_REVISION_VERSION, FW_ENGINEERING_VERSION);
1481 static int qedf_lport_setup(struct qedf_ctx *qedf)
1483 struct fc_lport *lport = qedf->lport;
1485 lport->link_up = 0;
1486 lport->max_retry_count = QEDF_FLOGI_RETRY_CNT;
1487 lport->max_rport_retry_count = QEDF_RPORT_RETRY_CNT;
1488 lport->service_params = (FCP_SPPF_INIT_FCN | FCP_SPPF_RD_XRDY_DIS |
1489 FCP_SPPF_RETRY | FCP_SPPF_CONF_COMPL);
1490 lport->boot_time = jiffies;
1491 lport->e_d_tov = 2 * 1000;
1492 lport->r_a_tov = 10 * 1000;
1494 /* Set NPIV support */
1495 lport->does_npiv = 1;
1496 fc_host_max_npiv_vports(lport->host) = QEDF_MAX_NPIV;
1498 fc_set_wwnn(lport, qedf->wwnn);
1499 fc_set_wwpn(lport, qedf->wwpn);
1501 fcoe_libfc_config(lport, &qedf->ctlr, &qedf_lport_template, 0);
1503 /* Allocate the exchange manager */
1504 fc_exch_mgr_alloc(lport, FC_CLASS_3, qedf->max_scsi_xid + 1,
1505 qedf->max_els_xid, NULL);
1507 if (fc_lport_init_stats(lport))
1508 return -ENOMEM;
1510 /* Finish lport config */
1511 fc_lport_config(lport);
1513 /* Set max frame size */
1514 fc_set_mfs(lport, QEDF_MFS);
1515 fc_host_maxframe_size(lport->host) = lport->mfs;
1517 /* Set default dev_loss_tmo based on module parameter */
1518 fc_host_dev_loss_tmo(lport->host) = qedf_dev_loss_tmo;
1520 /* Set symbolic node name */
1521 snprintf(fc_host_symbolic_name(lport->host), 256,
1522 "QLogic %s v%s", QEDF_MODULE_NAME, QEDF_VERSION);
1524 qedf_setup_fdmi(qedf);
1526 return 0;
1530 * NPIV functions
1533 static int qedf_vport_libfc_config(struct fc_vport *vport,
1534 struct fc_lport *lport)
1536 lport->link_up = 0;
1537 lport->qfull = 0;
1538 lport->max_retry_count = QEDF_FLOGI_RETRY_CNT;
1539 lport->max_rport_retry_count = QEDF_RPORT_RETRY_CNT;
1540 lport->service_params = (FCP_SPPF_INIT_FCN | FCP_SPPF_RD_XRDY_DIS |
1541 FCP_SPPF_RETRY | FCP_SPPF_CONF_COMPL);
1542 lport->boot_time = jiffies;
1543 lport->e_d_tov = 2 * 1000;
1544 lport->r_a_tov = 10 * 1000;
1545 lport->does_npiv = 1; /* Temporary until we add NPIV support */
1547 /* Allocate stats for vport */
1548 if (fc_lport_init_stats(lport))
1549 return -ENOMEM;
1551 /* Finish lport config */
1552 fc_lport_config(lport);
1554 /* offload related configuration */
1555 lport->crc_offload = 0;
1556 lport->seq_offload = 0;
1557 lport->lro_enabled = 0;
1558 lport->lro_xid = 0;
1559 lport->lso_max = 0;
1561 return 0;
1564 static int qedf_vport_create(struct fc_vport *vport, bool disabled)
1566 struct Scsi_Host *shost = vport_to_shost(vport);
1567 struct fc_lport *n_port = shost_priv(shost);
1568 struct fc_lport *vn_port;
1569 struct qedf_ctx *base_qedf = lport_priv(n_port);
1570 struct qedf_ctx *vport_qedf;
1572 char buf[32];
1573 int rc = 0;
1575 rc = fcoe_validate_vport_create(vport);
1576 if (rc) {
1577 fcoe_wwn_to_str(vport->port_name, buf, sizeof(buf));
1578 QEDF_WARN(&(base_qedf->dbg_ctx), "Failed to create vport, "
1579 "WWPN (0x%s) already exists.\n", buf);
1580 goto err1;
1583 if (atomic_read(&base_qedf->link_state) != QEDF_LINK_UP) {
1584 QEDF_WARN(&(base_qedf->dbg_ctx), "Cannot create vport "
1585 "because link is not up.\n");
1586 rc = -EIO;
1587 goto err1;
1590 vn_port = libfc_vport_create(vport, sizeof(struct qedf_ctx));
1591 if (!vn_port) {
1592 QEDF_WARN(&(base_qedf->dbg_ctx), "Could not create lport "
1593 "for vport.\n");
1594 rc = -ENOMEM;
1595 goto err1;
1598 fcoe_wwn_to_str(vport->port_name, buf, sizeof(buf));
1599 QEDF_ERR(&(base_qedf->dbg_ctx), "Creating NPIV port, WWPN=%s.\n",
1600 buf);
1602 /* Copy some fields from base_qedf */
1603 vport_qedf = lport_priv(vn_port);
1604 memcpy(vport_qedf, base_qedf, sizeof(struct qedf_ctx));
1606 /* Set qedf data specific to this vport */
1607 vport_qedf->lport = vn_port;
1608 /* Use same hba_lock as base_qedf */
1609 vport_qedf->hba_lock = base_qedf->hba_lock;
1610 vport_qedf->pdev = base_qedf->pdev;
1611 vport_qedf->cmd_mgr = base_qedf->cmd_mgr;
1612 init_completion(&vport_qedf->flogi_compl);
1613 INIT_LIST_HEAD(&vport_qedf->fcports);
1615 rc = qedf_vport_libfc_config(vport, vn_port);
1616 if (rc) {
1617 QEDF_ERR(&(base_qedf->dbg_ctx), "Could not allocate memory "
1618 "for lport stats.\n");
1619 goto err2;
1622 fc_set_wwnn(vn_port, vport->node_name);
1623 fc_set_wwpn(vn_port, vport->port_name);
1624 vport_qedf->wwnn = vn_port->wwnn;
1625 vport_qedf->wwpn = vn_port->wwpn;
1627 vn_port->host->transportt = qedf_fc_vport_transport_template;
1628 vn_port->host->can_queue = QEDF_MAX_ELS_XID;
1629 vn_port->host->max_lun = qedf_max_lun;
1630 vn_port->host->sg_tablesize = QEDF_MAX_BDS_PER_CMD;
1631 vn_port->host->max_cmd_len = QEDF_MAX_CDB_LEN;
1633 rc = scsi_add_host(vn_port->host, &vport->dev);
1634 if (rc) {
1635 QEDF_WARN(&(base_qedf->dbg_ctx), "Error adding Scsi_Host.\n");
1636 goto err2;
1639 /* Set default dev_loss_tmo based on module parameter */
1640 fc_host_dev_loss_tmo(vn_port->host) = qedf_dev_loss_tmo;
1642 /* Init libfc stuffs */
1643 memcpy(&vn_port->tt, &qedf_lport_template,
1644 sizeof(qedf_lport_template));
1645 fc_exch_init(vn_port);
1646 fc_elsct_init(vn_port);
1647 fc_lport_init(vn_port);
1648 fc_disc_init(vn_port);
1649 fc_disc_config(vn_port, vn_port);
1652 /* Allocate the exchange manager */
1653 shost = vport_to_shost(vport);
1654 n_port = shost_priv(shost);
1655 fc_exch_mgr_list_clone(n_port, vn_port);
1657 /* Set max frame size */
1658 fc_set_mfs(vn_port, QEDF_MFS);
1660 fc_host_port_type(vn_port->host) = FC_PORTTYPE_UNKNOWN;
1662 if (disabled) {
1663 fc_vport_set_state(vport, FC_VPORT_DISABLED);
1664 } else {
1665 vn_port->boot_time = jiffies;
1666 fc_fabric_login(vn_port);
1667 fc_vport_setlink(vn_port);
1670 QEDF_INFO(&(base_qedf->dbg_ctx), QEDF_LOG_NPIV, "vn_port=%p.\n",
1671 vn_port);
1673 /* Set up debug context for vport */
1674 vport_qedf->dbg_ctx.host_no = vn_port->host->host_no;
1675 vport_qedf->dbg_ctx.pdev = base_qedf->pdev;
1677 err2:
1678 scsi_host_put(vn_port->host);
1679 err1:
1680 return rc;
1683 static int qedf_vport_destroy(struct fc_vport *vport)
1685 struct Scsi_Host *shost = vport_to_shost(vport);
1686 struct fc_lport *n_port = shost_priv(shost);
1687 struct fc_lport *vn_port = vport->dd_data;
1688 struct qedf_ctx *qedf = lport_priv(vn_port);
1690 if (!qedf) {
1691 QEDF_ERR(NULL, "qedf is NULL.\n");
1692 goto out;
1695 /* Set unloading bit on vport qedf_ctx to prevent more I/O */
1696 set_bit(QEDF_UNLOADING, &qedf->flags);
1698 mutex_lock(&n_port->lp_mutex);
1699 list_del(&vn_port->list);
1700 mutex_unlock(&n_port->lp_mutex);
1702 fc_fabric_logoff(vn_port);
1703 fc_lport_destroy(vn_port);
1705 /* Detach from scsi-ml */
1706 fc_remove_host(vn_port->host);
1707 scsi_remove_host(vn_port->host);
1710 * Only try to release the exchange manager if the vn_port
1711 * configuration is complete.
1713 if (vn_port->state == LPORT_ST_READY)
1714 fc_exch_mgr_free(vn_port);
1716 /* Free memory used by statistical counters */
1717 fc_lport_free_stats(vn_port);
1719 /* Release Scsi_Host */
1720 if (vn_port->host)
1721 scsi_host_put(vn_port->host);
1723 out:
1724 return 0;
1727 static int qedf_vport_disable(struct fc_vport *vport, bool disable)
1729 struct fc_lport *lport = vport->dd_data;
1731 if (disable) {
1732 fc_vport_set_state(vport, FC_VPORT_DISABLED);
1733 fc_fabric_logoff(lport);
1734 } else {
1735 lport->boot_time = jiffies;
1736 fc_fabric_login(lport);
1737 fc_vport_setlink(lport);
1739 return 0;
1743 * During removal we need to wait for all the vports associated with a port
1744 * to be destroyed so we avoid a race condition where libfc is still trying
1745 * to reap vports while the driver remove function has already reaped the
1746 * driver contexts associated with the physical port.
1748 static void qedf_wait_for_vport_destroy(struct qedf_ctx *qedf)
1750 struct fc_host_attrs *fc_host = shost_to_fc_host(qedf->lport->host);
1752 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_NPIV,
1753 "Entered.\n");
1754 while (fc_host->npiv_vports_inuse > 0) {
1755 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_NPIV,
1756 "Waiting for all vports to be reaped.\n");
1757 msleep(1000);
1762 * qedf_fcoe_reset - Resets the fcoe
1764 * @shost: shost the reset is from
1766 * Returns: always 0
1768 static int qedf_fcoe_reset(struct Scsi_Host *shost)
1770 struct fc_lport *lport = shost_priv(shost);
1772 qedf_ctx_soft_reset(lport);
1773 return 0;
1776 static struct fc_host_statistics *qedf_fc_get_host_stats(struct Scsi_Host
1777 *shost)
1779 struct fc_host_statistics *qedf_stats;
1780 struct fc_lport *lport = shost_priv(shost);
1781 struct qedf_ctx *qedf = lport_priv(lport);
1782 struct qed_fcoe_stats *fw_fcoe_stats;
1784 qedf_stats = fc_get_host_stats(shost);
1786 /* We don't collect offload stats for specific NPIV ports */
1787 if (lport->vport)
1788 goto out;
1790 fw_fcoe_stats = kmalloc(sizeof(struct qed_fcoe_stats), GFP_KERNEL);
1791 if (!fw_fcoe_stats) {
1792 QEDF_ERR(&(qedf->dbg_ctx), "Could not allocate memory for "
1793 "fw_fcoe_stats.\n");
1794 goto out;
1797 mutex_lock(&qedf->stats_mutex);
1799 /* Query firmware for offload stats */
1800 qed_ops->get_stats(qedf->cdev, fw_fcoe_stats);
1803 * The expectation is that we add our offload stats to the stats
1804 * being maintained by libfc each time the fc_get_host_status callback
1805 * is invoked. The additions are not carried over for each call to
1806 * the fc_get_host_stats callback.
1808 qedf_stats->tx_frames += fw_fcoe_stats->fcoe_tx_data_pkt_cnt +
1809 fw_fcoe_stats->fcoe_tx_xfer_pkt_cnt +
1810 fw_fcoe_stats->fcoe_tx_other_pkt_cnt;
1811 qedf_stats->rx_frames += fw_fcoe_stats->fcoe_rx_data_pkt_cnt +
1812 fw_fcoe_stats->fcoe_rx_xfer_pkt_cnt +
1813 fw_fcoe_stats->fcoe_rx_other_pkt_cnt;
1814 qedf_stats->fcp_input_megabytes +=
1815 do_div(fw_fcoe_stats->fcoe_rx_byte_cnt, 1000000);
1816 qedf_stats->fcp_output_megabytes +=
1817 do_div(fw_fcoe_stats->fcoe_tx_byte_cnt, 1000000);
1818 qedf_stats->rx_words += fw_fcoe_stats->fcoe_rx_byte_cnt / 4;
1819 qedf_stats->tx_words += fw_fcoe_stats->fcoe_tx_byte_cnt / 4;
1820 qedf_stats->invalid_crc_count +=
1821 fw_fcoe_stats->fcoe_silent_drop_pkt_crc_error_cnt;
1822 qedf_stats->dumped_frames =
1823 fw_fcoe_stats->fcoe_silent_drop_total_pkt_cnt;
1824 qedf_stats->error_frames +=
1825 fw_fcoe_stats->fcoe_silent_drop_total_pkt_cnt;
1826 qedf_stats->fcp_input_requests += qedf->input_requests;
1827 qedf_stats->fcp_output_requests += qedf->output_requests;
1828 qedf_stats->fcp_control_requests += qedf->control_requests;
1829 qedf_stats->fcp_packet_aborts += qedf->packet_aborts;
1830 qedf_stats->fcp_frame_alloc_failures += qedf->alloc_failures;
1832 mutex_unlock(&qedf->stats_mutex);
1833 kfree(fw_fcoe_stats);
1834 out:
1835 return qedf_stats;
1838 static struct fc_function_template qedf_fc_transport_fn = {
1839 .show_host_node_name = 1,
1840 .show_host_port_name = 1,
1841 .show_host_supported_classes = 1,
1842 .show_host_supported_fc4s = 1,
1843 .show_host_active_fc4s = 1,
1844 .show_host_maxframe_size = 1,
1846 .show_host_port_id = 1,
1847 .show_host_supported_speeds = 1,
1848 .get_host_speed = fc_get_host_speed,
1849 .show_host_speed = 1,
1850 .show_host_port_type = 1,
1851 .get_host_port_state = fc_get_host_port_state,
1852 .show_host_port_state = 1,
1853 .show_host_symbolic_name = 1,
1856 * Tell FC transport to allocate enough space to store the backpointer
1857 * for the associate qedf_rport struct.
1859 .dd_fcrport_size = (sizeof(struct fc_rport_libfc_priv) +
1860 sizeof(struct qedf_rport)),
1861 .show_rport_maxframe_size = 1,
1862 .show_rport_supported_classes = 1,
1863 .show_host_fabric_name = 1,
1864 .show_starget_node_name = 1,
1865 .show_starget_port_name = 1,
1866 .show_starget_port_id = 1,
1867 .set_rport_dev_loss_tmo = fc_set_rport_loss_tmo,
1868 .show_rport_dev_loss_tmo = 1,
1869 .get_fc_host_stats = qedf_fc_get_host_stats,
1870 .issue_fc_host_lip = qedf_fcoe_reset,
1871 .vport_create = qedf_vport_create,
1872 .vport_delete = qedf_vport_destroy,
1873 .vport_disable = qedf_vport_disable,
1874 .bsg_request = fc_lport_bsg_request,
1877 static struct fc_function_template qedf_fc_vport_transport_fn = {
1878 .show_host_node_name = 1,
1879 .show_host_port_name = 1,
1880 .show_host_supported_classes = 1,
1881 .show_host_supported_fc4s = 1,
1882 .show_host_active_fc4s = 1,
1883 .show_host_maxframe_size = 1,
1884 .show_host_port_id = 1,
1885 .show_host_supported_speeds = 1,
1886 .get_host_speed = fc_get_host_speed,
1887 .show_host_speed = 1,
1888 .show_host_port_type = 1,
1889 .get_host_port_state = fc_get_host_port_state,
1890 .show_host_port_state = 1,
1891 .show_host_symbolic_name = 1,
1892 .dd_fcrport_size = (sizeof(struct fc_rport_libfc_priv) +
1893 sizeof(struct qedf_rport)),
1894 .show_rport_maxframe_size = 1,
1895 .show_rport_supported_classes = 1,
1896 .show_host_fabric_name = 1,
1897 .show_starget_node_name = 1,
1898 .show_starget_port_name = 1,
1899 .show_starget_port_id = 1,
1900 .set_rport_dev_loss_tmo = fc_set_rport_loss_tmo,
1901 .show_rport_dev_loss_tmo = 1,
1902 .get_fc_host_stats = fc_get_host_stats,
1903 .issue_fc_host_lip = qedf_fcoe_reset,
1904 .bsg_request = fc_lport_bsg_request,
1907 static bool qedf_fp_has_work(struct qedf_fastpath *fp)
1909 struct qedf_ctx *qedf = fp->qedf;
1910 struct global_queue *que;
1911 struct qed_sb_info *sb_info = fp->sb_info;
1912 struct status_block_e4 *sb = sb_info->sb_virt;
1913 u16 prod_idx;
1915 /* Get the pointer to the global CQ this completion is on */
1916 que = qedf->global_queues[fp->sb_id];
1918 /* Be sure all responses have been written to PI */
1919 rmb();
1921 /* Get the current firmware producer index */
1922 prod_idx = sb->pi_array[QEDF_FCOE_PARAMS_GL_RQ_PI];
1924 return (que->cq_prod_idx != prod_idx);
1928 * Interrupt handler code.
1931 /* Process completion queue and copy CQE contents for deferred processesing
1933 * Return true if we should wake the I/O thread, false if not.
1935 static bool qedf_process_completions(struct qedf_fastpath *fp)
1937 struct qedf_ctx *qedf = fp->qedf;
1938 struct qed_sb_info *sb_info = fp->sb_info;
1939 struct status_block_e4 *sb = sb_info->sb_virt;
1940 struct global_queue *que;
1941 u16 prod_idx;
1942 struct fcoe_cqe *cqe;
1943 struct qedf_io_work *io_work;
1944 int num_handled = 0;
1945 unsigned int cpu;
1946 struct qedf_ioreq *io_req = NULL;
1947 u16 xid;
1948 u16 new_cqes;
1949 u32 comp_type;
1951 /* Get the current firmware producer index */
1952 prod_idx = sb->pi_array[QEDF_FCOE_PARAMS_GL_RQ_PI];
1954 /* Get the pointer to the global CQ this completion is on */
1955 que = qedf->global_queues[fp->sb_id];
1957 /* Calculate the amount of new elements since last processing */
1958 new_cqes = (prod_idx >= que->cq_prod_idx) ?
1959 (prod_idx - que->cq_prod_idx) :
1960 0x10000 - que->cq_prod_idx + prod_idx;
1962 /* Save producer index */
1963 que->cq_prod_idx = prod_idx;
1965 while (new_cqes) {
1966 fp->completions++;
1967 num_handled++;
1968 cqe = &que->cq[que->cq_cons_idx];
1970 comp_type = (cqe->cqe_data >> FCOE_CQE_CQE_TYPE_SHIFT) &
1971 FCOE_CQE_CQE_TYPE_MASK;
1974 * Process unsolicited CQEs directly in the interrupt handler
1975 * sine we need the fastpath ID
1977 if (comp_type == FCOE_UNSOLIC_CQE_TYPE) {
1978 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_UNSOL,
1979 "Unsolicated CQE.\n");
1980 qedf_process_unsol_compl(qedf, fp->sb_id, cqe);
1982 * Don't add a work list item. Increment consumer
1983 * consumer index and move on.
1985 goto inc_idx;
1988 xid = cqe->cqe_data & FCOE_CQE_TASK_ID_MASK;
1989 io_req = &qedf->cmd_mgr->cmds[xid];
1992 * Figure out which percpu thread we should queue this I/O
1993 * on.
1995 if (!io_req)
1996 /* If there is not io_req assocated with this CQE
1997 * just queue it on CPU 0
1999 cpu = 0;
2000 else {
2001 cpu = io_req->cpu;
2002 io_req->int_cpu = smp_processor_id();
2005 io_work = mempool_alloc(qedf->io_mempool, GFP_ATOMIC);
2006 if (!io_work) {
2007 QEDF_WARN(&(qedf->dbg_ctx), "Could not allocate "
2008 "work for I/O completion.\n");
2009 continue;
2011 memset(io_work, 0, sizeof(struct qedf_io_work));
2013 INIT_WORK(&io_work->work, qedf_fp_io_handler);
2015 /* Copy contents of CQE for deferred processing */
2016 memcpy(&io_work->cqe, cqe, sizeof(struct fcoe_cqe));
2018 io_work->qedf = fp->qedf;
2019 io_work->fp = NULL; /* Only used for unsolicited frames */
2021 queue_work_on(cpu, qedf_io_wq, &io_work->work);
2023 inc_idx:
2024 que->cq_cons_idx++;
2025 if (que->cq_cons_idx == fp->cq_num_entries)
2026 que->cq_cons_idx = 0;
2027 new_cqes--;
2030 return true;
2034 /* MSI-X fastpath handler code */
2035 static irqreturn_t qedf_msix_handler(int irq, void *dev_id)
2037 struct qedf_fastpath *fp = dev_id;
2039 if (!fp) {
2040 QEDF_ERR(NULL, "fp is null.\n");
2041 return IRQ_HANDLED;
2043 if (!fp->sb_info) {
2044 QEDF_ERR(NULL, "fp->sb_info in null.");
2045 return IRQ_HANDLED;
2049 * Disable interrupts for this status block while we process new
2050 * completions
2052 qed_sb_ack(fp->sb_info, IGU_INT_DISABLE, 0 /*do not update*/);
2054 while (1) {
2055 qedf_process_completions(fp);
2057 if (qedf_fp_has_work(fp) == 0) {
2058 /* Update the sb information */
2059 qed_sb_update_sb_idx(fp->sb_info);
2061 /* Check for more work */
2062 rmb();
2064 if (qedf_fp_has_work(fp) == 0) {
2065 /* Re-enable interrupts */
2066 qed_sb_ack(fp->sb_info, IGU_INT_ENABLE, 1);
2067 return IRQ_HANDLED;
2072 /* Do we ever want to break out of above loop? */
2073 return IRQ_HANDLED;
2076 /* simd handler for MSI/INTa */
2077 static void qedf_simd_int_handler(void *cookie)
2079 /* Cookie is qedf_ctx struct */
2080 struct qedf_ctx *qedf = (struct qedf_ctx *)cookie;
2082 QEDF_WARN(&(qedf->dbg_ctx), "qedf=%p.\n", qedf);
2085 #define QEDF_SIMD_HANDLER_NUM 0
2086 static void qedf_sync_free_irqs(struct qedf_ctx *qedf)
2088 int i;
2090 if (qedf->int_info.msix_cnt) {
2091 for (i = 0; i < qedf->int_info.used_cnt; i++) {
2092 synchronize_irq(qedf->int_info.msix[i].vector);
2093 irq_set_affinity_hint(qedf->int_info.msix[i].vector,
2094 NULL);
2095 irq_set_affinity_notifier(qedf->int_info.msix[i].vector,
2096 NULL);
2097 free_irq(qedf->int_info.msix[i].vector,
2098 &qedf->fp_array[i]);
2100 } else
2101 qed_ops->common->simd_handler_clean(qedf->cdev,
2102 QEDF_SIMD_HANDLER_NUM);
2104 qedf->int_info.used_cnt = 0;
2105 qed_ops->common->set_fp_int(qedf->cdev, 0);
2108 static int qedf_request_msix_irq(struct qedf_ctx *qedf)
2110 int i, rc, cpu;
2112 cpu = cpumask_first(cpu_online_mask);
2113 for (i = 0; i < qedf->num_queues; i++) {
2114 rc = request_irq(qedf->int_info.msix[i].vector,
2115 qedf_msix_handler, 0, "qedf", &qedf->fp_array[i]);
2117 if (rc) {
2118 QEDF_WARN(&(qedf->dbg_ctx), "request_irq failed.\n");
2119 qedf_sync_free_irqs(qedf);
2120 return rc;
2123 qedf->int_info.used_cnt++;
2124 rc = irq_set_affinity_hint(qedf->int_info.msix[i].vector,
2125 get_cpu_mask(cpu));
2126 cpu = cpumask_next(cpu, cpu_online_mask);
2129 return 0;
2132 static int qedf_setup_int(struct qedf_ctx *qedf)
2134 int rc = 0;
2137 * Learn interrupt configuration
2139 rc = qed_ops->common->set_fp_int(qedf->cdev, num_online_cpus());
2140 if (rc <= 0)
2141 return 0;
2143 rc = qed_ops->common->get_fp_int(qedf->cdev, &qedf->int_info);
2144 if (rc)
2145 return 0;
2147 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "Number of msix_cnt = "
2148 "0x%x num of cpus = 0x%x\n", qedf->int_info.msix_cnt,
2149 num_online_cpus());
2151 if (qedf->int_info.msix_cnt)
2152 return qedf_request_msix_irq(qedf);
2154 qed_ops->common->simd_handler_config(qedf->cdev, &qedf,
2155 QEDF_SIMD_HANDLER_NUM, qedf_simd_int_handler);
2156 qedf->int_info.used_cnt = 1;
2158 QEDF_ERR(&qedf->dbg_ctx, "Only MSI-X supported. Failing probe.\n");
2159 return -EINVAL;
2162 /* Main function for libfc frame reception */
2163 static void qedf_recv_frame(struct qedf_ctx *qedf,
2164 struct sk_buff *skb)
2166 u32 fr_len;
2167 struct fc_lport *lport;
2168 struct fc_frame_header *fh;
2169 struct fcoe_crc_eof crc_eof;
2170 struct fc_frame *fp;
2171 u8 *mac = NULL;
2172 u8 *dest_mac = NULL;
2173 struct fcoe_hdr *hp;
2174 struct qedf_rport *fcport;
2175 struct fc_lport *vn_port;
2176 u32 f_ctl;
2178 lport = qedf->lport;
2179 if (lport == NULL || lport->state == LPORT_ST_DISABLED) {
2180 QEDF_WARN(NULL, "Invalid lport struct or lport disabled.\n");
2181 kfree_skb(skb);
2182 return;
2185 if (skb_is_nonlinear(skb))
2186 skb_linearize(skb);
2187 mac = eth_hdr(skb)->h_source;
2188 dest_mac = eth_hdr(skb)->h_dest;
2190 /* Pull the header */
2191 hp = (struct fcoe_hdr *)skb->data;
2192 fh = (struct fc_frame_header *) skb_transport_header(skb);
2193 skb_pull(skb, sizeof(struct fcoe_hdr));
2194 fr_len = skb->len - sizeof(struct fcoe_crc_eof);
2196 fp = (struct fc_frame *)skb;
2197 fc_frame_init(fp);
2198 fr_dev(fp) = lport;
2199 fr_sof(fp) = hp->fcoe_sof;
2200 if (skb_copy_bits(skb, fr_len, &crc_eof, sizeof(crc_eof))) {
2201 kfree_skb(skb);
2202 return;
2204 fr_eof(fp) = crc_eof.fcoe_eof;
2205 fr_crc(fp) = crc_eof.fcoe_crc32;
2206 if (pskb_trim(skb, fr_len)) {
2207 kfree_skb(skb);
2208 return;
2211 fh = fc_frame_header_get(fp);
2214 * Invalid frame filters.
2217 if (fh->fh_r_ctl == FC_RCTL_DD_SOL_DATA &&
2218 fh->fh_type == FC_TYPE_FCP) {
2219 /* Drop FCP data. We dont this in L2 path */
2220 kfree_skb(skb);
2221 return;
2223 if (fh->fh_r_ctl == FC_RCTL_ELS_REQ &&
2224 fh->fh_type == FC_TYPE_ELS) {
2225 switch (fc_frame_payload_op(fp)) {
2226 case ELS_LOGO:
2227 if (ntoh24(fh->fh_s_id) == FC_FID_FLOGI) {
2228 /* drop non-FIP LOGO */
2229 kfree_skb(skb);
2230 return;
2232 break;
2236 if (fh->fh_r_ctl == FC_RCTL_BA_ABTS) {
2237 /* Drop incoming ABTS */
2238 kfree_skb(skb);
2239 return;
2242 if (ntoh24(&dest_mac[3]) != ntoh24(fh->fh_d_id)) {
2243 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_LL2,
2244 "FC frame d_id mismatch with MAC %pM.\n", dest_mac);
2245 kfree_skb(skb);
2246 return;
2249 if (qedf->ctlr.state) {
2250 if (!ether_addr_equal(mac, qedf->ctlr.dest_addr)) {
2251 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_LL2,
2252 "Wrong source address: mac:%pM dest_addr:%pM.\n",
2253 mac, qedf->ctlr.dest_addr);
2254 kfree_skb(skb);
2255 return;
2259 vn_port = fc_vport_id_lookup(lport, ntoh24(fh->fh_d_id));
2262 * If the destination ID from the frame header does not match what we
2263 * have on record for lport and the search for a NPIV port came up
2264 * empty then this is not addressed to our port so simply drop it.
2266 if (lport->port_id != ntoh24(fh->fh_d_id) && !vn_port) {
2267 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_LL2,
2268 "Dropping frame due to destination mismatch: lport->port_id=%x fh->d_id=%x.\n",
2269 lport->port_id, ntoh24(fh->fh_d_id));
2270 kfree_skb(skb);
2271 return;
2274 f_ctl = ntoh24(fh->fh_f_ctl);
2275 if ((fh->fh_type == FC_TYPE_BLS) && (f_ctl & FC_FC_SEQ_CTX) &&
2276 (f_ctl & FC_FC_EX_CTX)) {
2277 /* Drop incoming ABTS response that has both SEQ/EX CTX set */
2278 kfree_skb(skb);
2279 return;
2283 * If a connection is uploading, drop incoming FCoE frames as there
2284 * is a small window where we could try to return a frame while libfc
2285 * is trying to clean things up.
2288 /* Get fcport associated with d_id if it exists */
2289 fcport = qedf_fcport_lookup(qedf, ntoh24(fh->fh_d_id));
2291 if (fcport && test_bit(QEDF_RPORT_UPLOADING_CONNECTION,
2292 &fcport->flags)) {
2293 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_LL2,
2294 "Connection uploading, dropping fp=%p.\n", fp);
2295 kfree_skb(skb);
2296 return;
2299 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_LL2, "FCoE frame receive: "
2300 "skb=%p fp=%p src=%06x dest=%06x r_ctl=%x fh_type=%x.\n", skb, fp,
2301 ntoh24(fh->fh_s_id), ntoh24(fh->fh_d_id), fh->fh_r_ctl,
2302 fh->fh_type);
2303 if (qedf_dump_frames)
2304 print_hex_dump(KERN_WARNING, "fcoe: ", DUMP_PREFIX_OFFSET, 16,
2305 1, skb->data, skb->len, false);
2306 fc_exch_recv(lport, fp);
2309 static void qedf_ll2_process_skb(struct work_struct *work)
2311 struct qedf_skb_work *skb_work =
2312 container_of(work, struct qedf_skb_work, work);
2313 struct qedf_ctx *qedf = skb_work->qedf;
2314 struct sk_buff *skb = skb_work->skb;
2315 struct ethhdr *eh;
2317 if (!qedf) {
2318 QEDF_ERR(NULL, "qedf is NULL\n");
2319 goto err_out;
2322 eh = (struct ethhdr *)skb->data;
2324 /* Undo VLAN encapsulation */
2325 if (eh->h_proto == htons(ETH_P_8021Q)) {
2326 memmove((u8 *)eh + VLAN_HLEN, eh, ETH_ALEN * 2);
2327 eh = skb_pull(skb, VLAN_HLEN);
2328 skb_reset_mac_header(skb);
2332 * Process either a FIP frame or FCoE frame based on the
2333 * protocol value. If it's not either just drop the
2334 * frame.
2336 if (eh->h_proto == htons(ETH_P_FIP)) {
2337 qedf_fip_recv(qedf, skb);
2338 goto out;
2339 } else if (eh->h_proto == htons(ETH_P_FCOE)) {
2340 __skb_pull(skb, ETH_HLEN);
2341 qedf_recv_frame(qedf, skb);
2342 goto out;
2343 } else
2344 goto err_out;
2346 err_out:
2347 kfree_skb(skb);
2348 out:
2349 kfree(skb_work);
2350 return;
2353 static int qedf_ll2_rx(void *cookie, struct sk_buff *skb,
2354 u32 arg1, u32 arg2)
2356 struct qedf_ctx *qedf = (struct qedf_ctx *)cookie;
2357 struct qedf_skb_work *skb_work;
2359 skb_work = kzalloc(sizeof(struct qedf_skb_work), GFP_ATOMIC);
2360 if (!skb_work) {
2361 QEDF_WARN(&(qedf->dbg_ctx), "Could not allocate skb_work so "
2362 "dropping frame.\n");
2363 kfree_skb(skb);
2364 return 0;
2367 INIT_WORK(&skb_work->work, qedf_ll2_process_skb);
2368 skb_work->skb = skb;
2369 skb_work->qedf = qedf;
2370 queue_work(qedf->ll2_recv_wq, &skb_work->work);
2372 return 0;
2375 static struct qed_ll2_cb_ops qedf_ll2_cb_ops = {
2376 .rx_cb = qedf_ll2_rx,
2377 .tx_cb = NULL,
2380 /* Main thread to process I/O completions */
2381 void qedf_fp_io_handler(struct work_struct *work)
2383 struct qedf_io_work *io_work =
2384 container_of(work, struct qedf_io_work, work);
2385 u32 comp_type;
2388 * Deferred part of unsolicited CQE sends
2389 * frame to libfc.
2391 comp_type = (io_work->cqe.cqe_data >>
2392 FCOE_CQE_CQE_TYPE_SHIFT) &
2393 FCOE_CQE_CQE_TYPE_MASK;
2394 if (comp_type == FCOE_UNSOLIC_CQE_TYPE &&
2395 io_work->fp)
2396 fc_exch_recv(io_work->qedf->lport, io_work->fp);
2397 else
2398 qedf_process_cqe(io_work->qedf, &io_work->cqe);
2400 kfree(io_work);
2403 static int qedf_alloc_and_init_sb(struct qedf_ctx *qedf,
2404 struct qed_sb_info *sb_info, u16 sb_id)
2406 struct status_block_e4 *sb_virt;
2407 dma_addr_t sb_phys;
2408 int ret;
2410 sb_virt = dma_alloc_coherent(&qedf->pdev->dev,
2411 sizeof(struct status_block_e4), &sb_phys, GFP_KERNEL);
2413 if (!sb_virt) {
2414 QEDF_ERR(&(qedf->dbg_ctx), "Status block allocation failed "
2415 "for id = %d.\n", sb_id);
2416 return -ENOMEM;
2419 ret = qed_ops->common->sb_init(qedf->cdev, sb_info, sb_virt, sb_phys,
2420 sb_id, QED_SB_TYPE_STORAGE);
2422 if (ret) {
2423 QEDF_ERR(&(qedf->dbg_ctx), "Status block initialization "
2424 "failed for id = %d.\n", sb_id);
2425 return ret;
2428 return 0;
2431 static void qedf_free_sb(struct qedf_ctx *qedf, struct qed_sb_info *sb_info)
2433 if (sb_info->sb_virt)
2434 dma_free_coherent(&qedf->pdev->dev, sizeof(*sb_info->sb_virt),
2435 (void *)sb_info->sb_virt, sb_info->sb_phys);
2438 static void qedf_destroy_sb(struct qedf_ctx *qedf)
2440 int id;
2441 struct qedf_fastpath *fp = NULL;
2443 for (id = 0; id < qedf->num_queues; id++) {
2444 fp = &(qedf->fp_array[id]);
2445 if (fp->sb_id == QEDF_SB_ID_NULL)
2446 break;
2447 qedf_free_sb(qedf, fp->sb_info);
2448 kfree(fp->sb_info);
2450 kfree(qedf->fp_array);
2453 static int qedf_prepare_sb(struct qedf_ctx *qedf)
2455 int id;
2456 struct qedf_fastpath *fp;
2457 int ret;
2459 qedf->fp_array =
2460 kcalloc(qedf->num_queues, sizeof(struct qedf_fastpath),
2461 GFP_KERNEL);
2463 if (!qedf->fp_array) {
2464 QEDF_ERR(&(qedf->dbg_ctx), "fastpath array allocation "
2465 "failed.\n");
2466 return -ENOMEM;
2469 for (id = 0; id < qedf->num_queues; id++) {
2470 fp = &(qedf->fp_array[id]);
2471 fp->sb_id = QEDF_SB_ID_NULL;
2472 fp->sb_info = kcalloc(1, sizeof(*fp->sb_info), GFP_KERNEL);
2473 if (!fp->sb_info) {
2474 QEDF_ERR(&(qedf->dbg_ctx), "SB info struct "
2475 "allocation failed.\n");
2476 goto err;
2478 ret = qedf_alloc_and_init_sb(qedf, fp->sb_info, id);
2479 if (ret) {
2480 QEDF_ERR(&(qedf->dbg_ctx), "SB allocation and "
2481 "initialization failed.\n");
2482 goto err;
2484 fp->sb_id = id;
2485 fp->qedf = qedf;
2486 fp->cq_num_entries =
2487 qedf->global_queues[id]->cq_mem_size /
2488 sizeof(struct fcoe_cqe);
2490 err:
2491 return 0;
2494 void qedf_process_cqe(struct qedf_ctx *qedf, struct fcoe_cqe *cqe)
2496 u16 xid;
2497 struct qedf_ioreq *io_req;
2498 struct qedf_rport *fcport;
2499 u32 comp_type;
2501 comp_type = (cqe->cqe_data >> FCOE_CQE_CQE_TYPE_SHIFT) &
2502 FCOE_CQE_CQE_TYPE_MASK;
2504 xid = cqe->cqe_data & FCOE_CQE_TASK_ID_MASK;
2505 io_req = &qedf->cmd_mgr->cmds[xid];
2507 /* Completion not for a valid I/O anymore so just return */
2508 if (!io_req)
2509 return;
2511 fcport = io_req->fcport;
2513 if (fcport == NULL) {
2514 QEDF_ERR(&(qedf->dbg_ctx), "fcport is NULL.\n");
2515 return;
2519 * Check that fcport is offloaded. If it isn't then the spinlock
2520 * isn't valid and shouldn't be taken. We should just return.
2522 if (!test_bit(QEDF_RPORT_SESSION_READY, &fcport->flags)) {
2523 QEDF_ERR(&(qedf->dbg_ctx), "Session not offloaded yet.\n");
2524 return;
2528 switch (comp_type) {
2529 case FCOE_GOOD_COMPLETION_CQE_TYPE:
2530 atomic_inc(&fcport->free_sqes);
2531 switch (io_req->cmd_type) {
2532 case QEDF_SCSI_CMD:
2533 qedf_scsi_completion(qedf, cqe, io_req);
2534 break;
2535 case QEDF_ELS:
2536 qedf_process_els_compl(qedf, cqe, io_req);
2537 break;
2538 case QEDF_TASK_MGMT_CMD:
2539 qedf_process_tmf_compl(qedf, cqe, io_req);
2540 break;
2541 case QEDF_SEQ_CLEANUP:
2542 qedf_process_seq_cleanup_compl(qedf, cqe, io_req);
2543 break;
2545 break;
2546 case FCOE_ERROR_DETECTION_CQE_TYPE:
2547 atomic_inc(&fcport->free_sqes);
2548 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO,
2549 "Error detect CQE.\n");
2550 qedf_process_error_detect(qedf, cqe, io_req);
2551 break;
2552 case FCOE_EXCH_CLEANUP_CQE_TYPE:
2553 atomic_inc(&fcport->free_sqes);
2554 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO,
2555 "Cleanup CQE.\n");
2556 qedf_process_cleanup_compl(qedf, cqe, io_req);
2557 break;
2558 case FCOE_ABTS_CQE_TYPE:
2559 atomic_inc(&fcport->free_sqes);
2560 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO,
2561 "Abort CQE.\n");
2562 qedf_process_abts_compl(qedf, cqe, io_req);
2563 break;
2564 case FCOE_DUMMY_CQE_TYPE:
2565 atomic_inc(&fcport->free_sqes);
2566 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO,
2567 "Dummy CQE.\n");
2568 break;
2569 case FCOE_LOCAL_COMP_CQE_TYPE:
2570 atomic_inc(&fcport->free_sqes);
2571 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO,
2572 "Local completion CQE.\n");
2573 break;
2574 case FCOE_WARNING_CQE_TYPE:
2575 atomic_inc(&fcport->free_sqes);
2576 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO,
2577 "Warning CQE.\n");
2578 qedf_process_warning_compl(qedf, cqe, io_req);
2579 break;
2580 case MAX_FCOE_CQE_TYPE:
2581 atomic_inc(&fcport->free_sqes);
2582 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO,
2583 "Max FCoE CQE.\n");
2584 break;
2585 default:
2586 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO,
2587 "Default CQE.\n");
2588 break;
2592 static void qedf_free_bdq(struct qedf_ctx *qedf)
2594 int i;
2596 if (qedf->bdq_pbl_list)
2597 dma_free_coherent(&qedf->pdev->dev, QEDF_PAGE_SIZE,
2598 qedf->bdq_pbl_list, qedf->bdq_pbl_list_dma);
2600 if (qedf->bdq_pbl)
2601 dma_free_coherent(&qedf->pdev->dev, qedf->bdq_pbl_mem_size,
2602 qedf->bdq_pbl, qedf->bdq_pbl_dma);
2604 for (i = 0; i < QEDF_BDQ_SIZE; i++) {
2605 if (qedf->bdq[i].buf_addr) {
2606 dma_free_coherent(&qedf->pdev->dev, QEDF_BDQ_BUF_SIZE,
2607 qedf->bdq[i].buf_addr, qedf->bdq[i].buf_dma);
2612 static void qedf_free_global_queues(struct qedf_ctx *qedf)
2614 int i;
2615 struct global_queue **gl = qedf->global_queues;
2617 for (i = 0; i < qedf->num_queues; i++) {
2618 if (!gl[i])
2619 continue;
2621 if (gl[i]->cq)
2622 dma_free_coherent(&qedf->pdev->dev,
2623 gl[i]->cq_mem_size, gl[i]->cq, gl[i]->cq_dma);
2624 if (gl[i]->cq_pbl)
2625 dma_free_coherent(&qedf->pdev->dev, gl[i]->cq_pbl_size,
2626 gl[i]->cq_pbl, gl[i]->cq_pbl_dma);
2628 kfree(gl[i]);
2631 qedf_free_bdq(qedf);
2634 static int qedf_alloc_bdq(struct qedf_ctx *qedf)
2636 int i;
2637 struct scsi_bd *pbl;
2638 u64 *list;
2639 dma_addr_t page;
2641 /* Alloc dma memory for BDQ buffers */
2642 for (i = 0; i < QEDF_BDQ_SIZE; i++) {
2643 qedf->bdq[i].buf_addr = dma_alloc_coherent(&qedf->pdev->dev,
2644 QEDF_BDQ_BUF_SIZE, &qedf->bdq[i].buf_dma, GFP_KERNEL);
2645 if (!qedf->bdq[i].buf_addr) {
2646 QEDF_ERR(&(qedf->dbg_ctx), "Could not allocate BDQ "
2647 "buffer %d.\n", i);
2648 return -ENOMEM;
2652 /* Alloc dma memory for BDQ page buffer list */
2653 qedf->bdq_pbl_mem_size =
2654 QEDF_BDQ_SIZE * sizeof(struct scsi_bd);
2655 qedf->bdq_pbl_mem_size =
2656 ALIGN(qedf->bdq_pbl_mem_size, QEDF_PAGE_SIZE);
2658 qedf->bdq_pbl = dma_alloc_coherent(&qedf->pdev->dev,
2659 qedf->bdq_pbl_mem_size, &qedf->bdq_pbl_dma, GFP_KERNEL);
2660 if (!qedf->bdq_pbl) {
2661 QEDF_ERR(&(qedf->dbg_ctx), "Could not allocate BDQ PBL.\n");
2662 return -ENOMEM;
2665 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
2666 "BDQ PBL addr=0x%p dma=%pad\n",
2667 qedf->bdq_pbl, &qedf->bdq_pbl_dma);
2670 * Populate BDQ PBL with physical and virtual address of individual
2671 * BDQ buffers
2673 pbl = (struct scsi_bd *)qedf->bdq_pbl;
2674 for (i = 0; i < QEDF_BDQ_SIZE; i++) {
2675 pbl->address.hi = cpu_to_le32(U64_HI(qedf->bdq[i].buf_dma));
2676 pbl->address.lo = cpu_to_le32(U64_LO(qedf->bdq[i].buf_dma));
2677 pbl->opaque.fcoe_opaque.hi = 0;
2678 /* Opaque lo data is an index into the BDQ array */
2679 pbl->opaque.fcoe_opaque.lo = cpu_to_le32(i);
2680 pbl++;
2683 /* Allocate list of PBL pages */
2684 qedf->bdq_pbl_list = dma_zalloc_coherent(&qedf->pdev->dev,
2685 QEDF_PAGE_SIZE, &qedf->bdq_pbl_list_dma, GFP_KERNEL);
2686 if (!qedf->bdq_pbl_list) {
2687 QEDF_ERR(&(qedf->dbg_ctx), "Could not allocate list of PBL pages.\n");
2688 return -ENOMEM;
2692 * Now populate PBL list with pages that contain pointers to the
2693 * individual buffers.
2695 qedf->bdq_pbl_list_num_entries = qedf->bdq_pbl_mem_size /
2696 QEDF_PAGE_SIZE;
2697 list = (u64 *)qedf->bdq_pbl_list;
2698 page = qedf->bdq_pbl_list_dma;
2699 for (i = 0; i < qedf->bdq_pbl_list_num_entries; i++) {
2700 *list = qedf->bdq_pbl_dma;
2701 list++;
2702 page += QEDF_PAGE_SIZE;
2705 return 0;
2708 static int qedf_alloc_global_queues(struct qedf_ctx *qedf)
2710 u32 *list;
2711 int i;
2712 int status = 0, rc;
2713 u32 *pbl;
2714 dma_addr_t page;
2715 int num_pages;
2717 /* Allocate and map CQs, RQs */
2719 * Number of global queues (CQ / RQ). This should
2720 * be <= number of available MSIX vectors for the PF
2722 if (!qedf->num_queues) {
2723 QEDF_ERR(&(qedf->dbg_ctx), "No MSI-X vectors available!\n");
2724 return 1;
2728 * Make sure we allocated the PBL that will contain the physical
2729 * addresses of our queues
2731 if (!qedf->p_cpuq) {
2732 status = 1;
2733 goto mem_alloc_failure;
2736 qedf->global_queues = kzalloc((sizeof(struct global_queue *)
2737 * qedf->num_queues), GFP_KERNEL);
2738 if (!qedf->global_queues) {
2739 QEDF_ERR(&(qedf->dbg_ctx), "Unable to allocate global "
2740 "queues array ptr memory\n");
2741 return -ENOMEM;
2743 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
2744 "qedf->global_queues=%p.\n", qedf->global_queues);
2746 /* Allocate DMA coherent buffers for BDQ */
2747 rc = qedf_alloc_bdq(qedf);
2748 if (rc)
2749 goto mem_alloc_failure;
2751 /* Allocate a CQ and an associated PBL for each MSI-X vector */
2752 for (i = 0; i < qedf->num_queues; i++) {
2753 qedf->global_queues[i] = kzalloc(sizeof(struct global_queue),
2754 GFP_KERNEL);
2755 if (!qedf->global_queues[i]) {
2756 QEDF_WARN(&(qedf->dbg_ctx), "Unable to allocate "
2757 "global queue %d.\n", i);
2758 status = -ENOMEM;
2759 goto mem_alloc_failure;
2762 qedf->global_queues[i]->cq_mem_size =
2763 FCOE_PARAMS_CQ_NUM_ENTRIES * sizeof(struct fcoe_cqe);
2764 qedf->global_queues[i]->cq_mem_size =
2765 ALIGN(qedf->global_queues[i]->cq_mem_size, QEDF_PAGE_SIZE);
2767 qedf->global_queues[i]->cq_pbl_size =
2768 (qedf->global_queues[i]->cq_mem_size /
2769 PAGE_SIZE) * sizeof(void *);
2770 qedf->global_queues[i]->cq_pbl_size =
2771 ALIGN(qedf->global_queues[i]->cq_pbl_size, QEDF_PAGE_SIZE);
2773 qedf->global_queues[i]->cq =
2774 dma_zalloc_coherent(&qedf->pdev->dev,
2775 qedf->global_queues[i]->cq_mem_size,
2776 &qedf->global_queues[i]->cq_dma, GFP_KERNEL);
2778 if (!qedf->global_queues[i]->cq) {
2779 QEDF_WARN(&(qedf->dbg_ctx), "Could not allocate cq.\n");
2780 status = -ENOMEM;
2781 goto mem_alloc_failure;
2784 qedf->global_queues[i]->cq_pbl =
2785 dma_zalloc_coherent(&qedf->pdev->dev,
2786 qedf->global_queues[i]->cq_pbl_size,
2787 &qedf->global_queues[i]->cq_pbl_dma, GFP_KERNEL);
2789 if (!qedf->global_queues[i]->cq_pbl) {
2790 QEDF_WARN(&(qedf->dbg_ctx), "Could not allocate cq PBL.\n");
2791 status = -ENOMEM;
2792 goto mem_alloc_failure;
2795 /* Create PBL */
2796 num_pages = qedf->global_queues[i]->cq_mem_size /
2797 QEDF_PAGE_SIZE;
2798 page = qedf->global_queues[i]->cq_dma;
2799 pbl = (u32 *)qedf->global_queues[i]->cq_pbl;
2801 while (num_pages--) {
2802 *pbl = U64_LO(page);
2803 pbl++;
2804 *pbl = U64_HI(page);
2805 pbl++;
2806 page += QEDF_PAGE_SIZE;
2808 /* Set the initial consumer index for cq */
2809 qedf->global_queues[i]->cq_cons_idx = 0;
2812 list = (u32 *)qedf->p_cpuq;
2815 * The list is built as follows: CQ#0 PBL pointer, RQ#0 PBL pointer,
2816 * CQ#1 PBL pointer, RQ#1 PBL pointer, etc. Each PBL pointer points
2817 * to the physical address which contains an array of pointers to
2818 * the physical addresses of the specific queue pages.
2820 for (i = 0; i < qedf->num_queues; i++) {
2821 *list = U64_LO(qedf->global_queues[i]->cq_pbl_dma);
2822 list++;
2823 *list = U64_HI(qedf->global_queues[i]->cq_pbl_dma);
2824 list++;
2825 *list = U64_LO(0);
2826 list++;
2827 *list = U64_HI(0);
2828 list++;
2831 return 0;
2833 mem_alloc_failure:
2834 qedf_free_global_queues(qedf);
2835 return status;
2838 static int qedf_set_fcoe_pf_param(struct qedf_ctx *qedf)
2840 u8 sq_num_pbl_pages;
2841 u32 sq_mem_size;
2842 u32 cq_mem_size;
2843 u32 cq_num_entries;
2844 int rval;
2847 * The number of completion queues/fastpath interrupts/status blocks
2848 * we allocation is the minimum off:
2850 * Number of CPUs
2851 * Number allocated by qed for our PCI function
2853 qedf->num_queues = MIN_NUM_CPUS_MSIX(qedf);
2855 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "Number of CQs is %d.\n",
2856 qedf->num_queues);
2858 qedf->p_cpuq = pci_alloc_consistent(qedf->pdev,
2859 qedf->num_queues * sizeof(struct qedf_glbl_q_params),
2860 &qedf->hw_p_cpuq);
2862 if (!qedf->p_cpuq) {
2863 QEDF_ERR(&(qedf->dbg_ctx), "pci_alloc_consistent failed.\n");
2864 return 1;
2867 rval = qedf_alloc_global_queues(qedf);
2868 if (rval) {
2869 QEDF_ERR(&(qedf->dbg_ctx), "Global queue allocation "
2870 "failed.\n");
2871 return 1;
2874 /* Calculate SQ PBL size in the same manner as in qedf_sq_alloc() */
2875 sq_mem_size = SQ_NUM_ENTRIES * sizeof(struct fcoe_wqe);
2876 sq_mem_size = ALIGN(sq_mem_size, QEDF_PAGE_SIZE);
2877 sq_num_pbl_pages = (sq_mem_size / QEDF_PAGE_SIZE);
2879 /* Calculate CQ num entries */
2880 cq_mem_size = FCOE_PARAMS_CQ_NUM_ENTRIES * sizeof(struct fcoe_cqe);
2881 cq_mem_size = ALIGN(cq_mem_size, QEDF_PAGE_SIZE);
2882 cq_num_entries = cq_mem_size / sizeof(struct fcoe_cqe);
2884 memset(&(qedf->pf_params), 0, sizeof(qedf->pf_params));
2886 /* Setup the value for fcoe PF */
2887 qedf->pf_params.fcoe_pf_params.num_cons = QEDF_MAX_SESSIONS;
2888 qedf->pf_params.fcoe_pf_params.num_tasks = FCOE_PARAMS_NUM_TASKS;
2889 qedf->pf_params.fcoe_pf_params.glbl_q_params_addr =
2890 (u64)qedf->hw_p_cpuq;
2891 qedf->pf_params.fcoe_pf_params.sq_num_pbl_pages = sq_num_pbl_pages;
2893 qedf->pf_params.fcoe_pf_params.rq_buffer_log_size = 0;
2895 qedf->pf_params.fcoe_pf_params.cq_num_entries = cq_num_entries;
2896 qedf->pf_params.fcoe_pf_params.num_cqs = qedf->num_queues;
2898 /* log_page_size: 12 for 4KB pages */
2899 qedf->pf_params.fcoe_pf_params.log_page_size = ilog2(QEDF_PAGE_SIZE);
2901 qedf->pf_params.fcoe_pf_params.mtu = 9000;
2902 qedf->pf_params.fcoe_pf_params.gl_rq_pi = QEDF_FCOE_PARAMS_GL_RQ_PI;
2903 qedf->pf_params.fcoe_pf_params.gl_cmd_pi = QEDF_FCOE_PARAMS_GL_CMD_PI;
2905 /* BDQ address and size */
2906 qedf->pf_params.fcoe_pf_params.bdq_pbl_base_addr[0] =
2907 qedf->bdq_pbl_list_dma;
2908 qedf->pf_params.fcoe_pf_params.bdq_pbl_num_entries[0] =
2909 qedf->bdq_pbl_list_num_entries;
2910 qedf->pf_params.fcoe_pf_params.rq_buffer_size = QEDF_BDQ_BUF_SIZE;
2912 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
2913 "bdq_list=%p bdq_pbl_list_dma=%llx bdq_pbl_list_entries=%d.\n",
2914 qedf->bdq_pbl_list,
2915 qedf->pf_params.fcoe_pf_params.bdq_pbl_base_addr[0],
2916 qedf->pf_params.fcoe_pf_params.bdq_pbl_num_entries[0]);
2918 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
2919 "cq_num_entries=%d.\n",
2920 qedf->pf_params.fcoe_pf_params.cq_num_entries);
2922 return 0;
2925 /* Free DMA coherent memory for array of queue pointers we pass to qed */
2926 static void qedf_free_fcoe_pf_param(struct qedf_ctx *qedf)
2928 size_t size = 0;
2930 if (qedf->p_cpuq) {
2931 size = qedf->num_queues * sizeof(struct qedf_glbl_q_params);
2932 pci_free_consistent(qedf->pdev, size, qedf->p_cpuq,
2933 qedf->hw_p_cpuq);
2936 qedf_free_global_queues(qedf);
2938 if (qedf->global_queues)
2939 kfree(qedf->global_queues);
2943 * PCI driver functions
2946 static const struct pci_device_id qedf_pci_tbl[] = {
2947 { PCI_DEVICE(PCI_VENDOR_ID_QLOGIC, 0x165c) },
2948 { PCI_DEVICE(PCI_VENDOR_ID_QLOGIC, 0x8080) },
2951 MODULE_DEVICE_TABLE(pci, qedf_pci_tbl);
2953 static struct pci_driver qedf_pci_driver = {
2954 .name = QEDF_MODULE_NAME,
2955 .id_table = qedf_pci_tbl,
2956 .probe = qedf_probe,
2957 .remove = qedf_remove,
2960 static int __qedf_probe(struct pci_dev *pdev, int mode)
2962 int rc = -EINVAL;
2963 struct fc_lport *lport;
2964 struct qedf_ctx *qedf;
2965 struct Scsi_Host *host;
2966 bool is_vf = false;
2967 struct qed_ll2_params params;
2968 char host_buf[20];
2969 struct qed_link_params link_params;
2970 int status;
2971 void *task_start, *task_end;
2972 struct qed_slowpath_params slowpath_params;
2973 struct qed_probe_params qed_params;
2974 u16 tmp;
2977 * When doing error recovery we didn't reap the lport so don't try
2978 * to reallocate it.
2980 if (mode != QEDF_MODE_RECOVERY) {
2981 lport = libfc_host_alloc(&qedf_host_template,
2982 sizeof(struct qedf_ctx));
2984 if (!lport) {
2985 QEDF_ERR(NULL, "Could not allocate lport.\n");
2986 rc = -ENOMEM;
2987 goto err0;
2990 /* Initialize qedf_ctx */
2991 qedf = lport_priv(lport);
2992 qedf->lport = lport;
2993 qedf->ctlr.lp = lport;
2994 qedf->pdev = pdev;
2995 qedf->dbg_ctx.pdev = pdev;
2996 qedf->dbg_ctx.host_no = lport->host->host_no;
2997 spin_lock_init(&qedf->hba_lock);
2998 INIT_LIST_HEAD(&qedf->fcports);
2999 qedf->curr_conn_id = QEDF_MAX_SESSIONS - 1;
3000 atomic_set(&qedf->num_offloads, 0);
3001 qedf->stop_io_on_error = false;
3002 pci_set_drvdata(pdev, qedf);
3003 init_completion(&qedf->fipvlan_compl);
3004 mutex_init(&qedf->stats_mutex);
3006 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_INFO,
3007 "QLogic FastLinQ FCoE Module qedf %s, "
3008 "FW %d.%d.%d.%d\n", QEDF_VERSION,
3009 FW_MAJOR_VERSION, FW_MINOR_VERSION, FW_REVISION_VERSION,
3010 FW_ENGINEERING_VERSION);
3011 } else {
3012 /* Init pointers during recovery */
3013 qedf = pci_get_drvdata(pdev);
3014 lport = qedf->lport;
3017 host = lport->host;
3019 /* Allocate mempool for qedf_io_work structs */
3020 qedf->io_mempool = mempool_create_slab_pool(QEDF_IO_WORK_MIN,
3021 qedf_io_work_cache);
3022 if (qedf->io_mempool == NULL) {
3023 QEDF_ERR(&(qedf->dbg_ctx), "qedf->io_mempool is NULL.\n");
3024 goto err1;
3026 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_INFO, "qedf->io_mempool=%p.\n",
3027 qedf->io_mempool);
3029 sprintf(host_buf, "qedf_%u_link",
3030 qedf->lport->host->host_no);
3031 qedf->link_update_wq = create_workqueue(host_buf);
3032 INIT_DELAYED_WORK(&qedf->link_update, qedf_handle_link_update);
3033 INIT_DELAYED_WORK(&qedf->link_recovery, qedf_link_recovery);
3034 INIT_DELAYED_WORK(&qedf->grcdump_work, qedf_wq_grcdump);
3035 qedf->fipvlan_retries = qedf_fipvlan_retries;
3036 /* Set a default prio in case DCBX doesn't converge */
3037 if (qedf_default_prio > -1) {
3039 * This is the case where we pass a modparam in so we want to
3040 * honor it even if dcbx doesn't converge.
3042 qedf->prio = qedf_default_prio;
3043 } else
3044 qedf->prio = QEDF_DEFAULT_PRIO;
3047 * Common probe. Takes care of basic hardware init and pci_*
3048 * functions.
3050 memset(&qed_params, 0, sizeof(qed_params));
3051 qed_params.protocol = QED_PROTOCOL_FCOE;
3052 qed_params.dp_module = qedf_dp_module;
3053 qed_params.dp_level = qedf_dp_level;
3054 qed_params.is_vf = is_vf;
3055 qedf->cdev = qed_ops->common->probe(pdev, &qed_params);
3056 if (!qedf->cdev) {
3057 rc = -ENODEV;
3058 goto err1;
3061 /* Learn information crucial for qedf to progress */
3062 rc = qed_ops->fill_dev_info(qedf->cdev, &qedf->dev_info);
3063 if (rc) {
3064 QEDF_ERR(&(qedf->dbg_ctx), "Failed to dev info.\n");
3065 goto err1;
3068 /* queue allocation code should come here
3069 * order should be
3070 * slowpath_start
3071 * status block allocation
3072 * interrupt registration (to get min number of queues)
3073 * set_fcoe_pf_param
3074 * qed_sp_fcoe_func_start
3076 rc = qedf_set_fcoe_pf_param(qedf);
3077 if (rc) {
3078 QEDF_ERR(&(qedf->dbg_ctx), "Cannot set fcoe pf param.\n");
3079 goto err2;
3081 qed_ops->common->update_pf_params(qedf->cdev, &qedf->pf_params);
3083 /* Record BDQ producer doorbell addresses */
3084 qedf->bdq_primary_prod = qedf->dev_info.primary_dbq_rq_addr;
3085 qedf->bdq_secondary_prod = qedf->dev_info.secondary_bdq_rq_addr;
3086 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
3087 "BDQ primary_prod=%p secondary_prod=%p.\n", qedf->bdq_primary_prod,
3088 qedf->bdq_secondary_prod);
3090 qed_ops->register_ops(qedf->cdev, &qedf_cb_ops, qedf);
3092 rc = qedf_prepare_sb(qedf);
3093 if (rc) {
3095 QEDF_ERR(&(qedf->dbg_ctx), "Cannot start slowpath.\n");
3096 goto err2;
3099 /* Start the Slowpath-process */
3100 slowpath_params.int_mode = QED_INT_MODE_MSIX;
3101 slowpath_params.drv_major = QEDF_DRIVER_MAJOR_VER;
3102 slowpath_params.drv_minor = QEDF_DRIVER_MINOR_VER;
3103 slowpath_params.drv_rev = QEDF_DRIVER_REV_VER;
3104 slowpath_params.drv_eng = QEDF_DRIVER_ENG_VER;
3105 strncpy(slowpath_params.name, "qedf", QED_DRV_VER_STR_SIZE);
3106 rc = qed_ops->common->slowpath_start(qedf->cdev, &slowpath_params);
3107 if (rc) {
3108 QEDF_ERR(&(qedf->dbg_ctx), "Cannot start slowpath.\n");
3109 goto err2;
3113 * update_pf_params needs to be called before and after slowpath
3114 * start
3116 qed_ops->common->update_pf_params(qedf->cdev, &qedf->pf_params);
3118 /* Setup interrupts */
3119 rc = qedf_setup_int(qedf);
3120 if (rc)
3121 goto err3;
3123 rc = qed_ops->start(qedf->cdev, &qedf->tasks);
3124 if (rc) {
3125 QEDF_ERR(&(qedf->dbg_ctx), "Cannot start FCoE function.\n");
3126 goto err4;
3128 task_start = qedf_get_task_mem(&qedf->tasks, 0);
3129 task_end = qedf_get_task_mem(&qedf->tasks, MAX_TID_BLOCKS_FCOE - 1);
3130 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "Task context start=%p, "
3131 "end=%p block_size=%u.\n", task_start, task_end,
3132 qedf->tasks.size);
3135 * We need to write the number of BDs in the BDQ we've preallocated so
3136 * the f/w will do a prefetch and we'll get an unsolicited CQE when a
3137 * packet arrives.
3139 qedf->bdq_prod_idx = QEDF_BDQ_SIZE;
3140 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
3141 "Writing %d to primary and secondary BDQ doorbell registers.\n",
3142 qedf->bdq_prod_idx);
3143 writew(qedf->bdq_prod_idx, qedf->bdq_primary_prod);
3144 tmp = readw(qedf->bdq_primary_prod);
3145 writew(qedf->bdq_prod_idx, qedf->bdq_secondary_prod);
3146 tmp = readw(qedf->bdq_secondary_prod);
3148 qed_ops->common->set_power_state(qedf->cdev, PCI_D0);
3150 /* Now that the dev_info struct has been filled in set the MAC
3151 * address
3153 ether_addr_copy(qedf->mac, qedf->dev_info.common.hw_mac);
3154 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "MAC address is %pM.\n",
3155 qedf->mac);
3158 * Set the WWNN and WWPN in the following way:
3160 * If the info we get from qed is non-zero then use that to set the
3161 * WWPN and WWNN. Otherwise fall back to use fcoe_wwn_from_mac() based
3162 * on the MAC address.
3164 if (qedf->dev_info.wwnn != 0 && qedf->dev_info.wwpn != 0) {
3165 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
3166 "Setting WWPN and WWNN from qed dev_info.\n");
3167 qedf->wwnn = qedf->dev_info.wwnn;
3168 qedf->wwpn = qedf->dev_info.wwpn;
3169 } else {
3170 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
3171 "Setting WWPN and WWNN using fcoe_wwn_from_mac().\n");
3172 qedf->wwnn = fcoe_wwn_from_mac(qedf->mac, 1, 0);
3173 qedf->wwpn = fcoe_wwn_from_mac(qedf->mac, 2, 0);
3175 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "WWNN=%016llx "
3176 "WWPN=%016llx.\n", qedf->wwnn, qedf->wwpn);
3178 sprintf(host_buf, "host_%d", host->host_no);
3179 qed_ops->common->set_name(qedf->cdev, host_buf);
3182 /* Set xid max values */
3183 qedf->max_scsi_xid = QEDF_MAX_SCSI_XID;
3184 qedf->max_els_xid = QEDF_MAX_ELS_XID;
3186 /* Allocate cmd mgr */
3187 qedf->cmd_mgr = qedf_cmd_mgr_alloc(qedf);
3188 if (!qedf->cmd_mgr) {
3189 QEDF_ERR(&(qedf->dbg_ctx), "Failed to allocate cmd mgr.\n");
3190 rc = -ENOMEM;
3191 goto err5;
3194 if (mode != QEDF_MODE_RECOVERY) {
3195 host->transportt = qedf_fc_transport_template;
3196 host->can_queue = QEDF_MAX_ELS_XID;
3197 host->max_lun = qedf_max_lun;
3198 host->max_cmd_len = QEDF_MAX_CDB_LEN;
3199 rc = scsi_add_host(host, &pdev->dev);
3200 if (rc)
3201 goto err6;
3204 memset(&params, 0, sizeof(params));
3205 params.mtu = 9000;
3206 ether_addr_copy(params.ll2_mac_address, qedf->mac);
3208 /* Start LL2 processing thread */
3209 snprintf(host_buf, 20, "qedf_%d_ll2", host->host_no);
3210 qedf->ll2_recv_wq =
3211 create_workqueue(host_buf);
3212 if (!qedf->ll2_recv_wq) {
3213 QEDF_ERR(&(qedf->dbg_ctx), "Failed to LL2 workqueue.\n");
3214 rc = -ENOMEM;
3215 goto err7;
3218 #ifdef CONFIG_DEBUG_FS
3219 qedf_dbg_host_init(&(qedf->dbg_ctx), qedf_debugfs_ops,
3220 qedf_dbg_fops);
3221 #endif
3223 /* Start LL2 */
3224 qed_ops->ll2->register_cb_ops(qedf->cdev, &qedf_ll2_cb_ops, qedf);
3225 rc = qed_ops->ll2->start(qedf->cdev, &params);
3226 if (rc) {
3227 QEDF_ERR(&(qedf->dbg_ctx), "Could not start Light L2.\n");
3228 goto err7;
3230 set_bit(QEDF_LL2_STARTED, &qedf->flags);
3232 /* Set initial FIP/FCoE VLAN to NULL */
3233 qedf->vlan_id = 0;
3236 * No need to setup fcoe_ctlr or fc_lport objects during recovery since
3237 * they were not reaped during the unload process.
3239 if (mode != QEDF_MODE_RECOVERY) {
3240 /* Setup imbedded fcoe controller */
3241 qedf_fcoe_ctlr_setup(qedf);
3243 /* Setup lport */
3244 rc = qedf_lport_setup(qedf);
3245 if (rc) {
3246 QEDF_ERR(&(qedf->dbg_ctx),
3247 "qedf_lport_setup failed.\n");
3248 goto err7;
3252 sprintf(host_buf, "qedf_%u_timer", qedf->lport->host->host_no);
3253 qedf->timer_work_queue =
3254 create_workqueue(host_buf);
3255 if (!qedf->timer_work_queue) {
3256 QEDF_ERR(&(qedf->dbg_ctx), "Failed to start timer "
3257 "workqueue.\n");
3258 rc = -ENOMEM;
3259 goto err7;
3262 /* DPC workqueue is not reaped during recovery unload */
3263 if (mode != QEDF_MODE_RECOVERY) {
3264 sprintf(host_buf, "qedf_%u_dpc",
3265 qedf->lport->host->host_no);
3266 qedf->dpc_wq = create_workqueue(host_buf);
3270 * GRC dump and sysfs parameters are not reaped during the recovery
3271 * unload process.
3273 if (mode != QEDF_MODE_RECOVERY) {
3274 qedf->grcdump_size =
3275 qed_ops->common->dbg_all_data_size(qedf->cdev);
3276 if (qedf->grcdump_size) {
3277 rc = qedf_alloc_grc_dump_buf(&qedf->grcdump,
3278 qedf->grcdump_size);
3279 if (rc) {
3280 QEDF_ERR(&(qedf->dbg_ctx),
3281 "GRC Dump buffer alloc failed.\n");
3282 qedf->grcdump = NULL;
3285 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
3286 "grcdump: addr=%p, size=%u.\n",
3287 qedf->grcdump, qedf->grcdump_size);
3289 qedf_create_sysfs_ctx_attr(qedf);
3291 /* Initialize I/O tracing for this adapter */
3292 spin_lock_init(&qedf->io_trace_lock);
3293 qedf->io_trace_idx = 0;
3296 init_completion(&qedf->flogi_compl);
3298 status = qed_ops->common->update_drv_state(qedf->cdev, true);
3299 if (status)
3300 QEDF_ERR(&(qedf->dbg_ctx),
3301 "Failed to send drv state to MFW.\n");
3303 memset(&link_params, 0, sizeof(struct qed_link_params));
3304 link_params.link_up = true;
3305 status = qed_ops->common->set_link(qedf->cdev, &link_params);
3306 if (status)
3307 QEDF_WARN(&(qedf->dbg_ctx), "set_link failed.\n");
3309 /* Start/restart discovery */
3310 if (mode == QEDF_MODE_RECOVERY)
3311 fcoe_ctlr_link_up(&qedf->ctlr);
3312 else
3313 fc_fabric_login(lport);
3315 /* All good */
3316 return 0;
3318 err7:
3319 if (qedf->ll2_recv_wq)
3320 destroy_workqueue(qedf->ll2_recv_wq);
3321 fc_remove_host(qedf->lport->host);
3322 scsi_remove_host(qedf->lport->host);
3323 #ifdef CONFIG_DEBUG_FS
3324 qedf_dbg_host_exit(&(qedf->dbg_ctx));
3325 #endif
3326 err6:
3327 qedf_cmd_mgr_free(qedf->cmd_mgr);
3328 err5:
3329 qed_ops->stop(qedf->cdev);
3330 err4:
3331 qedf_free_fcoe_pf_param(qedf);
3332 qedf_sync_free_irqs(qedf);
3333 err3:
3334 qed_ops->common->slowpath_stop(qedf->cdev);
3335 err2:
3336 qed_ops->common->remove(qedf->cdev);
3337 err1:
3338 scsi_host_put(lport->host);
3339 err0:
3340 return rc;
3343 static int qedf_probe(struct pci_dev *pdev, const struct pci_device_id *id)
3345 return __qedf_probe(pdev, QEDF_MODE_NORMAL);
3348 static void __qedf_remove(struct pci_dev *pdev, int mode)
3350 struct qedf_ctx *qedf;
3351 int rc;
3353 if (!pdev) {
3354 QEDF_ERR(NULL, "pdev is NULL.\n");
3355 return;
3358 qedf = pci_get_drvdata(pdev);
3361 * Prevent race where we're in board disable work and then try to
3362 * rmmod the module.
3364 if (test_bit(QEDF_UNLOADING, &qedf->flags)) {
3365 QEDF_ERR(&qedf->dbg_ctx, "Already removing PCI function.\n");
3366 return;
3369 if (mode != QEDF_MODE_RECOVERY)
3370 set_bit(QEDF_UNLOADING, &qedf->flags);
3372 /* Logoff the fabric to upload all connections */
3373 if (mode == QEDF_MODE_RECOVERY)
3374 fcoe_ctlr_link_down(&qedf->ctlr);
3375 else
3376 fc_fabric_logoff(qedf->lport);
3377 qedf_wait_for_upload(qedf);
3379 #ifdef CONFIG_DEBUG_FS
3380 qedf_dbg_host_exit(&(qedf->dbg_ctx));
3381 #endif
3383 /* Stop any link update handling */
3384 cancel_delayed_work_sync(&qedf->link_update);
3385 destroy_workqueue(qedf->link_update_wq);
3386 qedf->link_update_wq = NULL;
3388 if (qedf->timer_work_queue)
3389 destroy_workqueue(qedf->timer_work_queue);
3391 /* Stop Light L2 */
3392 clear_bit(QEDF_LL2_STARTED, &qedf->flags);
3393 qed_ops->ll2->stop(qedf->cdev);
3394 if (qedf->ll2_recv_wq)
3395 destroy_workqueue(qedf->ll2_recv_wq);
3397 /* Stop fastpath */
3398 qedf_sync_free_irqs(qedf);
3399 qedf_destroy_sb(qedf);
3402 * During recovery don't destroy OS constructs that represent the
3403 * physical port.
3405 if (mode != QEDF_MODE_RECOVERY) {
3406 qedf_free_grc_dump_buf(&qedf->grcdump);
3407 qedf_remove_sysfs_ctx_attr(qedf);
3409 /* Remove all SCSI/libfc/libfcoe structures */
3410 fcoe_ctlr_destroy(&qedf->ctlr);
3411 fc_lport_destroy(qedf->lport);
3412 fc_remove_host(qedf->lport->host);
3413 scsi_remove_host(qedf->lport->host);
3416 qedf_cmd_mgr_free(qedf->cmd_mgr);
3418 if (mode != QEDF_MODE_RECOVERY) {
3419 fc_exch_mgr_free(qedf->lport);
3420 fc_lport_free_stats(qedf->lport);
3422 /* Wait for all vports to be reaped */
3423 qedf_wait_for_vport_destroy(qedf);
3427 * Now that all connections have been uploaded we can stop the
3428 * rest of the qed operations
3430 qed_ops->stop(qedf->cdev);
3432 if (mode != QEDF_MODE_RECOVERY) {
3433 if (qedf->dpc_wq) {
3434 /* Stop general DPC handling */
3435 destroy_workqueue(qedf->dpc_wq);
3436 qedf->dpc_wq = NULL;
3440 /* Final shutdown for the board */
3441 qedf_free_fcoe_pf_param(qedf);
3442 if (mode != QEDF_MODE_RECOVERY) {
3443 qed_ops->common->set_power_state(qedf->cdev, PCI_D0);
3444 pci_set_drvdata(pdev, NULL);
3447 rc = qed_ops->common->update_drv_state(qedf->cdev, false);
3448 if (rc)
3449 QEDF_ERR(&(qedf->dbg_ctx),
3450 "Failed to send drv state to MFW.\n");
3452 qed_ops->common->slowpath_stop(qedf->cdev);
3453 qed_ops->common->remove(qedf->cdev);
3455 mempool_destroy(qedf->io_mempool);
3457 /* Only reap the Scsi_host on a real removal */
3458 if (mode != QEDF_MODE_RECOVERY)
3459 scsi_host_put(qedf->lport->host);
3462 static void qedf_remove(struct pci_dev *pdev)
3464 /* Check to make sure this function wasn't already disabled */
3465 if (!atomic_read(&pdev->enable_cnt))
3466 return;
3468 __qedf_remove(pdev, QEDF_MODE_NORMAL);
3471 void qedf_wq_grcdump(struct work_struct *work)
3473 struct qedf_ctx *qedf =
3474 container_of(work, struct qedf_ctx, grcdump_work.work);
3476 QEDF_ERR(&(qedf->dbg_ctx), "Collecting GRC dump.\n");
3477 qedf_capture_grc_dump(qedf);
3481 * Protocol TLV handler
3483 void qedf_get_protocol_tlv_data(void *dev, void *data)
3485 struct qedf_ctx *qedf = dev;
3486 struct qed_mfw_tlv_fcoe *fcoe = data;
3487 struct fc_lport *lport = qedf->lport;
3488 struct Scsi_Host *host = lport->host;
3489 struct fc_host_attrs *fc_host = shost_to_fc_host(host);
3490 struct fc_host_statistics *hst;
3492 /* Force a refresh of the fc_host stats including offload stats */
3493 hst = qedf_fc_get_host_stats(host);
3495 fcoe->qos_pri_set = true;
3496 fcoe->qos_pri = 3; /* Hard coded to 3 in driver */
3498 fcoe->ra_tov_set = true;
3499 fcoe->ra_tov = lport->r_a_tov;
3501 fcoe->ed_tov_set = true;
3502 fcoe->ed_tov = lport->e_d_tov;
3504 fcoe->npiv_state_set = true;
3505 fcoe->npiv_state = 1; /* NPIV always enabled */
3507 fcoe->num_npiv_ids_set = true;
3508 fcoe->num_npiv_ids = fc_host->npiv_vports_inuse;
3510 /* Certain attributes we only want to set if we've selected an FCF */
3511 if (qedf->ctlr.sel_fcf) {
3512 fcoe->switch_name_set = true;
3513 u64_to_wwn(qedf->ctlr.sel_fcf->switch_name, fcoe->switch_name);
3516 fcoe->port_state_set = true;
3517 /* For qedf we're either link down or fabric attach */
3518 if (lport->link_up)
3519 fcoe->port_state = QED_MFW_TLV_PORT_STATE_FABRIC;
3520 else
3521 fcoe->port_state = QED_MFW_TLV_PORT_STATE_OFFLINE;
3523 fcoe->link_failures_set = true;
3524 fcoe->link_failures = (u16)hst->link_failure_count;
3526 fcoe->fcoe_txq_depth_set = true;
3527 fcoe->fcoe_rxq_depth_set = true;
3528 fcoe->fcoe_rxq_depth = FCOE_PARAMS_NUM_TASKS;
3529 fcoe->fcoe_txq_depth = FCOE_PARAMS_NUM_TASKS;
3531 fcoe->fcoe_rx_frames_set = true;
3532 fcoe->fcoe_rx_frames = hst->rx_frames;
3534 fcoe->fcoe_tx_frames_set = true;
3535 fcoe->fcoe_tx_frames = hst->tx_frames;
3537 fcoe->fcoe_rx_bytes_set = true;
3538 fcoe->fcoe_rx_bytes = hst->fcp_input_megabytes * 1000000;
3540 fcoe->fcoe_tx_bytes_set = true;
3541 fcoe->fcoe_tx_bytes = hst->fcp_output_megabytes * 1000000;
3543 fcoe->crc_count_set = true;
3544 fcoe->crc_count = hst->invalid_crc_count;
3546 fcoe->tx_abts_set = true;
3547 fcoe->tx_abts = hst->fcp_packet_aborts;
3549 fcoe->tx_lun_rst_set = true;
3550 fcoe->tx_lun_rst = qedf->lun_resets;
3552 fcoe->abort_task_sets_set = true;
3553 fcoe->abort_task_sets = qedf->packet_aborts;
3555 fcoe->scsi_busy_set = true;
3556 fcoe->scsi_busy = qedf->busy;
3558 fcoe->scsi_tsk_full_set = true;
3559 fcoe->scsi_tsk_full = qedf->task_set_fulls;
3562 /* Generic TLV data callback */
3563 void qedf_get_generic_tlv_data(void *dev, struct qed_generic_tlvs *data)
3565 struct qedf_ctx *qedf;
3567 if (!dev) {
3568 QEDF_INFO(NULL, QEDF_LOG_EVT,
3569 "dev is NULL so ignoring get_generic_tlv_data request.\n");
3570 return;
3572 qedf = (struct qedf_ctx *)dev;
3574 memset(data, 0, sizeof(struct qed_generic_tlvs));
3575 ether_addr_copy(data->mac[0], qedf->mac);
3579 * Module Init/Remove
3582 static int __init qedf_init(void)
3584 int ret;
3586 /* If debug=1 passed, set the default log mask */
3587 if (qedf_debug == QEDF_LOG_DEFAULT)
3588 qedf_debug = QEDF_DEFAULT_LOG_MASK;
3591 * Check that default prio for FIP/FCoE traffic is between 0..7 if a
3592 * value has been set
3594 if (qedf_default_prio > -1)
3595 if (qedf_default_prio > 7) {
3596 qedf_default_prio = QEDF_DEFAULT_PRIO;
3597 QEDF_ERR(NULL, "FCoE/FIP priority out of range, resetting to %d.\n",
3598 QEDF_DEFAULT_PRIO);
3601 /* Print driver banner */
3602 QEDF_INFO(NULL, QEDF_LOG_INFO, "%s v%s.\n", QEDF_DESCR,
3603 QEDF_VERSION);
3605 /* Create kmem_cache for qedf_io_work structs */
3606 qedf_io_work_cache = kmem_cache_create("qedf_io_work_cache",
3607 sizeof(struct qedf_io_work), 0, SLAB_HWCACHE_ALIGN, NULL);
3608 if (qedf_io_work_cache == NULL) {
3609 QEDF_ERR(NULL, "qedf_io_work_cache is NULL.\n");
3610 goto err1;
3612 QEDF_INFO(NULL, QEDF_LOG_DISC, "qedf_io_work_cache=%p.\n",
3613 qedf_io_work_cache);
3615 qed_ops = qed_get_fcoe_ops();
3616 if (!qed_ops) {
3617 QEDF_ERR(NULL, "Failed to get qed fcoe operations\n");
3618 goto err1;
3621 #ifdef CONFIG_DEBUG_FS
3622 qedf_dbg_init("qedf");
3623 #endif
3625 qedf_fc_transport_template =
3626 fc_attach_transport(&qedf_fc_transport_fn);
3627 if (!qedf_fc_transport_template) {
3628 QEDF_ERR(NULL, "Could not register with FC transport\n");
3629 goto err2;
3632 qedf_fc_vport_transport_template =
3633 fc_attach_transport(&qedf_fc_vport_transport_fn);
3634 if (!qedf_fc_vport_transport_template) {
3635 QEDF_ERR(NULL, "Could not register vport template with FC "
3636 "transport\n");
3637 goto err3;
3640 qedf_io_wq = create_workqueue("qedf_io_wq");
3641 if (!qedf_io_wq) {
3642 QEDF_ERR(NULL, "Could not create qedf_io_wq.\n");
3643 goto err4;
3646 qedf_cb_ops.get_login_failures = qedf_get_login_failures;
3648 ret = pci_register_driver(&qedf_pci_driver);
3649 if (ret) {
3650 QEDF_ERR(NULL, "Failed to register driver\n");
3651 goto err5;
3654 return 0;
3656 err5:
3657 destroy_workqueue(qedf_io_wq);
3658 err4:
3659 fc_release_transport(qedf_fc_vport_transport_template);
3660 err3:
3661 fc_release_transport(qedf_fc_transport_template);
3662 err2:
3663 #ifdef CONFIG_DEBUG_FS
3664 qedf_dbg_exit();
3665 #endif
3666 qed_put_fcoe_ops();
3667 err1:
3668 return -EINVAL;
3671 static void __exit qedf_cleanup(void)
3673 pci_unregister_driver(&qedf_pci_driver);
3675 destroy_workqueue(qedf_io_wq);
3677 fc_release_transport(qedf_fc_vport_transport_template);
3678 fc_release_transport(qedf_fc_transport_template);
3679 #ifdef CONFIG_DEBUG_FS
3680 qedf_dbg_exit();
3681 #endif
3682 qed_put_fcoe_ops();
3684 kmem_cache_destroy(qedf_io_work_cache);
3687 MODULE_LICENSE("GPL");
3688 MODULE_DESCRIPTION("QLogic QEDF 25/40/50/100Gb FCoE Driver");
3689 MODULE_AUTHOR("QLogic Corporation");
3690 MODULE_VERSION(QEDF_VERSION);
3691 module_init(qedf_init);
3692 module_exit(qedf_cleanup);