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(¶ms, 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, ¶ms); 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); 3501