1/*
2 * QLogic FCoE Offload Driver
3 * Copyright (c) 2016-2018 Cavium Inc.
4 *
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>
28
29const struct qed_fcoe_ops *qed_ops;
30
31static int qedf_probe(struct pci_dev *pdev, const struct pci_device_id *id);
32static void qedf_remove(struct pci_dev *pdev);
33
34/*
35 * Driver module parameters.
36 */
37static unsigned int qedf_dev_loss_tmo = 60;
38module_param_named(dev_loss_tmo, qedf_dev_loss_tmo, int, S_IRUGO);
39MODULE_PARM_DESC(dev_loss_tmo, " dev_loss_tmo setting for attached "
40 "remote ports (default 60)");
41
42uint qedf_debug = QEDF_LOG_INFO;
43module_param_named(debug, qedf_debug, uint, S_IRUGO);
44MODULE_PARM_DESC(debug, " Debug mask. Pass '1' to enable default debugging"
45 " mask");
46
47static uint qedf_fipvlan_retries = 60;
48module_param_named(fipvlan_retries, qedf_fipvlan_retries, int, S_IRUGO);
49MODULE_PARM_DESC(fipvlan_retries, " Number of FIP VLAN requests to attempt "
50 "before giving up (default 60)");
51
52static uint qedf_fallback_vlan = QEDF_FALLBACK_VLAN;
53module_param_named(fallback_vlan, qedf_fallback_vlan, int, S_IRUGO);
54MODULE_PARM_DESC(fallback_vlan, " VLAN ID to try if fip vlan request fails "
55 "(default 1002).");
56
57static int qedf_default_prio = -1;
58module_param_named(default_prio, qedf_default_prio, int, S_IRUGO);
59MODULE_PARM_DESC(default_prio, " Override 802.1q priority for FIP and FCoE"
60 " traffic (value between 0 and 7, default 3).");
61
62uint qedf_dump_frames;
63module_param_named(dump_frames, qedf_dump_frames, int, S_IRUGO | S_IWUSR);
64MODULE_PARM_DESC(dump_frames, " Print the skb data of FIP and FCoE frames "
65 "(default off)");
66
67static uint qedf_queue_depth;
68module_param_named(queue_depth, qedf_queue_depth, int, S_IRUGO);
69MODULE_PARM_DESC(queue_depth, " Sets the queue depth for all LUNs discovered "
70 "by the qedf driver. Default is 0 (use OS default).");
71
72uint qedf_io_tracing;
73module_param_named(io_tracing, qedf_io_tracing, int, S_IRUGO | S_IWUSR);
74MODULE_PARM_DESC(io_tracing, " Enable logging of SCSI requests/completions "
75 "into trace buffer. (default off).");
76
77static uint qedf_max_lun = MAX_FIBRE_LUNS;
78module_param_named(max_lun, qedf_max_lun, int, S_IRUGO);
79MODULE_PARM_DESC(max_lun, " Sets the maximum luns per target that the driver "
80 "supports. (default 0xffffffff)");
81
82uint qedf_link_down_tmo;
83module_param_named(link_down_tmo, qedf_link_down_tmo, int, S_IRUGO);
84MODULE_PARM_DESC(link_down_tmo, " Delays informing the fcoe transport that the "
85 "link is down by N seconds.");
86
87bool qedf_retry_delay;
88module_param_named(retry_delay, qedf_retry_delay, bool, S_IRUGO | S_IWUSR);
89MODULE_PARM_DESC(retry_delay, " Enable/disable handling of FCP_RSP IU retry "
90 "delay handling (default off).");
91
92static bool qedf_dcbx_no_wait;
93module_param_named(dcbx_no_wait, qedf_dcbx_no_wait, bool, S_IRUGO | S_IWUSR);
94MODULE_PARM_DESC(dcbx_no_wait, " Do not wait for DCBX convergence to start "
95 "sending FIP VLAN requests on link up (Default: off).");
96
97static uint qedf_dp_module;
98module_param_named(dp_module, qedf_dp_module, uint, S_IRUGO);
99MODULE_PARM_DESC(dp_module, " bit flags control for verbose printk passed "
100 "qed module during probe.");
101
102static uint qedf_dp_level = QED_LEVEL_NOTICE;
103module_param_named(dp_level, qedf_dp_level, uint, S_IRUGO);
104MODULE_PARM_DESC(dp_level, " printk verbosity control passed to qed module "
105 "during probe (0-3: 0 more verbose).");
106
107struct workqueue_struct *qedf_io_wq;
108
109static struct fcoe_percpu_s qedf_global;
110static DEFINE_SPINLOCK(qedf_global_lock);
111
112static struct kmem_cache *qedf_io_work_cache;
113
114void qedf_set_vlan_id(struct qedf_ctx *qedf, int vlan_id)
115{
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);
120}
121
122/* Returns true if we have a valid vlan, false otherwise */
123static bool qedf_initiate_fipvlan_req(struct qedf_ctx *qedf)
124{
125 int rc;
126
127 if (atomic_read(&qedf->link_state) != QEDF_LINK_UP) {
128 QEDF_ERR(&(qedf->dbg_ctx), "Link not up.\n");
129 return false;
130 }
131
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;
144 }
145 }
146
147 return false;
148}
149
150static void qedf_handle_link_update(struct work_struct *work)
151{
152 struct qedf_ctx *qedf =
153 container_of(work, struct qedf_ctx, link_update.work);
154 int rc;
155
156 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "Entered.\n");
157
158 if (atomic_read(&qedf->link_state) == QEDF_LINK_UP) {
159 rc = qedf_initiate_fipvlan_req(qedf);
160 if (rc)
161 return;
162 /*
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
166 */
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);
171
172 /*
173 * Zero out data_src_addr so we'll update it with the new
174 * lport port_id
175 */
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) {
179 /*
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.
183 */
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;
191 }
192}
193
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
197static void qedf_set_data_src_addr(struct qedf_ctx *qedf, struct fc_frame *fp)
198{
199 u8 *granted_mac;
200 struct fc_frame_header *fh = fc_frame_header_get(fp);
201 u8 fc_map[3];
202 int method = 0;
203
204 /* Get granted MAC address from FIP FLOGI payload */
205 granted_mac = fr_cb(fp)->granted_mac;
206
207 /*
208 * We set the source MAC for FCoE traffic based on the Granted MAC
209 * address from the switch.
210 *
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.
216 */
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;
232 }
233
234 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
235 "QEDF data_src_mac=%pM method=%d.\n", qedf->data_src_addr, method);
236}
237
238static void qedf_flogi_resp(struct fc_seq *seq, struct fc_frame *fp,
239 void *arg)
240{
241 struct fc_exch *exch = fc_seq_exch(seq);
242 struct fc_lport *lport = exch->lp;
243 struct qedf_ctx *qedf = lport_priv(lport);
244
245 if (!qedf) {
246 QEDF_ERR(NULL, "qedf is NULL.\n");
247 return;
248 }
249
250 /*
251 * If ERR_PTR is set then don't try to stat anything as it will cause
252 * a crash when we access fp.
253 */
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;
258 }
259
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);
266 }
267
268 /* Complete flogi_compl so we can proceed to sending ADISCs */
269 complete(&qedf->flogi_compl);
270
271skip_stat:
272 /* Report response to libfc */
273 fc_lport_flogi_resp(seq, fp, lport);
274}
275
276static 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)
282{
283 struct qedf_ctx *qedf = lport_priv(lport);
284
285 /*
286 * Intercept FLOGI for statistic purposes. Note we use the resp
287 * callback to tell if this is really a flogi.
288 */
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);
293 }
294
295 return fc_elsct_send(lport, did, fp, op, resp, arg, timeout);
296}
297
298int qedf_send_flogi(struct qedf_ctx *qedf)
299{
300 struct fc_lport *lport;
301 struct fc_frame *fp;
302
303 lport = qedf->lport;
304
305 if (!lport->tt.elsct_send)
306 return -EINVAL;
307
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;
312 }
313
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);
318
319 init_completion(&qedf->flogi_compl);
320
321 return 0;
322}
323
324struct qedf_tmp_rdata_item {
325 struct fc_rport_priv *rdata;
326 struct list_head list;
327};
328
329/*
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().
333 */
334static void qedf_link_recovery(struct work_struct *work)
335{
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;
345
346 INIT_LIST_HEAD(&rdata_login_list);
347
348 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
349 "Link down tmo did not expire.\n");
350
351 /*
352 * Essentially reset the fcoe_ctlr here without affecting the state
353 * of the libfc structs.
354 */
355 qedf->ctlr.state = FIP_ST_LINK_WAIT;
356 fcoe_ctlr_link_down(&qedf->ctlr);
357
358 /*
359 * Bring the link up before we send the fipvlan request so libfcoe
360 * can select a new fcf in parallel
361 */
362 fcoe_ctlr_link_up(&qedf->ctlr);
363
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);
370
371 /*
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.
374 */
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;
380 }
381 msleep(500);
382 retries--;
383 }
384
385 if (retries < 1) {
386 QEDF_ERR(&(qedf->dbg_ctx), "Exhausted retries waiting for "
387 "FCF selection.\n");
388 return;
389 }
390
391 rval = qedf_send_flogi(qedf);
392 if (rval)
393 return;
394
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;
401 }
402
403 /*
404 * Call lport->tt.rport_login which will cause libfc to send an
405 * ADISC since the rport is in state ready.
406 */
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);
421 }
422 rcu_read_unlock();
423 /*
424 * Do the fc_rport_login outside of the rcu lock so we don't take a
425 * mutex in an atomic context.
426 */
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);
433 }
434}
435
436static void qedf_update_link_speed(struct qedf_ctx *qedf,
437 struct qed_link_output *link)
438{
439 struct fc_lport *lport = qedf->lport;
440
441 lport->link_speed = FC_PORTSPEED_UNKNOWN;
442 lport->link_supported_speeds = FC_PORTSPEED_UNKNOWN;
443
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;
464 }
465
466 /*
467 * Set supported link speed by querying the supported
468 * capabilities of the link.
469 */
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;
481}
482
483static void qedf_link_update(void *dev, struct qed_link_output *link)
484{
485 struct qedf_ctx *qedf = (struct qedf_ctx *)dev;
486
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;
492 }
493 QEDF_ERR(&(qedf->dbg_ctx), "LINK UP (%d GB/s).\n",
494 link->speed / 1000);
495
496 /* Cancel any pending link down work */
497 cancel_delayed_work(&qedf->link_update);
498
499 atomic_set(&qedf->link_state, QEDF_LINK_UP);
500 qedf_update_link_speed(qedf, link);
501
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);
513 }
514
515 } else {
516 QEDF_ERR(&(qedf->dbg_ctx), "LINK DOWN.\n");
517
518 atomic_set(&qedf->link_state, QEDF_LINK_DOWN);
519 atomic_set(&qedf->dcbx, QEDF_DCBX_PENDING);
520 /*
521 * Flag that we're waiting for the link to come back up before
522 * informing the fcoe layer of the event.
523 */
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);
528 }
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);
533 }
534}
535
536
537static void qedf_dcbx_handler(void *dev, struct qed_dcbx_get *get, u32 mib_type)
538{
539 struct qedf_ctx *qedf = (struct qedf_ctx *)dev;
540 u8 tmp_prio;
541
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);
545
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;
552 }
553
554 atomic_set(&qedf->dcbx, QEDF_DCBX_DONE);
555
556 /*
557 * Set the 8021q priority in the following manner:
558 *
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
562 */
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;
573
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);
583 }
584 }
585
586}
587
588static u32 qedf_get_login_failures(void *cookie)
589{
590 struct qedf_ctx *qedf;
591
592 qedf = (struct qedf_ctx *)cookie;
593 return qedf->flogi_failed;
594}
595
596static struct qed_fcoe_cb_ops qedf_cb_ops = {
597 {
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,
602 }
603};
604
605/*
606 * Various transport templates.
607 */
608
609static struct scsi_transport_template *qedf_fc_transport_template;
610static struct scsi_transport_template *qedf_fc_vport_transport_template;
611
612/*
613 * SCSI EH handlers
614 */
615static int qedf_eh_abort(struct scsi_cmnd *sc_cmd)
616{
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;
625
626 if (fc_remote_port_chkready(rport)) {
627 QEDF_ERR(NULL, "rport not ready\n");
628 goto out;
629 }
630
631 lport = shost_priv(sc_cmd->device->host);
632 qedf = (struct qedf_ctx *)lport_priv(lport);
633
634 if ((lport->state != LPORT_ST_READY) || !(lport->link_up)) {
635 QEDF_ERR(&(qedf->dbg_ctx), "link not ready.\n");
636 goto out;
637 }
638
639 fcport = (struct qedf_rport *)&rp[1];
640
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;
646 }
647
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);
650
651 if (qedf->stop_io_on_error) {
652 qedf_stop_all_io(qedf);
653 rc = SUCCESS;
654 goto out;
655 }
656
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;
662 }
663
664 wait_for_completion(&io_req->abts_done);
665
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) {
669 /*
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
673 */
674 rc = SUCCESS;
675 } else {
676 /* If the abort and cleanup failed then return a failure */
677 rc = FAILED;
678 }
679
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);
686
687out:
688 return rc;
689}
690
691static int qedf_eh_target_reset(struct scsi_cmnd *sc_cmd)
692{
693 QEDF_ERR(NULL, "TARGET RESET Issued...");
694 return qedf_initiate_tmf(sc_cmd, FCP_TMF_TGT_RESET);
695}
696
697static int qedf_eh_device_reset(struct scsi_cmnd *sc_cmd)
698{
699 QEDF_ERR(NULL, "LUN RESET Issued...\n");
700 return qedf_initiate_tmf(sc_cmd, FCP_TMF_LUN_RESET);
701}
702
703void qedf_wait_for_upload(struct qedf_ctx *qedf)
704{
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);
712 }
713}
714
715/* Performs soft reset of qedf_ctx by simulating a link down/up */
716static void qedf_ctx_soft_reset(struct fc_lport *lport)
717{
718 struct qedf_ctx *qedf;
719
720 if (lport->vport) {
721 QEDF_ERR(NULL, "Cannot issue host reset on NPIV port.\n");
722 return;
723 }
724
725 qedf = lport_priv(lport);
726
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,
730 0);
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,
735 0);
736}
737
738/* Reset the host by gracefully logging out and then logging back in */
739static int qedf_eh_host_reset(struct scsi_cmnd *sc_cmd)
740{
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;
747
748 rval = fc_remote_port_chkready(rport);
749
750 if (rval) {
751 QEDF_ERR(NULL, "device_reset rport not ready\n");
752 return FAILED;
753 }
754
755 if (fcport == NULL) {
756 QEDF_ERR(NULL, "device_reset: rport is NULL\n");
757 return FAILED;
758 }
759
760 lport = shost_priv(sc_cmd->device->host);
761 qedf = lport_priv(lport);
762
763 if (atomic_read(&qedf->link_state) == QEDF_LINK_DOWN ||
764 test_bit(QEDF_UNLOADING, &qedf->flags))
765 return FAILED;
766
767 QEDF_ERR(&(qedf->dbg_ctx), "HOST RESET Issued...");
768
769 qedf_ctx_soft_reset(lport);
770
771 return SUCCESS;
772}
773
774static int qedf_slave_configure(struct scsi_device *sdev)
775{
776 if (qedf_queue_depth) {
777 scsi_change_queue_depth(sdev, qedf_queue_depth);
778 }
779
780 return 0;
781}
782
783static 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 .max_sectors = 0xffff,
789 .queuecommand = qedf_queuecommand,
790 .shost_attrs = qedf_host_attrs,
791 .eh_abort_handler = qedf_eh_abort,
792 .eh_device_reset_handler = qedf_eh_device_reset, /* lun reset */
793 .eh_target_reset_handler = qedf_eh_target_reset, /* target reset */
794 .eh_host_reset_handler = qedf_eh_host_reset,
795 .slave_configure = qedf_slave_configure,
796 .dma_boundary = QED_HW_DMA_BOUNDARY,
797 .sg_tablesize = QEDF_MAX_BDS_PER_CMD,
798 .can_queue = FCOE_PARAMS_NUM_TASKS,
799 .change_queue_depth = scsi_change_queue_depth,
800};
801
802static int qedf_get_paged_crc_eof(struct sk_buff *skb, int tlen)
803{
804 int rc;
805
806 spin_lock(&qedf_global_lock);
807 rc = fcoe_get_paged_crc_eof(skb, tlen, &qedf_global);
808 spin_unlock(&qedf_global_lock);
809
810 return rc;
811}
812
813static struct qedf_rport *qedf_fcport_lookup(struct qedf_ctx *qedf, u32 port_id)
814{
815 struct qedf_rport *fcport;
816 struct fc_rport_priv *rdata;
817
818 rcu_read_lock();
819 list_for_each_entry_rcu(fcport, &qedf->fcports, peers) {
820 rdata = fcport->rdata;
821 if (rdata == NULL)
822 continue;
823 if (rdata->ids.port_id == port_id) {
824 rcu_read_unlock();
825 return fcport;
826 }
827 }
828 rcu_read_unlock();
829
830 /* Return NULL to caller to let them know fcport was not found */
831 return NULL;
832}
833
834/* Transmits an ELS frame over an offloaded session */
835static int qedf_xmit_l2_frame(struct qedf_rport *fcport, struct fc_frame *fp)
836{
837 struct fc_frame_header *fh;
838 int rc = 0;
839
840 fh = fc_frame_header_get(fp);
841 if ((fh->fh_type == FC_TYPE_ELS) &&
842 (fh->fh_r_ctl == FC_RCTL_ELS_REQ)) {
843 switch (fc_frame_payload_op(fp)) {
844 case ELS_ADISC:
845 qedf_send_adisc(fcport, fp);
846 rc = 1;
847 break;
848 }
849 }
850
851 return rc;
852}
853
854/**
855 * qedf_xmit - qedf FCoE frame transmit function
856 *
857 */
858static int qedf_xmit(struct fc_lport *lport, struct fc_frame *fp)
859{
860 struct fc_lport *base_lport;
861 struct qedf_ctx *qedf;
862 struct ethhdr *eh;
863 struct fcoe_crc_eof *cp;
864 struct sk_buff *skb;
865 struct fc_frame_header *fh;
866 struct fcoe_hdr *hp;
867 u8 sof, eof;
868 u32 crc;
869 unsigned int hlen, tlen, elen;
870 int wlen;
871 struct fc_stats *stats;
872 struct fc_lport *tmp_lport;
873 struct fc_lport *vn_port = NULL;
874 struct qedf_rport *fcport;
875 int rc;
876 u16 vlan_tci = 0;
877
878 qedf = (struct qedf_ctx *)lport_priv(lport);
879
880 fh = fc_frame_header_get(fp);
881 skb = fp_skb(fp);
882
883 /* Filter out traffic to other NPIV ports on the same host */
884 if (lport->vport)
885 base_lport = shost_priv(vport_to_shost(lport->vport));
886 else
887 base_lport = lport;
888
889 /* Flag if the destination is the base port */
890 if (base_lport->port_id == ntoh24(fh->fh_d_id)) {
891 vn_port = base_lport;
892 } else {
893 /* Got through the list of vports attached to the base_lport
894 * and see if we have a match with the destination address.
895 */
896 list_for_each_entry(tmp_lport, &base_lport->vports, list) {
897 if (tmp_lport->port_id == ntoh24(fh->fh_d_id)) {
898 vn_port = tmp_lport;
899 break;
900 }
901 }
902 }
903 if (vn_port && ntoh24(fh->fh_d_id) != FC_FID_FLOGI) {
904 struct fc_rport_priv *rdata = NULL;
905
906 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_LL2,
907 "Dropping FCoE frame to %06x.\n", ntoh24(fh->fh_d_id));
908 kfree_skb(skb);
909 rdata = fc_rport_lookup(lport, ntoh24(fh->fh_d_id));
910 if (rdata)
911 rdata->retries = lport->max_rport_retry_count;
912 return -EINVAL;
913 }
914 /* End NPIV filtering */
915
916 if (!qedf->ctlr.sel_fcf) {
917 kfree_skb(skb);
918 return 0;
919 }
920
921 if (!test_bit(QEDF_LL2_STARTED, &qedf->flags)) {
922 QEDF_WARN(&(qedf->dbg_ctx), "LL2 not started\n");
923 kfree_skb(skb);
924 return 0;
925 }
926
927 if (atomic_read(&qedf->link_state) != QEDF_LINK_UP) {
928 QEDF_WARN(&(qedf->dbg_ctx), "qedf link down\n");
929 kfree_skb(skb);
930 return 0;
931 }
932
933 if (unlikely(fh->fh_r_ctl == FC_RCTL_ELS_REQ)) {
934 if (fcoe_ctlr_els_send(&qedf->ctlr, lport, skb))
935 return 0;
936 }
937
938 /* Check to see if this needs to be sent on an offloaded session */
939 fcport = qedf_fcport_lookup(qedf, ntoh24(fh->fh_d_id));
940
941 if (fcport && test_bit(QEDF_RPORT_SESSION_READY, &fcport->flags)) {
942 rc = qedf_xmit_l2_frame(fcport, fp);
943 /*
944 * If the frame was successfully sent over the middle path
945 * then do not try to also send it over the LL2 path
946 */
947 if (rc)
948 return 0;
949 }
950
951 sof = fr_sof(fp);
952 eof = fr_eof(fp);
953
954 elen = sizeof(struct ethhdr);
955 hlen = sizeof(struct fcoe_hdr);
956 tlen = sizeof(struct fcoe_crc_eof);
957 wlen = (skb->len - tlen + sizeof(crc)) / FCOE_WORD_TO_BYTE;
958
959 skb->ip_summed = CHECKSUM_NONE;
960 crc = fcoe_fc_crc(fp);
961
962 /* copy port crc and eof to the skb buff */
963 if (skb_is_nonlinear(skb)) {
964 skb_frag_t *frag;
965
966 if (qedf_get_paged_crc_eof(skb, tlen)) {
967 kfree_skb(skb);
968 return -ENOMEM;
969 }
970 frag = &skb_shinfo(skb)->frags[skb_shinfo(skb)->nr_frags - 1];
971 cp = kmap_atomic(skb_frag_page(frag)) + frag->page_offset;
972 } else {
973 cp = skb_put(skb, tlen);
974 }
975
976 memset(cp, 0, sizeof(*cp));
977 cp->fcoe_eof = eof;
978 cp->fcoe_crc32 = cpu_to_le32(~crc);
979 if (skb_is_nonlinear(skb)) {
980 kunmap_atomic(cp);
981 cp = NULL;
982 }
983
984
985 /* adjust skb network/transport offsets to match mac/fcoe/port */
986 skb_push(skb, elen + hlen);
987 skb_reset_mac_header(skb);
988 skb_reset_network_header(skb);
989 skb->mac_len = elen;
990 skb->protocol = htons(ETH_P_FCOE);
991
992 /*
993 * Add VLAN tag to non-offload FCoE frame based on current stored VLAN
994 * for FIP/FCoE traffic.
995 */
996 __vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), qedf->vlan_id);
997
998 /* fill up mac and fcoe headers */
999 eh = eth_hdr(skb);
1000 eh->h_proto = htons(ETH_P_FCOE);
1001 if (qedf->ctlr.map_dest)
1002 fc_fcoe_set_mac(eh->h_dest, fh->fh_d_id);
1003 else
1004 /* insert GW address */
1005 ether_addr_copy(eh->h_dest, qedf->ctlr.dest_addr);
1006
1007 /* Set the source MAC address */
1008 ether_addr_copy(eh->h_source, qedf->data_src_addr);
1009
1010 hp = (struct fcoe_hdr *)(eh + 1);
1011 memset(hp, 0, sizeof(*hp));
1012 if (FC_FCOE_VER)
1013 FC_FCOE_ENCAPS_VER(hp, FC_FCOE_VER);
1014 hp->fcoe_sof = sof;
1015
1016 /*update tx stats */
1017 stats = per_cpu_ptr(lport->stats, get_cpu());
1018 stats->TxFrames++;
1019 stats->TxWords += wlen;
1020 put_cpu();
1021
1022 /* Get VLAN ID from skb for printing purposes */
1023 __vlan_hwaccel_get_tag(skb, &vlan_tci);
1024
1025 /* send down to lld */
1026 fr_dev(fp) = lport;
1027 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_LL2, "FCoE frame send: "
1028 "src=%06x dest=%06x r_ctl=%x type=%x vlan=%04x.\n",
1029 ntoh24(fh->fh_s_id), ntoh24(fh->fh_d_id), fh->fh_r_ctl, fh->fh_type,
1030 vlan_tci);
1031 if (qedf_dump_frames)
1032 print_hex_dump(KERN_WARNING, "fcoe: ", DUMP_PREFIX_OFFSET, 16,
1033 1, skb->data, skb->len, false);
1034 qed_ops->ll2->start_xmit(qedf->cdev, skb, 0);
1035
1036 return 0;
1037}
1038
1039static int qedf_alloc_sq(struct qedf_ctx *qedf, struct qedf_rport *fcport)
1040{
1041 int rval = 0;
1042 u32 *pbl;
1043 dma_addr_t page;
1044 int num_pages;
1045
1046 /* Calculate appropriate queue and PBL sizes */
1047 fcport->sq_mem_size = SQ_NUM_ENTRIES * sizeof(struct fcoe_wqe);
1048 fcport->sq_mem_size = ALIGN(fcport->sq_mem_size, QEDF_PAGE_SIZE);
1049 fcport->sq_pbl_size = (fcport->sq_mem_size / QEDF_PAGE_SIZE) *
1050 sizeof(void *);
1051 fcport->sq_pbl_size = fcport->sq_pbl_size + QEDF_PAGE_SIZE;
1052
1053 fcport->sq = dma_alloc_coherent(&qedf->pdev->dev, fcport->sq_mem_size,
1054 &fcport->sq_dma, GFP_KERNEL);
1055 if (!fcport->sq) {
1056 QEDF_WARN(&(qedf->dbg_ctx), "Could not allocate send queue.\n");
1057 rval = 1;
1058 goto out;
1059 }
1060
1061 fcport->sq_pbl = dma_alloc_coherent(&qedf->pdev->dev,
1062 fcport->sq_pbl_size,
1063 &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;
1068 }
1069
1070 /* Create PBL */
1071 num_pages = fcport->sq_mem_size / QEDF_PAGE_SIZE;
1072 page = fcport->sq_dma;
1073 pbl = (u32 *)fcport->sq_pbl;
1074
1075 while (num_pages--) {
1076 *pbl = U64_LO(page);
1077 pbl++;
1078 *pbl = U64_HI(page);
1079 pbl++;
1080 page += QEDF_PAGE_SIZE;
1081 }
1082
1083 return rval;
1084
1085out_free_sq:
1086 dma_free_coherent(&qedf->pdev->dev, fcport->sq_mem_size, fcport->sq,
1087 fcport->sq_dma);
1088out:
1089 return rval;
1090}
1091
1092static void qedf_free_sq(struct qedf_ctx *qedf, struct qedf_rport *fcport)
1093{
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);
1100}
1101
1102static int qedf_offload_connection(struct qedf_ctx *qedf,
1103 struct qedf_rport *fcport)
1104{
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));
1109
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;
1119 }
1120
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);
1124
1125 memset(&conn_info, 0, sizeof(struct qed_fcoe_params_offload));
1126
1127 /* Fill in the offload connection info */
1128 conn_info.sq_pbl_addr = fcport->sq_pbl_dma;
1129
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));
1133
1134 /* Need to use our FCoE MAC for the offload session */
1135 ether_addr_copy(conn_info.src_mac, qedf->data_src_addr);
1136
1137 ether_addr_copy(conn_info.dst_mac, qedf->ctlr.dest_addr);
1138
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;
1143
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);
1151
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;
1158
1159 conn_info.max_conc_seqs_c3 = fcport->rdata->max_seq;
1160
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;
1166
1167 conn_info.def_q_idx = 0; /* Default index for send queue? */
1168
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;
1179 }
1180
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);
1190
1191 spin_lock_init(&fcport->rport_lock);
1192 atomic_set(&fcport->free_sqes, total_sqe);
1193 return 0;
1194out_free_conn:
1195 qed_ops->release_conn(qedf->cdev, fcport->handle);
1196out:
1197 return rval;
1198}
1199
1200#define QEDF_TERM_BUFF_SIZE 10
1201static void qedf_upload_connection(struct qedf_ctx *qedf,
1202 struct qedf_rport *fcport)
1203{
1204 void *term_params;
1205 dma_addr_t term_params_dma;
1206
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.
1210 */
1211 term_params = dma_alloc_coherent(&qedf->pdev->dev, QEDF_TERM_BUFF_SIZE,
1212 &term_params_dma, GFP_KERNEL);
1213
1214 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_CONN, "Uploading connection "
1215 "port_id=%06x.\n", fcport->rdata->ids.port_id);
1216
1217 qed_ops->destroy_conn(qedf->cdev, fcport->handle, term_params_dma);
1218 qed_ops->release_conn(qedf->cdev, fcport->handle);
1219
1220 dma_free_coherent(&qedf->pdev->dev, QEDF_TERM_BUFF_SIZE, term_params,
1221 term_params_dma);
1222}
1223
1224static void qedf_cleanup_fcport(struct qedf_ctx *qedf,
1225 struct qedf_rport *fcport)
1226{
1227 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_CONN, "Cleaning up portid=%06x.\n",
1228 fcport->rdata->ids.port_id);
1229
1230 /* Flush any remaining i/o's before we upload the connection */
1231 qedf_flush_active_ios(fcport, -1);
1232
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;
1238}
1239
1240/**
1241 * This event_callback is called after successful completion of libfc
1242 * initiated target login. qedf can proceed with initiating the session
1243 * establishment.
1244 */
1245static void qedf_rport_event_handler(struct fc_lport *lport,
1246 struct fc_rport_priv *rdata,
1247 enum fc_rport_event event)
1248{
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;
1256
1257 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "event = %d, "
1258 "port_id = 0x%x\n", event, rdata->ids.port_id);
1259
1260 switch (event) {
1261 case RPORT_EV_READY:
1262 if (!rport) {
1263 QEDF_WARN(&(qedf->dbg_ctx), "rport is NULL.\n");
1264 break;
1265 }
1266
1267 rp = rport->dd_data;
1268 fcport = (struct qedf_rport *)&rp[1];
1269 fcport->qedf = qedf;
1270
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;
1276 }
1277
1278 /*
1279 * Don't try to offload the session again. Can happen when we
1280 * get an ADISC
1281 */
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;
1287 }
1288
1289 if (rport->port_id == FC_FID_DIR_SERV) {
1290 /*
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
1295 */
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;
1300 }
1301
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;
1306 }
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;
1311 }
1312
1313 fcport->rdata = rdata;
1314 fcport->rport = rport;
1315
1316 rval = qedf_alloc_sq(qedf, fcport);
1317 if (rval) {
1318 qedf_cleanup_fcport(qedf, fcport);
1319 break;
1320 }
1321
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;
1332 }
1333
1334 rval = qedf_offload_connection(qedf, fcport);
1335 if (rval) {
1336 qedf_cleanup_fcport(qedf, fcport);
1337 break;
1338 }
1339
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);
1344
1345 /*
1346 * Set the session ready bit to let everyone know that this
1347 * connection is ready for I/O
1348 */
1349 set_bit(QEDF_RPORT_SESSION_READY, &fcport->flags);
1350 atomic_inc(&qedf->num_offloads);
1351
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;
1359
1360 if (!rport) {
1361 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
1362 "port_id=%x - rport notcreated Yet!!\n", port_id);
1363 break;
1364 }
1365 rp = rport->dd_data;
1366 /*
1367 * Perform session upload. Note that rdata->peers is already
1368 * removed from disc->rports list before we get this event.
1369 */
1370 fcport = (struct qedf_rport *)&rp[1];
1371
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);
1376
1377 /*
1378 * Remove fcport to list of qedf_ctx list of offloaded
1379 * ports
1380 */
1381 spin_lock_irqsave(&qedf->hba_lock, flags);
1382 list_del_rcu(&fcport->peers);
1383 spin_unlock_irqrestore(&qedf->hba_lock, flags);
1384
1385 clear_bit(QEDF_RPORT_UPLOADING_CONNECTION,
1386 &fcport->flags);
1387 atomic_dec(&qedf->num_offloads);
1388 }
1389
1390 break;
1391
1392 case RPORT_EV_NONE:
1393 break;
1394 }
1395}
1396
1397static void qedf_abort_io(struct fc_lport *lport)
1398{
1399 /* NO-OP but need to fill in the template */
1400}
1401
1402static void qedf_fcp_cleanup(struct fc_lport *lport)
1403{
1404 /*
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.
1408 */
1409}
1410
1411static 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,
1417};
1418
1419static void qedf_fcoe_ctlr_setup(struct qedf_ctx *qedf)
1420{
1421 fcoe_ctlr_init(&qedf->ctlr, FIP_MODE_AUTO);
1422
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);
1426}
1427
1428static void qedf_setup_fdmi(struct qedf_ctx *qedf)
1429{
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;
1434
1435 /*
1436 * fdmi_enabled needs to be set for libfc to execute FDMI registration.
1437 */
1438 lport->fdmi_enabled = 1;
1439
1440 /*
1441 * Setup the necessary fc_host attributes to that will be used to fill
1442 * in the FDMI information.
1443 */
1444
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]);
1451
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");
1460
1461 snprintf(fc_host->manufacturer,
1462 sizeof(fc_host->manufacturer), "%s", "Cavium Inc.");
1463
1464 snprintf(fc_host->model, sizeof(fc_host->model), "%s", "QL41000");
1465
1466 snprintf(fc_host->model_description, sizeof(fc_host->model_description),
1467 "%s", "QLogic FastLinQ QL41000 Series 10/25/40/50GGbE Controller"
1468 "(FCoE)");
1469
1470 snprintf(fc_host->hardware_version, sizeof(fc_host->hardware_version),
1471 "Rev %d", qedf->pdev->revision);
1472
1473 snprintf(fc_host->driver_version, sizeof(fc_host->driver_version),
1474 "%s", QEDF_VERSION);
1475
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);
1479}
1480
1481static int qedf_lport_setup(struct qedf_ctx *qedf)
1482{
1483 struct fc_lport *lport = qedf->lport;
1484
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;
1493
1494 /* Set NPIV support */
1495 lport->does_npiv = 1;
1496 fc_host_max_npiv_vports(lport->host) = QEDF_MAX_NPIV;
1497
1498 fc_set_wwnn(lport, qedf->wwnn);
1499 fc_set_wwpn(lport, qedf->wwpn);
1500
1501 fcoe_libfc_config(lport, &qedf->ctlr, &qedf_lport_template, 0);
1502
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);
1506
1507 if (fc_lport_init_stats(lport))
1508 return -ENOMEM;
1509
1510 /* Finish lport config */
1511 fc_lport_config(lport);
1512
1513 /* Set max frame size */
1514 fc_set_mfs(lport, QEDF_MFS);
1515 fc_host_maxframe_size(lport->host) = lport->mfs;
1516
1517 /* Set default dev_loss_tmo based on module parameter */
1518 fc_host_dev_loss_tmo(lport->host) = qedf_dev_loss_tmo;
1519
1520 /* Set symbolic node name */
1521 snprintf(fc_host_symbolic_name(lport->host), 256,
1522 "QLogic %s v%s", QEDF_MODULE_NAME, QEDF_VERSION);
1523
1524 qedf_setup_fdmi(qedf);
1525
1526 return 0;
1527}
1528
1529/*
1530 * NPIV functions
1531 */
1532
1533static int qedf_vport_libfc_config(struct fc_vport *vport,
1534 struct fc_lport *lport)
1535{
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 */
1546
1547 /* Allocate stats for vport */
1548 if (fc_lport_init_stats(lport))
1549 return -ENOMEM;
1550
1551 /* Finish lport config */
1552 fc_lport_config(lport);
1553
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;
1560
1561 return 0;
1562}
1563
1564static int qedf_vport_create(struct fc_vport *vport, bool disabled)
1565{
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;
1571
1572 char buf[32];
1573 int rc = 0;
1574
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;
1581 }
1582
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;
1588 }
1589
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;
1596 }
1597
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);
1601
1602 /* Copy some fields from base_qedf */
1603 vport_qedf = lport_priv(vn_port);
1604 memcpy(vport_qedf, base_qedf, sizeof(struct qedf_ctx));
1605
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);
1614
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;
1620 }
1621
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;
1626
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;
1632
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;
1637 }
1638
1639 /* Set default dev_loss_tmo based on module parameter */
1640 fc_host_dev_loss_tmo(vn_port->host) = qedf_dev_loss_tmo;
1641
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);
1650
1651
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);
1656
1657 /* Set max frame size */
1658 fc_set_mfs(vn_port, QEDF_MFS);
1659
1660 fc_host_port_type(vn_port->host) = FC_PORTTYPE_UNKNOWN;
1661
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);
1668 }
1669
1670 QEDF_INFO(&(base_qedf->dbg_ctx), QEDF_LOG_NPIV, "vn_port=%p.\n",
1671 vn_port);
1672
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;
1676
1677err2:
1678 scsi_host_put(vn_port->host);
1679err1:
1680 return rc;
1681}
1682
1683static int qedf_vport_destroy(struct fc_vport *vport)
1684{
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);
1689
1690 if (!qedf) {
1691 QEDF_ERR(NULL, "qedf is NULL.\n");
1692 goto out;
1693 }
1694
1695 /* Set unloading bit on vport qedf_ctx to prevent more I/O */
1696 set_bit(QEDF_UNLOADING, &qedf->flags);
1697
1698 mutex_lock(&n_port->lp_mutex);
1699 list_del(&vn_port->list);
1700 mutex_unlock(&n_port->lp_mutex);
1701
1702 fc_fabric_logoff(vn_port);
1703 fc_lport_destroy(vn_port);
1704
1705 /* Detach from scsi-ml */
1706 fc_remove_host(vn_port->host);
1707 scsi_remove_host(vn_port->host);
1708
1709 /*
1710 * Only try to release the exchange manager if the vn_port
1711 * configuration is complete.
1712 */
1713 if (vn_port->state == LPORT_ST_READY)
1714 fc_exch_mgr_free(vn_port);
1715
1716 /* Free memory used by statistical counters */
1717 fc_lport_free_stats(vn_port);
1718
1719 /* Release Scsi_Host */
1720 if (vn_port->host)
1721 scsi_host_put(vn_port->host);
1722
1723out:
1724 return 0;
1725}
1726
1727static int qedf_vport_disable(struct fc_vport *vport, bool disable)
1728{
1729 struct fc_lport *lport = vport->dd_data;
1730
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);
1738 }
1739 return 0;
1740}
1741
1742/*
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.
1747 */
1748static void qedf_wait_for_vport_destroy(struct qedf_ctx *qedf)
1749{
1750 struct fc_host_attrs *fc_host = shost_to_fc_host(qedf->lport->host);
1751
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);
1758 }
1759}
1760
1761/**
1762 * qedf_fcoe_reset - Resets the fcoe
1763 *
1764 * @shost: shost the reset is from
1765 *
1766 * Returns: always 0
1767 */
1768static int qedf_fcoe_reset(struct Scsi_Host *shost)
1769{
1770 struct fc_lport *lport = shost_priv(shost);
1771
1772 qedf_ctx_soft_reset(lport);
1773 return 0;
1774}
1775
1776static struct fc_host_statistics *qedf_fc_get_host_stats(struct Scsi_Host
1777 *shost)
1778{
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;
1783
1784 qedf_stats = fc_get_host_stats(shost);
1785
1786 /* We don't collect offload stats for specific NPIV ports */
1787 if (lport->vport)
1788 goto out;
1789
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;
1795 }
1796
1797 mutex_lock(&qedf->stats_mutex);
1798
1799 /* Query firmware for offload stats */
1800 qed_ops->get_stats(qedf->cdev, fw_fcoe_stats);
1801
1802 /*
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.
1807 */
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;
1831
1832 mutex_unlock(&qedf->stats_mutex);
1833 kfree(fw_fcoe_stats);
1834out:
1835 return qedf_stats;
1836}
1837
1838static 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,
1845
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,
1854
1855 /*
1856 * Tell FC transport to allocate enough space to store the backpointer
1857 * for the associate qedf_rport struct.
1858 */
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,
1875};
1876
1877static 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,
1905};
1906
1907static bool qedf_fp_has_work(struct qedf_fastpath *fp)
1908{
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;
1914
1915 /* Get the pointer to the global CQ this completion is on */
1916 que = qedf->global_queues[fp->sb_id];
1917
1918 /* Be sure all responses have been written to PI */
1919 rmb();
1920
1921 /* Get the current firmware producer index */
1922 prod_idx = sb->pi_array[QEDF_FCOE_PARAMS_GL_RQ_PI];
1923
1924 return (que->cq_prod_idx != prod_idx);
1925}
1926
1927/*
1928 * Interrupt handler code.
1929 */
1930
1931/* Process completion queue and copy CQE contents for deferred processesing
1932 *
1933 * Return true if we should wake the I/O thread, false if not.
1934 */
1935static bool qedf_process_completions(struct qedf_fastpath *fp)
1936{
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;
1950
1951 /* Get the current firmware producer index */
1952 prod_idx = sb->pi_array[QEDF_FCOE_PARAMS_GL_RQ_PI];
1953
1954 /* Get the pointer to the global CQ this completion is on */
1955 que = qedf->global_queues[fp->sb_id];
1956
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;
1961
1962 /* Save producer index */
1963 que->cq_prod_idx = prod_idx;
1964
1965 while (new_cqes) {
1966 fp->completions++;
1967 num_handled++;
1968 cqe = &que->cq[que->cq_cons_idx];
1969
1970 comp_type = (cqe->cqe_data >> FCOE_CQE_CQE_TYPE_SHIFT) &
1971 FCOE_CQE_CQE_TYPE_MASK;
1972
1973 /*
1974 * Process unsolicited CQEs directly in the interrupt handler
1975 * sine we need the fastpath ID
1976 */
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);
1981 /*
1982 * Don't add a work list item. Increment consumer
1983 * consumer index and move on.
1984 */
1985 goto inc_idx;
1986 }
1987
1988 xid = cqe->cqe_data & FCOE_CQE_TASK_ID_MASK;
1989 io_req = &qedf->cmd_mgr->cmds[xid];
1990
1991 /*
1992 * Figure out which percpu thread we should queue this I/O
1993 * on.
1994 */
1995 if (!io_req)
1996 /* If there is not io_req assocated with this CQE
1997 * just queue it on CPU 0
1998 */
1999 cpu = 0;
2000 else {
2001 cpu = io_req->cpu;
2002 io_req->int_cpu = smp_processor_id();
2003 }
2004
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;
2010 }
2011 memset(io_work, 0, sizeof(struct qedf_io_work));
2012
2013 INIT_WORK(&io_work->work, qedf_fp_io_handler);
2014
2015 /* Copy contents of CQE for deferred processing */
2016 memcpy(&io_work->cqe, cqe, sizeof(struct fcoe_cqe));
2017
2018 io_work->qedf = fp->qedf;
2019 io_work->fp = NULL; /* Only used for unsolicited frames */
2020
2021 queue_work_on(cpu, qedf_io_wq, &io_work->work);
2022
2023inc_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--;
2028 }
2029
2030 return true;
2031}
2032
2033
2034/* MSI-X fastpath handler code */
2035static irqreturn_t qedf_msix_handler(int irq, void *dev_id)
2036{
2037 struct qedf_fastpath *fp = dev_id;
2038
2039 if (!fp) {
2040 QEDF_ERR(NULL, "fp is null.\n");
2041 return IRQ_HANDLED;
2042 }
2043 if (!fp->sb_info) {
2044 QEDF_ERR(NULL, "fp->sb_info in null.");
2045 return IRQ_HANDLED;
2046 }
2047
2048 /*
2049 * Disable interrupts for this status block while we process new
2050 * completions
2051 */
2052 qed_sb_ack(fp->sb_info, IGU_INT_DISABLE, 0 /*do not update*/);
2053
2054 while (1) {
2055 qedf_process_completions(fp);
2056
2057 if (qedf_fp_has_work(fp) == 0) {
2058 /* Update the sb information */
2059 qed_sb_update_sb_idx(fp->sb_info);
2060
2061 /* Check for more work */
2062 rmb();
2063
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;
2068 }
2069 }
2070 }
2071
2072 /* Do we ever want to break out of above loop? */
2073 return IRQ_HANDLED;
2074}
2075
2076/* simd handler for MSI/INTa */
2077static void qedf_simd_int_handler(void *cookie)
2078{
2079 /* Cookie is qedf_ctx struct */
2080 struct qedf_ctx *qedf = (struct qedf_ctx *)cookie;
2081
2082 QEDF_WARN(&(qedf->dbg_ctx), "qedf=%p.\n", qedf);
2083}
2084
2085#define QEDF_SIMD_HANDLER_NUM 0
2086static void qedf_sync_free_irqs(struct qedf_ctx *qedf)
2087{
2088 int i;
2089
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]);
2099 }
2100 } else
2101 qed_ops->common->simd_handler_clean(qedf->cdev,
2102 QEDF_SIMD_HANDLER_NUM);
2103
2104 qedf->int_info.used_cnt = 0;
2105 qed_ops->common->set_fp_int(qedf->cdev, 0);
2106}
2107
2108static int qedf_request_msix_irq(struct qedf_ctx *qedf)
2109{
2110 int i, rc, cpu;
2111
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]);
2116
2117 if (rc) {
2118 QEDF_WARN(&(qedf->dbg_ctx), "request_irq failed.\n");
2119 qedf_sync_free_irqs(qedf);
2120 return rc;
2121 }
2122
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);
2127 }
2128
2129 return 0;
2130}
2131
2132static int qedf_setup_int(struct qedf_ctx *qedf)
2133{
2134 int rc = 0;
2135
2136 /*
2137 * Learn interrupt configuration
2138 */
2139 rc = qed_ops->common->set_fp_int(qedf->cdev, num_online_cpus());
2140 if (rc <= 0)
2141 return 0;
2142
2143 rc = qed_ops->common->get_fp_int(qedf->cdev, &qedf->int_info);
2144 if (rc)
2145 return 0;
2146
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());
2150
2151 if (qedf->int_info.msix_cnt)
2152 return qedf_request_msix_irq(qedf);
2153
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;
2157
2158 QEDF_ERR(&qedf->dbg_ctx, "Only MSI-X supported. Failing probe.\n");
2159 return -EINVAL;
2160}
2161
2162/* Main function for libfc frame reception */
2163static void qedf_recv_frame(struct qedf_ctx *qedf,
2164 struct sk_buff *skb)
2165{
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;
2177
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;
2183 }
2184
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;
2189
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);
2195
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;
2203 }
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;
2209 }
2210
2211 fh = fc_frame_header_get(fp);
2212
2213 /*
2214 * Invalid frame filters.
2215 */
2216
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;
2222 }
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;
2231 }
2232 break;
2233 }
2234 }
2235
2236 if (fh->fh_r_ctl == FC_RCTL_BA_ABTS) {
2237 /* Drop incoming ABTS */
2238 kfree_skb(skb);
2239 return;
2240 }
2241
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;
2247 }
2248
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;
2256 }
2257 }
2258
2259 vn_port = fc_vport_id_lookup(lport, ntoh24(fh->fh_d_id));
2260
2261 /*
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.
2265 */
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;
2272 }
2273
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;
2280 }
2281
2282 /*
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.
2286 */
2287
2288 /* Get fcport associated with d_id if it exists */
2289 fcport = qedf_fcport_lookup(qedf, ntoh24(fh->fh_d_id));
2290
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;
2297 }
2298
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);
2307}
2308
2309static void qedf_ll2_process_skb(struct work_struct *work)
2310{
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;
2316
2317 if (!qedf) {
2318 QEDF_ERR(NULL, "qedf is NULL\n");
2319 goto err_out;
2320 }
2321
2322 eh = (struct ethhdr *)skb->data;
2323
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);
2329 }
2330
2331 /*
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.
2335 */
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;
2345
2346err_out:
2347 kfree_skb(skb);
2348out:
2349 kfree(skb_work);
2350 return;
2351}
2352
2353static int qedf_ll2_rx(void *cookie, struct sk_buff *skb,
2354 u32 arg1, u32 arg2)
2355{
2356 struct qedf_ctx *qedf = (struct qedf_ctx *)cookie;
2357 struct qedf_skb_work *skb_work;
2358
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;
2365 }
2366
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);
2371
2372 return 0;
2373}
2374
2375static struct qed_ll2_cb_ops qedf_ll2_cb_ops = {
2376 .rx_cb = qedf_ll2_rx,
2377 .tx_cb = NULL,
2378};
2379
2380/* Main thread to process I/O completions */
2381void qedf_fp_io_handler(struct work_struct *work)
2382{
2383 struct qedf_io_work *io_work =
2384 container_of(work, struct qedf_io_work, work);
2385 u32 comp_type;
2386
2387 /*
2388 * Deferred part of unsolicited CQE sends
2389 * frame to libfc.
2390 */
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);
2399
2400 kfree(io_work);
2401}
2402
2403static int qedf_alloc_and_init_sb(struct qedf_ctx *qedf,
2404 struct qed_sb_info *sb_info, u16 sb_id)
2405{
2406 struct status_block_e4 *sb_virt;
2407 dma_addr_t sb_phys;
2408 int ret;
2409
2410 sb_virt = dma_alloc_coherent(&qedf->pdev->dev,
2411 sizeof(struct status_block_e4), &sb_phys, GFP_KERNEL);
2412
2413 if (!sb_virt) {
2414 QEDF_ERR(&(qedf->dbg_ctx), "Status block allocation failed "
2415 "for id = %d.\n", sb_id);
2416 return -ENOMEM;
2417 }
2418
2419 ret = qed_ops->common->sb_init(qedf->cdev, sb_info, sb_virt, sb_phys,
2420 sb_id, QED_SB_TYPE_STORAGE);
2421
2422 if (ret) {
2423 QEDF_ERR(&(qedf->dbg_ctx), "Status block initialization "
2424 "failed for id = %d.\n", sb_id);
2425 return ret;
2426 }
2427
2428 return 0;
2429}
2430
2431static void qedf_free_sb(struct qedf_ctx *qedf, struct qed_sb_info *sb_info)
2432{
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);
2436}
2437
2438static void qedf_destroy_sb(struct qedf_ctx *qedf)
2439{
2440 int id;
2441 struct qedf_fastpath *fp = NULL;
2442
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);
2449 }
2450 kfree(qedf->fp_array);
2451}
2452
2453static int qedf_prepare_sb(struct qedf_ctx *qedf)
2454{
2455 int id;
2456 struct qedf_fastpath *fp;
2457 int ret;
2458
2459 qedf->fp_array =
2460 kcalloc(qedf->num_queues, sizeof(struct qedf_fastpath),
2461 GFP_KERNEL);
2462
2463 if (!qedf->fp_array) {
2464 QEDF_ERR(&(qedf->dbg_ctx), "fastpath array allocation "
2465 "failed.\n");
2466 return -ENOMEM;
2467 }
2468
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;
2477 }
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;
2483 }
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);
2489 }
2490err:
2491 return 0;
2492}
2493
2494void qedf_process_cqe(struct qedf_ctx *qedf, struct fcoe_cqe *cqe)
2495{
2496 u16 xid;
2497 struct qedf_ioreq *io_req;
2498 struct qedf_rport *fcport;
2499 u32 comp_type;
2500
2501 comp_type = (cqe->cqe_data >> FCOE_CQE_CQE_TYPE_SHIFT) &
2502 FCOE_CQE_CQE_TYPE_MASK;
2503
2504 xid = cqe->cqe_data & FCOE_CQE_TASK_ID_MASK;
2505 io_req = &qedf->cmd_mgr->cmds[xid];
2506
2507 /* Completion not for a valid I/O anymore so just return */
2508 if (!io_req)
2509 return;
2510
2511 fcport = io_req->fcport;
2512
2513 if (fcport == NULL) {
2514 QEDF_ERR(&(qedf->dbg_ctx), "fcport is NULL.\n");
2515 return;
2516 }
2517
2518 /*
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.
2521 */
2522 if (!test_bit(QEDF_RPORT_SESSION_READY, &fcport->flags)) {
2523 QEDF_ERR(&(qedf->dbg_ctx), "Session not offloaded yet.\n");
2524 return;
2525 }
2526
2527
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;
2544 }
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;
2589 }
2590}
2591
2592static void qedf_free_bdq(struct qedf_ctx *qedf)
2593{
2594 int i;
2595
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);
2599
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);
2603
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);
2608 }
2609 }
2610}
2611
2612static void qedf_free_global_queues(struct qedf_ctx *qedf)
2613{
2614 int i;
2615 struct global_queue **gl = qedf->global_queues;
2616
2617 for (i = 0; i < qedf->num_queues; i++) {
2618 if (!gl[i])
2619 continue;
2620
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);
2627
2628 kfree(gl[i]);
2629 }
2630
2631 qedf_free_bdq(qedf);
2632}
2633
2634static int qedf_alloc_bdq(struct qedf_ctx *qedf)
2635{
2636 int i;
2637 struct scsi_bd *pbl;
2638 u64 *list;
2639 dma_addr_t page;
2640
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;
2649 }
2650 }
2651
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);
2657
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;
2663 }
2664
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);
2668
2669 /*
2670 * Populate BDQ PBL with physical and virtual address of individual
2671 * BDQ buffers
2672 */
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++;
2681 }
2682
2683 /* Allocate list of PBL pages */
2684 qedf->bdq_pbl_list = dma_alloc_coherent(&qedf->pdev->dev,
2685 QEDF_PAGE_SIZE,
2686 &qedf->bdq_pbl_list_dma,
2687 GFP_KERNEL);
2688 if (!qedf->bdq_pbl_list) {
2689 QEDF_ERR(&(qedf->dbg_ctx), "Could not allocate list of PBL pages.\n");
2690 return -ENOMEM;
2691 }
2692
2693 /*
2694 * Now populate PBL list with pages that contain pointers to the
2695 * individual buffers.
2696 */
2697 qedf->bdq_pbl_list_num_entries = qedf->bdq_pbl_mem_size /
2698 QEDF_PAGE_SIZE;
2699 list = (u64 *)qedf->bdq_pbl_list;
2700 page = qedf->bdq_pbl_list_dma;
2701 for (i = 0; i < qedf->bdq_pbl_list_num_entries; i++) {
2702 *list = qedf->bdq_pbl_dma;
2703 list++;
2704 page += QEDF_PAGE_SIZE;
2705 }
2706
2707 return 0;
2708}
2709
2710static int qedf_alloc_global_queues(struct qedf_ctx *qedf)
2711{
2712 u32 *list;
2713 int i;
2714 int status = 0, rc;
2715 u32 *pbl;
2716 dma_addr_t page;
2717 int num_pages;
2718
2719 /* Allocate and map CQs, RQs */
2720 /*
2721 * Number of global queues (CQ / RQ). This should
2722 * be <= number of available MSIX vectors for the PF
2723 */
2724 if (!qedf->num_queues) {
2725 QEDF_ERR(&(qedf->dbg_ctx), "No MSI-X vectors available!\n");
2726 return 1;
2727 }
2728
2729 /*
2730 * Make sure we allocated the PBL that will contain the physical
2731 * addresses of our queues
2732 */
2733 if (!qedf->p_cpuq) {
2734 status = 1;
2735 goto mem_alloc_failure;
2736 }
2737
2738 qedf->global_queues = kzalloc((sizeof(struct global_queue *)
2739 * qedf->num_queues), GFP_KERNEL);
2740 if (!qedf->global_queues) {
2741 QEDF_ERR(&(qedf->dbg_ctx), "Unable to allocate global "
2742 "queues array ptr memory\n");
2743 return -ENOMEM;
2744 }
2745 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
2746 "qedf->global_queues=%p.\n", qedf->global_queues);
2747
2748 /* Allocate DMA coherent buffers for BDQ */
2749 rc = qedf_alloc_bdq(qedf);
2750 if (rc)
2751 goto mem_alloc_failure;
2752
2753 /* Allocate a CQ and an associated PBL for each MSI-X vector */
2754 for (i = 0; i < qedf->num_queues; i++) {
2755 qedf->global_queues[i] = kzalloc(sizeof(struct global_queue),
2756 GFP_KERNEL);
2757 if (!qedf->global_queues[i]) {
2758 QEDF_WARN(&(qedf->dbg_ctx), "Unable to allocate "
2759 "global queue %d.\n", i);
2760 status = -ENOMEM;
2761 goto mem_alloc_failure;
2762 }
2763
2764 qedf->global_queues[i]->cq_mem_size =
2765 FCOE_PARAMS_CQ_NUM_ENTRIES * sizeof(struct fcoe_cqe);
2766 qedf->global_queues[i]->cq_mem_size =
2767 ALIGN(qedf->global_queues[i]->cq_mem_size, QEDF_PAGE_SIZE);
2768
2769 qedf->global_queues[i]->cq_pbl_size =
2770 (qedf->global_queues[i]->cq_mem_size /
2771 PAGE_SIZE) * sizeof(void *);
2772 qedf->global_queues[i]->cq_pbl_size =
2773 ALIGN(qedf->global_queues[i]->cq_pbl_size, QEDF_PAGE_SIZE);
2774
2775 qedf->global_queues[i]->cq =
2776 dma_alloc_coherent(&qedf->pdev->dev,
2777 qedf->global_queues[i]->cq_mem_size,
2778 &qedf->global_queues[i]->cq_dma,
2779 GFP_KERNEL);
2780
2781 if (!qedf->global_queues[i]->cq) {
2782 QEDF_WARN(&(qedf->dbg_ctx), "Could not allocate cq.\n");
2783 status = -ENOMEM;
2784 goto mem_alloc_failure;
2785 }
2786
2787 qedf->global_queues[i]->cq_pbl =
2788 dma_alloc_coherent(&qedf->pdev->dev,
2789 qedf->global_queues[i]->cq_pbl_size,
2790 &qedf->global_queues[i]->cq_pbl_dma,
2791 GFP_KERNEL);
2792
2793 if (!qedf->global_queues[i]->cq_pbl) {
2794 QEDF_WARN(&(qedf->dbg_ctx), "Could not allocate cq PBL.\n");
2795 status = -ENOMEM;
2796 goto mem_alloc_failure;
2797 }
2798
2799 /* Create PBL */
2800 num_pages = qedf->global_queues[i]->cq_mem_size /
2801 QEDF_PAGE_SIZE;
2802 page = qedf->global_queues[i]->cq_dma;
2803 pbl = (u32 *)qedf->global_queues[i]->cq_pbl;
2804
2805 while (num_pages--) {
2806 *pbl = U64_LO(page);
2807 pbl++;
2808 *pbl = U64_HI(page);
2809 pbl++;
2810 page += QEDF_PAGE_SIZE;
2811 }
2812 /* Set the initial consumer index for cq */
2813 qedf->global_queues[i]->cq_cons_idx = 0;
2814 }
2815
2816 list = (u32 *)qedf->p_cpuq;
2817
2818 /*
2819 * The list is built as follows: CQ#0 PBL pointer, RQ#0 PBL pointer,
2820 * CQ#1 PBL pointer, RQ#1 PBL pointer, etc. Each PBL pointer points
2821 * to the physical address which contains an array of pointers to
2822 * the physical addresses of the specific queue pages.
2823 */
2824 for (i = 0; i < qedf->num_queues; i++) {
2825 *list = U64_LO(qedf->global_queues[i]->cq_pbl_dma);
2826 list++;
2827 *list = U64_HI(qedf->global_queues[i]->cq_pbl_dma);
2828 list++;
2829 *list = U64_LO(0);
2830 list++;
2831 *list = U64_HI(0);
2832 list++;
2833 }
2834
2835 return 0;
2836
2837mem_alloc_failure:
2838 qedf_free_global_queues(qedf);
2839 return status;
2840}
2841
2842static int qedf_set_fcoe_pf_param(struct qedf_ctx *qedf)
2843{
2844 u8 sq_num_pbl_pages;
2845 u32 sq_mem_size;
2846 u32 cq_mem_size;
2847 u32 cq_num_entries;
2848 int rval;
2849
2850 /*
2851 * The number of completion queues/fastpath interrupts/status blocks
2852 * we allocation is the minimum off:
2853 *
2854 * Number of CPUs
2855 * Number allocated by qed for our PCI function
2856 */
2857 qedf->num_queues = MIN_NUM_CPUS_MSIX(qedf);
2858
2859 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "Number of CQs is %d.\n",
2860 qedf->num_queues);
2861
2862 qedf->p_cpuq = dma_alloc_coherent(&qedf->pdev->dev,
2863 qedf->num_queues * sizeof(struct qedf_glbl_q_params),
2864 &qedf->hw_p_cpuq, GFP_KERNEL);
2865
2866 if (!qedf->p_cpuq) {
2867 QEDF_ERR(&(qedf->dbg_ctx), "dma_alloc_coherent failed.\n");
2868 return 1;
2869 }
2870
2871 rval = qedf_alloc_global_queues(qedf);
2872 if (rval) {
2873 QEDF_ERR(&(qedf->dbg_ctx), "Global queue allocation "
2874 "failed.\n");
2875 return 1;
2876 }
2877
2878 /* Calculate SQ PBL size in the same manner as in qedf_sq_alloc() */
2879 sq_mem_size = SQ_NUM_ENTRIES * sizeof(struct fcoe_wqe);
2880 sq_mem_size = ALIGN(sq_mem_size, QEDF_PAGE_SIZE);
2881 sq_num_pbl_pages = (sq_mem_size / QEDF_PAGE_SIZE);
2882
2883 /* Calculate CQ num entries */
2884 cq_mem_size = FCOE_PARAMS_CQ_NUM_ENTRIES * sizeof(struct fcoe_cqe);
2885 cq_mem_size = ALIGN(cq_mem_size, QEDF_PAGE_SIZE);
2886 cq_num_entries = cq_mem_size / sizeof(struct fcoe_cqe);
2887
2888 memset(&(qedf->pf_params), 0, sizeof(qedf->pf_params));
2889
2890 /* Setup the value for fcoe PF */
2891 qedf->pf_params.fcoe_pf_params.num_cons = QEDF_MAX_SESSIONS;
2892 qedf->pf_params.fcoe_pf_params.num_tasks = FCOE_PARAMS_NUM_TASKS;
2893 qedf->pf_params.fcoe_pf_params.glbl_q_params_addr =
2894 (u64)qedf->hw_p_cpuq;
2895 qedf->pf_params.fcoe_pf_params.sq_num_pbl_pages = sq_num_pbl_pages;
2896
2897 qedf->pf_params.fcoe_pf_params.rq_buffer_log_size = 0;
2898
2899 qedf->pf_params.fcoe_pf_params.cq_num_entries = cq_num_entries;
2900 qedf->pf_params.fcoe_pf_params.num_cqs = qedf->num_queues;
2901
2902 /* log_page_size: 12 for 4KB pages */
2903 qedf->pf_params.fcoe_pf_params.log_page_size = ilog2(QEDF_PAGE_SIZE);
2904
2905 qedf->pf_params.fcoe_pf_params.mtu = 9000;
2906 qedf->pf_params.fcoe_pf_params.gl_rq_pi = QEDF_FCOE_PARAMS_GL_RQ_PI;
2907 qedf->pf_params.fcoe_pf_params.gl_cmd_pi = QEDF_FCOE_PARAMS_GL_CMD_PI;
2908
2909 /* BDQ address and size */
2910 qedf->pf_params.fcoe_pf_params.bdq_pbl_base_addr[0] =
2911 qedf->bdq_pbl_list_dma;
2912 qedf->pf_params.fcoe_pf_params.bdq_pbl_num_entries[0] =
2913 qedf->bdq_pbl_list_num_entries;
2914 qedf->pf_params.fcoe_pf_params.rq_buffer_size = QEDF_BDQ_BUF_SIZE;
2915
2916 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
2917 "bdq_list=%p bdq_pbl_list_dma=%llx bdq_pbl_list_entries=%d.\n",
2918 qedf->bdq_pbl_list,
2919 qedf->pf_params.fcoe_pf_params.bdq_pbl_base_addr[0],
2920 qedf->pf_params.fcoe_pf_params.bdq_pbl_num_entries[0]);
2921
2922 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
2923 "cq_num_entries=%d.\n",
2924 qedf->pf_params.fcoe_pf_params.cq_num_entries);
2925
2926 return 0;
2927}
2928
2929/* Free DMA coherent memory for array of queue pointers we pass to qed */
2930static void qedf_free_fcoe_pf_param(struct qedf_ctx *qedf)
2931{
2932 size_t size = 0;
2933
2934 if (qedf->p_cpuq) {
2935 size = qedf->num_queues * sizeof(struct qedf_glbl_q_params);
2936 dma_free_coherent(&qedf->pdev->dev, size, qedf->p_cpuq,
2937 qedf->hw_p_cpuq);
2938 }
2939
2940 qedf_free_global_queues(qedf);
2941
2942 kfree(qedf->global_queues);
2943}
2944
2945/*
2946 * PCI driver functions
2947 */
2948
2949static const struct pci_device_id qedf_pci_tbl[] = {
2950 { PCI_DEVICE(PCI_VENDOR_ID_QLOGIC, 0x165c) },
2951 { PCI_DEVICE(PCI_VENDOR_ID_QLOGIC, 0x8080) },
2952 {0}
2953};
2954MODULE_DEVICE_TABLE(pci, qedf_pci_tbl);
2955
2956static struct pci_driver qedf_pci_driver = {
2957 .name = QEDF_MODULE_NAME,
2958 .id_table = qedf_pci_tbl,
2959 .probe = qedf_probe,
2960 .remove = qedf_remove,
2961};
2962
2963static int __qedf_probe(struct pci_dev *pdev, int mode)
2964{
2965 int rc = -EINVAL;
2966 struct fc_lport *lport;
2967 struct qedf_ctx *qedf;
2968 struct Scsi_Host *host;
2969 bool is_vf = false;
2970 struct qed_ll2_params params;
2971 char host_buf[20];
2972 struct qed_link_params link_params;
2973 int status;
2974 void *task_start, *task_end;
2975 struct qed_slowpath_params slowpath_params;
2976 struct qed_probe_params qed_params;
2977 u16 tmp;
2978
2979 /*
2980 * When doing error recovery we didn't reap the lport so don't try
2981 * to reallocate it.
2982 */
2983 if (mode != QEDF_MODE_RECOVERY) {
2984 lport = libfc_host_alloc(&qedf_host_template,
2985 sizeof(struct qedf_ctx));
2986
2987 if (!lport) {
2988 QEDF_ERR(NULL, "Could not allocate lport.\n");
2989 rc = -ENOMEM;
2990 goto err0;
2991 }
2992
2993 /* Initialize qedf_ctx */
2994 qedf = lport_priv(lport);
2995 qedf->lport = lport;
2996 qedf->ctlr.lp = lport;
2997 qedf->pdev = pdev;
2998 qedf->dbg_ctx.pdev = pdev;
2999 qedf->dbg_ctx.host_no = lport->host->host_no;
3000 spin_lock_init(&qedf->hba_lock);
3001 INIT_LIST_HEAD(&qedf->fcports);
3002 qedf->curr_conn_id = QEDF_MAX_SESSIONS - 1;
3003 atomic_set(&qedf->num_offloads, 0);
3004 qedf->stop_io_on_error = false;
3005 pci_set_drvdata(pdev, qedf);
3006 init_completion(&qedf->fipvlan_compl);
3007 mutex_init(&qedf->stats_mutex);
3008
3009 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_INFO,
3010 "QLogic FastLinQ FCoE Module qedf %s, "
3011 "FW %d.%d.%d.%d\n", QEDF_VERSION,
3012 FW_MAJOR_VERSION, FW_MINOR_VERSION, FW_REVISION_VERSION,
3013 FW_ENGINEERING_VERSION);
3014 } else {
3015 /* Init pointers during recovery */
3016 qedf = pci_get_drvdata(pdev);
3017 lport = qedf->lport;
3018 }
3019
3020 host = lport->host;
3021
3022 /* Allocate mempool for qedf_io_work structs */
3023 qedf->io_mempool = mempool_create_slab_pool(QEDF_IO_WORK_MIN,
3024 qedf_io_work_cache);
3025 if (qedf->io_mempool == NULL) {
3026 QEDF_ERR(&(qedf->dbg_ctx), "qedf->io_mempool is NULL.\n");
3027 goto err1;
3028 }
3029 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_INFO, "qedf->io_mempool=%p.\n",
3030 qedf->io_mempool);
3031
3032 sprintf(host_buf, "qedf_%u_link",
3033 qedf->lport->host->host_no);
3034 qedf->link_update_wq = create_workqueue(host_buf);
3035 INIT_DELAYED_WORK(&qedf->link_update, qedf_handle_link_update);
3036 INIT_DELAYED_WORK(&qedf->link_recovery, qedf_link_recovery);
3037 INIT_DELAYED_WORK(&qedf->grcdump_work, qedf_wq_grcdump);
3038 qedf->fipvlan_retries = qedf_fipvlan_retries;
3039 /* Set a default prio in case DCBX doesn't converge */
3040 if (qedf_default_prio > -1) {
3041 /*
3042 * This is the case where we pass a modparam in so we want to
3043 * honor it even if dcbx doesn't converge.
3044 */
3045 qedf->prio = qedf_default_prio;
3046 } else
3047 qedf->prio = QEDF_DEFAULT_PRIO;
3048
3049 /*
3050 * Common probe. Takes care of basic hardware init and pci_*
3051 * functions.
3052 */
3053 memset(&qed_params, 0, sizeof(qed_params));
3054 qed_params.protocol = QED_PROTOCOL_FCOE;
3055 qed_params.dp_module = qedf_dp_module;
3056 qed_params.dp_level = qedf_dp_level;
3057 qed_params.is_vf = is_vf;
3058 qedf->cdev = qed_ops->common->probe(pdev, &qed_params);
3059 if (!qedf->cdev) {
3060 rc = -ENODEV;
3061 goto err1;
3062 }
3063
3064 /* Learn information crucial for qedf to progress */
3065 rc = qed_ops->fill_dev_info(qedf->cdev, &qedf->dev_info);
3066 if (rc) {
3067 QEDF_ERR(&(qedf->dbg_ctx), "Failed to dev info.\n");
3068 goto err1;
3069 }
3070
3071 /* queue allocation code should come here
3072 * order should be
3073 * slowpath_start
3074 * status block allocation
3075 * interrupt registration (to get min number of queues)
3076 * set_fcoe_pf_param
3077 * qed_sp_fcoe_func_start
3078 */
3079 rc = qedf_set_fcoe_pf_param(qedf);
3080 if (rc) {
3081 QEDF_ERR(&(qedf->dbg_ctx), "Cannot set fcoe pf param.\n");
3082 goto err2;
3083 }
3084 qed_ops->common->update_pf_params(qedf->cdev, &qedf->pf_params);
3085
3086 /* Record BDQ producer doorbell addresses */
3087 qedf->bdq_primary_prod = qedf->dev_info.primary_dbq_rq_addr;
3088 qedf->bdq_secondary_prod = qedf->dev_info.secondary_bdq_rq_addr;
3089 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
3090 "BDQ primary_prod=%p secondary_prod=%p.\n", qedf->bdq_primary_prod,
3091 qedf->bdq_secondary_prod);
3092
3093 qed_ops->register_ops(qedf->cdev, &qedf_cb_ops, qedf);
3094
3095 rc = qedf_prepare_sb(qedf);
3096 if (rc) {
3097
3098 QEDF_ERR(&(qedf->dbg_ctx), "Cannot start slowpath.\n");
3099 goto err2;
3100 }
3101
3102 /* Start the Slowpath-process */
3103 slowpath_params.int_mode = QED_INT_MODE_MSIX;
3104 slowpath_params.drv_major = QEDF_DRIVER_MAJOR_VER;
3105 slowpath_params.drv_minor = QEDF_DRIVER_MINOR_VER;
3106 slowpath_params.drv_rev = QEDF_DRIVER_REV_VER;
3107 slowpath_params.drv_eng = QEDF_DRIVER_ENG_VER;
3108 strncpy(slowpath_params.name, "qedf", QED_DRV_VER_STR_SIZE);
3109 rc = qed_ops->common->slowpath_start(qedf->cdev, &slowpath_params);
3110 if (rc) {
3111 QEDF_ERR(&(qedf->dbg_ctx), "Cannot start slowpath.\n");
3112 goto err2;
3113 }
3114
3115 /*
3116 * update_pf_params needs to be called before and after slowpath
3117 * start
3118 */
3119 qed_ops->common->update_pf_params(qedf->cdev, &qedf->pf_params);
3120
3121 /* Setup interrupts */
3122 rc = qedf_setup_int(qedf);
3123 if (rc)
3124 goto err3;
3125
3126 rc = qed_ops->start(qedf->cdev, &qedf->tasks);
3127 if (rc) {
3128 QEDF_ERR(&(qedf->dbg_ctx), "Cannot start FCoE function.\n");
3129 goto err4;
3130 }
3131 task_start = qedf_get_task_mem(&qedf->tasks, 0);
3132 task_end = qedf_get_task_mem(&qedf->tasks, MAX_TID_BLOCKS_FCOE - 1);
3133 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "Task context start=%p, "
3134 "end=%p block_size=%u.\n", task_start, task_end,
3135 qedf->tasks.size);
3136
3137 /*
3138 * We need to write the number of BDs in the BDQ we've preallocated so
3139 * the f/w will do a prefetch and we'll get an unsolicited CQE when a
3140 * packet arrives.
3141 */
3142 qedf->bdq_prod_idx = QEDF_BDQ_SIZE;
3143 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
3144 "Writing %d to primary and secondary BDQ doorbell registers.\n",
3145 qedf->bdq_prod_idx);
3146 writew(qedf->bdq_prod_idx, qedf->bdq_primary_prod);
3147 tmp = readw(qedf->bdq_primary_prod);
3148 writew(qedf->bdq_prod_idx, qedf->bdq_secondary_prod);
3149 tmp = readw(qedf->bdq_secondary_prod);
3150
3151 qed_ops->common->set_power_state(qedf->cdev, PCI_D0);
3152
3153 /* Now that the dev_info struct has been filled in set the MAC
3154 * address
3155 */
3156 ether_addr_copy(qedf->mac, qedf->dev_info.common.hw_mac);
3157 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "MAC address is %pM.\n",
3158 qedf->mac);
3159
3160 /*
3161 * Set the WWNN and WWPN in the following way:
3162 *
3163 * If the info we get from qed is non-zero then use that to set the
3164 * WWPN and WWNN. Otherwise fall back to use fcoe_wwn_from_mac() based
3165 * on the MAC address.
3166 */
3167 if (qedf->dev_info.wwnn != 0 && qedf->dev_info.wwpn != 0) {
3168 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
3169 "Setting WWPN and WWNN from qed dev_info.\n");
3170 qedf->wwnn = qedf->dev_info.wwnn;
3171 qedf->wwpn = qedf->dev_info.wwpn;
3172 } else {
3173 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
3174 "Setting WWPN and WWNN using fcoe_wwn_from_mac().\n");
3175 qedf->wwnn = fcoe_wwn_from_mac(qedf->mac, 1, 0);
3176 qedf->wwpn = fcoe_wwn_from_mac(qedf->mac, 2, 0);
3177 }
3178 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "WWNN=%016llx "
3179 "WWPN=%016llx.\n", qedf->wwnn, qedf->wwpn);
3180
3181 sprintf(host_buf, "host_%d", host->host_no);
3182 qed_ops->common->set_name(qedf->cdev, host_buf);
3183
3184
3185 /* Set xid max values */
3186 qedf->max_scsi_xid = QEDF_MAX_SCSI_XID;
3187 qedf->max_els_xid = QEDF_MAX_ELS_XID;
3188
3189 /* Allocate cmd mgr */
3190 qedf->cmd_mgr = qedf_cmd_mgr_alloc(qedf);
3191 if (!qedf->cmd_mgr) {
3192 QEDF_ERR(&(qedf->dbg_ctx), "Failed to allocate cmd mgr.\n");
3193 rc = -ENOMEM;
3194 goto err5;
3195 }
3196
3197 if (mode != QEDF_MODE_RECOVERY) {
3198 host->transportt = qedf_fc_transport_template;
3199 host->can_queue = QEDF_MAX_ELS_XID;
3200 host->max_lun = qedf_max_lun;
3201 host->max_cmd_len = QEDF_MAX_CDB_LEN;
3202 rc = scsi_add_host(host, &pdev->dev);
3203 if (rc)
3204 goto err6;
3205 }
3206
3207 memset(&params, 0, sizeof(params));
3208 params.mtu = 9000;
3209 ether_addr_copy(params.ll2_mac_address, qedf->mac);
3210
3211 /* Start LL2 processing thread */
3212 snprintf(host_buf, 20, "qedf_%d_ll2", host->host_no);
3213 qedf->ll2_recv_wq =
3214 create_workqueue(host_buf);
3215 if (!qedf->ll2_recv_wq) {
3216 QEDF_ERR(&(qedf->dbg_ctx), "Failed to LL2 workqueue.\n");
3217 rc = -ENOMEM;
3218 goto err7;
3219 }
3220
3221#ifdef CONFIG_DEBUG_FS
3222 qedf_dbg_host_init(&(qedf->dbg_ctx), qedf_debugfs_ops,
3223 qedf_dbg_fops);
3224#endif
3225
3226 /* Start LL2 */
3227 qed_ops->ll2->register_cb_ops(qedf->cdev, &qedf_ll2_cb_ops, qedf);
3228 rc = qed_ops->ll2->start(qedf->cdev, &params);
3229 if (rc) {
3230 QEDF_ERR(&(qedf->dbg_ctx), "Could not start Light L2.\n");
3231 goto err7;
3232 }
3233 set_bit(QEDF_LL2_STARTED, &qedf->flags);
3234
3235 /* Set initial FIP/FCoE VLAN to NULL */
3236 qedf->vlan_id = 0;
3237
3238 /*
3239 * No need to setup fcoe_ctlr or fc_lport objects during recovery since
3240 * they were not reaped during the unload process.
3241 */
3242 if (mode != QEDF_MODE_RECOVERY) {
3243 /* Setup imbedded fcoe controller */
3244 qedf_fcoe_ctlr_setup(qedf);
3245
3246 /* Setup lport */
3247 rc = qedf_lport_setup(qedf);
3248 if (rc) {
3249 QEDF_ERR(&(qedf->dbg_ctx),
3250 "qedf_lport_setup failed.\n");
3251 goto err7;
3252 }
3253 }
3254
3255 sprintf(host_buf, "qedf_%u_timer", qedf->lport->host->host_no);
3256 qedf->timer_work_queue =
3257 create_workqueue(host_buf);
3258 if (!qedf->timer_work_queue) {
3259 QEDF_ERR(&(qedf->dbg_ctx), "Failed to start timer "
3260 "workqueue.\n");
3261 rc = -ENOMEM;
3262 goto err7;
3263 }
3264
3265 /* DPC workqueue is not reaped during recovery unload */
3266 if (mode != QEDF_MODE_RECOVERY) {
3267 sprintf(host_buf, "qedf_%u_dpc",
3268 qedf->lport->host->host_no);
3269 qedf->dpc_wq = create_workqueue(host_buf);
3270 }
3271
3272 /*
3273 * GRC dump and sysfs parameters are not reaped during the recovery
3274 * unload process.
3275 */
3276 if (mode != QEDF_MODE_RECOVERY) {
3277 qedf->grcdump_size =
3278 qed_ops->common->dbg_all_data_size(qedf->cdev);
3279 if (qedf->grcdump_size) {
3280 rc = qedf_alloc_grc_dump_buf(&qedf->grcdump,
3281 qedf->grcdump_size);
3282 if (rc) {
3283 QEDF_ERR(&(qedf->dbg_ctx),
3284 "GRC Dump buffer alloc failed.\n");
3285 qedf->grcdump = NULL;
3286 }
3287
3288 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
3289 "grcdump: addr=%p, size=%u.\n",
3290 qedf->grcdump, qedf->grcdump_size);
3291 }
3292 qedf_create_sysfs_ctx_attr(qedf);
3293
3294 /* Initialize I/O tracing for this adapter */
3295 spin_lock_init(&qedf->io_trace_lock);
3296 qedf->io_trace_idx = 0;
3297 }
3298
3299 init_completion(&qedf->flogi_compl);
3300
3301 status = qed_ops->common->update_drv_state(qedf->