?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Linux 4.16.11
[linux/fpc-iii.git] / drivers / scsi / qedf / qedf_main.c
blobccd9a08ea030cb508ef64add78495b4242fd6d42
1 /*
2 * QLogic FCoE Offload Driver
3 * Copyright (c) 2016-2017 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 <uapi/linux/pci_regs.h>
27
28 const struct qed_fcoe_ops *qed_ops;
29
30 static int qedf_probe(struct pci_dev *pdev, const struct pci_device_id *id);
31 static void qedf_remove(struct pci_dev *pdev);
32
33 extern struct qedf_debugfs_ops qedf_debugfs_ops;
34 extern struct file_operations qedf_dbg_fops;
35
36 /*
37 * Driver module parameters.
38 */
39 static unsigned int qedf_dev_loss_tmo = 60;
40 module_param_named(dev_loss_tmo, qedf_dev_loss_tmo, int, S_IRUGO);
41 MODULE_PARM_DESC(dev_loss_tmo, " dev_loss_tmo setting for attached "
42 "remote ports (default 60)");
43
44 uint qedf_debug = QEDF_LOG_INFO;
45 module_param_named(debug, qedf_debug, uint, S_IRUGO);
46 MODULE_PARM_DESC(debug, " Debug mask. Pass '1' to enable default debugging"
47 " mask");
48
49 static uint qedf_fipvlan_retries = 30;
50 module_param_named(fipvlan_retries, qedf_fipvlan_retries, int, S_IRUGO);
51 MODULE_PARM_DESC(fipvlan_retries, " Number of FIP VLAN requests to attempt "
52 "before giving up (default 30)");
53
54 static uint qedf_fallback_vlan = QEDF_FALLBACK_VLAN;
55 module_param_named(fallback_vlan, qedf_fallback_vlan, int, S_IRUGO);
56 MODULE_PARM_DESC(fallback_vlan, " VLAN ID to try if fip vlan request fails "
57 "(default 1002).");
58
59 static uint qedf_default_prio = QEDF_DEFAULT_PRIO;
60 module_param_named(default_prio, qedf_default_prio, int, S_IRUGO);
61 MODULE_PARM_DESC(default_prio, " Default 802.1q priority for FIP and FCoE"
62 " traffic (default 3).");
63
64 uint qedf_dump_frames;
65 module_param_named(dump_frames, qedf_dump_frames, int, S_IRUGO | S_IWUSR);
66 MODULE_PARM_DESC(dump_frames, " Print the skb data of FIP and FCoE frames "
67 "(default off)");
68
69 static uint qedf_queue_depth;
70 module_param_named(queue_depth, qedf_queue_depth, int, S_IRUGO);
71 MODULE_PARM_DESC(queue_depth, " Sets the queue depth for all LUNs discovered "
72 "by the qedf driver. Default is 0 (use OS default).");
73
74 uint qedf_io_tracing;
75 module_param_named(io_tracing, qedf_io_tracing, int, S_IRUGO | S_IWUSR);
76 MODULE_PARM_DESC(io_tracing, " Enable logging of SCSI requests/completions "
77 "into trace buffer. (default off).");
78
79 static uint qedf_max_lun = MAX_FIBRE_LUNS;
80 module_param_named(max_lun, qedf_max_lun, int, S_IRUGO);
81 MODULE_PARM_DESC(max_lun, " Sets the maximum luns per target that the driver "
82 "supports. (default 0xffffffff)");
83
84 uint qedf_link_down_tmo;
85 module_param_named(link_down_tmo, qedf_link_down_tmo, int, S_IRUGO);
86 MODULE_PARM_DESC(link_down_tmo, " Delays informing the fcoe transport that the "
87 "link is down by N seconds.");
88
89 bool qedf_retry_delay;
90 module_param_named(retry_delay, qedf_retry_delay, bool, S_IRUGO | S_IWUSR);
91 MODULE_PARM_DESC(retry_delay, " Enable/disable handling of FCP_RSP IU retry "
92 "delay handling (default off).");
93
94 static uint qedf_dp_module;
95 module_param_named(dp_module, qedf_dp_module, uint, S_IRUGO);
96 MODULE_PARM_DESC(dp_module, " bit flags control for verbose printk passed "
97 "qed module during probe.");
98
99 static uint qedf_dp_level = QED_LEVEL_NOTICE;
100 module_param_named(dp_level, qedf_dp_level, uint, S_IRUGO);
101 MODULE_PARM_DESC(dp_level, " printk verbosity control passed to qed module "
102 "during probe (0-3: 0 more verbose).");
103
104 struct workqueue_struct *qedf_io_wq;
105
106 static struct fcoe_percpu_s qedf_global;
107 static DEFINE_SPINLOCK(qedf_global_lock);
108
109 static struct kmem_cache *qedf_io_work_cache;
110
111 void qedf_set_vlan_id(struct qedf_ctx *qedf, int vlan_id)
112 {
113 qedf->vlan_id = vlan_id;
114 qedf->vlan_id |= qedf_default_prio << VLAN_PRIO_SHIFT;
115 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "Setting vlan_id=%04x "
116 "prio=%d.\n", vlan_id, qedf_default_prio);
117 }
118
119 /* Returns true if we have a valid vlan, false otherwise */
120 static bool qedf_initiate_fipvlan_req(struct qedf_ctx *qedf)
121 {
122 int rc;
123
124 if (atomic_read(&qedf->link_state) != QEDF_LINK_UP) {
125 QEDF_ERR(&(qedf->dbg_ctx), "Link not up.\n");
126 return false;
127 }
128
129 while (qedf->fipvlan_retries--) {
130 if (qedf->vlan_id > 0)
131 return true;
132 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
133 "Retry %d.\n", qedf->fipvlan_retries);
134 init_completion(&qedf->fipvlan_compl);
135 qedf_fcoe_send_vlan_req(qedf);
136 rc = wait_for_completion_timeout(&qedf->fipvlan_compl,
137 1 * HZ);
138 if (rc > 0) {
139 fcoe_ctlr_link_up(&qedf->ctlr);
140 return true;
141 }
142 }
143
144 return false;
145 }
146
147 static void qedf_handle_link_update(struct work_struct *work)
148 {
149 struct qedf_ctx *qedf =
150 container_of(work, struct qedf_ctx, link_update.work);
151 int rc;
152
153 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "Entered.\n");
154
155 if (atomic_read(&qedf->link_state) == QEDF_LINK_UP) {
156 rc = qedf_initiate_fipvlan_req(qedf);
157 if (rc)
158 return;
159 /*
160 * If we get here then we never received a repsonse to our
161 * fip vlan request so set the vlan_id to the default and
162 * tell FCoE that the link is up
163 */
164 QEDF_WARN(&(qedf->dbg_ctx), "Did not receive FIP VLAN "
165 "response, falling back to default VLAN %d.\n",
166 qedf_fallback_vlan);
167 qedf_set_vlan_id(qedf, qedf_fallback_vlan);
168
169 /*
170 * Zero out data_src_addr so we'll update it with the new
171 * lport port_id
172 */
173 eth_zero_addr(qedf->data_src_addr);
174 fcoe_ctlr_link_up(&qedf->ctlr);
175 } else if (atomic_read(&qedf->link_state) == QEDF_LINK_DOWN) {
176 /*
177 * If we hit here and link_down_tmo_valid is still 1 it means
178 * that link_down_tmo timed out so set it to 0 to make sure any
179 * other readers have accurate state.
180 */
181 atomic_set(&qedf->link_down_tmo_valid, 0);
182 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
183 "Calling fcoe_ctlr_link_down().\n");
184 fcoe_ctlr_link_down(&qedf->ctlr);
185 qedf_wait_for_upload(qedf);
186 /* Reset the number of FIP VLAN retries */
187 qedf->fipvlan_retries = qedf_fipvlan_retries;
188 }
189 }
190
191 #define QEDF_FCOE_MAC_METHOD_GRANGED_MAC 1
192 #define QEDF_FCOE_MAC_METHOD_FCF_MAP 2
193 #define QEDF_FCOE_MAC_METHOD_FCOE_SET_MAC 3
194 static void qedf_set_data_src_addr(struct qedf_ctx *qedf, struct fc_frame *fp)
195 {
196 u8 *granted_mac;
197 struct fc_frame_header *fh = fc_frame_header_get(fp);
198 u8 fc_map[3];
199 int method = 0;
200
201 /* Get granted MAC address from FIP FLOGI payload */
202 granted_mac = fr_cb(fp)->granted_mac;
203
204 /*
205 * We set the source MAC for FCoE traffic based on the Granted MAC
206 * address from the switch.
207 *
208 * If granted_mac is non-zero, we used that.
209 * If the granted_mac is zeroed out, created the FCoE MAC based on
210 * the sel_fcf->fc_map and the d_id fo the FLOGI frame.
211 * If sel_fcf->fc_map is 0 then we use the default FCF-MAC plus the
212 * d_id of the FLOGI frame.
213 */
214 if (!is_zero_ether_addr(granted_mac)) {
215 ether_addr_copy(qedf->data_src_addr, granted_mac);
216 method = QEDF_FCOE_MAC_METHOD_GRANGED_MAC;
217 } else if (qedf->ctlr.sel_fcf->fc_map != 0) {
218 hton24(fc_map, qedf->ctlr.sel_fcf->fc_map);
219 qedf->data_src_addr[0] = fc_map[0];
220 qedf->data_src_addr[1] = fc_map[1];
221 qedf->data_src_addr[2] = fc_map[2];
222 qedf->data_src_addr[3] = fh->fh_d_id[0];
223 qedf->data_src_addr[4] = fh->fh_d_id[1];
224 qedf->data_src_addr[5] = fh->fh_d_id[2];
225 method = QEDF_FCOE_MAC_METHOD_FCF_MAP;
226 } else {
227 fc_fcoe_set_mac(qedf->data_src_addr, fh->fh_d_id);
228 method = QEDF_FCOE_MAC_METHOD_FCOE_SET_MAC;
229 }
230
231 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
232 "QEDF data_src_mac=%pM method=%d.\n", qedf->data_src_addr, method);
233 }
234
235 static void qedf_flogi_resp(struct fc_seq *seq, struct fc_frame *fp,
236 void *arg)
237 {
238 struct fc_exch *exch = fc_seq_exch(seq);
239 struct fc_lport *lport = exch->lp;
240 struct qedf_ctx *qedf = lport_priv(lport);
241
242 if (!qedf) {
243 QEDF_ERR(NULL, "qedf is NULL.\n");
244 return;
245 }
246
247 /*
248 * If ERR_PTR is set then don't try to stat anything as it will cause
249 * a crash when we access fp.
250 */
251 if (IS_ERR(fp)) {
252 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_ELS,
253 "fp has IS_ERR() set.\n");
254 goto skip_stat;
255 }
256
257 /* Log stats for FLOGI reject */
258 if (fc_frame_payload_op(fp) == ELS_LS_RJT)
259 qedf->flogi_failed++;
260 else if (fc_frame_payload_op(fp) == ELS_LS_ACC) {
261 /* Set the source MAC we will use for FCoE traffic */
262 qedf_set_data_src_addr(qedf, fp);
263 }
264
265 /* Complete flogi_compl so we can proceed to sending ADISCs */
266 complete(&qedf->flogi_compl);
267
268 skip_stat:
269 /* Report response to libfc */
270 fc_lport_flogi_resp(seq, fp, lport);
271 }
272
273 static struct fc_seq *qedf_elsct_send(struct fc_lport *lport, u32 did,
274 struct fc_frame *fp, unsigned int op,
275 void (*resp)(struct fc_seq *,
276 struct fc_frame *,
277 void *),
278 void *arg, u32 timeout)
279 {
280 struct qedf_ctx *qedf = lport_priv(lport);
281
282 /*
283 * Intercept FLOGI for statistic purposes. Note we use the resp
284 * callback to tell if this is really a flogi.
285 */
286 if (resp == fc_lport_flogi_resp) {
287 qedf->flogi_cnt++;
288 return fc_elsct_send(lport, did, fp, op, qedf_flogi_resp,
289 arg, timeout);
290 }
291
292 return fc_elsct_send(lport, did, fp, op, resp, arg, timeout);
293 }
294
295 int qedf_send_flogi(struct qedf_ctx *qedf)
296 {
297 struct fc_lport *lport;
298 struct fc_frame *fp;
299
300 lport = qedf->lport;
301
302 if (!lport->tt.elsct_send)
303 return -EINVAL;
304
305 fp = fc_frame_alloc(lport, sizeof(struct fc_els_flogi));
306 if (!fp) {
307 QEDF_ERR(&(qedf->dbg_ctx), "fc_frame_alloc failed.\n");
308 return -ENOMEM;
309 }
310
311 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_ELS,
312 "Sending FLOGI to reestablish session with switch.\n");
313 lport->tt.elsct_send(lport, FC_FID_FLOGI, fp,
314 ELS_FLOGI, qedf_flogi_resp, lport, lport->r_a_tov);
315
316 init_completion(&qedf->flogi_compl);
317
318 return 0;
319 }
320
321 struct qedf_tmp_rdata_item {
322 struct fc_rport_priv *rdata;
323 struct list_head list;
324 };
325
326 /*
327 * This function is called if link_down_tmo is in use. If we get a link up and
328 * link_down_tmo has not expired then use just FLOGI/ADISC to recover our
329 * sessions with targets. Otherwise, just call fcoe_ctlr_link_up().
330 */
331 static void qedf_link_recovery(struct work_struct *work)
332 {
333 struct qedf_ctx *qedf =
334 container_of(work, struct qedf_ctx, link_recovery.work);
335 struct qedf_rport *fcport;
336 struct fc_rport_priv *rdata;
337 struct qedf_tmp_rdata_item *rdata_item, *tmp_rdata_item;
338 bool rc;
339 int retries = 30;
340 int rval, i;
341 struct list_head rdata_login_list;
342
343 INIT_LIST_HEAD(&rdata_login_list);
344
345 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
346 "Link down tmo did not expire.\n");
347
348 /*
349 * Essentially reset the fcoe_ctlr here without affecting the state
350 * of the libfc structs.
351 */
352 qedf->ctlr.state = FIP_ST_LINK_WAIT;
353 fcoe_ctlr_link_down(&qedf->ctlr);
354
355 /*
356 * Bring the link up before we send the fipvlan request so libfcoe
357 * can select a new fcf in parallel
358 */
359 fcoe_ctlr_link_up(&qedf->ctlr);
360
361 /* Since the link when down and up to verify which vlan we're on */
362 qedf->fipvlan_retries = qedf_fipvlan_retries;
363 rc = qedf_initiate_fipvlan_req(qedf);
364 /* If getting the VLAN fails, set the VLAN to the fallback one */
365 if (!rc)
366 qedf_set_vlan_id(qedf, qedf_fallback_vlan);
367
368 /*
369 * We need to wait for an FCF to be selected due to the
370 * fcoe_ctlr_link_up other the FLOGI will be rejected.
371 */
372 while (retries > 0) {
373 if (qedf->ctlr.sel_fcf) {
374 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
375 "FCF reselected, proceeding with FLOGI.\n");
376 break;
377 }
378 msleep(500);
379 retries--;
380 }
381
382 if (retries < 1) {
383 QEDF_ERR(&(qedf->dbg_ctx), "Exhausted retries waiting for "
384 "FCF selection.\n");
385 return;
386 }
387
388 rval = qedf_send_flogi(qedf);
389 if (rval)
390 return;
391
392 /* Wait for FLOGI completion before proceeding with sending ADISCs */
393 i = wait_for_completion_timeout(&qedf->flogi_compl,
394 qedf->lport->r_a_tov);
395 if (i == 0) {
396 QEDF_ERR(&(qedf->dbg_ctx), "FLOGI timed out.\n");
397 return;
398 }
399
400 /*
401 * Call lport->tt.rport_login which will cause libfc to send an
402 * ADISC since the rport is in state ready.
403 */
404 rcu_read_lock();
405 list_for_each_entry_rcu(fcport, &qedf->fcports, peers) {
406 rdata = fcport->rdata;
407 if (rdata == NULL)
408 continue;
409 rdata_item = kzalloc(sizeof(struct qedf_tmp_rdata_item),
410 GFP_ATOMIC);
411 if (!rdata_item)
412 continue;
413 if (kref_get_unless_zero(&rdata->kref)) {
414 rdata_item->rdata = rdata;
415 list_add(&rdata_item->list, &rdata_login_list);
416 } else
417 kfree(rdata_item);
418 }
419 rcu_read_unlock();
420 /*
421 * Do the fc_rport_login outside of the rcu lock so we don't take a
422 * mutex in an atomic context.
423 */
424 list_for_each_entry_safe(rdata_item, tmp_rdata_item, &rdata_login_list,
425 list) {
426 list_del(&rdata_item->list);
427 fc_rport_login(rdata_item->rdata);
428 kref_put(&rdata_item->rdata->kref, fc_rport_destroy);
429 kfree(rdata_item);
430 }
431 }
432
433 static void qedf_update_link_speed(struct qedf_ctx *qedf,
434 struct qed_link_output *link)
435 {
436 struct fc_lport *lport = qedf->lport;
437
438 lport->link_speed = FC_PORTSPEED_UNKNOWN;
439 lport->link_supported_speeds = FC_PORTSPEED_UNKNOWN;
440
441 /* Set fc_host link speed */
442 switch (link->speed) {
443 case 10000:
444 lport->link_speed = FC_PORTSPEED_10GBIT;
445 break;
446 case 25000:
447 lport->link_speed = FC_PORTSPEED_25GBIT;
448 break;
449 case 40000:
450 lport->link_speed = FC_PORTSPEED_40GBIT;
451 break;
452 case 50000:
453 lport->link_speed = FC_PORTSPEED_50GBIT;
454 break;
455 case 100000:
456 lport->link_speed = FC_PORTSPEED_100GBIT;
457 break;
458 default:
459 lport->link_speed = FC_PORTSPEED_UNKNOWN;
460 break;
461 }
462
463 /*
464 * Set supported link speed by querying the supported
465 * capabilities of the link.
466 */
467 if (link->supported_caps & SUPPORTED_10000baseKR_Full)
468 lport->link_supported_speeds |= FC_PORTSPEED_10GBIT;
469 if (link->supported_caps & SUPPORTED_25000baseKR_Full)
470 lport->link_supported_speeds |= FC_PORTSPEED_25GBIT;
471 if (link->supported_caps & SUPPORTED_40000baseLR4_Full)
472 lport->link_supported_speeds |= FC_PORTSPEED_40GBIT;
473 if (link->supported_caps & SUPPORTED_50000baseKR2_Full)
474 lport->link_supported_speeds |= FC_PORTSPEED_50GBIT;
475 if (link->supported_caps & SUPPORTED_100000baseKR4_Full)
476 lport->link_supported_speeds |= FC_PORTSPEED_100GBIT;
477 fc_host_supported_speeds(lport->host) = lport->link_supported_speeds;
478 }
479
480 static void qedf_link_update(void *dev, struct qed_link_output *link)
481 {
482 struct qedf_ctx *qedf = (struct qedf_ctx *)dev;
483
484 if (link->link_up) {
485 QEDF_ERR(&(qedf->dbg_ctx), "LINK UP (%d GB/s).\n",
486 link->speed / 1000);
487
488 /* Cancel any pending link down work */
489 cancel_delayed_work(&qedf->link_update);
490
491 atomic_set(&qedf->link_state, QEDF_LINK_UP);
492 qedf_update_link_speed(qedf, link);
493
494 if (atomic_read(&qedf->dcbx) == QEDF_DCBX_DONE) {
495 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
496 "DCBx done.\n");
497 if (atomic_read(&qedf->link_down_tmo_valid) > 0)
498 queue_delayed_work(qedf->link_update_wq,
499 &qedf->link_recovery, 0);
500 else
501 queue_delayed_work(qedf->link_update_wq,
502 &qedf->link_update, 0);
503 atomic_set(&qedf->link_down_tmo_valid, 0);
504 }
505
506 } else {
507 QEDF_ERR(&(qedf->dbg_ctx), "LINK DOWN.\n");
508
509 atomic_set(&qedf->link_state, QEDF_LINK_DOWN);
510 atomic_set(&qedf->dcbx, QEDF_DCBX_PENDING);
511 /*
512 * Flag that we're waiting for the link to come back up before
513 * informing the fcoe layer of the event.
514 */
515 if (qedf_link_down_tmo > 0) {
516 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
517 "Starting link down tmo.\n");
518 atomic_set(&qedf->link_down_tmo_valid, 1);
519 }
520 qedf->vlan_id = 0;
521 qedf_update_link_speed(qedf, link);
522 queue_delayed_work(qedf->link_update_wq, &qedf->link_update,
523 qedf_link_down_tmo * HZ);
524 }
525 }
526
527
528 static void qedf_dcbx_handler(void *dev, struct qed_dcbx_get *get, u32 mib_type)
529 {
530 struct qedf_ctx *qedf = (struct qedf_ctx *)dev;
531
532 QEDF_ERR(&(qedf->dbg_ctx), "DCBx event valid=%d enabled=%d fcoe "
533 "prio=%d.\n", get->operational.valid, get->operational.enabled,
534 get->operational.app_prio.fcoe);
535
536 if (get->operational.enabled && get->operational.valid) {
537 /* If DCBX was already negotiated on link up then just exit */
538 if (atomic_read(&qedf->dcbx) == QEDF_DCBX_DONE) {
539 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
540 "DCBX already set on link up.\n");
541 return;
542 }
543
544 atomic_set(&qedf->dcbx, QEDF_DCBX_DONE);
545
546 if (atomic_read(&qedf->link_state) == QEDF_LINK_UP) {
547 if (atomic_read(&qedf->link_down_tmo_valid) > 0)
548 queue_delayed_work(qedf->link_update_wq,
549 &qedf->link_recovery, 0);
550 else
551 queue_delayed_work(qedf->link_update_wq,
552 &qedf->link_update, 0);
553 atomic_set(&qedf->link_down_tmo_valid, 0);
554 }
555 }
556
557 }
558
559 static u32 qedf_get_login_failures(void *cookie)
560 {
561 struct qedf_ctx *qedf;
562
563 qedf = (struct qedf_ctx *)cookie;
564 return qedf->flogi_failed;
565 }
566
567 static struct qed_fcoe_cb_ops qedf_cb_ops = {
568 {
569 .link_update = qedf_link_update,
570 .dcbx_aen = qedf_dcbx_handler,
571 }
572 };
573
574 /*
575 * Various transport templates.
576 */
577
578 static struct scsi_transport_template *qedf_fc_transport_template;
579 static struct scsi_transport_template *qedf_fc_vport_transport_template;
580
581 /*
582 * SCSI EH handlers
583 */
584 static int qedf_eh_abort(struct scsi_cmnd *sc_cmd)
585 {
586 struct fc_rport *rport = starget_to_rport(scsi_target(sc_cmd->device));
587 struct fc_rport_libfc_priv *rp = rport->dd_data;
588 struct qedf_rport *fcport;
589 struct fc_lport *lport;
590 struct qedf_ctx *qedf;
591 struct qedf_ioreq *io_req;
592 int rc = FAILED;
593 int rval;
594
595 if (fc_remote_port_chkready(rport)) {
596 QEDF_ERR(NULL, "rport not ready\n");
597 goto out;
598 }
599
600 lport = shost_priv(sc_cmd->device->host);
601 qedf = (struct qedf_ctx *)lport_priv(lport);
602
603 if ((lport->state != LPORT_ST_READY) || !(lport->link_up)) {
604 QEDF_ERR(&(qedf->dbg_ctx), "link not ready.\n");
605 goto out;
606 }
607
608 fcport = (struct qedf_rport *)&rp[1];
609
610 io_req = (struct qedf_ioreq *)sc_cmd->SCp.ptr;
611 if (!io_req) {
612 QEDF_ERR(&(qedf->dbg_ctx), "io_req is NULL.\n");
613 rc = SUCCESS;
614 goto out;
615 }
616
617 if (!test_bit(QEDF_CMD_OUTSTANDING, &io_req->flags) ||
618 test_bit(QEDF_CMD_IN_CLEANUP, &io_req->flags) ||
619 test_bit(QEDF_CMD_IN_ABORT, &io_req->flags)) {
620 QEDF_ERR(&(qedf->dbg_ctx), "io_req xid=0x%x already in "
621 "cleanup or abort processing or already "
622 "completed.\n", io_req->xid);
623 rc = SUCCESS;
624 goto out;
625 }
626
627 QEDF_ERR(&(qedf->dbg_ctx), "Aborting io_req sc_cmd=%p xid=0x%x "
628 "fp_idx=%d.\n", sc_cmd, io_req->xid, io_req->fp_idx);
629
630 if (qedf->stop_io_on_error) {
631 qedf_stop_all_io(qedf);
632 rc = SUCCESS;
633 goto out;
634 }
635
636 init_completion(&io_req->abts_done);
637 rval = qedf_initiate_abts(io_req, true);
638 if (rval) {
639 QEDF_ERR(&(qedf->dbg_ctx), "Failed to queue ABTS.\n");
640 goto out;
641 }
642
643 wait_for_completion(&io_req->abts_done);
644
645 if (io_req->event == QEDF_IOREQ_EV_ABORT_SUCCESS ||
646 io_req->event == QEDF_IOREQ_EV_ABORT_FAILED ||
647 io_req->event == QEDF_IOREQ_EV_CLEANUP_SUCCESS) {
648 /*
649 * If we get a reponse to the abort this is success from
650 * the perspective that all references to the command have
651 * been removed from the driver and firmware
652 */
653 rc = SUCCESS;
654 } else {
655 /* If the abort and cleanup failed then return a failure */
656 rc = FAILED;
657 }
658
659 if (rc == SUCCESS)
660 QEDF_ERR(&(qedf->dbg_ctx), "ABTS succeeded, xid=0x%x.\n",
661 io_req->xid);
662 else
663 QEDF_ERR(&(qedf->dbg_ctx), "ABTS failed, xid=0x%x.\n",
664 io_req->xid);
665
666 out:
667 return rc;
668 }
669
670 static int qedf_eh_target_reset(struct scsi_cmnd *sc_cmd)
671 {
672 QEDF_ERR(NULL, "TARGET RESET Issued...");
673 return qedf_initiate_tmf(sc_cmd, FCP_TMF_TGT_RESET);
674 }
675
676 static int qedf_eh_device_reset(struct scsi_cmnd *sc_cmd)
677 {
678 QEDF_ERR(NULL, "LUN RESET Issued...\n");
679 return qedf_initiate_tmf(sc_cmd, FCP_TMF_LUN_RESET);
680 }
681
682 void qedf_wait_for_upload(struct qedf_ctx *qedf)
683 {
684 while (1) {
685 if (atomic_read(&qedf->num_offloads))
686 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
687 "Waiting for all uploads to complete.\n");
688 else
689 break;
690 msleep(500);
691 }
692 }
693
694 /* Performs soft reset of qedf_ctx by simulating a link down/up */
695 static void qedf_ctx_soft_reset(struct fc_lport *lport)
696 {
697 struct qedf_ctx *qedf;
698
699 if (lport->vport) {
700 QEDF_ERR(NULL, "Cannot issue host reset on NPIV port.\n");
701 return;
702 }
703
704 qedf = lport_priv(lport);
705
706 /* For host reset, essentially do a soft link up/down */
707 atomic_set(&qedf->link_state, QEDF_LINK_DOWN);
708 atomic_set(&qedf->dcbx, QEDF_DCBX_PENDING);
709 queue_delayed_work(qedf->link_update_wq, &qedf->link_update,
710 0);
711 qedf_wait_for_upload(qedf);
712 atomic_set(&qedf->link_state, QEDF_LINK_UP);
713 qedf->vlan_id = 0;
714 queue_delayed_work(qedf->link_update_wq, &qedf->link_update,
715 0);
716 }
717
718 /* Reset the host by gracefully logging out and then logging back in */
719 static int qedf_eh_host_reset(struct scsi_cmnd *sc_cmd)
720 {
721 struct fc_lport *lport;
722 struct qedf_ctx *qedf;
723
724 lport = shost_priv(sc_cmd->device->host);
725 qedf = lport_priv(lport);
726
727 if (atomic_read(&qedf->link_state) == QEDF_LINK_DOWN ||
728 test_bit(QEDF_UNLOADING, &qedf->flags))
729 return FAILED;
730
731 QEDF_ERR(&(qedf->dbg_ctx), "HOST RESET Issued...");
732
733 qedf_ctx_soft_reset(lport);
734
735 return SUCCESS;
736 }
737
738 static int qedf_slave_configure(struct scsi_device *sdev)
739 {
740 if (qedf_queue_depth) {
741 scsi_change_queue_depth(sdev, qedf_queue_depth);
742 }
743
744 return 0;
745 }
746
747 static struct scsi_host_template qedf_host_template = {
748 .module = THIS_MODULE,
749 .name = QEDF_MODULE_NAME,
750 .this_id = -1,
751 .cmd_per_lun = 32,
752 .use_clustering = ENABLE_CLUSTERING,
753 .max_sectors = 0xffff,
754 .queuecommand = qedf_queuecommand,
755 .shost_attrs = qedf_host_attrs,
756 .eh_abort_handler = qedf_eh_abort,
757 .eh_device_reset_handler = qedf_eh_device_reset, /* lun reset */
758 .eh_target_reset_handler = qedf_eh_target_reset, /* target reset */
759 .eh_host_reset_handler = qedf_eh_host_reset,
760 .slave_configure = qedf_slave_configure,
761 .dma_boundary = QED_HW_DMA_BOUNDARY,
762 .sg_tablesize = QEDF_MAX_BDS_PER_CMD,
763 .can_queue = FCOE_PARAMS_NUM_TASKS,
764 .change_queue_depth = scsi_change_queue_depth,
765 };
766
767 static int qedf_get_paged_crc_eof(struct sk_buff *skb, int tlen)
768 {
769 int rc;
770
771 spin_lock(&qedf_global_lock);
772 rc = fcoe_get_paged_crc_eof(skb, tlen, &qedf_global);
773 spin_unlock(&qedf_global_lock);
774
775 return rc;
776 }
777
778 static struct qedf_rport *qedf_fcport_lookup(struct qedf_ctx *qedf, u32 port_id)
779 {
780 struct qedf_rport *fcport;
781 struct fc_rport_priv *rdata;
782
783 rcu_read_lock();
784 list_for_each_entry_rcu(fcport, &qedf->fcports, peers) {
785 rdata = fcport->rdata;
786 if (rdata == NULL)
787 continue;
788 if (rdata->ids.port_id == port_id) {
789 rcu_read_unlock();
790 return fcport;
791 }
792 }
793 rcu_read_unlock();
794
795 /* Return NULL to caller to let them know fcport was not found */
796 return NULL;
797 }
798
799 /* Transmits an ELS frame over an offloaded session */
800 static int qedf_xmit_l2_frame(struct qedf_rport *fcport, struct fc_frame *fp)
801 {
802 struct fc_frame_header *fh;
803 int rc = 0;
804
805 fh = fc_frame_header_get(fp);
806 if ((fh->fh_type == FC_TYPE_ELS) &&
807 (fh->fh_r_ctl == FC_RCTL_ELS_REQ)) {
808 switch (fc_frame_payload_op(fp)) {
809 case ELS_ADISC:
810 qedf_send_adisc(fcport, fp);
811 rc = 1;
812 break;
813 }
814 }
815
816 return rc;
817 }
818
819 /**
820 * qedf_xmit - qedf FCoE frame transmit function
821 *
822 */
823 static int qedf_xmit(struct fc_lport *lport, struct fc_frame *fp)
824 {
825 struct fc_lport *base_lport;
826 struct qedf_ctx *qedf;
827 struct ethhdr *eh;
828 struct fcoe_crc_eof *cp;
829 struct sk_buff *skb;
830 struct fc_frame_header *fh;
831 struct fcoe_hdr *hp;
832 u8 sof, eof;
833 u32 crc;
834 unsigned int hlen, tlen, elen;
835 int wlen;
836 struct fc_stats *stats;
837 struct fc_lport *tmp_lport;
838 struct fc_lport *vn_port = NULL;
839 struct qedf_rport *fcport;
840 int rc;
841 u16 vlan_tci = 0;
842
843 qedf = (struct qedf_ctx *)lport_priv(lport);
844
845 fh = fc_frame_header_get(fp);
846 skb = fp_skb(fp);
847
848 /* Filter out traffic to other NPIV ports on the same host */
849 if (lport->vport)
850 base_lport = shost_priv(vport_to_shost(lport->vport));
851 else
852 base_lport = lport;
853
854 /* Flag if the destination is the base port */
855 if (base_lport->port_id == ntoh24(fh->fh_d_id)) {
856 vn_port = base_lport;
857 } else {
858 /* Got through the list of vports attached to the base_lport
859 * and see if we have a match with the destination address.
860 */
861 list_for_each_entry(tmp_lport, &base_lport->vports, list) {
862 if (tmp_lport->port_id == ntoh24(fh->fh_d_id)) {
863 vn_port = tmp_lport;
864 break;
865 }
866 }
867 }
868 if (vn_port && ntoh24(fh->fh_d_id) != FC_FID_FLOGI) {
869 struct fc_rport_priv *rdata = NULL;
870
871 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_LL2,
872 "Dropping FCoE frame to %06x.\n", ntoh24(fh->fh_d_id));
873 kfree_skb(skb);
874 rdata = fc_rport_lookup(lport, ntoh24(fh->fh_d_id));
875 if (rdata)
876 rdata->retries = lport->max_rport_retry_count;
877 return -EINVAL;
878 }
879 /* End NPIV filtering */
880
881 if (!qedf->ctlr.sel_fcf) {
882 kfree_skb(skb);
883 return 0;
884 }
885
886 if (!test_bit(QEDF_LL2_STARTED, &qedf->flags)) {
887 QEDF_WARN(&(qedf->dbg_ctx), "LL2 not started\n");
888 kfree_skb(skb);
889 return 0;
890 }
891
892 if (atomic_read(&qedf->link_state) != QEDF_LINK_UP) {
893 QEDF_WARN(&(qedf->dbg_ctx), "qedf link down\n");
894 kfree_skb(skb);
895 return 0;
896 }
897
898 if (unlikely(fh->fh_r_ctl == FC_RCTL_ELS_REQ)) {
899 if (fcoe_ctlr_els_send(&qedf->ctlr, lport, skb))
900 return 0;
901 }
902
903 /* Check to see if this needs to be sent on an offloaded session */
904 fcport = qedf_fcport_lookup(qedf, ntoh24(fh->fh_d_id));
905
906 if (fcport && test_bit(QEDF_RPORT_SESSION_READY, &fcport->flags)) {
907 rc = qedf_xmit_l2_frame(fcport, fp);
908 /*
909 * If the frame was successfully sent over the middle path
910 * then do not try to also send it over the LL2 path
911 */
912 if (rc)
913 return 0;
914 }
915
916 sof = fr_sof(fp);
917 eof = fr_eof(fp);
918
919 elen = sizeof(struct ethhdr);
920 hlen = sizeof(struct fcoe_hdr);
921 tlen = sizeof(struct fcoe_crc_eof);
922 wlen = (skb->len - tlen + sizeof(crc)) / FCOE_WORD_TO_BYTE;
923
924 skb->ip_summed = CHECKSUM_NONE;
925 crc = fcoe_fc_crc(fp);
926
927 /* copy port crc and eof to the skb buff */
928 if (skb_is_nonlinear(skb)) {
929 skb_frag_t *frag;
930
931 if (qedf_get_paged_crc_eof(skb, tlen)) {
932 kfree_skb(skb);
933 return -ENOMEM;
934 }
935 frag = &skb_shinfo(skb)->frags[skb_shinfo(skb)->nr_frags - 1];
936 cp = kmap_atomic(skb_frag_page(frag)) + frag->page_offset;
937 } else {
938 cp = skb_put(skb, tlen);
939 }
940
941 memset(cp, 0, sizeof(*cp));
942 cp->fcoe_eof = eof;
943 cp->fcoe_crc32 = cpu_to_le32(~crc);
944 if (skb_is_nonlinear(skb)) {
945 kunmap_atomic(cp);
946 cp = NULL;
947 }
948
949
950 /* adjust skb network/transport offsets to match mac/fcoe/port */
951 skb_push(skb, elen + hlen);
952 skb_reset_mac_header(skb);
953 skb_reset_network_header(skb);
954 skb->mac_len = elen;
955 skb->protocol = htons(ETH_P_FCOE);
956
957 /*
958 * Add VLAN tag to non-offload FCoE frame based on current stored VLAN
959 * for FIP/FCoE traffic.
960 */
961 __vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), qedf->vlan_id);
962
963 /* fill up mac and fcoe headers */
964 eh = eth_hdr(skb);
965 eh->h_proto = htons(ETH_P_FCOE);
966 if (qedf->ctlr.map_dest)
967 fc_fcoe_set_mac(eh->h_dest, fh->fh_d_id);
968 else
969 /* insert GW address */
970 ether_addr_copy(eh->h_dest, qedf->ctlr.dest_addr);
971
972 /* Set the source MAC address */
973 ether_addr_copy(eh->h_source, qedf->data_src_addr);
974
975 hp = (struct fcoe_hdr *)(eh + 1);
976 memset(hp, 0, sizeof(*hp));
977 if (FC_FCOE_VER)
978 FC_FCOE_ENCAPS_VER(hp, FC_FCOE_VER);
979 hp->fcoe_sof = sof;
980
981 /*update tx stats */
982 stats = per_cpu_ptr(lport->stats, get_cpu());
983 stats->TxFrames++;
984 stats->TxWords += wlen;
985 put_cpu();
986
987 /* Get VLAN ID from skb for printing purposes */
988 __vlan_hwaccel_get_tag(skb, &vlan_tci);
989
990 /* send down to lld */
991 fr_dev(fp) = lport;
992 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_LL2, "FCoE frame send: "
993 "src=%06x dest=%06x r_ctl=%x type=%x vlan=%04x.\n",
994 ntoh24(fh->fh_s_id), ntoh24(fh->fh_d_id), fh->fh_r_ctl, fh->fh_type,
995 vlan_tci);
996 if (qedf_dump_frames)
997 print_hex_dump(KERN_WARNING, "fcoe: ", DUMP_PREFIX_OFFSET, 16,
998 1, skb->data, skb->len, false);
999 qed_ops->ll2->start_xmit(qedf->cdev, skb);
1000
1001 return 0;
1002 }
1003
1004 static int qedf_alloc_sq(struct qedf_ctx *qedf, struct qedf_rport *fcport)
1005 {
1006 int rval = 0;
1007 u32 *pbl;
1008 dma_addr_t page;
1009 int num_pages;
1010
1011 /* Calculate appropriate queue and PBL sizes */
1012 fcport->sq_mem_size = SQ_NUM_ENTRIES * sizeof(struct fcoe_wqe);
1013 fcport->sq_mem_size = ALIGN(fcport->sq_mem_size, QEDF_PAGE_SIZE);
1014 fcport->sq_pbl_size = (fcport->sq_mem_size / QEDF_PAGE_SIZE) *
1015 sizeof(void *);
1016 fcport->sq_pbl_size = fcport->sq_pbl_size + QEDF_PAGE_SIZE;
1017
1018 fcport->sq = dma_zalloc_coherent(&qedf->pdev->dev,
1019 fcport->sq_mem_size, &fcport->sq_dma, GFP_KERNEL);
1020 if (!fcport->sq) {
1021 QEDF_WARN(&(qedf->dbg_ctx), "Could not allocate send queue.\n");
1022 rval = 1;
1023 goto out;
1024 }
1025
1026 fcport->sq_pbl = dma_zalloc_coherent(&qedf->pdev->dev,
1027 fcport->sq_pbl_size, &fcport->sq_pbl_dma, GFP_KERNEL);
1028 if (!fcport->sq_pbl) {
1029 QEDF_WARN(&(qedf->dbg_ctx), "Could not allocate send queue PBL.\n");
1030 rval = 1;
1031 goto out_free_sq;
1032 }
1033
1034 /* Create PBL */
1035 num_pages = fcport->sq_mem_size / QEDF_PAGE_SIZE;
1036 page = fcport->sq_dma;
1037 pbl = (u32 *)fcport->sq_pbl;
1038
1039 while (num_pages--) {
1040 *pbl = U64_LO(page);
1041 pbl++;
1042 *pbl = U64_HI(page);
1043 pbl++;
1044 page += QEDF_PAGE_SIZE;
1045 }
1046
1047 return rval;
1048
1049 out_free_sq:
1050 dma_free_coherent(&qedf->pdev->dev, fcport->sq_mem_size, fcport->sq,
1051 fcport->sq_dma);
1052 out:
1053 return rval;
1054 }
1055
1056 static void qedf_free_sq(struct qedf_ctx *qedf, struct qedf_rport *fcport)
1057 {
1058 if (fcport->sq_pbl)
1059 dma_free_coherent(&qedf->pdev->dev, fcport->sq_pbl_size,
1060 fcport->sq_pbl, fcport->sq_pbl_dma);
1061 if (fcport->sq)
1062 dma_free_coherent(&qedf->pdev->dev, fcport->sq_mem_size,
1063 fcport->sq, fcport->sq_dma);
1064 }
1065
1066 static int qedf_offload_connection(struct qedf_ctx *qedf,
1067 struct qedf_rport *fcport)
1068 {
1069 struct qed_fcoe_params_offload conn_info;
1070 u32 port_id;
1071 int rval;
1072 uint16_t total_sqe = (fcport->sq_mem_size / sizeof(struct fcoe_wqe));
1073
1074 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_CONN, "Offloading connection "
1075 "portid=%06x.\n", fcport->rdata->ids.port_id);
1076 rval = qed_ops->acquire_conn(qedf->cdev, &fcport->handle,
1077 &fcport->fw_cid, &fcport->p_doorbell);
1078 if (rval) {
1079 QEDF_WARN(&(qedf->dbg_ctx), "Could not acquire connection "
1080 "for portid=%06x.\n", fcport->rdata->ids.port_id);
1081 rval = 1; /* For some reason qed returns 0 on failure here */
1082 goto out;
1083 }
1084
1085 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_CONN, "portid=%06x "
1086 "fw_cid=%08x handle=%d.\n", fcport->rdata->ids.port_id,
1087 fcport->fw_cid, fcport->handle);
1088
1089 memset(&conn_info, 0, sizeof(struct qed_fcoe_params_offload));
1090
1091 /* Fill in the offload connection info */
1092 conn_info.sq_pbl_addr = fcport->sq_pbl_dma;
1093
1094 conn_info.sq_curr_page_addr = (dma_addr_t)(*(u64 *)fcport->sq_pbl);
1095 conn_info.sq_next_page_addr =
1096 (dma_addr_t)(*(u64 *)(fcport->sq_pbl + 8));
1097
1098 /* Need to use our FCoE MAC for the offload session */
1099 ether_addr_copy(conn_info.src_mac, qedf->data_src_addr);
1100
1101 ether_addr_copy(conn_info.dst_mac, qedf->ctlr.dest_addr);
1102
1103 conn_info.tx_max_fc_pay_len = fcport->rdata->maxframe_size;
1104 conn_info.e_d_tov_timer_val = qedf->lport->e_d_tov / 20;
1105 conn_info.rec_tov_timer_val = 3; /* I think this is what E3 was */
1106 conn_info.rx_max_fc_pay_len = fcport->rdata->maxframe_size;
1107
1108 /* Set VLAN data */
1109 conn_info.vlan_tag = qedf->vlan_id <<
1110 FCOE_CONN_OFFLOAD_RAMROD_DATA_VLAN_ID_SHIFT;
1111 conn_info.vlan_tag |=
1112 qedf_default_prio << FCOE_CONN_OFFLOAD_RAMROD_DATA_PRIORITY_SHIFT;
1113 conn_info.flags |= (FCOE_CONN_OFFLOAD_RAMROD_DATA_B_VLAN_FLAG_MASK <<
1114 FCOE_CONN_OFFLOAD_RAMROD_DATA_B_VLAN_FLAG_SHIFT);
1115
1116 /* Set host port source id */
1117 port_id = fc_host_port_id(qedf->lport->host);
1118 fcport->sid = port_id;
1119 conn_info.s_id.addr_hi = (port_id & 0x000000FF);
1120 conn_info.s_id.addr_mid = (port_id & 0x0000FF00) >> 8;
1121 conn_info.s_id.addr_lo = (port_id & 0x00FF0000) >> 16;
1122
1123 conn_info.max_conc_seqs_c3 = fcport->rdata->max_seq;
1124
1125 /* Set remote port destination id */
1126 port_id = fcport->rdata->rport->port_id;
1127 conn_info.d_id.addr_hi = (port_id & 0x000000FF);
1128 conn_info.d_id.addr_mid = (port_id & 0x0000FF00) >> 8;
1129 conn_info.d_id.addr_lo = (port_id & 0x00FF0000) >> 16;
1130
1131 conn_info.def_q_idx = 0; /* Default index for send queue? */
1132
1133 /* Set FC-TAPE specific flags if needed */
1134 if (fcport->dev_type == QEDF_RPORT_TYPE_TAPE) {
1135 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_CONN,
1136 "Enable CONF, REC for portid=%06x.\n",
1137 fcport->rdata->ids.port_id);
1138 conn_info.flags |= 1 <<
1139 FCOE_CONN_OFFLOAD_RAMROD_DATA_B_CONF_REQ_SHIFT;
1140 conn_info.flags |=
1141 ((fcport->rdata->sp_features & FC_SP_FT_SEQC) ? 1 : 0) <<
1142 FCOE_CONN_OFFLOAD_RAMROD_DATA_B_REC_VALID_SHIFT;
1143 }
1144
1145 rval = qed_ops->offload_conn(qedf->cdev, fcport->handle, &conn_info);
1146 if (rval) {
1147 QEDF_WARN(&(qedf->dbg_ctx), "Could not offload connection "
1148 "for portid=%06x.\n", fcport->rdata->ids.port_id);
1149 goto out_free_conn;
1150 } else
1151 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_CONN, "Offload "
1152 "succeeded portid=%06x total_sqe=%d.\n",
1153 fcport->rdata->ids.port_id, total_sqe);
1154
1155 spin_lock_init(&fcport->rport_lock);
1156 atomic_set(&fcport->free_sqes, total_sqe);
1157 return 0;
1158 out_free_conn:
1159 qed_ops->release_conn(qedf->cdev, fcport->handle);
1160 out:
1161 return rval;
1162 }
1163
1164 #define QEDF_TERM_BUFF_SIZE 10
1165 static void qedf_upload_connection(struct qedf_ctx *qedf,
1166 struct qedf_rport *fcport)
1167 {
1168 void *term_params;
1169 dma_addr_t term_params_dma;
1170
1171 /* Term params needs to be a DMA coherent buffer as qed shared the
1172 * physical DMA address with the firmware. The buffer may be used in
1173 * the receive path so we may eventually have to move this.
1174 */
1175 term_params = dma_alloc_coherent(&qedf->pdev->dev, QEDF_TERM_BUFF_SIZE,
1176 &term_params_dma, GFP_KERNEL);
1177
1178 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_CONN, "Uploading connection "
1179 "port_id=%06x.\n", fcport->rdata->ids.port_id);
1180
1181 qed_ops->destroy_conn(qedf->cdev, fcport->handle, term_params_dma);
1182 qed_ops->release_conn(qedf->cdev, fcport->handle);
1183
1184 dma_free_coherent(&qedf->pdev->dev, QEDF_TERM_BUFF_SIZE, term_params,
1185 term_params_dma);
1186 }
1187
1188 static void qedf_cleanup_fcport(struct qedf_ctx *qedf,
1189 struct qedf_rport *fcport)
1190 {
1191 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_CONN, "Cleaning up portid=%06x.\n",
1192 fcport->rdata->ids.port_id);
1193
1194 /* Flush any remaining i/o's before we upload the connection */
1195 qedf_flush_active_ios(fcport, -1);
1196
1197 if (test_and_clear_bit(QEDF_RPORT_SESSION_READY, &fcport->flags))
1198 qedf_upload_connection(qedf, fcport);
1199 qedf_free_sq(qedf, fcport);
1200 fcport->rdata = NULL;
1201 fcport->qedf = NULL;
1202 }
1203
1204 /**
1205 * This event_callback is called after successful completion of libfc
1206 * initiated target login. qedf can proceed with initiating the session
1207 * establishment.
1208 */
1209 static void qedf_rport_event_handler(struct fc_lport *lport,
1210 struct fc_rport_priv *rdata,
1211 enum fc_rport_event event)
1212 {
1213 struct qedf_ctx *qedf = lport_priv(lport);
1214 struct fc_rport *rport = rdata->rport;
1215 struct fc_rport_libfc_priv *rp;
1216 struct qedf_rport *fcport;
1217 u32 port_id;
1218 int rval;
1219 unsigned long flags;
1220
1221 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "event = %d, "
1222 "port_id = 0x%x\n", event, rdata->ids.port_id);
1223
1224 switch (event) {
1225 case RPORT_EV_READY:
1226 if (!rport) {
1227 QEDF_WARN(&(qedf->dbg_ctx), "rport is NULL.\n");
1228 break;
1229 }
1230
1231 rp = rport->dd_data;
1232 fcport = (struct qedf_rport *)&rp[1];
1233 fcport->qedf = qedf;
1234
1235 if (atomic_read(&qedf->num_offloads) >= QEDF_MAX_SESSIONS) {
1236 QEDF_ERR(&(qedf->dbg_ctx), "Not offloading "
1237 "portid=0x%x as max number of offloaded sessions "
1238 "reached.\n", rdata->ids.port_id);
1239 return;
1240 }
1241
1242 /*
1243 * Don't try to offload the session again. Can happen when we
1244 * get an ADISC
1245 */
1246 if (test_bit(QEDF_RPORT_SESSION_READY, &fcport->flags)) {
1247 QEDF_WARN(&(qedf->dbg_ctx), "Session already "
1248 "offloaded, portid=0x%x.\n",
1249 rdata->ids.port_id);
1250 return;
1251 }
1252
1253 if (rport->port_id == FC_FID_DIR_SERV) {
1254 /*
1255 * qedf_rport structure doesn't exist for
1256 * directory server.
1257 * We should not come here, as lport will
1258 * take care of fabric login
1259 */
1260 QEDF_WARN(&(qedf->dbg_ctx), "rport struct does not "
1261 "exist for dir server port_id=%x\n",
1262 rdata->ids.port_id);
1263 break;
1264 }
1265
1266 if (rdata->spp_type != FC_TYPE_FCP) {
1267 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
1268 "Not offloading since spp type isn't FCP\n");
1269 break;
1270 }
1271 if (!(rdata->ids.roles & FC_RPORT_ROLE_FCP_TARGET)) {
1272 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
1273 "Not FCP target so not offloading\n");
1274 break;
1275 }
1276
1277 fcport->rdata = rdata;
1278 fcport->rport = rport;
1279
1280 rval = qedf_alloc_sq(qedf, fcport);
1281 if (rval) {
1282 qedf_cleanup_fcport(qedf, fcport);
1283 break;
1284 }
1285
1286 /* Set device type */
1287 if (rdata->flags & FC_RP_FLAGS_RETRY &&
1288 rdata->ids.roles & FC_RPORT_ROLE_FCP_TARGET &&
1289 !(rdata->ids.roles & FC_RPORT_ROLE_FCP_INITIATOR)) {
1290 fcport->dev_type = QEDF_RPORT_TYPE_TAPE;
1291 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
1292 "portid=%06x is a TAPE device.\n",
1293 rdata->ids.port_id);
1294 } else {
1295 fcport->dev_type = QEDF_RPORT_TYPE_DISK;
1296 }
1297
1298 rval = qedf_offload_connection(qedf, fcport);
1299 if (rval) {
1300 qedf_cleanup_fcport(qedf, fcport);
1301 break;
1302 }
1303
1304 /* Add fcport to list of qedf_ctx list of offloaded ports */
1305 spin_lock_irqsave(&qedf->hba_lock, flags);
1306 list_add_rcu(&fcport->peers, &qedf->fcports);
1307 spin_unlock_irqrestore(&qedf->hba_lock, flags);
1308
1309 /*
1310 * Set the session ready bit to let everyone know that this
1311 * connection is ready for I/O
1312 */
1313 set_bit(QEDF_RPORT_SESSION_READY, &fcport->flags);
1314 atomic_inc(&qedf->num_offloads);
1315
1316 break;
1317 case RPORT_EV_LOGO:
1318 case RPORT_EV_FAILED:
1319 case RPORT_EV_STOP:
1320 port_id = rdata->ids.port_id;
1321 if (port_id == FC_FID_DIR_SERV)
1322 break;
1323
1324 if (!rport) {
1325 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
1326 "port_id=%x - rport notcreated Yet!!\n", port_id);
1327 break;
1328 }
1329 rp = rport->dd_data;
1330 /*
1331 * Perform session upload. Note that rdata->peers is already
1332 * removed from disc->rports list before we get this event.
1333 */
1334 fcport = (struct qedf_rport *)&rp[1];
1335
1336 /* Only free this fcport if it is offloaded already */
1337 if (test_bit(QEDF_RPORT_SESSION_READY, &fcport->flags)) {
1338 set_bit(QEDF_RPORT_UPLOADING_CONNECTION, &fcport->flags);
1339 qedf_cleanup_fcport(qedf, fcport);
1340
1341 /*
1342 * Remove fcport to list of qedf_ctx list of offloaded
1343 * ports
1344 */
1345 spin_lock_irqsave(&qedf->hba_lock, flags);
1346 list_del_rcu(&fcport->peers);
1347 spin_unlock_irqrestore(&qedf->hba_lock, flags);
1348
1349 clear_bit(QEDF_RPORT_UPLOADING_CONNECTION,
1350 &fcport->flags);
1351 atomic_dec(&qedf->num_offloads);
1352 }
1353
1354 break;
1355
1356 case RPORT_EV_NONE:
1357 break;
1358 }
1359 }
1360
1361 static void qedf_abort_io(struct fc_lport *lport)
1362 {
1363 /* NO-OP but need to fill in the template */
1364 }
1365
1366 static void qedf_fcp_cleanup(struct fc_lport *lport)
1367 {
1368 /*
1369 * NO-OP but need to fill in template to prevent a NULL
1370 * function pointer dereference during link down. I/Os
1371 * will be flushed when port is uploaded.
1372 */
1373 }
1374
1375 static struct libfc_function_template qedf_lport_template = {
1376 .frame_send = qedf_xmit,
1377 .fcp_abort_io = qedf_abort_io,
1378 .fcp_cleanup = qedf_fcp_cleanup,
1379 .rport_event_callback = qedf_rport_event_handler,
1380 .elsct_send = qedf_elsct_send,
1381 };
1382
1383 static void qedf_fcoe_ctlr_setup(struct qedf_ctx *qedf)
1384 {
1385 fcoe_ctlr_init(&qedf->ctlr, FIP_ST_AUTO);
1386
1387 qedf->ctlr.send = qedf_fip_send;
1388 qedf->ctlr.get_src_addr = qedf_get_src_mac;
1389 ether_addr_copy(qedf->ctlr.ctl_src_addr, qedf->mac);
1390 }
1391
1392 static void qedf_setup_fdmi(struct qedf_ctx *qedf)
1393 {
1394 struct fc_lport *lport = qedf->lport;
1395 struct fc_host_attrs *fc_host = shost_to_fc_host(lport->host);
1396 u8 buf[8];
1397 int i, pos;
1398
1399 /*
1400 * fdmi_enabled needs to be set for libfc to execute FDMI registration.
1401 */
1402 lport->fdmi_enabled = 1;
1403
1404 /*
1405 * Setup the necessary fc_host attributes to that will be used to fill
1406 * in the FDMI information.
1407 */
1408
1409 /* Get the PCI-e Device Serial Number Capability */
1410 pos = pci_find_ext_capability(qedf->pdev, PCI_EXT_CAP_ID_DSN);
1411 if (pos) {
1412 pos += 4;
1413 for (i = 0; i < 8; i++)
1414 pci_read_config_byte(qedf->pdev, pos + i, &buf[i]);
1415
1416 snprintf(fc_host->serial_number,
1417 sizeof(fc_host->serial_number),
1418 "%02X%02X%02X%02X%02X%02X%02X%02X",
1419 buf[7], buf[6], buf[5], buf[4],
1420 buf[3], buf[2], buf[1], buf[0]);
1421 } else
1422 snprintf(fc_host->serial_number,
1423 sizeof(fc_host->serial_number), "Unknown");
1424
1425 snprintf(fc_host->manufacturer,
1426 sizeof(fc_host->manufacturer), "%s", "Cavium Inc.");
1427
1428 snprintf(fc_host->model, sizeof(fc_host->model), "%s", "QL41000");
1429
1430 snprintf(fc_host->model_description, sizeof(fc_host->model_description),
1431 "%s", "QLogic FastLinQ QL41000 Series 10/25/40/50GGbE Controller"
1432 "(FCoE)");
1433
1434 snprintf(fc_host->hardware_version, sizeof(fc_host->hardware_version),
1435 "Rev %d", qedf->pdev->revision);
1436
1437 snprintf(fc_host->driver_version, sizeof(fc_host->driver_version),
1438 "%s", QEDF_VERSION);
1439
1440 snprintf(fc_host->firmware_version, sizeof(fc_host->firmware_version),
1441 "%d.%d.%d.%d", FW_MAJOR_VERSION, FW_MINOR_VERSION,
1442 FW_REVISION_VERSION, FW_ENGINEERING_VERSION);
1443 }
1444
1445 static int qedf_lport_setup(struct qedf_ctx *qedf)
1446 {
1447 struct fc_lport *lport = qedf->lport;
1448
1449 lport->link_up = 0;
1450 lport->max_retry_count = QEDF_FLOGI_RETRY_CNT;
1451 lport->max_rport_retry_count = QEDF_RPORT_RETRY_CNT;
1452 lport->service_params = (FCP_SPPF_INIT_FCN | FCP_SPPF_RD_XRDY_DIS |
1453 FCP_SPPF_RETRY | FCP_SPPF_CONF_COMPL);
1454 lport->boot_time = jiffies;
1455 lport->e_d_tov = 2 * 1000;
1456 lport->r_a_tov = 10 * 1000;
1457
1458 /* Set NPIV support */
1459 lport->does_npiv = 1;
1460 fc_host_max_npiv_vports(lport->host) = QEDF_MAX_NPIV;
1461
1462 fc_set_wwnn(lport, qedf->wwnn);
1463 fc_set_wwpn(lport, qedf->wwpn);
1464
1465 fcoe_libfc_config(lport, &qedf->ctlr, &qedf_lport_template, 0);
1466
1467 /* Allocate the exchange manager */
1468 fc_exch_mgr_alloc(lport, FC_CLASS_3, qedf->max_scsi_xid + 1,
1469 qedf->max_els_xid, NULL);
1470
1471 if (fc_lport_init_stats(lport))
1472 return -ENOMEM;
1473
1474 /* Finish lport config */
1475 fc_lport_config(lport);
1476
1477 /* Set max frame size */
1478 fc_set_mfs(lport, QEDF_MFS);
1479 fc_host_maxframe_size(lport->host) = lport->mfs;
1480
1481 /* Set default dev_loss_tmo based on module parameter */
1482 fc_host_dev_loss_tmo(lport->host) = qedf_dev_loss_tmo;
1483
1484 /* Set symbolic node name */
1485 snprintf(fc_host_symbolic_name(lport->host), 256,
1486 "QLogic %s v%s", QEDF_MODULE_NAME, QEDF_VERSION);
1487
1488 qedf_setup_fdmi(qedf);
1489
1490 return 0;
1491 }
1492
1493 /*
1494 * NPIV functions
1495 */
1496
1497 static int qedf_vport_libfc_config(struct fc_vport *vport,
1498 struct fc_lport *lport)
1499 {
1500 lport->link_up = 0;
1501 lport->qfull = 0;
1502 lport->max_retry_count = QEDF_FLOGI_RETRY_CNT;
1503 lport->max_rport_retry_count = QEDF_RPORT_RETRY_CNT;
1504 lport->service_params = (FCP_SPPF_INIT_FCN | FCP_SPPF_RD_XRDY_DIS |
1505 FCP_SPPF_RETRY | FCP_SPPF_CONF_COMPL);
1506 lport->boot_time = jiffies;
1507 lport->e_d_tov = 2 * 1000;
1508 lport->r_a_tov = 10 * 1000;
1509 lport->does_npiv = 1; /* Temporary until we add NPIV support */
1510
1511 /* Allocate stats for vport */
1512 if (fc_lport_init_stats(lport))
1513 return -ENOMEM;
1514
1515 /* Finish lport config */
1516 fc_lport_config(lport);
1517
1518 /* offload related configuration */
1519 lport->crc_offload = 0;
1520 lport->seq_offload = 0;
1521 lport->lro_enabled = 0;
1522 lport->lro_xid = 0;
1523 lport->lso_max = 0;
1524
1525 return 0;
1526 }
1527
1528 static int qedf_vport_create(struct fc_vport *vport, bool disabled)
1529 {
1530 struct Scsi_Host *shost = vport_to_shost(vport);
1531 struct fc_lport *n_port = shost_priv(shost);
1532 struct fc_lport *vn_port;
1533 struct qedf_ctx *base_qedf = lport_priv(n_port);
1534 struct qedf_ctx *vport_qedf;
1535
1536 char buf[32];
1537 int rc = 0;
1538
1539 rc = fcoe_validate_vport_create(vport);
1540 if (rc) {
1541 fcoe_wwn_to_str(vport->port_name, buf, sizeof(buf));
1542 QEDF_WARN(&(base_qedf->dbg_ctx), "Failed to create vport, "
1543 "WWPN (0x%s) already exists.\n", buf);
1544 goto err1;
1545 }
1546
1547 if (atomic_read(&base_qedf->link_state) != QEDF_LINK_UP) {
1548 QEDF_WARN(&(base_qedf->dbg_ctx), "Cannot create vport "
1549 "because link is not up.\n");
1550 rc = -EIO;
1551 goto err1;
1552 }
1553
1554 vn_port = libfc_vport_create(vport, sizeof(struct qedf_ctx));
1555 if (!vn_port) {
1556 QEDF_WARN(&(base_qedf->dbg_ctx), "Could not create lport "
1557 "for vport.\n");
1558 rc = -ENOMEM;
1559 goto err1;
1560 }
1561
1562 fcoe_wwn_to_str(vport->port_name, buf, sizeof(buf));
1563 QEDF_ERR(&(base_qedf->dbg_ctx), "Creating NPIV port, WWPN=%s.\n",
1564 buf);
1565
1566 /* Copy some fields from base_qedf */
1567 vport_qedf = lport_priv(vn_port);
1568 memcpy(vport_qedf, base_qedf, sizeof(struct qedf_ctx));
1569
1570 /* Set qedf data specific to this vport */
1571 vport_qedf->lport = vn_port;
1572 /* Use same hba_lock as base_qedf */
1573 vport_qedf->hba_lock = base_qedf->hba_lock;
1574 vport_qedf->pdev = base_qedf->pdev;
1575 vport_qedf->cmd_mgr = base_qedf->cmd_mgr;
1576 init_completion(&vport_qedf->flogi_compl);
1577 INIT_LIST_HEAD(&vport_qedf->fcports);
1578
1579 rc = qedf_vport_libfc_config(vport, vn_port);
1580 if (rc) {
1581 QEDF_ERR(&(base_qedf->dbg_ctx), "Could not allocate memory "
1582 "for lport stats.\n");
1583 goto err2;
1584 }
1585
1586 fc_set_wwnn(vn_port, vport->node_name);
1587 fc_set_wwpn(vn_port, vport->port_name);
1588 vport_qedf->wwnn = vn_port->wwnn;
1589 vport_qedf->wwpn = vn_port->wwpn;
1590
1591 vn_port->host->transportt = qedf_fc_vport_transport_template;
1592 vn_port->host->can_queue = QEDF_MAX_ELS_XID;
1593 vn_port->host->max_lun = qedf_max_lun;
1594 vn_port->host->sg_tablesize = QEDF_MAX_BDS_PER_CMD;
1595 vn_port->host->max_cmd_len = QEDF_MAX_CDB_LEN;
1596
1597 rc = scsi_add_host(vn_port->host, &vport->dev);
1598 if (rc) {
1599 QEDF_WARN(&(base_qedf->dbg_ctx), "Error adding Scsi_Host.\n");
1600 goto err2;
1601 }
1602
1603 /* Set default dev_loss_tmo based on module parameter */
1604 fc_host_dev_loss_tmo(vn_port->host) = qedf_dev_loss_tmo;
1605
1606 /* Init libfc stuffs */
1607 memcpy(&vn_port->tt, &qedf_lport_template,
1608 sizeof(qedf_lport_template));
1609 fc_exch_init(vn_port);
1610 fc_elsct_init(vn_port);
1611 fc_lport_init(vn_port);
1612 fc_disc_init(vn_port);
1613 fc_disc_config(vn_port, vn_port);
1614
1615
1616 /* Allocate the exchange manager */
1617 shost = vport_to_shost(vport);
1618 n_port = shost_priv(shost);
1619 fc_exch_mgr_list_clone(n_port, vn_port);
1620
1621 /* Set max frame size */
1622 fc_set_mfs(vn_port, QEDF_MFS);
1623
1624 fc_host_port_type(vn_port->host) = FC_PORTTYPE_UNKNOWN;
1625
1626 if (disabled) {
1627 fc_vport_set_state(vport, FC_VPORT_DISABLED);
1628 } else {
1629 vn_port->boot_time = jiffies;
1630 fc_fabric_login(vn_port);
1631 fc_vport_setlink(vn_port);
1632 }
1633
1634 QEDF_INFO(&(base_qedf->dbg_ctx), QEDF_LOG_NPIV, "vn_port=%p.\n",
1635 vn_port);
1636
1637 /* Set up debug context for vport */
1638 vport_qedf->dbg_ctx.host_no = vn_port->host->host_no;
1639 vport_qedf->dbg_ctx.pdev = base_qedf->pdev;
1640
1641 err2:
1642 scsi_host_put(vn_port->host);
1643 err1:
1644 return rc;
1645 }
1646
1647 static int qedf_vport_destroy(struct fc_vport *vport)
1648 {
1649 struct Scsi_Host *shost = vport_to_shost(vport);
1650 struct fc_lport *n_port = shost_priv(shost);
1651 struct fc_lport *vn_port = vport->dd_data;
1652
1653 mutex_lock(&n_port->lp_mutex);
1654 list_del(&vn_port->list);
1655 mutex_unlock(&n_port->lp_mutex);
1656
1657 fc_fabric_logoff(vn_port);
1658 fc_lport_destroy(vn_port);
1659
1660 /* Detach from scsi-ml */
1661 fc_remove_host(vn_port->host);
1662 scsi_remove_host(vn_port->host);
1663
1664 /*
1665 * Only try to release the exchange manager if the vn_port
1666 * configuration is complete.
1667 */
1668 if (vn_port->state == LPORT_ST_READY)
1669 fc_exch_mgr_free(vn_port);
1670
1671 /* Free memory used by statistical counters */
1672 fc_lport_free_stats(vn_port);
1673
1674 /* Release Scsi_Host */
1675 if (vn_port->host)
1676 scsi_host_put(vn_port->host);
1677
1678 return 0;
1679 }
1680
1681 static int qedf_vport_disable(struct fc_vport *vport, bool disable)
1682 {
1683 struct fc_lport *lport = vport->dd_data;
1684
1685 if (disable) {
1686 fc_vport_set_state(vport, FC_VPORT_DISABLED);
1687 fc_fabric_logoff(lport);
1688 } else {
1689 lport->boot_time = jiffies;
1690 fc_fabric_login(lport);
1691 fc_vport_setlink(lport);
1692 }
1693 return 0;
1694 }
1695
1696 /*
1697 * During removal we need to wait for all the vports associated with a port
1698 * to be destroyed so we avoid a race condition where libfc is still trying
1699 * to reap vports while the driver remove function has already reaped the
1700 * driver contexts associated with the physical port.
1701 */
1702 static void qedf_wait_for_vport_destroy(struct qedf_ctx *qedf)
1703 {
1704 struct fc_host_attrs *fc_host = shost_to_fc_host(qedf->lport->host);
1705
1706 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_NPIV,
1707 "Entered.\n");
1708 while (fc_host->npiv_vports_inuse > 0) {
1709 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_NPIV,
1710 "Waiting for all vports to be reaped.\n");
1711 msleep(1000);
1712 }
1713 }
1714
1715 /**
1716 * qedf_fcoe_reset - Resets the fcoe
1717 *
1718 * @shost: shost the reset is from
1719 *
1720 * Returns: always 0
1721 */
1722 static int qedf_fcoe_reset(struct Scsi_Host *shost)
1723 {
1724 struct fc_lport *lport = shost_priv(shost);
1725
1726 qedf_ctx_soft_reset(lport);
1727 return 0;
1728 }
1729
1730 static struct fc_host_statistics *qedf_fc_get_host_stats(struct Scsi_Host
1731 *shost)
1732 {
1733 struct fc_host_statistics *qedf_stats;
1734 struct fc_lport *lport = shost_priv(shost);
1735 struct qedf_ctx *qedf = lport_priv(lport);
1736 struct qed_fcoe_stats *fw_fcoe_stats;
1737
1738 qedf_stats = fc_get_host_stats(shost);
1739
1740 /* We don't collect offload stats for specific NPIV ports */
1741 if (lport->vport)
1742 goto out;
1743
1744 fw_fcoe_stats = kmalloc(sizeof(struct qed_fcoe_stats), GFP_KERNEL);
1745 if (!fw_fcoe_stats) {
1746 QEDF_ERR(&(qedf->dbg_ctx), "Could not allocate memory for "
1747 "fw_fcoe_stats.\n");
1748 goto out;
1749 }
1750
1751 /* Query firmware for offload stats */
1752 qed_ops->get_stats(qedf->cdev, fw_fcoe_stats);
1753
1754 /*
1755 * The expectation is that we add our offload stats to the stats
1756 * being maintained by libfc each time the fc_get_host_status callback
1757 * is invoked. The additions are not carried over for each call to
1758 * the fc_get_host_stats callback.
1759 */
1760 qedf_stats->tx_frames += fw_fcoe_stats->fcoe_tx_data_pkt_cnt +
1761 fw_fcoe_stats->fcoe_tx_xfer_pkt_cnt +
1762 fw_fcoe_stats->fcoe_tx_other_pkt_cnt;
1763 qedf_stats->rx_frames += fw_fcoe_stats->fcoe_rx_data_pkt_cnt +
1764 fw_fcoe_stats->fcoe_rx_xfer_pkt_cnt +
1765 fw_fcoe_stats->fcoe_rx_other_pkt_cnt;
1766 qedf_stats->fcp_input_megabytes +=
1767 do_div(fw_fcoe_stats->fcoe_rx_byte_cnt, 1000000);
1768 qedf_stats->fcp_output_megabytes +=
1769 do_div(fw_fcoe_stats->fcoe_tx_byte_cnt, 1000000);
1770 qedf_stats->rx_words += fw_fcoe_stats->fcoe_rx_byte_cnt / 4;
1771 qedf_stats->tx_words += fw_fcoe_stats->fcoe_tx_byte_cnt / 4;
1772 qedf_stats->invalid_crc_count +=
1773 fw_fcoe_stats->fcoe_silent_drop_pkt_crc_error_cnt;
1774 qedf_stats->dumped_frames =
1775 fw_fcoe_stats->fcoe_silent_drop_total_pkt_cnt;
1776 qedf_stats->error_frames +=
1777 fw_fcoe_stats->fcoe_silent_drop_total_pkt_cnt;
1778 qedf_stats->fcp_input_requests += qedf->input_requests;
1779 qedf_stats->fcp_output_requests += qedf->output_requests;
1780 qedf_stats->fcp_control_requests += qedf->control_requests;
1781 qedf_stats->fcp_packet_aborts += qedf->packet_aborts;
1782 qedf_stats->fcp_frame_alloc_failures += qedf->alloc_failures;
1783
1784 kfree(fw_fcoe_stats);
1785 out:
1786 return qedf_stats;
1787 }
1788
1789 static struct fc_function_template qedf_fc_transport_fn = {
1790 .show_host_node_name = 1,
1791 .show_host_port_name = 1,
1792 .show_host_supported_classes = 1,
1793 .show_host_supported_fc4s = 1,
1794 .show_host_active_fc4s = 1,
1795 .show_host_maxframe_size = 1,
1796
1797 .show_host_port_id = 1,
1798 .show_host_supported_speeds = 1,
1799 .get_host_speed = fc_get_host_speed,
1800 .show_host_speed = 1,
1801 .show_host_port_type = 1,
1802 .get_host_port_state = fc_get_host_port_state,
1803 .show_host_port_state = 1,
1804 .show_host_symbolic_name = 1,
1805
1806 /*
1807 * Tell FC transport to allocate enough space to store the backpointer
1808 * for the associate qedf_rport struct.
1809 */
1810 .dd_fcrport_size = (sizeof(struct fc_rport_libfc_priv) +
1811 sizeof(struct qedf_rport)),
1812 .show_rport_maxframe_size = 1,
1813 .show_rport_supported_classes = 1,
1814 .show_host_fabric_name = 1,
1815 .show_starget_node_name = 1,
1816 .show_starget_port_name = 1,
1817 .show_starget_port_id = 1,
1818 .set_rport_dev_loss_tmo = fc_set_rport_loss_tmo,
1819 .show_rport_dev_loss_tmo = 1,
1820 .get_fc_host_stats = qedf_fc_get_host_stats,
1821 .issue_fc_host_lip = qedf_fcoe_reset,
1822 .vport_create = qedf_vport_create,
1823 .vport_delete = qedf_vport_destroy,
1824 .vport_disable = qedf_vport_disable,
1825 .bsg_request = fc_lport_bsg_request,
1826 };
1827
1828 static struct fc_function_template qedf_fc_vport_transport_fn = {
1829 .show_host_node_name = 1,
1830 .show_host_port_name = 1,
1831 .show_host_supported_classes = 1,
1832 .show_host_supported_fc4s = 1,
1833 .show_host_active_fc4s = 1,
1834 .show_host_maxframe_size = 1,
1835 .show_host_port_id = 1,
1836 .show_host_supported_speeds = 1,
1837 .get_host_speed = fc_get_host_speed,
1838 .show_host_speed = 1,
1839 .show_host_port_type = 1,
1840 .get_host_port_state = fc_get_host_port_state,
1841 .show_host_port_state = 1,
1842 .show_host_symbolic_name = 1,
1843 .dd_fcrport_size = (sizeof(struct fc_rport_libfc_priv) +
1844 sizeof(struct qedf_rport)),
1845 .show_rport_maxframe_size = 1,
1846 .show_rport_supported_classes = 1,
1847 .show_host_fabric_name = 1,
1848 .show_starget_node_name = 1,
1849 .show_starget_port_name = 1,
1850 .show_starget_port_id = 1,
1851 .set_rport_dev_loss_tmo = fc_set_rport_loss_tmo,
1852 .show_rport_dev_loss_tmo = 1,
1853 .get_fc_host_stats = fc_get_host_stats,
1854 .issue_fc_host_lip = qedf_fcoe_reset,
1855 .bsg_request = fc_lport_bsg_request,
1856 };
1857
1858 static bool qedf_fp_has_work(struct qedf_fastpath *fp)
1859 {
1860 struct qedf_ctx *qedf = fp->qedf;
1861 struct global_queue *que;
1862 struct qed_sb_info *sb_info = fp->sb_info;
1863 struct status_block_e4 *sb = sb_info->sb_virt;
1864 u16 prod_idx;
1865
1866 /* Get the pointer to the global CQ this completion is on */
1867 que = qedf->global_queues[fp->sb_id];
1868
1869 /* Be sure all responses have been written to PI */
1870 rmb();
1871
1872 /* Get the current firmware producer index */
1873 prod_idx = sb->pi_array[QEDF_FCOE_PARAMS_GL_RQ_PI];
1874
1875 return (que->cq_prod_idx != prod_idx);
1876 }
1877
1878 /*
1879 * Interrupt handler code.
1880 */
1881
1882 /* Process completion queue and copy CQE contents for deferred processesing
1883 *
1884 * Return true if we should wake the I/O thread, false if not.
1885 */
1886 static bool qedf_process_completions(struct qedf_fastpath *fp)
1887 {
1888 struct qedf_ctx *qedf = fp->qedf;
1889 struct qed_sb_info *sb_info = fp->sb_info;
1890 struct status_block_e4 *sb = sb_info->sb_virt;
1891 struct global_queue *que;
1892 u16 prod_idx;
1893 struct fcoe_cqe *cqe;
1894 struct qedf_io_work *io_work;
1895 int num_handled = 0;
1896 unsigned int cpu;
1897 struct qedf_ioreq *io_req = NULL;
1898 u16 xid;
1899 u16 new_cqes;
1900 u32 comp_type;
1901
1902 /* Get the current firmware producer index */
1903 prod_idx = sb->pi_array[QEDF_FCOE_PARAMS_GL_RQ_PI];
1904
1905 /* Get the pointer to the global CQ this completion is on */
1906 que = qedf->global_queues[fp->sb_id];
1907
1908 /* Calculate the amount of new elements since last processing */
1909 new_cqes = (prod_idx >= que->cq_prod_idx) ?
1910 (prod_idx - que->cq_prod_idx) :
1911 0x10000 - que->cq_prod_idx + prod_idx;
1912
1913 /* Save producer index */
1914 que->cq_prod_idx = prod_idx;
1915
1916 while (new_cqes) {
1917 fp->completions++;
1918 num_handled++;
1919 cqe = &que->cq[que->cq_cons_idx];
1920
1921 comp_type = (cqe->cqe_data >> FCOE_CQE_CQE_TYPE_SHIFT) &
1922 FCOE_CQE_CQE_TYPE_MASK;
1923
1924 /*
1925 * Process unsolicited CQEs directly in the interrupt handler
1926 * sine we need the fastpath ID
1927 */
1928 if (comp_type == FCOE_UNSOLIC_CQE_TYPE) {
1929 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_UNSOL,
1930 "Unsolicated CQE.\n");
1931 qedf_process_unsol_compl(qedf, fp->sb_id, cqe);
1932 /*
1933 * Don't add a work list item. Increment consumer
1934 * consumer index and move on.
1935 */
1936 goto inc_idx;
1937 }
1938
1939 xid = cqe->cqe_data & FCOE_CQE_TASK_ID_MASK;
1940 io_req = &qedf->cmd_mgr->cmds[xid];
1941
1942 /*
1943 * Figure out which percpu thread we should queue this I/O
1944 * on.
1945 */
1946 if (!io_req)
1947 /* If there is not io_req assocated with this CQE
1948 * just queue it on CPU 0
1949 */
1950 cpu = 0;
1951 else {
1952 cpu = io_req->cpu;
1953 io_req->int_cpu = smp_processor_id();
1954 }
1955
1956 io_work = mempool_alloc(qedf->io_mempool, GFP_ATOMIC);
1957 if (!io_work) {
1958 QEDF_WARN(&(qedf->dbg_ctx), "Could not allocate "
1959 "work for I/O completion.\n");
1960 continue;
1961 }
1962 memset(io_work, 0, sizeof(struct qedf_io_work));
1963
1964 INIT_WORK(&io_work->work, qedf_fp_io_handler);
1965
1966 /* Copy contents of CQE for deferred processing */
1967 memcpy(&io_work->cqe, cqe, sizeof(struct fcoe_cqe));
1968
1969 io_work->qedf = fp->qedf;
1970 io_work->fp = NULL; /* Only used for unsolicited frames */
1971
1972 queue_work_on(cpu, qedf_io_wq, &io_work->work);
1973
1974 inc_idx:
1975 que->cq_cons_idx++;
1976 if (que->cq_cons_idx == fp->cq_num_entries)
1977 que->cq_cons_idx = 0;
1978 new_cqes--;
1979 }
1980
1981 return true;
1982 }
1983
1984
1985 /* MSI-X fastpath handler code */
1986 static irqreturn_t qedf_msix_handler(int irq, void *dev_id)
1987 {
1988 struct qedf_fastpath *fp = dev_id;
1989
1990 if (!fp) {
1991 QEDF_ERR(NULL, "fp is null.\n");
1992 return IRQ_HANDLED;
1993 }
1994 if (!fp->sb_info) {
1995 QEDF_ERR(NULL, "fp->sb_info in null.");
1996 return IRQ_HANDLED;
1997 }
1998
1999 /*
2000 * Disable interrupts for this status block while we process new
2001 * completions
2002 */
2003 qed_sb_ack(fp->sb_info, IGU_INT_DISABLE, 0 /*do not update*/);
2004
2005 while (1) {
2006 qedf_process_completions(fp);
2007
2008 if (qedf_fp_has_work(fp) == 0) {
2009 /* Update the sb information */
2010 qed_sb_update_sb_idx(fp->sb_info);
2011
2012 /* Check for more work */
2013 rmb();
2014
2015 if (qedf_fp_has_work(fp) == 0) {
2016 /* Re-enable interrupts */
2017 qed_sb_ack(fp->sb_info, IGU_INT_ENABLE, 1);
2018 return IRQ_HANDLED;
2019 }
2020 }
2021 }
2022
2023 /* Do we ever want to break out of above loop? */
2024 return IRQ_HANDLED;
2025 }
2026
2027 /* simd handler for MSI/INTa */
2028 static void qedf_simd_int_handler(void *cookie)
2029 {
2030 /* Cookie is qedf_ctx struct */
2031 struct qedf_ctx *qedf = (struct qedf_ctx *)cookie;
2032
2033 QEDF_WARN(&(qedf->dbg_ctx), "qedf=%p.\n", qedf);
2034 }
2035
2036 #define QEDF_SIMD_HANDLER_NUM 0
2037 static void qedf_sync_free_irqs(struct qedf_ctx *qedf)
2038 {
2039 int i;
2040
2041 if (qedf->int_info.msix_cnt) {
2042 for (i = 0; i < qedf->int_info.used_cnt; i++) {
2043 synchronize_irq(qedf->int_info.msix[i].vector);
2044 irq_set_affinity_hint(qedf->int_info.msix[i].vector,
2045 NULL);
2046 irq_set_affinity_notifier(qedf->int_info.msix[i].vector,
2047 NULL);
2048 free_irq(qedf->int_info.msix[i].vector,
2049 &qedf->fp_array[i]);
2050 }
2051 } else
2052 qed_ops->common->simd_handler_clean(qedf->cdev,
2053 QEDF_SIMD_HANDLER_NUM);
2054
2055 qedf->int_info.used_cnt = 0;
2056 qed_ops->common->set_fp_int(qedf->cdev, 0);
2057 }
2058
2059 static int qedf_request_msix_irq(struct qedf_ctx *qedf)
2060 {
2061 int i, rc, cpu;
2062
2063 cpu = cpumask_first(cpu_online_mask);
2064 for (i = 0; i < qedf->num_queues; i++) {
2065 rc = request_irq(qedf->int_info.msix[i].vector,
2066 qedf_msix_handler, 0, "qedf", &qedf->fp_array[i]);
2067
2068 if (rc) {
2069 QEDF_WARN(&(qedf->dbg_ctx), "request_irq failed.\n");
2070 qedf_sync_free_irqs(qedf);
2071 return rc;
2072 }
2073
2074 qedf->int_info.used_cnt++;
2075 rc = irq_set_affinity_hint(qedf->int_info.msix[i].vector,
2076 get_cpu_mask(cpu));
2077 cpu = cpumask_next(cpu, cpu_online_mask);
2078 }
2079
2080 return 0;
2081 }
2082
2083 static int qedf_setup_int(struct qedf_ctx *qedf)
2084 {
2085 int rc = 0;
2086
2087 /*
2088 * Learn interrupt configuration
2089 */
2090 rc = qed_ops->common->set_fp_int(qedf->cdev, num_online_cpus());
2091 if (rc <= 0)
2092 return 0;
2093
2094 rc = qed_ops->common->get_fp_int(qedf->cdev, &qedf->int_info);
2095 if (rc)
2096 return 0;
2097
2098 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "Number of msix_cnt = "
2099 "0x%x num of cpus = 0x%x\n", qedf->int_info.msix_cnt,
2100 num_online_cpus());
2101
2102 if (qedf->int_info.msix_cnt)
2103 return qedf_request_msix_irq(qedf);
2104
2105 qed_ops->common->simd_handler_config(qedf->cdev, &qedf,
2106 QEDF_SIMD_HANDLER_NUM, qedf_simd_int_handler);
2107 qedf->int_info.used_cnt = 1;
2108
2109 return 0;
2110 }
2111
2112 /* Main function for libfc frame reception */
2113 static void qedf_recv_frame(struct qedf_ctx *qedf,
2114 struct sk_buff *skb)
2115 {
2116 u32 fr_len;
2117 struct fc_lport *lport;
2118 struct fc_frame_header *fh;
2119 struct fcoe_crc_eof crc_eof;
2120 struct fc_frame *fp;
2121 u8 *mac = NULL;
2122 u8 *dest_mac = NULL;
2123 struct fcoe_hdr *hp;
2124 struct qedf_rport *fcport;
2125 struct fc_lport *vn_port;
2126 u32 f_ctl;
2127
2128 lport = qedf->lport;
2129 if (lport == NULL || lport->state == LPORT_ST_DISABLED) {
2130 QEDF_WARN(NULL, "Invalid lport struct or lport disabled.\n");
2131 kfree_skb(skb);
2132 return;
2133 }
2134
2135 if (skb_is_nonlinear(skb))
2136 skb_linearize(skb);
2137 mac = eth_hdr(skb)->h_source;
2138 dest_mac = eth_hdr(skb)->h_dest;
2139
2140 /* Pull the header */
2141 hp = (struct fcoe_hdr *)skb->data;
2142 fh = (struct fc_frame_header *) skb_transport_header(skb);
2143 skb_pull(skb, sizeof(struct fcoe_hdr));
2144 fr_len = skb->len - sizeof(struct fcoe_crc_eof);
2145
2146 fp = (struct fc_frame *)skb;
2147 fc_frame_init(fp);
2148 fr_dev(fp) = lport;
2149 fr_sof(fp) = hp->fcoe_sof;
2150 if (skb_copy_bits(skb, fr_len, &crc_eof, sizeof(crc_eof))) {
2151 kfree_skb(skb);
2152 return;
2153 }
2154 fr_eof(fp) = crc_eof.fcoe_eof;
2155 fr_crc(fp) = crc_eof.fcoe_crc32;
2156 if (pskb_trim(skb, fr_len)) {
2157 kfree_skb(skb);
2158 return;
2159 }
2160
2161 fh = fc_frame_header_get(fp);
2162
2163 /*
2164 * Invalid frame filters.
2165 */
2166
2167 if (fh->fh_r_ctl == FC_RCTL_DD_SOL_DATA &&
2168 fh->fh_type == FC_TYPE_FCP) {
2169 /* Drop FCP data. We dont this in L2 path */
2170 kfree_skb(skb);
2171 return;
2172 }
2173 if (fh->fh_r_ctl == FC_RCTL_ELS_REQ &&
2174 fh->fh_type == FC_TYPE_ELS) {
2175 switch (fc_frame_payload_op(fp)) {
2176 case ELS_LOGO:
2177 if (ntoh24(fh->fh_s_id) == FC_FID_FLOGI) {
2178 /* drop non-FIP LOGO */
2179 kfree_skb(skb);
2180 return;
2181 }
2182 break;
2183 }
2184 }
2185
2186 if (fh->fh_r_ctl == FC_RCTL_BA_ABTS) {
2187 /* Drop incoming ABTS */
2188 kfree_skb(skb);
2189 return;
2190 }
2191
2192 if (ntoh24(&dest_mac[3]) != ntoh24(fh->fh_d_id)) {
2193 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_LL2,
2194 "FC frame d_id mismatch with MAC %pM.\n", dest_mac);
2195 return;
2196 }
2197
2198 if (qedf->ctlr.state) {
2199 if (!ether_addr_equal(mac, qedf->ctlr.dest_addr)) {
2200 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_LL2,
2201 "Wrong source address: mac:%pM dest_addr:%pM.\n",
2202 mac, qedf->ctlr.dest_addr);
2203 kfree_skb(skb);
2204 return;
2205 }
2206 }
2207
2208 vn_port = fc_vport_id_lookup(lport, ntoh24(fh->fh_d_id));
2209
2210 /*
2211 * If the destination ID from the frame header does not match what we
2212 * have on record for lport and the search for a NPIV port came up
2213 * empty then this is not addressed to our port so simply drop it.
2214 */
2215 if (lport->port_id != ntoh24(fh->fh_d_id) && !vn_port) {
2216 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_LL2,
2217 "Dropping frame due to destination mismatch: lport->port_id=%x fh->d_id=%x.\n",
2218 lport->port_id, ntoh24(fh->fh_d_id));
2219 kfree_skb(skb);
2220 return;
2221 }
2222
2223 f_ctl = ntoh24(fh->fh_f_ctl);
2224 if ((fh->fh_type == FC_TYPE_BLS) && (f_ctl & FC_FC_SEQ_CTX) &&
2225 (f_ctl & FC_FC_EX_CTX)) {
2226 /* Drop incoming ABTS response that has both SEQ/EX CTX set */
2227 kfree_skb(skb);
2228 return;
2229 }
2230
2231 /*
2232 * If a connection is uploading, drop incoming FCoE frames as there
2233 * is a small window where we could try to return a frame while libfc
2234 * is trying to clean things up.
2235 */
2236
2237 /* Get fcport associated with d_id if it exists */
2238 fcport = qedf_fcport_lookup(qedf, ntoh24(fh->fh_d_id));
2239
2240 if (fcport && test_bit(QEDF_RPORT_UPLOADING_CONNECTION,
2241 &fcport->flags)) {
2242 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_LL2,
2243 "Connection uploading, dropping fp=%p.\n", fp);
2244 kfree_skb(skb);
2245 return;
2246 }
2247
2248 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_LL2, "FCoE frame receive: "
2249 "skb=%p fp=%p src=%06x dest=%06x r_ctl=%x fh_type=%x.\n", skb, fp,
2250 ntoh24(fh->fh_s_id), ntoh24(fh->fh_d_id), fh->fh_r_ctl,
2251 fh->fh_type);
2252 if (qedf_dump_frames)
2253 print_hex_dump(KERN_WARNING, "fcoe: ", DUMP_PREFIX_OFFSET, 16,
2254 1, skb->data, skb->len, false);
2255 fc_exch_recv(lport, fp);
2256 }
2257
2258 static void qedf_ll2_process_skb(struct work_struct *work)
2259 {
2260 struct qedf_skb_work *skb_work =
2261 container_of(work, struct qedf_skb_work, work);
2262 struct qedf_ctx *qedf = skb_work->qedf;
2263 struct sk_buff *skb = skb_work->skb;
2264 struct ethhdr *eh;
2265
2266 if (!qedf) {
2267 QEDF_ERR(NULL, "qedf is NULL\n");
2268 goto err_out;
2269 }
2270
2271 eh = (struct ethhdr *)skb->data;
2272
2273 /* Undo VLAN encapsulation */
2274 if (eh->h_proto == htons(ETH_P_8021Q)) {
2275 memmove((u8 *)eh + VLAN_HLEN, eh, ETH_ALEN * 2);
2276 eh = skb_pull(skb, VLAN_HLEN);
2277 skb_reset_mac_header(skb);
2278 }
2279
2280 /*
2281 * Process either a FIP frame or FCoE frame based on the
2282 * protocol value. If it's not either just drop the
2283 * frame.
2284 */
2285 if (eh->h_proto == htons(ETH_P_FIP)) {
2286 qedf_fip_recv(qedf, skb);
2287 goto out;
2288 } else if (eh->h_proto == htons(ETH_P_FCOE)) {
2289 __skb_pull(skb, ETH_HLEN);
2290 qedf_recv_frame(qedf, skb);
2291 goto out;
2292 } else
2293 goto err_out;
2294
2295 err_out:
2296 kfree_skb(skb);
2297 out:
2298 kfree(skb_work);
2299 return;
2300 }
2301
2302 static int qedf_ll2_rx(void *cookie, struct sk_buff *skb,
2303 u32 arg1, u32 arg2)
2304 {
2305 struct qedf_ctx *qedf = (struct qedf_ctx *)cookie;
2306 struct qedf_skb_work *skb_work;
2307
2308 skb_work = kzalloc(sizeof(struct qedf_skb_work), GFP_ATOMIC);
2309 if (!skb_work) {
2310 QEDF_WARN(&(qedf->dbg_ctx), "Could not allocate skb_work so "
2311 "dropping frame.\n");
2312 kfree_skb(skb);
2313 return 0;
2314 }
2315
2316 INIT_WORK(&skb_work->work, qedf_ll2_process_skb);
2317 skb_work->skb = skb;
2318 skb_work->qedf = qedf;
2319 queue_work(qedf->ll2_recv_wq, &skb_work->work);
2320
2321 return 0;
2322 }
2323
2324 static struct qed_ll2_cb_ops qedf_ll2_cb_ops = {
2325 .rx_cb = qedf_ll2_rx,
2326 .tx_cb = NULL,
2327 };
2328
2329 /* Main thread to process I/O completions */
2330 void qedf_fp_io_handler(struct work_struct *work)
2331 {
2332 struct qedf_io_work *io_work =
2333 container_of(work, struct qedf_io_work, work);
2334 u32 comp_type;
2335
2336 /*
2337 * Deferred part of unsolicited CQE sends
2338 * frame to libfc.
2339 */
2340 comp_type = (io_work->cqe.cqe_data >>
2341 FCOE_CQE_CQE_TYPE_SHIFT) &
2342 FCOE_CQE_CQE_TYPE_MASK;
2343 if (comp_type == FCOE_UNSOLIC_CQE_TYPE &&
2344 io_work->fp)
2345 fc_exch_recv(io_work->qedf->lport, io_work->fp);
2346 else
2347 qedf_process_cqe(io_work->qedf, &io_work->cqe);
2348
2349 kfree(io_work);
2350 }
2351
2352 static int qedf_alloc_and_init_sb(struct qedf_ctx *qedf,
2353 struct qed_sb_info *sb_info, u16 sb_id)
2354 {
2355 struct status_block_e4 *sb_virt;
2356 dma_addr_t sb_phys;
2357 int ret;
2358
2359 sb_virt = dma_alloc_coherent(&qedf->pdev->dev,
2360 sizeof(struct status_block_e4), &sb_phys, GFP_KERNEL);
2361
2362 if (!sb_virt) {
2363 QEDF_ERR(&(qedf->dbg_ctx), "Status block allocation failed "
2364 "for id = %d.\n", sb_id);
2365 return -ENOMEM;
2366 }
2367
2368 ret = qed_ops->common->sb_init(qedf->cdev, sb_info, sb_virt, sb_phys,
2369 sb_id, QED_SB_TYPE_STORAGE);
2370
2371 if (ret) {
2372 QEDF_ERR(&(qedf->dbg_ctx), "Status block initialization "
2373 "failed for id = %d.\n", sb_id);
2374 return ret;
2375 }
2376
2377 return 0;
2378 }
2379
2380 static void qedf_free_sb(struct qedf_ctx *qedf, struct qed_sb_info *sb_info)
2381 {
2382 if (sb_info->sb_virt)
2383 dma_free_coherent(&qedf->pdev->dev, sizeof(*sb_info->sb_virt),
2384 (void *)sb_info->sb_virt, sb_info->sb_phys);
2385 }
2386
2387 static void qedf_destroy_sb(struct qedf_ctx *qedf)
2388 {
2389 int id;
2390 struct qedf_fastpath *fp = NULL;
2391
2392 for (id = 0; id < qedf->num_queues; id++) {
2393 fp = &(qedf->fp_array[id]);
2394 if (fp->sb_id == QEDF_SB_ID_NULL)
2395 break;
2396 qedf_free_sb(qedf, fp->sb_info);
2397 kfree(fp->sb_info);
2398 }
2399 kfree(qedf->fp_array);
2400 }
2401
2402 static int qedf_prepare_sb(struct qedf_ctx *qedf)
2403 {
2404 int id;
2405 struct qedf_fastpath *fp;
2406 int ret;
2407
2408 qedf->fp_array =
2409 kcalloc(qedf->num_queues, sizeof(struct qedf_fastpath),
2410 GFP_KERNEL);
2411
2412 if (!qedf->fp_array) {
2413 QEDF_ERR(&(qedf->dbg_ctx), "fastpath array allocation "
2414 "failed.\n");
2415 return -ENOMEM;
2416 }
2417
2418 for (id = 0; id < qedf->num_queues; id++) {
2419 fp = &(qedf->fp_array[id]);
2420 fp->sb_id = QEDF_SB_ID_NULL;
2421 fp->sb_info = kcalloc(1, sizeof(*fp->sb_info), GFP_KERNEL);
2422 if (!fp->sb_info) {
2423 QEDF_ERR(&(qedf->dbg_ctx), "SB info struct "
2424 "allocation failed.\n");
2425 goto err;
2426 }
2427 ret = qedf_alloc_and_init_sb(qedf, fp->sb_info, id);
2428 if (ret) {
2429 QEDF_ERR(&(qedf->dbg_ctx), "SB allocation and "
2430 "initialization failed.\n");
2431 goto err;
2432 }
2433 fp->sb_id = id;
2434 fp->qedf = qedf;
2435 fp->cq_num_entries =
2436 qedf->global_queues[id]->cq_mem_size /
2437 sizeof(struct fcoe_cqe);
2438 }
2439 err:
2440 return 0;
2441 }
2442
2443 void qedf_process_cqe(struct qedf_ctx *qedf, struct fcoe_cqe *cqe)
2444 {
2445 u16 xid;
2446 struct qedf_ioreq *io_req;
2447 struct qedf_rport *fcport;
2448 u32 comp_type;
2449
2450 comp_type = (cqe->cqe_data >> FCOE_CQE_CQE_TYPE_SHIFT) &
2451 FCOE_CQE_CQE_TYPE_MASK;
2452
2453 xid = cqe->cqe_data & FCOE_CQE_TASK_ID_MASK;
2454 io_req = &qedf->cmd_mgr->cmds[xid];
2455
2456 /* Completion not for a valid I/O anymore so just return */
2457 if (!io_req)
2458 return;
2459
2460 fcport = io_req->fcport;
2461
2462 if (fcport == NULL) {
2463 QEDF_ERR(&(qedf->dbg_ctx), "fcport is NULL.\n");
2464 return;
2465 }
2466
2467 /*
2468 * Check that fcport is offloaded. If it isn't then the spinlock
2469 * isn't valid and shouldn't be taken. We should just return.
2470 */
2471 if (!test_bit(QEDF_RPORT_SESSION_READY, &fcport->flags)) {
2472 QEDF_ERR(&(qedf->dbg_ctx), "Session not offloaded yet.\n");
2473 return;
2474 }
2475
2476
2477 switch (comp_type) {
2478 case FCOE_GOOD_COMPLETION_CQE_TYPE:
2479 atomic_inc(&fcport->free_sqes);
2480 switch (io_req->cmd_type) {
2481 case QEDF_SCSI_CMD:
2482 qedf_scsi_completion(qedf, cqe, io_req);
2483 break;
2484 case QEDF_ELS:
2485 qedf_process_els_compl(qedf, cqe, io_req);
2486 break;
2487 case QEDF_TASK_MGMT_CMD:
2488 qedf_process_tmf_compl(qedf, cqe, io_req);
2489 break;
2490 case QEDF_SEQ_CLEANUP:
2491 qedf_process_seq_cleanup_compl(qedf, cqe, io_req);
2492 break;
2493 }
2494 break;
2495 case FCOE_ERROR_DETECTION_CQE_TYPE:
2496 atomic_inc(&fcport->free_sqes);
2497 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO,
2498 "Error detect CQE.\n");
2499 qedf_process_error_detect(qedf, cqe, io_req);
2500 break;
2501 case FCOE_EXCH_CLEANUP_CQE_TYPE:
2502 atomic_inc(&fcport->free_sqes);
2503 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO,
2504 "Cleanup CQE.\n");
2505 qedf_process_cleanup_compl(qedf, cqe, io_req);
2506 break;
2507 case FCOE_ABTS_CQE_TYPE:
2508 atomic_inc(&fcport->free_sqes);
2509 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO,
2510 "Abort CQE.\n");
2511 qedf_process_abts_compl(qedf, cqe, io_req);
2512 break;
2513 case FCOE_DUMMY_CQE_TYPE:
2514 atomic_inc(&fcport->free_sqes);
2515 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO,
2516 "Dummy CQE.\n");
2517 break;
2518 case FCOE_LOCAL_COMP_CQE_TYPE:
2519 atomic_inc(&fcport->free_sqes);
2520 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO,
2521 "Local completion CQE.\n");
2522 break;
2523 case FCOE_WARNING_CQE_TYPE:
2524 atomic_inc(&fcport->free_sqes);
2525 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO,
2526 "Warning CQE.\n");
2527 qedf_process_warning_compl(qedf, cqe, io_req);
2528 break;
2529 case MAX_FCOE_CQE_TYPE:
2530 atomic_inc(&fcport->free_sqes);
2531 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO,
2532 "Max FCoE CQE.\n");
2533 break;
2534 default:
2535 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO,
2536 "Default CQE.\n");
2537 break;
2538 }
2539 }
2540
2541 static void qedf_free_bdq(struct qedf_ctx *qedf)
2542 {
2543 int i;
2544
2545 if (qedf->bdq_pbl_list)
2546 dma_free_coherent(&qedf->pdev->dev, QEDF_PAGE_SIZE,
2547 qedf->bdq_pbl_list, qedf->bdq_pbl_list_dma);
2548
2549 if (qedf->bdq_pbl)
2550 dma_free_coherent(&qedf->pdev->dev, qedf->bdq_pbl_mem_size,
2551 qedf->bdq_pbl, qedf->bdq_pbl_dma);
2552
2553 for (i = 0; i < QEDF_BDQ_SIZE; i++) {
2554 if (qedf->bdq[i].buf_addr) {
2555 dma_free_coherent(&qedf->pdev->dev, QEDF_BDQ_BUF_SIZE,
2556 qedf->bdq[i].buf_addr, qedf->bdq[i].buf_dma);
2557 }
2558 }
2559 }
2560
2561 static void qedf_free_global_queues(struct qedf_ctx *qedf)
2562 {
2563 int i;
2564 struct global_queue **gl = qedf->global_queues;
2565
2566 for (i = 0; i < qedf->num_queues; i++) {
2567 if (!gl[i])
2568 continue;
2569
2570 if (gl[i]->cq)
2571 dma_free_coherent(&qedf->pdev->dev,
2572 gl[i]->cq_mem_size, gl[i]->cq, gl[i]->cq_dma);
2573 if (gl[i]->cq_pbl)
2574 dma_free_coherent(&qedf->pdev->dev, gl[i]->cq_pbl_size,
2575 gl[i]->cq_pbl, gl[i]->cq_pbl_dma);
2576
2577 kfree(gl[i]);
2578 }
2579
2580 qedf_free_bdq(qedf);
2581 }
2582
2583 static int qedf_alloc_bdq(struct qedf_ctx *qedf)
2584 {
2585 int i;
2586 struct scsi_bd *pbl;
2587 u64 *list;
2588 dma_addr_t page;
2589
2590 /* Alloc dma memory for BDQ buffers */
2591 for (i = 0; i < QEDF_BDQ_SIZE; i++) {
2592 qedf->bdq[i].buf_addr = dma_alloc_coherent(&qedf->pdev->dev,
2593 QEDF_BDQ_BUF_SIZE, &qedf->bdq[i].buf_dma, GFP_KERNEL);
2594 if (!qedf->bdq[i].buf_addr) {
2595 QEDF_ERR(&(qedf->dbg_ctx), "Could not allocate BDQ "
2596 "buffer %d.\n", i);
2597 return -ENOMEM;
2598 }
2599 }
2600
2601 /* Alloc dma memory for BDQ page buffer list */
2602 qedf->bdq_pbl_mem_size =
2603 QEDF_BDQ_SIZE * sizeof(struct scsi_bd);
2604 qedf->bdq_pbl_mem_size =
2605 ALIGN(qedf->bdq_pbl_mem_size, QEDF_PAGE_SIZE);
2606
2607 qedf->bdq_pbl = dma_alloc_coherent(&qedf->pdev->dev,
2608 qedf->bdq_pbl_mem_size, &qedf->bdq_pbl_dma, GFP_KERNEL);
2609 if (!qedf->bdq_pbl) {
2610 QEDF_ERR(&(qedf->dbg_ctx), "Could not allocate BDQ PBL.\n");
2611 return -ENOMEM;
2612 }
2613
2614 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
2615 "BDQ PBL addr=0x%p dma=%pad\n",
2616 qedf->bdq_pbl, &qedf->bdq_pbl_dma);
2617
2618 /*
2619 * Populate BDQ PBL with physical and virtual address of individual
2620 * BDQ buffers
2621 */
2622 pbl = (struct scsi_bd *)qedf->bdq_pbl;
2623 for (i = 0; i < QEDF_BDQ_SIZE; i++) {
2624 pbl->address.hi = cpu_to_le32(U64_HI(qedf->bdq[i].buf_dma));
2625 pbl->address.lo = cpu_to_le32(U64_LO(qedf->bdq[i].buf_dma));
2626 pbl->opaque.fcoe_opaque.hi = 0;
2627 /* Opaque lo data is an index into the BDQ array */
2628 pbl->opaque.fcoe_opaque.lo = cpu_to_le32(i);
2629 pbl++;
2630 }
2631
2632 /* Allocate list of PBL pages */
2633 qedf->bdq_pbl_list = dma_zalloc_coherent(&qedf->pdev->dev,
2634 QEDF_PAGE_SIZE, &qedf->bdq_pbl_list_dma, GFP_KERNEL);
2635 if (!qedf->bdq_pbl_list) {
2636 QEDF_ERR(&(qedf->dbg_ctx), "Could not allocate list of PBL pages.\n");
2637 return -ENOMEM;
2638 }
2639
2640 /*
2641 * Now populate PBL list with pages that contain pointers to the
2642 * individual buffers.
2643 */
2644 qedf->bdq_pbl_list_num_entries = qedf->bdq_pbl_mem_size /
2645 QEDF_PAGE_SIZE;
2646 list = (u64 *)qedf->bdq_pbl_list;
2647 page = qedf->bdq_pbl_list_dma;
2648 for (i = 0; i < qedf->bdq_pbl_list_num_entries; i++) {
2649 *list = qedf->bdq_pbl_dma;
2650 list++;
2651 page += QEDF_PAGE_SIZE;
2652 }
2653
2654 return 0;
2655 }
2656
2657 static int qedf_alloc_global_queues(struct qedf_ctx *qedf)
2658 {
2659 u32 *list;
2660 int i;
2661 int status = 0, rc;
2662 u32 *pbl;
2663 dma_addr_t page;
2664 int num_pages;
2665
2666 /* Allocate and map CQs, RQs */
2667 /*
2668 * Number of global queues (CQ / RQ). This should
2669 * be <= number of available MSIX vectors for the PF
2670 */
2671 if (!qedf->num_queues) {
2672 QEDF_ERR(&(qedf->dbg_ctx), "No MSI-X vectors available!\n");
2673 return 1;
2674 }
2675
2676 /*
2677 * Make sure we allocated the PBL that will contain the physical
2678 * addresses of our queues
2679 */
2680 if (!qedf->p_cpuq) {
2681 status = 1;
2682 goto mem_alloc_failure;
2683 }
2684
2685 qedf->global_queues = kzalloc((sizeof(struct global_queue *)
2686 * qedf->num_queues), GFP_KERNEL);
2687 if (!qedf->global_queues) {
2688 QEDF_ERR(&(qedf->dbg_ctx), "Unable to allocate global "
2689 "queues array ptr memory\n");
2690 return -ENOMEM;
2691 }
2692 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
2693 "qedf->global_queues=%p.\n", qedf->global_queues);
2694
2695 /* Allocate DMA coherent buffers for BDQ */
2696 rc = qedf_alloc_bdq(qedf);
2697 if (rc)
2698 goto mem_alloc_failure;
2699
2700 /* Allocate a CQ and an associated PBL for each MSI-X vector */
2701 for (i = 0; i < qedf->num_queues; i++) {
2702 qedf->global_queues[i] = kzalloc(sizeof(struct global_queue),
2703 GFP_KERNEL);
2704 if (!qedf->global_queues[i]) {
2705 QEDF_WARN(&(qedf->dbg_ctx), "Unable to allocate "
2706 "global queue %d.\n", i);
2707 status = -ENOMEM;
2708 goto mem_alloc_failure;
2709 }
2710
2711 qedf->global_queues[i]->cq_mem_size =
2712 FCOE_PARAMS_CQ_NUM_ENTRIES * sizeof(struct fcoe_cqe);
2713 qedf->global_queues[i]->cq_mem_size =
2714 ALIGN(qedf->global_queues[i]->cq_mem_size, QEDF_PAGE_SIZE);
2715
2716 qedf->global_queues[i]->cq_pbl_size =
2717 (qedf->global_queues[i]->cq_mem_size /
2718 PAGE_SIZE) * sizeof(void *);
2719 qedf->global_queues[i]->cq_pbl_size =
2720 ALIGN(qedf->global_queues[i]->cq_pbl_size, QEDF_PAGE_SIZE);
2721
2722 qedf->global_queues[i]->cq =
2723 dma_zalloc_coherent(&qedf->pdev->dev,
2724 qedf->global_queues[i]->cq_mem_size,
2725 &qedf->global_queues[i]->cq_dma, GFP_KERNEL);
2726
2727 if (!qedf->global_queues[i]->cq) {
2728 QEDF_WARN(&(qedf->dbg_ctx), "Could not allocate cq.\n");
2729 status = -ENOMEM;
2730 goto mem_alloc_failure;
2731 }
2732
2733 qedf->global_queues[i]->cq_pbl =
2734 dma_zalloc_coherent(&qedf->pdev->dev,
2735 qedf->global_queues[i]->cq_pbl_size,
2736 &qedf->global_queues[i]->cq_pbl_dma, GFP_KERNEL);
2737
2738 if (!qedf->global_queues[i]->cq_pbl) {
2739 QEDF_WARN(&(qedf->dbg_ctx), "Could not allocate cq PBL.\n");
2740 status = -ENOMEM;
2741 goto mem_alloc_failure;
2742 }
2743
2744 /* Create PBL */
2745 num_pages = qedf->global_queues[i]->cq_mem_size /
2746 QEDF_PAGE_SIZE;
2747 page = qedf->global_queues[i]->cq_dma;
2748 pbl = (u32 *)qedf->global_queues[i]->cq_pbl;
2749
2750 while (num_pages--) {
2751 *pbl = U64_LO(page);
2752 pbl++;
2753 *pbl = U64_HI(page);
2754 pbl++;
2755 page += QEDF_PAGE_SIZE;
2756 }
2757 /* Set the initial consumer index for cq */
2758 qedf->global_queues[i]->cq_cons_idx = 0;
2759 }
2760
2761 list = (u32 *)qedf->p_cpuq;
2762
2763 /*
2764 * The list is built as follows: CQ#0 PBL pointer, RQ#0 PBL pointer,
2765 * CQ#1 PBL pointer, RQ#1 PBL pointer, etc. Each PBL pointer points
2766 * to the physical address which contains an array of pointers to
2767 * the physical addresses of the specific queue pages.
2768 */
2769 for (i = 0; i < qedf->num_queues; i++) {
2770 *list = U64_LO(qedf->global_queues[i]->cq_pbl_dma);
2771 list++;
2772 *list = U64_HI(qedf->global_queues[i]->cq_pbl_dma);
2773 list++;
2774 *list = U64_LO(0);
2775 list++;
2776 *list = U64_HI(0);
2777 list++;
2778 }
2779
2780 return 0;
2781
2782 mem_alloc_failure:
2783 qedf_free_global_queues(qedf);
2784 return status;
2785 }
2786
2787 static int qedf_set_fcoe_pf_param(struct qedf_ctx *qedf)
2788 {
2789 u8 sq_num_pbl_pages;
2790 u32 sq_mem_size;
2791 u32 cq_mem_size;
2792 u32 cq_num_entries;
2793 int rval;
2794
2795 /*
2796 * The number of completion queues/fastpath interrupts/status blocks
2797 * we allocation is the minimum off:
2798 *
2799 * Number of CPUs
2800 * Number allocated by qed for our PCI function
2801 */
2802 qedf->num_queues = MIN_NUM_CPUS_MSIX(qedf);
2803
2804 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "Number of CQs is %d.\n",
2805 qedf->num_queues);
2806
2807 qedf->p_cpuq = pci_alloc_consistent(qedf->pdev,
2808 qedf->num_queues * sizeof(struct qedf_glbl_q_params),
2809 &qedf->hw_p_cpuq);
2810
2811 if (!qedf->p_cpuq) {
2812 QEDF_ERR(&(qedf->dbg_ctx), "pci_alloc_consistent failed.\n");
2813 return 1;
2814 }
2815
2816 rval = qedf_alloc_global_queues(qedf);
2817 if (rval) {
2818 QEDF_ERR(&(qedf->dbg_ctx), "Global queue allocation "
2819 "failed.\n");
2820 return 1;
2821 }
2822
2823 /* Calculate SQ PBL size in the same manner as in qedf_sq_alloc() */
2824 sq_mem_size = SQ_NUM_ENTRIES * sizeof(struct fcoe_wqe);
2825 sq_mem_size = ALIGN(sq_mem_size, QEDF_PAGE_SIZE);
2826 sq_num_pbl_pages = (sq_mem_size / QEDF_PAGE_SIZE);
2827
2828 /* Calculate CQ num entries */
2829 cq_mem_size = FCOE_PARAMS_CQ_NUM_ENTRIES * sizeof(struct fcoe_cqe);
2830 cq_mem_size = ALIGN(cq_mem_size, QEDF_PAGE_SIZE);
2831 cq_num_entries = cq_mem_size / sizeof(struct fcoe_cqe);
2832
2833 memset(&(qedf->pf_params), 0, sizeof(qedf->pf_params));
2834
2835 /* Setup the value for fcoe PF */
2836 qedf->pf_params.fcoe_pf_params.num_cons = QEDF_MAX_SESSIONS;
2837 qedf->pf_params.fcoe_pf_params.num_tasks = FCOE_PARAMS_NUM_TASKS;
2838 qedf->pf_params.fcoe_pf_params.glbl_q_params_addr =
2839 (u64)qedf->hw_p_cpuq;
2840 qedf->pf_params.fcoe_pf_params.sq_num_pbl_pages = sq_num_pbl_pages;
2841
2842 qedf->pf_params.fcoe_pf_params.rq_buffer_log_size = 0;
2843
2844 qedf->pf_params.fcoe_pf_params.cq_num_entries = cq_num_entries;
2845 qedf->pf_params.fcoe_pf_params.num_cqs = qedf->num_queues;
2846
2847 /* log_page_size: 12 for 4KB pages */
2848 qedf->pf_params.fcoe_pf_params.log_page_size = ilog2(QEDF_PAGE_SIZE);
2849
2850 qedf->pf_params.fcoe_pf_params.mtu = 9000;
2851 qedf->pf_params.fcoe_pf_params.gl_rq_pi = QEDF_FCOE_PARAMS_GL_RQ_PI;
2852 qedf->pf_params.fcoe_pf_params.gl_cmd_pi = QEDF_FCOE_PARAMS_GL_CMD_PI;
2853
2854 /* BDQ address and size */
2855 qedf->pf_params.fcoe_pf_params.bdq_pbl_base_addr[0] =
2856 qedf->bdq_pbl_list_dma;
2857 qedf->pf_params.fcoe_pf_params.bdq_pbl_num_entries[0] =
2858 qedf->bdq_pbl_list_num_entries;
2859 qedf->pf_params.fcoe_pf_params.rq_buffer_size = QEDF_BDQ_BUF_SIZE;
2860
2861 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
2862 "bdq_list=%p bdq_pbl_list_dma=%llx bdq_pbl_list_entries=%d.\n",
2863 qedf->bdq_pbl_list,
2864 qedf->pf_params.fcoe_pf_params.bdq_pbl_base_addr[0],
2865 qedf->pf_params.fcoe_pf_params.bdq_pbl_num_entries[0]);
2866
2867 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
2868 "cq_num_entries=%d.\n",
2869 qedf->pf_params.fcoe_pf_params.cq_num_entries);
2870
2871 return 0;
2872 }
2873
2874 /* Free DMA coherent memory for array of queue pointers we pass to qed */
2875 static void qedf_free_fcoe_pf_param(struct qedf_ctx *qedf)
2876 {
2877 size_t size = 0;
2878
2879 if (qedf->p_cpuq) {
2880 size = qedf->num_queues * sizeof(struct qedf_glbl_q_params);
2881 pci_free_consistent(qedf->pdev, size, qedf->p_cpuq,
2882 qedf->hw_p_cpuq);
2883 }
2884
2885 qedf_free_global_queues(qedf);
2886
2887 if (qedf->global_queues)
2888 kfree(qedf->global_queues);
2889 }
2890
2891 /*
2892 * PCI driver functions
2893 */
2894
2895 static const struct pci_device_id qedf_pci_tbl[] = {
2896 { PCI_DEVICE(PCI_VENDOR_ID_QLOGIC, 0x165c) },
2897 { PCI_DEVICE(PCI_VENDOR_ID_QLOGIC, 0x8080) },
2898 {0}
2899 };
2900 MODULE_DEVICE_TABLE(pci, qedf_pci_tbl);
2901
2902 static struct pci_driver qedf_pci_driver = {
2903 .name = QEDF_MODULE_NAME,
2904 .id_table = qedf_pci_tbl,
2905 .probe = qedf_probe,
2906 .remove = qedf_remove,
2907 };
2908
2909 static int __qedf_probe(struct pci_dev *pdev, int mode)
2910 {
2911 int rc = -EINVAL;
2912 struct fc_lport *lport;
2913 struct qedf_ctx *qedf;
2914 struct Scsi_Host *host;
2915 bool is_vf = false;
2916 struct qed_ll2_params params;
2917 char host_buf[20];
2918 struct qed_link_params link_params;
2919 int status;
2920 void *task_start, *task_end;
2921 struct qed_slowpath_params slowpath_params;
2922 struct qed_probe_params qed_params;
2923 u16 tmp;
2924
2925 /*
2926 * When doing error recovery we didn't reap the lport so don't try
2927 * to reallocate it.
2928 */
2929 if (mode != QEDF_MODE_RECOVERY) {
2930 lport = libfc_host_alloc(&qedf_host_template,
2931 sizeof(struct qedf_ctx));
2932
2933 if (!lport) {
2934 QEDF_ERR(NULL, "Could not allocate lport.\n");
2935 rc = -ENOMEM;
2936 goto err0;
2937 }
2938
2939 /* Initialize qedf_ctx */
2940 qedf = lport_priv(lport);
2941 qedf->lport = lport;
2942 qedf->ctlr.lp = lport;
2943 qedf->pdev = pdev;
2944 qedf->dbg_ctx.pdev = pdev;
2945 qedf->dbg_ctx.host_no = lport->host->host_no;
2946 spin_lock_init(&qedf->hba_lock);
2947 INIT_LIST_HEAD(&qedf->fcports);
2948 qedf->curr_conn_id = QEDF_MAX_SESSIONS - 1;
2949 atomic_set(&qedf->num_offloads, 0);
2950 qedf->stop_io_on_error = false;
2951 pci_set_drvdata(pdev, qedf);
2952 init_completion(&qedf->fipvlan_compl);
2953
2954 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_INFO,
2955 "QLogic FastLinQ FCoE Module qedf %s, "
2956 "FW %d.%d.%d.%d\n", QEDF_VERSION,
2957 FW_MAJOR_VERSION, FW_MINOR_VERSION, FW_REVISION_VERSION,
2958 FW_ENGINEERING_VERSION);
2959 } else {
2960 /* Init pointers during recovery */
2961 qedf = pci_get_drvdata(pdev);
2962 lport = qedf->lport;
2963 }
2964
2965 host = lport->host;
2966
2967 /* Allocate mempool for qedf_io_work structs */
2968 qedf->io_mempool = mempool_create_slab_pool(QEDF_IO_WORK_MIN,
2969 qedf_io_work_cache);
2970 if (qedf->io_mempool == NULL) {
2971 QEDF_ERR(&(qedf->dbg_ctx), "qedf->io_mempool is NULL.\n");
2972 goto err1;
2973 }
2974 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_INFO, "qedf->io_mempool=%p.\n",
2975 qedf->io_mempool);
2976
2977 sprintf(host_buf, "qedf_%u_link",
2978 qedf->lport->host->host_no);
2979 qedf->link_update_wq = create_workqueue(host_buf);
2980 INIT_DELAYED_WORK(&qedf->link_update, qedf_handle_link_update);
2981 INIT_DELAYED_WORK(&qedf->link_recovery, qedf_link_recovery);
2982
2983 qedf->fipvlan_retries = qedf_fipvlan_retries;
2984
2985 /*
2986 * Common probe. Takes care of basic hardware init and pci_*
2987 * functions.
2988 */
2989 memset(&qed_params, 0, sizeof(qed_params));
2990 qed_params.protocol = QED_PROTOCOL_FCOE;
2991 qed_params.dp_module = qedf_dp_module;
2992 qed_params.dp_level = qedf_dp_level;
2993 qed_params.is_vf = is_vf;
2994 qedf->cdev = qed_ops->common->probe(pdev, &qed_params);
2995 if (!qedf->cdev) {
2996 rc = -ENODEV;
2997 goto err1;
2998 }
2999
3000 /* Learn information crucial for qedf to progress */
3001 rc = qed_ops->fill_dev_info(qedf->cdev, &qedf->dev_info);
3002 if (rc) {
3003 QEDF_ERR(&(qedf->dbg_ctx), "Failed to dev info.\n");
3004 goto err1;
3005 }
3006
3007 /* queue allocation code should come here
3008 * order should be
3009 * slowpath_start
3010 * status block allocation
3011 * interrupt registration (to get min number of queues)
3012 * set_fcoe_pf_param
3013 * qed_sp_fcoe_func_start
3014 */
3015 rc = qedf_set_fcoe_pf_param(qedf);
3016 if (rc) {
3017 QEDF_ERR(&(qedf->dbg_ctx), "Cannot set fcoe pf param.\n");
3018 goto err2;
3019 }
3020 qed_ops->common->update_pf_params(qedf->cdev, &qedf->pf_params);
3021
3022 /* Record BDQ producer doorbell addresses */
3023 qedf->bdq_primary_prod = qedf->dev_info.primary_dbq_rq_addr;
3024 qedf->bdq_secondary_prod = qedf->dev_info.secondary_bdq_rq_addr;
3025 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
3026 "BDQ primary_prod=%p secondary_prod=%p.\n", qedf->bdq_primary_prod,
3027 qedf->bdq_secondary_prod);
3028
3029 qed_ops->register_ops(qedf->cdev, &qedf_cb_ops, qedf);
3030
3031 rc = qedf_prepare_sb(qedf);
3032 if (rc) {
3033
3034 QEDF_ERR(&(qedf->dbg_ctx), "Cannot start slowpath.\n");
3035 goto err2;
3036 }
3037
3038 /* Start the Slowpath-process */
3039 slowpath_params.int_mode = QED_INT_MODE_MSIX;
3040 slowpath_params.drv_major = QEDF_DRIVER_MAJOR_VER;
3041 slowpath_params.drv_minor = QEDF_DRIVER_MINOR_VER;
3042 slowpath_params.drv_rev = QEDF_DRIVER_REV_VER;
3043 slowpath_params.drv_eng = QEDF_DRIVER_ENG_VER;
3044 strncpy(slowpath_params.name, "qedf", QED_DRV_VER_STR_SIZE);
3045 rc = qed_ops->common->slowpath_start(qedf->cdev, &slowpath_params);
3046 if (rc) {
3047 QEDF_ERR(&(qedf->dbg_ctx), "Cannot start slowpath.\n");
3048 goto err2;
3049 }
3050
3051 /*
3052 * update_pf_params needs to be called before and after slowpath
3053 * start
3054 */
3055 qed_ops->common->update_pf_params(qedf->cdev, &qedf->pf_params);
3056
3057 /* Setup interrupts */
3058 rc = qedf_setup_int(qedf);
3059 if (rc)
3060 goto err3;
3061
3062 rc = qed_ops->start(qedf->cdev, &qedf->tasks);
3063 if (rc) {
3064 QEDF_ERR(&(qedf->dbg_ctx), "Cannot start FCoE function.\n");
3065 goto err4;
3066 }
3067 task_start = qedf_get_task_mem(&qedf->tasks, 0);
3068 task_end = qedf_get_task_mem(&qedf->tasks, MAX_TID_BLOCKS_FCOE - 1);
3069 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "Task context start=%p, "
3070 "end=%p block_size=%u.\n", task_start, task_end,
3071 qedf->tasks.size);
3072
3073 /*
3074 * We need to write the number of BDs in the BDQ we've preallocated so
3075 * the f/w will do a prefetch and we'll get an unsolicited CQE when a
3076 * packet arrives.
3077 */
3078 qedf->bdq_prod_idx = QEDF_BDQ_SIZE;
3079 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
3080 "Writing %d to primary and secondary BDQ doorbell registers.\n",
3081 qedf->bdq_prod_idx);
3082 writew(qedf->bdq_prod_idx, qedf->bdq_primary_prod);
3083 tmp = readw(qedf->bdq_primary_prod);
3084 writew(qedf->bdq_prod_idx, qedf->bdq_secondary_prod);
3085 tmp = readw(qedf->bdq_secondary_prod);
3086
3087 qed_ops->common->set_power_state(qedf->cdev, PCI_D0);
3088
3089 /* Now that the dev_info struct has been filled in set the MAC
3090 * address
3091 */
3092 ether_addr_copy(qedf->mac, qedf->dev_info.common.hw_mac);
3093 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "MAC address is %pM.\n",
3094 qedf->mac);
3095
3096 /*
3097 * Set the WWNN and WWPN in the following way:
3098 *
3099 * If the info we get from qed is non-zero then use that to set the
3100 * WWPN and WWNN. Otherwise fall back to use fcoe_wwn_from_mac() based
3101 * on the MAC address.
3102 */
3103 if (qedf->dev_info.wwnn != 0 && qedf->dev_info.wwpn != 0) {
3104 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
3105 "Setting WWPN and WWNN from qed dev_info.\n");
3106 qedf->wwnn = qedf->dev_info.wwnn;
3107 qedf->wwpn = qedf->dev_info.wwpn;
3108 } else {
3109 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
3110 "Setting WWPN and WWNN using fcoe_wwn_from_mac().\n");
3111 qedf->wwnn = fcoe_wwn_from_mac(qedf->mac, 1, 0);
3112 qedf->wwpn = fcoe_wwn_from_mac(qedf->mac, 2, 0);
3113 }
3114 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "WWNN=%016llx "
3115 "WWPN=%016llx.\n", qedf->wwnn, qedf->wwpn);
3116
3117 sprintf(host_buf, "host_%d", host->host_no);
3118 qed_ops->common->set_name(qedf->cdev, host_buf);
3119
3120
3121 /* Set xid max values */
3122 qedf->max_scsi_xid = QEDF_MAX_SCSI_XID;
3123 qedf->max_els_xid = QEDF_MAX_ELS_XID;
3124
3125 /* Allocate cmd mgr */
3126 qedf->cmd_mgr = qedf_cmd_mgr_alloc(qedf);
3127 if (!qedf->cmd_mgr) {
3128 QEDF_ERR(&(qedf->dbg_ctx), "Failed to allocate cmd mgr.\n");
3129 rc = -ENOMEM;
3130 goto err5;
3131 }
3132
3133 if (mode != QEDF_MODE_RECOVERY) {
3134 host->transportt = qedf_fc_transport_template;
3135 host->can_queue = QEDF_MAX_ELS_XID;
3136 host->max_lun = qedf_max_lun;
3137 host->max_cmd_len = QEDF_MAX_CDB_LEN;
3138 rc = scsi_add_host(host, &pdev->dev);
3139 if (rc)
3140 goto err6;
3141 }
3142
3143 memset(&params, 0, sizeof(params));
3144 params.mtu = 9000;
3145 ether_addr_copy(params.ll2_mac_address, qedf->mac);
3146
3147 /* Start LL2 processing thread */
3148 snprintf(host_buf, 20, "qedf_%d_ll2", host->host_no);
3149 qedf->ll2_recv_wq =
3150 create_workqueue(host_buf);
3151 if (!qedf->ll2_recv_wq) {
3152 QEDF_ERR(&(qedf->dbg_ctx), "Failed to LL2 workqueue.\n");
3153 rc = -ENOMEM;
3154 goto err7;
3155 }
3156
3157 #ifdef CONFIG_DEBUG_FS
3158 qedf_dbg_host_init(&(qedf->dbg_ctx), &qedf_debugfs_ops,
3159 &qedf_dbg_fops);
3160 #endif
3161
3162 /* Start LL2 */
3163 qed_ops->ll2->register_cb_ops(qedf->cdev, &qedf_ll2_cb_ops, qedf);
3164 rc = qed_ops->ll2->start(qedf->cdev, &params);
3165 if (rc) {
3166 QEDF_ERR(&(qedf->dbg_ctx), "Could not start Light L2.\n");
3167 goto err7;
3168 }
3169 set_bit(QEDF_LL2_STARTED, &qedf->flags);
3170
3171 /* Set initial FIP/FCoE VLAN to NULL */
3172 qedf->vlan_id = 0;
3173
3174 /*
3175 * No need to setup fcoe_ctlr or fc_lport objects during recovery since
3176 * they were not reaped during the unload process.
3177 */
3178 if (mode != QEDF_MODE_RECOVERY) {
3179 /* Setup imbedded fcoe controller */
3180 qedf_fcoe_ctlr_setup(qedf);
3181
3182 /* Setup lport */
3183 rc = qedf_lport_setup(qedf);
3184 if (rc) {
3185 QEDF_ERR(&(qedf->dbg_ctx),
3186 "qedf_lport_setup failed.\n");
3187 goto err7;
3188 }
3189 }
3190
3191 sprintf(host_buf, "qedf_%u_timer", qedf->lport->host->host_no);
3192 qedf->timer_work_queue =
3193 create_workqueue(host_buf);
3194 if (!qedf->timer_work_queue) {
3195 QEDF_ERR(&(qedf->dbg_ctx), "Failed to start timer "
3196 "workqueue.\n");
3197 rc = -ENOMEM;
3198 goto err7;
3199 }
3200
3201 /* DPC workqueue is not reaped during recovery unload */
3202 if (mode != QEDF_MODE_RECOVERY) {
3203 sprintf(host_buf, "qedf_%u_dpc",
3204 qedf->lport->host->host_no);
3205 qedf->dpc_wq = create_workqueue(host_buf);
3206 }
3207
3208 /*
3209 * GRC dump and sysfs parameters are not reaped during the recovery
3210 * unload process.
3211 */
3212 if (mode != QEDF_MODE_RECOVERY) {
3213 qedf->grcdump_size = qed_ops->common->dbg_grc_size(qedf->cdev);
3214 if (qedf->grcdump_size) {
3215 rc = qedf_alloc_grc_dump_buf(&qedf->grcdump,
3216 qedf->grcdump_size);
3217 if (rc) {
3218 QEDF_ERR(&(qedf->dbg_ctx),
3219 "GRC Dump buffer alloc failed.\n");
3220 qedf->grcdump = NULL;
3221 }
3222
3223 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC,
3224 "grcdump: addr=%p, size=%u.\n",
3225 qedf->grcdump, qedf->grcdump_size);
3226 }
3227 qedf_create_sysfs_ctx_attr(qedf);
3228
3229 /* Initialize I/O tracing for this adapter */
3230 spin_lock_init(&qedf->io_trace_lock);
3231 qedf->io_trace_idx = 0;
3232 }
3233
3234 init_completion(&qedf->flogi_compl);
3235
3236 memset(&link_params, 0, sizeof(struct qed_link_params));
3237 link_params.link_up = true;
3238 status = qed_ops->common->set_link(qedf->cdev, &link_params);
3239 if (status)
3240 QEDF_WARN(&(qedf->dbg_ctx), "set_link failed.\n");
3241
3242 /* Start/restart discovery */
3243 if (mode == QEDF_MODE_RECOVERY)
3244 fcoe_ctlr_link_up(&qedf->ctlr);
3245 else
3246 fc_fabric_login(lport);
3247
3248 /* All good */
3249 return 0;
3250
3251 err7:
3252 if (qedf->ll2_recv_wq)
3253 destroy_workqueue(qedf->ll2_recv_wq);
3254 fc_remove_host(qedf->lport->host);
3255 scsi_remove_host(qedf->lport->host);
3256 #ifdef CONFIG_DEBUG_FS
3257 qedf_dbg_host_exit(&(qedf->dbg_ctx));
3258 #endif
3259 err6:
3260 qedf_cmd_mgr_free(qedf->cmd_mgr);
3261 err5:
3262 qed_ops->stop(qedf->cdev);
3263 err4:
3264 qedf_free_fcoe_pf_param(qedf);
3265 qedf_sync_free_irqs(qedf);
3266 err3:
3267 qed_ops->common->slowpath_stop(qedf->cdev);
3268 err2:
3269 qed_ops->common->remove(qedf->cdev);
3270 err1:
3271 scsi_host_put(lport->host);
3272 err0:
3273 return rc;
3274 }
3275
3276 static int qedf_probe(struct pci_dev *pdev, const struct pci_device_id *id)
3277 {
3278 return __qedf_probe(pdev, QEDF_MODE_NORMAL);
3279 }
3280
3281 static void __qedf_remove(struct pci_dev *pdev, int mode)
3282 {
3283 struct qedf_ctx *qedf;
3284
3285 if (!pdev) {
3286 QEDF_ERR(NULL, "pdev is NULL.\n");
3287 return;
3288 }
3289
3290 qedf = pci_get_drvdata(pdev);
3291
3292 /*
3293 * Prevent race where we're in board disable work and then try to
3294 * rmmod the module.
3295 */
3296 if (test_bit(QEDF_UNLOADING, &qedf->flags)) {
3297 QEDF_ERR(&qedf->dbg_ctx, "Already removing PCI function.\n");
3298 return;
3299 }
3300
3301 if (mode != QEDF_MODE_RECOVERY)
3302 set_bit(QEDF_UNLOADING, &qedf->flags);
3303
3304 /* Logoff the fabric to upload all connections */
3305 if (mode == QEDF_MODE_RECOVERY)
3306 fcoe_ctlr_link_down(&qedf->ctlr);
3307 else
3308 fc_fabric_logoff(qedf->lport);
3309 qedf_wait_for_upload(qedf);
3310
3311 #ifdef CONFIG_DEBUG_FS
3312 qedf_dbg_host_exit(&(qedf->dbg_ctx));
3313 #endif
3314
3315 /* Stop any link update handling */
3316 cancel_delayed_work_sync(&qedf->link_update);
3317 destroy_workqueue(qedf->link_update_wq);
3318 qedf->link_update_wq = NULL;
3319
3320 if (qedf->timer_work_queue)
3321 destroy_workqueue(qedf->timer_work_queue);
3322
3323 /* Stop Light L2 */
3324 clear_bit(QEDF_LL2_STARTED, &qedf->flags);
3325 qed_ops->ll2->stop(qedf->cdev);
3326 if (qedf->ll2_recv_wq)
3327 destroy_workqueue(qedf->ll2_recv_wq);
3328
3329 /* Stop fastpath */
3330 qedf_sync_free_irqs(qedf);
3331 qedf_destroy_sb(qedf);
3332
3333 /*
3334 * During recovery don't destroy OS constructs that represent the
3335 * physical port.
3336 */
3337 if (mode != QEDF_MODE_RECOVERY) {
3338 qedf_free_grc_dump_buf(&qedf->grcdump);
3339 qedf_remove_sysfs_ctx_attr(qedf);
3340
3341 /* Remove all SCSI/libfc/libfcoe structures */
3342 fcoe_ctlr_destroy(&qedf->ctlr);
3343 fc_lport_destroy(qedf->lport);
3344 fc_remove_host(qedf->lport->host);
3345 scsi_remove_host(qedf->lport->host);
3346 }
3347
3348 qedf_cmd_mgr_free(qedf->cmd_mgr);
3349
3350 if (mode != QEDF_MODE_RECOVERY) {
3351 fc_exch_mgr_free(qedf->lport);
3352 fc_lport_free_stats(qedf->lport);
3353
3354 /* Wait for all vports to be reaped */
3355 qedf_wait_for_vport_destroy(qedf);
3356 }
3357
3358 /*
3359 * Now that all connections have been uploaded we can stop the
3360 * rest of the qed operations
3361 */
3362 qed_ops->stop(qedf->cdev);
3363
3364 if (mode != QEDF_MODE_RECOVERY) {
3365 if (qedf->dpc_wq) {
3366 /* Stop general DPC handling */
3367 destroy_workqueue(qedf->dpc_wq);
3368 qedf->dpc_wq = NULL;
3369 }
3370 }
3371
3372 /* Final shutdown for the board */
3373 qedf_free_fcoe_pf_param(qedf);
3374 if (mode != QEDF_MODE_RECOVERY) {
3375 qed_ops->common->set_power_state(qedf->cdev, PCI_D0);
3376 pci_set_drvdata(pdev, NULL);
3377 }
3378 qed_ops->common->slowpath_stop(qedf->cdev);
3379 qed_ops->common->remove(qedf->cdev);
3380
3381 mempool_destroy(qedf->io_mempool);
3382
3383 /* Only reap the Scsi_host on a real removal */
3384 if (mode != QEDF_MODE_RECOVERY)
3385 scsi_host_put(qedf->lport->host);
3386 }
3387
3388 static void qedf_remove(struct pci_dev *pdev)
3389 {
3390 /* Check to make sure this function wasn't already disabled */
3391 if (!atomic_read(&pdev->enable_cnt))
3392 return;
3393
3394 __qedf_remove(pdev, QEDF_MODE_NORMAL);
3395 }
3396
3397 /*
3398 * Module Init/Remove
3399 */
3400
3401 static int __init qedf_init(void)
3402 {
3403 int ret;
3404
3405 /* If debug=1 passed, set the default log mask */
3406 if (qedf_debug == QEDF_LOG_DEFAULT)
3407 qedf_debug = QEDF_DEFAULT_LOG_MASK;
3408
3409 /* Print driver banner */
3410 QEDF_INFO(NULL, QEDF_LOG_INFO, "%s v%s.\n", QEDF_DESCR,
3411 QEDF_VERSION);
3412
3413 /* Create kmem_cache for qedf_io_work structs */
3414 qedf_io_work_cache = kmem_cache_create("qedf_io_work_cache",
3415 sizeof(struct qedf_io_work), 0, SLAB_HWCACHE_ALIGN, NULL);
3416 if (qedf_io_work_cache == NULL) {
3417 QEDF_ERR(NULL, "qedf_io_work_cache is NULL.\n");
3418 goto err1;
3419 }
3420 QEDF_INFO(NULL, QEDF_LOG_DISC, "qedf_io_work_cache=%p.\n",
3421 qedf_io_work_cache);
3422
3423 qed_ops = qed_get_fcoe_ops();
3424 if (!qed_ops) {
3425 QEDF_ERR(NULL, "Failed to get qed fcoe operations\n");
3426 goto err1;
3427 }
3428
3429 #ifdef CONFIG_DEBUG_FS
3430 qedf_dbg_init("qedf");
3431 #endif
3432
3433 qedf_fc_transport_template =
3434 fc_attach_transport(&qedf_fc_transport_fn);
3435 if (!qedf_fc_transport_template) {
3436 QEDF_ERR(NULL, "Could not register with FC transport\n");
3437 goto err2;
3438 }
3439
3440 qedf_fc_vport_transport_template =
3441 fc_attach_transport(&qedf_fc_vport_transport_fn);
3442 if (!qedf_fc_vport_transport_template) {
3443 QEDF_ERR(NULL, "Could not register vport template with FC "
3444 "transport\n");
3445 goto err3;
3446 }
3447
3448 qedf_io_wq = create_workqueue("qedf_io_wq");
3449 if (!qedf_io_wq) {
3450 QEDF_ERR(NULL, "Could not create qedf_io_wq.\n");
3451 goto err4;
3452 }
3453
3454 qedf_cb_ops.get_login_failures = qedf_get_login_failures;
3455
3456 ret = pci_register_driver(&qedf_pci_driver);
3457 if (ret) {
3458 QEDF_ERR(NULL, "Failed to register driver\n");
3459 goto err5;
3460 }
3461
3462 return 0;
3463
3464 err5:
3465 destroy_workqueue(qedf_io_wq);
3466 err4:
3467 fc_release_transport(qedf_fc_vport_transport_template);
3468 err3:
3469 fc_release_transport(qedf_fc_transport_template);
3470 err2:
3471 #ifdef CONFIG_DEBUG_FS
3472 qedf_dbg_exit();
3473 #endif
3474 qed_put_fcoe_ops();
3475 err1:
3476 return -EINVAL;
3477 }
3478
3479 static void __exit qedf_cleanup(void)
3480 {
3481 pci_unregister_driver(&qedf_pci_driver);
3482
3483 destroy_workqueue(qedf_io_wq);
3484
3485 fc_release_transport(qedf_fc_vport_transport_template);
3486 fc_release_transport(qedf_fc_transport_template);
3487 #ifdef CONFIG_DEBUG_FS
3488 qedf_dbg_exit();
3489 #endif
3490 qed_put_fcoe_ops();
3491
3492 kmem_cache_destroy(qedf_io_work_cache);
3493 }
3494
3495 MODULE_LICENSE("GPL");
3496 MODULE_DESCRIPTION("QLogic QEDF 25/40/50/100Gb FCoE Driver");
3497 MODULE_AUTHOR("QLogic Corporation");
3498 MODULE_VERSION(QEDF_VERSION);
3499 module_init(qedf_init);
3500 module_exit(qedf_cleanup);
Linux with added FPC-III support