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/spinlock.h> 10 #include <linux/vmalloc.h> 11 #include "qedf.h" 12 #include <scsi/scsi_tcq.h> 13 14 void qedf_cmd_timer_set(struct qedf_ctx *qedf, struct qedf_ioreq *io_req, 15 unsigned int timer_msec) 16 { 17 queue_delayed_work(qedf->timer_work_queue, &io_req->timeout_work, 18 msecs_to_jiffies(timer_msec)); 19 } 20 21 static void qedf_cmd_timeout(struct work_struct *work) 22 { 23 24 struct qedf_ioreq *io_req = 25 container_of(work, struct qedf_ioreq, timeout_work.work); 26 struct qedf_ctx *qedf = io_req->fcport->qedf; 27 struct qedf_rport *fcport = io_req->fcport; 28 u8 op = 0; 29 30 switch (io_req->cmd_type) { 31 case QEDF_ABTS: 32 QEDF_ERR((&qedf->dbg_ctx), "ABTS timeout, xid=0x%x.\n", 33 io_req->xid); 34 /* Cleanup timed out ABTS */ 35 qedf_initiate_cleanup(io_req, true); 36 complete(&io_req->abts_done); 37 38 /* 39 * Need to call kref_put for reference taken when initiate_abts 40 * was called since abts_compl won't be called now that we've 41 * cleaned up the task. 42 */ 43 kref_put(&io_req->refcount, qedf_release_cmd); 44 45 /* 46 * Now that the original I/O and the ABTS are complete see 47 * if we need to reconnect to the target. 48 */ 49 qedf_restart_rport(fcport); 50 break; 51 case QEDF_ELS: 52 kref_get(&io_req->refcount); 53 /* 54 * Don't attempt to clean an ELS timeout as any subseqeunt 55 * ABTS or cleanup requests just hang. For now just free 56 * the resources of the original I/O and the RRQ 57 */ 58 QEDF_ERR(&(qedf->dbg_ctx), "ELS timeout, xid=0x%x.\n", 59 io_req->xid); 60 io_req->event = QEDF_IOREQ_EV_ELS_TMO; 61 /* Call callback function to complete command */ 62 if (io_req->cb_func && io_req->cb_arg) { 63 op = io_req->cb_arg->op; 64 io_req->cb_func(io_req->cb_arg); 65 io_req->cb_arg = NULL; 66 } 67 qedf_initiate_cleanup(io_req, true); 68 kref_put(&io_req->refcount, qedf_release_cmd); 69 break; 70 case QEDF_SEQ_CLEANUP: 71 QEDF_ERR(&(qedf->dbg_ctx), "Sequence cleanup timeout, " 72 "xid=0x%x.\n", io_req->xid); 73 qedf_initiate_cleanup(io_req, true); 74 io_req->event = QEDF_IOREQ_EV_ELS_TMO; 75 qedf_process_seq_cleanup_compl(qedf, NULL, io_req); 76 break; 77 default: 78 break; 79 } 80 } 81 82 void qedf_cmd_mgr_free(struct qedf_cmd_mgr *cmgr) 83 { 84 struct io_bdt *bdt_info; 85 struct qedf_ctx *qedf = cmgr->qedf; 86 size_t bd_tbl_sz; 87 u16 min_xid = QEDF_MIN_XID; 88 u16 max_xid = (FCOE_PARAMS_NUM_TASKS - 1); 89 int num_ios; 90 int i; 91 struct qedf_ioreq *io_req; 92 93 num_ios = max_xid - min_xid + 1; 94 95 /* Free fcoe_bdt_ctx structures */ 96 if (!cmgr->io_bdt_pool) 97 goto free_cmd_pool; 98 99 bd_tbl_sz = QEDF_MAX_BDS_PER_CMD * sizeof(struct scsi_sge); 100 for (i = 0; i < num_ios; i++) { 101 bdt_info = cmgr->io_bdt_pool[i]; 102 if (bdt_info->bd_tbl) { 103 dma_free_coherent(&qedf->pdev->dev, bd_tbl_sz, 104 bdt_info->bd_tbl, bdt_info->bd_tbl_dma); 105 bdt_info->bd_tbl = NULL; 106 } 107 } 108 109 /* Destroy io_bdt pool */ 110 for (i = 0; i < num_ios; i++) { 111 kfree(cmgr->io_bdt_pool[i]); 112 cmgr->io_bdt_pool[i] = NULL; 113 } 114 115 kfree(cmgr->io_bdt_pool); 116 cmgr->io_bdt_pool = NULL; 117 118 free_cmd_pool: 119 120 for (i = 0; i < num_ios; i++) { 121 io_req = &cmgr->cmds[i]; 122 kfree(io_req->sgl_task_params); 123 kfree(io_req->task_params); 124 /* Make sure we free per command sense buffer */ 125 if (io_req->sense_buffer) 126 dma_free_coherent(&qedf->pdev->dev, 127 QEDF_SCSI_SENSE_BUFFERSIZE, io_req->sense_buffer, 128 io_req->sense_buffer_dma); 129 cancel_delayed_work_sync(&io_req->rrq_work); 130 } 131 132 /* Free command manager itself */ 133 vfree(cmgr); 134 } 135 136 static void qedf_handle_rrq(struct work_struct *work) 137 { 138 struct qedf_ioreq *io_req = 139 container_of(work, struct qedf_ioreq, rrq_work.work); 140 141 qedf_send_rrq(io_req); 142 143 } 144 145 struct qedf_cmd_mgr *qedf_cmd_mgr_alloc(struct qedf_ctx *qedf) 146 { 147 struct qedf_cmd_mgr *cmgr; 148 struct io_bdt *bdt_info; 149 struct qedf_ioreq *io_req; 150 u16 xid; 151 int i; 152 int num_ios; 153 u16 min_xid = QEDF_MIN_XID; 154 u16 max_xid = (FCOE_PARAMS_NUM_TASKS - 1); 155 156 /* Make sure num_queues is already set before calling this function */ 157 if (!qedf->num_queues) { 158 QEDF_ERR(&(qedf->dbg_ctx), "num_queues is not set.\n"); 159 return NULL; 160 } 161 162 if (max_xid <= min_xid || max_xid == FC_XID_UNKNOWN) { 163 QEDF_WARN(&(qedf->dbg_ctx), "Invalid min_xid 0x%x and " 164 "max_xid 0x%x.\n", min_xid, max_xid); 165 return NULL; 166 } 167 168 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "min xid 0x%x, max xid " 169 "0x%x.\n", min_xid, max_xid); 170 171 num_ios = max_xid - min_xid + 1; 172 173 cmgr = vzalloc(sizeof(struct qedf_cmd_mgr)); 174 if (!cmgr) { 175 QEDF_WARN(&(qedf->dbg_ctx), "Failed to alloc cmd mgr.\n"); 176 return NULL; 177 } 178 179 cmgr->qedf = qedf; 180 spin_lock_init(&cmgr->lock); 181 182 /* 183 * Initialize I/O request fields. 184 */ 185 xid = QEDF_MIN_XID; 186 187 for (i = 0; i < num_ios; i++) { 188 io_req = &cmgr->cmds[i]; 189 INIT_DELAYED_WORK(&io_req->timeout_work, qedf_cmd_timeout); 190 191 io_req->xid = xid++; 192 193 INIT_DELAYED_WORK(&io_req->rrq_work, qedf_handle_rrq); 194 195 /* Allocate DMA memory to hold sense buffer */ 196 io_req->sense_buffer = dma_alloc_coherent(&qedf->pdev->dev, 197 QEDF_SCSI_SENSE_BUFFERSIZE, &io_req->sense_buffer_dma, 198 GFP_KERNEL); 199 if (!io_req->sense_buffer) 200 goto mem_err; 201 202 /* Allocate task parameters to pass to f/w init funcions */ 203 io_req->task_params = kzalloc(sizeof(*io_req->task_params), 204 GFP_KERNEL); 205 if (!io_req->task_params) { 206 QEDF_ERR(&(qedf->dbg_ctx), 207 "Failed to allocate task_params for xid=0x%x\n", 208 i); 209 goto mem_err; 210 } 211 212 /* 213 * Allocate scatter/gather list info to pass to f/w init 214 * functions. 215 */ 216 io_req->sgl_task_params = kzalloc( 217 sizeof(struct scsi_sgl_task_params), GFP_KERNEL); 218 if (!io_req->sgl_task_params) { 219 QEDF_ERR(&(qedf->dbg_ctx), 220 "Failed to allocate sgl_task_params for xid=0x%x\n", 221 i); 222 goto mem_err; 223 } 224 } 225 226 /* Allocate pool of io_bdts - one for each qedf_ioreq */ 227 cmgr->io_bdt_pool = kmalloc_array(num_ios, sizeof(struct io_bdt *), 228 GFP_KERNEL); 229 230 if (!cmgr->io_bdt_pool) { 231 QEDF_WARN(&(qedf->dbg_ctx), "Failed to alloc io_bdt_pool.\n"); 232 goto mem_err; 233 } 234 235 for (i = 0; i < num_ios; i++) { 236 cmgr->io_bdt_pool[i] = kmalloc(sizeof(struct io_bdt), 237 GFP_KERNEL); 238 if (!cmgr->io_bdt_pool[i]) { 239 QEDF_WARN(&(qedf->dbg_ctx), 240 "Failed to alloc io_bdt_pool[%d].\n", i); 241 goto mem_err; 242 } 243 } 244 245 for (i = 0; i < num_ios; i++) { 246 bdt_info = cmgr->io_bdt_pool[i]; 247 bdt_info->bd_tbl = dma_alloc_coherent(&qedf->pdev->dev, 248 QEDF_MAX_BDS_PER_CMD * sizeof(struct scsi_sge), 249 &bdt_info->bd_tbl_dma, GFP_KERNEL); 250 if (!bdt_info->bd_tbl) { 251 QEDF_WARN(&(qedf->dbg_ctx), 252 "Failed to alloc bdt_tbl[%d].\n", i); 253 goto mem_err; 254 } 255 } 256 atomic_set(&cmgr->free_list_cnt, num_ios); 257 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO, 258 "cmgr->free_list_cnt=%d.\n", 259 atomic_read(&cmgr->free_list_cnt)); 260 261 return cmgr; 262 263 mem_err: 264 qedf_cmd_mgr_free(cmgr); 265 return NULL; 266 } 267 268 struct qedf_ioreq *qedf_alloc_cmd(struct qedf_rport *fcport, u8 cmd_type) 269 { 270 struct qedf_ctx *qedf = fcport->qedf; 271 struct qedf_cmd_mgr *cmd_mgr = qedf->cmd_mgr; 272 struct qedf_ioreq *io_req = NULL; 273 struct io_bdt *bd_tbl; 274 u16 xid; 275 uint32_t free_sqes; 276 int i; 277 unsigned long flags; 278 279 free_sqes = atomic_read(&fcport->free_sqes); 280 281 if (!free_sqes) { 282 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO, 283 "Returning NULL, free_sqes=%d.\n ", 284 free_sqes); 285 goto out_failed; 286 } 287 288 /* Limit the number of outstanding R/W tasks */ 289 if ((atomic_read(&fcport->num_active_ios) >= 290 NUM_RW_TASKS_PER_CONNECTION)) { 291 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO, 292 "Returning NULL, num_active_ios=%d.\n", 293 atomic_read(&fcport->num_active_ios)); 294 goto out_failed; 295 } 296 297 /* Limit global TIDs certain tasks */ 298 if (atomic_read(&cmd_mgr->free_list_cnt) <= GBL_RSVD_TASKS) { 299 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO, 300 "Returning NULL, free_list_cnt=%d.\n", 301 atomic_read(&cmd_mgr->free_list_cnt)); 302 goto out_failed; 303 } 304 305 spin_lock_irqsave(&cmd_mgr->lock, flags); 306 for (i = 0; i < FCOE_PARAMS_NUM_TASKS; i++) { 307 io_req = &cmd_mgr->cmds[cmd_mgr->idx]; 308 cmd_mgr->idx++; 309 if (cmd_mgr->idx == FCOE_PARAMS_NUM_TASKS) 310 cmd_mgr->idx = 0; 311 312 /* Check to make sure command was previously freed */ 313 if (!test_bit(QEDF_CMD_OUTSTANDING, &io_req->flags)) 314 break; 315 } 316 317 if (i == FCOE_PARAMS_NUM_TASKS) { 318 spin_unlock_irqrestore(&cmd_mgr->lock, flags); 319 goto out_failed; 320 } 321 322 set_bit(QEDF_CMD_OUTSTANDING, &io_req->flags); 323 spin_unlock_irqrestore(&cmd_mgr->lock, flags); 324 325 atomic_inc(&fcport->num_active_ios); 326 atomic_dec(&fcport->free_sqes); 327 xid = io_req->xid; 328 atomic_dec(&cmd_mgr->free_list_cnt); 329 330 io_req->cmd_mgr = cmd_mgr; 331 io_req->fcport = fcport; 332 333 /* Hold the io_req against deletion */ 334 kref_init(&io_req->refcount); 335 336 /* Bind io_bdt for this io_req */ 337 /* Have a static link between io_req and io_bdt_pool */ 338 bd_tbl = io_req->bd_tbl = cmd_mgr->io_bdt_pool[xid]; 339 if (bd_tbl == NULL) { 340 QEDF_ERR(&(qedf->dbg_ctx), "bd_tbl is NULL, xid=%x.\n", xid); 341 kref_put(&io_req->refcount, qedf_release_cmd); 342 goto out_failed; 343 } 344 bd_tbl->io_req = io_req; 345 io_req->cmd_type = cmd_type; 346 io_req->tm_flags = 0; 347 348 /* Reset sequence offset data */ 349 io_req->rx_buf_off = 0; 350 io_req->tx_buf_off = 0; 351 io_req->rx_id = 0xffff; /* No OX_ID */ 352 353 return io_req; 354 355 out_failed: 356 /* Record failure for stats and return NULL to caller */ 357 qedf->alloc_failures++; 358 return NULL; 359 } 360 361 static void qedf_free_mp_resc(struct qedf_ioreq *io_req) 362 { 363 struct qedf_mp_req *mp_req = &(io_req->mp_req); 364 struct qedf_ctx *qedf = io_req->fcport->qedf; 365 uint64_t sz = sizeof(struct scsi_sge); 366 367 /* clear tm flags */ 368 if (mp_req->mp_req_bd) { 369 dma_free_coherent(&qedf->pdev->dev, sz, 370 mp_req->mp_req_bd, mp_req->mp_req_bd_dma); 371 mp_req->mp_req_bd = NULL; 372 } 373 if (mp_req->mp_resp_bd) { 374 dma_free_coherent(&qedf->pdev->dev, sz, 375 mp_req->mp_resp_bd, mp_req->mp_resp_bd_dma); 376 mp_req->mp_resp_bd = NULL; 377 } 378 if (mp_req->req_buf) { 379 dma_free_coherent(&qedf->pdev->dev, QEDF_PAGE_SIZE, 380 mp_req->req_buf, mp_req->req_buf_dma); 381 mp_req->req_buf = NULL; 382 } 383 if (mp_req->resp_buf) { 384 dma_free_coherent(&qedf->pdev->dev, QEDF_PAGE_SIZE, 385 mp_req->resp_buf, mp_req->resp_buf_dma); 386 mp_req->resp_buf = NULL; 387 } 388 } 389 390 void qedf_release_cmd(struct kref *ref) 391 { 392 struct qedf_ioreq *io_req = 393 container_of(ref, struct qedf_ioreq, refcount); 394 struct qedf_cmd_mgr *cmd_mgr = io_req->cmd_mgr; 395 struct qedf_rport *fcport = io_req->fcport; 396 397 if (io_req->cmd_type == QEDF_ELS || 398 io_req->cmd_type == QEDF_TASK_MGMT_CMD) 399 qedf_free_mp_resc(io_req); 400 401 atomic_inc(&cmd_mgr->free_list_cnt); 402 atomic_dec(&fcport->num_active_ios); 403 if (atomic_read(&fcport->num_active_ios) < 0) 404 QEDF_WARN(&(fcport->qedf->dbg_ctx), "active_ios < 0.\n"); 405 406 /* Increment task retry identifier now that the request is released */ 407 io_req->task_retry_identifier++; 408 409 clear_bit(QEDF_CMD_OUTSTANDING, &io_req->flags); 410 } 411 412 static int qedf_split_bd(struct qedf_ioreq *io_req, u64 addr, int sg_len, 413 int bd_index) 414 { 415 struct scsi_sge *bd = io_req->bd_tbl->bd_tbl; 416 int frag_size, sg_frags; 417 418 sg_frags = 0; 419 while (sg_len) { 420 if (sg_len > QEDF_BD_SPLIT_SZ) 421 frag_size = QEDF_BD_SPLIT_SZ; 422 else 423 frag_size = sg_len; 424 bd[bd_index + sg_frags].sge_addr.lo = U64_LO(addr); 425 bd[bd_index + sg_frags].sge_addr.hi = U64_HI(addr); 426 bd[bd_index + sg_frags].sge_len = (uint16_t)frag_size; 427 428 addr += (u64)frag_size; 429 sg_frags++; 430 sg_len -= frag_size; 431 } 432 return sg_frags; 433 } 434 435 static int qedf_map_sg(struct qedf_ioreq *io_req) 436 { 437 struct scsi_cmnd *sc = io_req->sc_cmd; 438 struct Scsi_Host *host = sc->device->host; 439 struct fc_lport *lport = shost_priv(host); 440 struct qedf_ctx *qedf = lport_priv(lport); 441 struct scsi_sge *bd = io_req->bd_tbl->bd_tbl; 442 struct scatterlist *sg; 443 int byte_count = 0; 444 int sg_count = 0; 445 int bd_count = 0; 446 int sg_frags; 447 unsigned int sg_len; 448 u64 addr, end_addr; 449 int i; 450 451 sg_count = dma_map_sg(&qedf->pdev->dev, scsi_sglist(sc), 452 scsi_sg_count(sc), sc->sc_data_direction); 453 454 sg = scsi_sglist(sc); 455 456 /* 457 * New condition to send single SGE as cached-SGL with length less 458 * than 64k. 459 */ 460 if ((sg_count == 1) && (sg_dma_len(sg) <= 461 QEDF_MAX_SGLEN_FOR_CACHESGL)) { 462 sg_len = sg_dma_len(sg); 463 addr = (u64)sg_dma_address(sg); 464 465 bd[bd_count].sge_addr.lo = (addr & 0xffffffff); 466 bd[bd_count].sge_addr.hi = (addr >> 32); 467 bd[bd_count].sge_len = (u16)sg_len; 468 469 return ++bd_count; 470 } 471 472 scsi_for_each_sg(sc, sg, sg_count, i) { 473 sg_len = sg_dma_len(sg); 474 addr = (u64)sg_dma_address(sg); 475 end_addr = (u64)(addr + sg_len); 476 477 /* 478 * First s/g element in the list so check if the end_addr 479 * is paged aligned. Also check to make sure the length is 480 * at least page size. 481 */ 482 if ((i == 0) && (sg_count > 1) && 483 ((end_addr % QEDF_PAGE_SIZE) || 484 sg_len < QEDF_PAGE_SIZE)) 485 io_req->use_slowpath = true; 486 /* 487 * Last s/g element so check if the start address is paged 488 * aligned. 489 */ 490 else if ((i == (sg_count - 1)) && (sg_count > 1) && 491 (addr % QEDF_PAGE_SIZE)) 492 io_req->use_slowpath = true; 493 /* 494 * Intermediate s/g element so check if start and end address 495 * is page aligned. 496 */ 497 else if ((i != 0) && (i != (sg_count - 1)) && 498 ((addr % QEDF_PAGE_SIZE) || (end_addr % QEDF_PAGE_SIZE))) 499 io_req->use_slowpath = true; 500 501 if (sg_len > QEDF_MAX_BD_LEN) { 502 sg_frags = qedf_split_bd(io_req, addr, sg_len, 503 bd_count); 504 } else { 505 sg_frags = 1; 506 bd[bd_count].sge_addr.lo = U64_LO(addr); 507 bd[bd_count].sge_addr.hi = U64_HI(addr); 508 bd[bd_count].sge_len = (uint16_t)sg_len; 509 } 510 511 bd_count += sg_frags; 512 byte_count += sg_len; 513 } 514 515 if (byte_count != scsi_bufflen(sc)) 516 QEDF_ERR(&(qedf->dbg_ctx), "byte_count = %d != " 517 "scsi_bufflen = %d, task_id = 0x%x.\n", byte_count, 518 scsi_bufflen(sc), io_req->xid); 519 520 return bd_count; 521 } 522 523 static int qedf_build_bd_list_from_sg(struct qedf_ioreq *io_req) 524 { 525 struct scsi_cmnd *sc = io_req->sc_cmd; 526 struct scsi_sge *bd = io_req->bd_tbl->bd_tbl; 527 int bd_count; 528 529 if (scsi_sg_count(sc)) { 530 bd_count = qedf_map_sg(io_req); 531 if (bd_count == 0) 532 return -ENOMEM; 533 } else { 534 bd_count = 0; 535 bd[0].sge_addr.lo = bd[0].sge_addr.hi = 0; 536 bd[0].sge_len = 0; 537 } 538 io_req->bd_tbl->bd_valid = bd_count; 539 540 return 0; 541 } 542 543 static void qedf_build_fcp_cmnd(struct qedf_ioreq *io_req, 544 struct fcp_cmnd *fcp_cmnd) 545 { 546 struct scsi_cmnd *sc_cmd = io_req->sc_cmd; 547 548 /* fcp_cmnd is 32 bytes */ 549 memset(fcp_cmnd, 0, FCP_CMND_LEN); 550 551 /* 8 bytes: SCSI LUN info */ 552 int_to_scsilun(sc_cmd->device->lun, 553 (struct scsi_lun *)&fcp_cmnd->fc_lun); 554 555 /* 4 bytes: flag info */ 556 fcp_cmnd->fc_pri_ta = 0; 557 fcp_cmnd->fc_tm_flags = io_req->tm_flags; 558 fcp_cmnd->fc_flags = io_req->io_req_flags; 559 fcp_cmnd->fc_cmdref = 0; 560 561 /* Populate data direction */ 562 if (io_req->cmd_type == QEDF_TASK_MGMT_CMD) { 563 fcp_cmnd->fc_flags |= FCP_CFL_RDDATA; 564 } else { 565 if (sc_cmd->sc_data_direction == DMA_TO_DEVICE) 566 fcp_cmnd->fc_flags |= FCP_CFL_WRDATA; 567 else if (sc_cmd->sc_data_direction == DMA_FROM_DEVICE) 568 fcp_cmnd->fc_flags |= FCP_CFL_RDDATA; 569 } 570 571 fcp_cmnd->fc_pri_ta = FCP_PTA_SIMPLE; 572 573 /* 16 bytes: CDB information */ 574 if (io_req->cmd_type != QEDF_TASK_MGMT_CMD) 575 memcpy(fcp_cmnd->fc_cdb, sc_cmd->cmnd, sc_cmd->cmd_len); 576 577 /* 4 bytes: FCP data length */ 578 fcp_cmnd->fc_dl = htonl(io_req->data_xfer_len); 579 } 580 581 static void qedf_init_task(struct qedf_rport *fcport, struct fc_lport *lport, 582 struct qedf_ioreq *io_req, struct e4_fcoe_task_context *task_ctx, 583 struct fcoe_wqe *sqe) 584 { 585 enum fcoe_task_type task_type; 586 struct scsi_cmnd *sc_cmd = io_req->sc_cmd; 587 struct io_bdt *bd_tbl = io_req->bd_tbl; 588 u8 fcp_cmnd[32]; 589 u32 tmp_fcp_cmnd[8]; 590 int bd_count = 0; 591 struct qedf_ctx *qedf = fcport->qedf; 592 uint16_t cq_idx = smp_processor_id() % qedf->num_queues; 593 struct regpair sense_data_buffer_phys_addr; 594 u32 tx_io_size = 0; 595 u32 rx_io_size = 0; 596 int i, cnt; 597 598 /* Note init_initiator_rw_fcoe_task memsets the task context */ 599 io_req->task = task_ctx; 600 memset(task_ctx, 0, sizeof(struct e4_fcoe_task_context)); 601 memset(io_req->task_params, 0, sizeof(struct fcoe_task_params)); 602 memset(io_req->sgl_task_params, 0, sizeof(struct scsi_sgl_task_params)); 603 604 /* Set task type bassed on DMA directio of command */ 605 if (io_req->cmd_type == QEDF_TASK_MGMT_CMD) { 606 task_type = FCOE_TASK_TYPE_READ_INITIATOR; 607 } else { 608 if (sc_cmd->sc_data_direction == DMA_TO_DEVICE) { 609 task_type = FCOE_TASK_TYPE_WRITE_INITIATOR; 610 tx_io_size = io_req->data_xfer_len; 611 } else { 612 task_type = FCOE_TASK_TYPE_READ_INITIATOR; 613 rx_io_size = io_req->data_xfer_len; 614 } 615 } 616 617 /* Setup the fields for fcoe_task_params */ 618 io_req->task_params->context = task_ctx; 619 io_req->task_params->sqe = sqe; 620 io_req->task_params->task_type = task_type; 621 io_req->task_params->tx_io_size = tx_io_size; 622 io_req->task_params->rx_io_size = rx_io_size; 623 io_req->task_params->conn_cid = fcport->fw_cid; 624 io_req->task_params->itid = io_req->xid; 625 io_req->task_params->cq_rss_number = cq_idx; 626 io_req->task_params->is_tape_device = fcport->dev_type; 627 628 /* Fill in information for scatter/gather list */ 629 if (io_req->cmd_type != QEDF_TASK_MGMT_CMD) { 630 bd_count = bd_tbl->bd_valid; 631 io_req->sgl_task_params->sgl = bd_tbl->bd_tbl; 632 io_req->sgl_task_params->sgl_phys_addr.lo = 633 U64_LO(bd_tbl->bd_tbl_dma); 634 io_req->sgl_task_params->sgl_phys_addr.hi = 635 U64_HI(bd_tbl->bd_tbl_dma); 636 io_req->sgl_task_params->num_sges = bd_count; 637 io_req->sgl_task_params->total_buffer_size = 638 scsi_bufflen(io_req->sc_cmd); 639 io_req->sgl_task_params->small_mid_sge = 640 io_req->use_slowpath; 641 } 642 643 /* Fill in physical address of sense buffer */ 644 sense_data_buffer_phys_addr.lo = U64_LO(io_req->sense_buffer_dma); 645 sense_data_buffer_phys_addr.hi = U64_HI(io_req->sense_buffer_dma); 646 647 /* fill FCP_CMND IU */ 648 qedf_build_fcp_cmnd(io_req, (struct fcp_cmnd *)tmp_fcp_cmnd); 649 650 /* Swap fcp_cmnd since FC is big endian */ 651 cnt = sizeof(struct fcp_cmnd) / sizeof(u32); 652 for (i = 0; i < cnt; i++) { 653 tmp_fcp_cmnd[i] = cpu_to_be32(tmp_fcp_cmnd[i]); 654 } 655 memcpy(fcp_cmnd, tmp_fcp_cmnd, sizeof(struct fcp_cmnd)); 656 657 init_initiator_rw_fcoe_task(io_req->task_params, 658 io_req->sgl_task_params, 659 sense_data_buffer_phys_addr, 660 io_req->task_retry_identifier, fcp_cmnd); 661 662 /* Increment SGL type counters */ 663 if (bd_count == 1) { 664 qedf->single_sge_ios++; 665 io_req->sge_type = QEDF_IOREQ_SINGLE_SGE; 666 } else if (io_req->use_slowpath) { 667 qedf->slow_sge_ios++; 668 io_req->sge_type = QEDF_IOREQ_SLOW_SGE; 669 } else { 670 qedf->fast_sge_ios++; 671 io_req->sge_type = QEDF_IOREQ_FAST_SGE; 672 } 673 } 674 675 void qedf_init_mp_task(struct qedf_ioreq *io_req, 676 struct e4_fcoe_task_context *task_ctx, struct fcoe_wqe *sqe) 677 { 678 struct qedf_mp_req *mp_req = &(io_req->mp_req); 679 struct qedf_rport *fcport = io_req->fcport; 680 struct qedf_ctx *qedf = io_req->fcport->qedf; 681 struct fc_frame_header *fc_hdr; 682 struct fcoe_tx_mid_path_params task_fc_hdr; 683 struct scsi_sgl_task_params tx_sgl_task_params; 684 struct scsi_sgl_task_params rx_sgl_task_params; 685 686 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, 687 "Initializing MP task for cmd_type=%d\n", 688 io_req->cmd_type); 689 690 qedf->control_requests++; 691 692 memset(&tx_sgl_task_params, 0, sizeof(struct scsi_sgl_task_params)); 693 memset(&rx_sgl_task_params, 0, sizeof(struct scsi_sgl_task_params)); 694 memset(task_ctx, 0, sizeof(struct e4_fcoe_task_context)); 695 memset(&task_fc_hdr, 0, sizeof(struct fcoe_tx_mid_path_params)); 696 697 /* Setup the task from io_req for easy reference */ 698 io_req->task = task_ctx; 699 700 /* Setup the fields for fcoe_task_params */ 701 io_req->task_params->context = task_ctx; 702 io_req->task_params->sqe = sqe; 703 io_req->task_params->task_type = FCOE_TASK_TYPE_MIDPATH; 704 io_req->task_params->tx_io_size = io_req->data_xfer_len; 705 /* rx_io_size tells the f/w how large a response buffer we have */ 706 io_req->task_params->rx_io_size = PAGE_SIZE; 707 io_req->task_params->conn_cid = fcport->fw_cid; 708 io_req->task_params->itid = io_req->xid; 709 /* Return middle path commands on CQ 0 */ 710 io_req->task_params->cq_rss_number = 0; 711 io_req->task_params->is_tape_device = fcport->dev_type; 712 713 fc_hdr = &(mp_req->req_fc_hdr); 714 /* Set OX_ID and RX_ID based on driver task id */ 715 fc_hdr->fh_ox_id = io_req->xid; 716 fc_hdr->fh_rx_id = htons(0xffff); 717 718 /* Set up FC header information */ 719 task_fc_hdr.parameter = fc_hdr->fh_parm_offset; 720 task_fc_hdr.r_ctl = fc_hdr->fh_r_ctl; 721 task_fc_hdr.type = fc_hdr->fh_type; 722 task_fc_hdr.cs_ctl = fc_hdr->fh_cs_ctl; 723 task_fc_hdr.df_ctl = fc_hdr->fh_df_ctl; 724 task_fc_hdr.rx_id = fc_hdr->fh_rx_id; 725 task_fc_hdr.ox_id = fc_hdr->fh_ox_id; 726 727 /* Set up s/g list parameters for request buffer */ 728 tx_sgl_task_params.sgl = mp_req->mp_req_bd; 729 tx_sgl_task_params.sgl_phys_addr.lo = U64_LO(mp_req->mp_req_bd_dma); 730 tx_sgl_task_params.sgl_phys_addr.hi = U64_HI(mp_req->mp_req_bd_dma); 731 tx_sgl_task_params.num_sges = 1; 732 /* Set PAGE_SIZE for now since sg element is that size ??? */ 733 tx_sgl_task_params.total_buffer_size = io_req->data_xfer_len; 734 tx_sgl_task_params.small_mid_sge = 0; 735 736 /* Set up s/g list parameters for request buffer */ 737 rx_sgl_task_params.sgl = mp_req->mp_resp_bd; 738 rx_sgl_task_params.sgl_phys_addr.lo = U64_LO(mp_req->mp_resp_bd_dma); 739 rx_sgl_task_params.sgl_phys_addr.hi = U64_HI(mp_req->mp_resp_bd_dma); 740 rx_sgl_task_params.num_sges = 1; 741 /* Set PAGE_SIZE for now since sg element is that size ??? */ 742 rx_sgl_task_params.total_buffer_size = PAGE_SIZE; 743 rx_sgl_task_params.small_mid_sge = 0; 744 745 746 /* 747 * Last arg is 0 as previous code did not set that we wanted the 748 * fc header information. 749 */ 750 init_initiator_midpath_unsolicited_fcoe_task(io_req->task_params, 751 &task_fc_hdr, 752 &tx_sgl_task_params, 753 &rx_sgl_task_params, 0); 754 755 /* Midpath requests always consume 1 SGE */ 756 qedf->single_sge_ios++; 757 } 758 759 /* Presumed that fcport->rport_lock is held */ 760 u16 qedf_get_sqe_idx(struct qedf_rport *fcport) 761 { 762 uint16_t total_sqe = (fcport->sq_mem_size)/(sizeof(struct fcoe_wqe)); 763 u16 rval; 764 765 rval = fcport->sq_prod_idx; 766 767 /* Adjust ring index */ 768 fcport->sq_prod_idx++; 769 fcport->fw_sq_prod_idx++; 770 if (fcport->sq_prod_idx == total_sqe) 771 fcport->sq_prod_idx = 0; 772 773 return rval; 774 } 775 776 void qedf_ring_doorbell(struct qedf_rport *fcport) 777 { 778 struct fcoe_db_data dbell = { 0 }; 779 780 dbell.agg_flags = 0; 781 782 dbell.params |= DB_DEST_XCM << FCOE_DB_DATA_DEST_SHIFT; 783 dbell.params |= DB_AGG_CMD_SET << FCOE_DB_DATA_AGG_CMD_SHIFT; 784 dbell.params |= DQ_XCM_FCOE_SQ_PROD_CMD << 785 FCOE_DB_DATA_AGG_VAL_SEL_SHIFT; 786 787 dbell.sq_prod = fcport->fw_sq_prod_idx; 788 writel(*(u32 *)&dbell, fcport->p_doorbell); 789 /* Make sure SQ index is updated so f/w prcesses requests in order */ 790 wmb(); 791 mmiowb(); 792 } 793 794 static void qedf_trace_io(struct qedf_rport *fcport, struct qedf_ioreq *io_req, 795 int8_t direction) 796 { 797 struct qedf_ctx *qedf = fcport->qedf; 798 struct qedf_io_log *io_log; 799 struct scsi_cmnd *sc_cmd = io_req->sc_cmd; 800 unsigned long flags; 801 uint8_t op; 802 803 spin_lock_irqsave(&qedf->io_trace_lock, flags); 804 805 io_log = &qedf->io_trace_buf[qedf->io_trace_idx]; 806 io_log->direction = direction; 807 io_log->task_id = io_req->xid; 808 io_log->port_id = fcport->rdata->ids.port_id; 809 io_log->lun = sc_cmd->device->lun; 810 io_log->op = op = sc_cmd->cmnd[0]; 811 io_log->lba[0] = sc_cmd->cmnd[2]; 812 io_log->lba[1] = sc_cmd->cmnd[3]; 813 io_log->lba[2] = sc_cmd->cmnd[4]; 814 io_log->lba[3] = sc_cmd->cmnd[5]; 815 io_log->bufflen = scsi_bufflen(sc_cmd); 816 io_log->sg_count = scsi_sg_count(sc_cmd); 817 io_log->result = sc_cmd->result; 818 io_log->jiffies = jiffies; 819 io_log->refcount = kref_read(&io_req->refcount); 820 821 if (direction == QEDF_IO_TRACE_REQ) { 822 /* For requests we only care abot the submission CPU */ 823 io_log->req_cpu = io_req->cpu; 824 io_log->int_cpu = 0; 825 io_log->rsp_cpu = 0; 826 } else if (direction == QEDF_IO_TRACE_RSP) { 827 io_log->req_cpu = io_req->cpu; 828 io_log->int_cpu = io_req->int_cpu; 829 io_log->rsp_cpu = smp_processor_id(); 830 } 831 832 io_log->sge_type = io_req->sge_type; 833 834 qedf->io_trace_idx++; 835 if (qedf->io_trace_idx == QEDF_IO_TRACE_SIZE) 836 qedf->io_trace_idx = 0; 837 838 spin_unlock_irqrestore(&qedf->io_trace_lock, flags); 839 } 840 841 int qedf_post_io_req(struct qedf_rport *fcport, struct qedf_ioreq *io_req) 842 { 843 struct scsi_cmnd *sc_cmd = io_req->sc_cmd; 844 struct Scsi_Host *host = sc_cmd->device->host; 845 struct fc_lport *lport = shost_priv(host); 846 struct qedf_ctx *qedf = lport_priv(lport); 847 struct e4_fcoe_task_context *task_ctx; 848 u16 xid; 849 enum fcoe_task_type req_type = 0; 850 struct fcoe_wqe *sqe; 851 u16 sqe_idx; 852 853 /* Initialize rest of io_req fileds */ 854 io_req->data_xfer_len = scsi_bufflen(sc_cmd); 855 sc_cmd->SCp.ptr = (char *)io_req; 856 io_req->use_slowpath = false; /* Assume fast SGL by default */ 857 858 /* Record which cpu this request is associated with */ 859 io_req->cpu = smp_processor_id(); 860 861 if (sc_cmd->sc_data_direction == DMA_FROM_DEVICE) { 862 req_type = FCOE_TASK_TYPE_READ_INITIATOR; 863 io_req->io_req_flags = QEDF_READ; 864 qedf->input_requests++; 865 } else if (sc_cmd->sc_data_direction == DMA_TO_DEVICE) { 866 req_type = FCOE_TASK_TYPE_WRITE_INITIATOR; 867 io_req->io_req_flags = QEDF_WRITE; 868 qedf->output_requests++; 869 } else { 870 io_req->io_req_flags = 0; 871 qedf->control_requests++; 872 } 873 874 xid = io_req->xid; 875 876 /* Build buffer descriptor list for firmware from sg list */ 877 if (qedf_build_bd_list_from_sg(io_req)) { 878 QEDF_ERR(&(qedf->dbg_ctx), "BD list creation failed.\n"); 879 kref_put(&io_req->refcount, qedf_release_cmd); 880 return -EAGAIN; 881 } 882 883 if (!test_bit(QEDF_RPORT_SESSION_READY, &fcport->flags)) { 884 QEDF_ERR(&(qedf->dbg_ctx), "Session not offloaded yet.\n"); 885 kref_put(&io_req->refcount, qedf_release_cmd); 886 } 887 888 /* Obtain free SQE */ 889 sqe_idx = qedf_get_sqe_idx(fcport); 890 sqe = &fcport->sq[sqe_idx]; 891 memset(sqe, 0, sizeof(struct fcoe_wqe)); 892 893 /* Get the task context */ 894 task_ctx = qedf_get_task_mem(&qedf->tasks, xid); 895 if (!task_ctx) { 896 QEDF_WARN(&(qedf->dbg_ctx), "task_ctx is NULL, xid=%d.\n", 897 xid); 898 kref_put(&io_req->refcount, qedf_release_cmd); 899 return -EINVAL; 900 } 901 902 qedf_init_task(fcport, lport, io_req, task_ctx, sqe); 903 904 /* Ring doorbell */ 905 qedf_ring_doorbell(fcport); 906 907 if (qedf_io_tracing && io_req->sc_cmd) 908 qedf_trace_io(fcport, io_req, QEDF_IO_TRACE_REQ); 909 910 return false; 911 } 912 913 int 914 qedf_queuecommand(struct Scsi_Host *host, struct scsi_cmnd *sc_cmd) 915 { 916 struct fc_lport *lport = shost_priv(host); 917 struct qedf_ctx *qedf = lport_priv(lport); 918 struct fc_rport *rport = starget_to_rport(scsi_target(sc_cmd->device)); 919 struct fc_rport_libfc_priv *rp = rport->dd_data; 920 struct qedf_rport *fcport; 921 struct qedf_ioreq *io_req; 922 int rc = 0; 923 int rval; 924 unsigned long flags = 0; 925 926 927 if (test_bit(QEDF_UNLOADING, &qedf->flags) || 928 test_bit(QEDF_DBG_STOP_IO, &qedf->flags)) { 929 sc_cmd->result = DID_NO_CONNECT << 16; 930 sc_cmd->scsi_done(sc_cmd); 931 return 0; 932 } 933 934 rval = fc_remote_port_chkready(rport); 935 if (rval) { 936 sc_cmd->result = rval; 937 sc_cmd->scsi_done(sc_cmd); 938 return 0; 939 } 940 941 /* Retry command if we are doing a qed drain operation */ 942 if (test_bit(QEDF_DRAIN_ACTIVE, &qedf->flags)) { 943 rc = SCSI_MLQUEUE_HOST_BUSY; 944 goto exit_qcmd; 945 } 946 947 if (lport->state != LPORT_ST_READY || 948 atomic_read(&qedf->link_state) != QEDF_LINK_UP) { 949 rc = SCSI_MLQUEUE_HOST_BUSY; 950 goto exit_qcmd; 951 } 952 953 /* rport and tgt are allocated together, so tgt should be non-NULL */ 954 fcport = (struct qedf_rport *)&rp[1]; 955 956 if (!test_bit(QEDF_RPORT_SESSION_READY, &fcport->flags)) { 957 /* 958 * Session is not offloaded yet. Let SCSI-ml retry 959 * the command. 960 */ 961 rc = SCSI_MLQUEUE_TARGET_BUSY; 962 goto exit_qcmd; 963 } 964 if (fcport->retry_delay_timestamp) { 965 if (time_after(jiffies, fcport->retry_delay_timestamp)) { 966 fcport->retry_delay_timestamp = 0; 967 } else { 968 /* If retry_delay timer is active, flow off the ML */ 969 rc = SCSI_MLQUEUE_TARGET_BUSY; 970 goto exit_qcmd; 971 } 972 } 973 974 io_req = qedf_alloc_cmd(fcport, QEDF_SCSI_CMD); 975 if (!io_req) { 976 rc = SCSI_MLQUEUE_HOST_BUSY; 977 goto exit_qcmd; 978 } 979 980 io_req->sc_cmd = sc_cmd; 981 982 /* Take fcport->rport_lock for posting to fcport send queue */ 983 spin_lock_irqsave(&fcport->rport_lock, flags); 984 if (qedf_post_io_req(fcport, io_req)) { 985 QEDF_WARN(&(qedf->dbg_ctx), "Unable to post io_req\n"); 986 /* Return SQE to pool */ 987 atomic_inc(&fcport->free_sqes); 988 rc = SCSI_MLQUEUE_HOST_BUSY; 989 } 990 spin_unlock_irqrestore(&fcport->rport_lock, flags); 991 992 exit_qcmd: 993 return rc; 994 } 995 996 static void qedf_parse_fcp_rsp(struct qedf_ioreq *io_req, 997 struct fcoe_cqe_rsp_info *fcp_rsp) 998 { 999 struct scsi_cmnd *sc_cmd = io_req->sc_cmd; 1000 struct qedf_ctx *qedf = io_req->fcport->qedf; 1001 u8 rsp_flags = fcp_rsp->rsp_flags.flags; 1002 int fcp_sns_len = 0; 1003 int fcp_rsp_len = 0; 1004 uint8_t *rsp_info, *sense_data; 1005 1006 io_req->fcp_status = FC_GOOD; 1007 io_req->fcp_resid = 0; 1008 if (rsp_flags & (FCOE_FCP_RSP_FLAGS_FCP_RESID_OVER | 1009 FCOE_FCP_RSP_FLAGS_FCP_RESID_UNDER)) 1010 io_req->fcp_resid = fcp_rsp->fcp_resid; 1011 1012 io_req->scsi_comp_flags = rsp_flags; 1013 CMD_SCSI_STATUS(sc_cmd) = io_req->cdb_status = 1014 fcp_rsp->scsi_status_code; 1015 1016 if (rsp_flags & 1017 FCOE_FCP_RSP_FLAGS_FCP_RSP_LEN_VALID) 1018 fcp_rsp_len = fcp_rsp->fcp_rsp_len; 1019 1020 if (rsp_flags & 1021 FCOE_FCP_RSP_FLAGS_FCP_SNS_LEN_VALID) 1022 fcp_sns_len = fcp_rsp->fcp_sns_len; 1023 1024 io_req->fcp_rsp_len = fcp_rsp_len; 1025 io_req->fcp_sns_len = fcp_sns_len; 1026 rsp_info = sense_data = io_req->sense_buffer; 1027 1028 /* fetch fcp_rsp_code */ 1029 if ((fcp_rsp_len == 4) || (fcp_rsp_len == 8)) { 1030 /* Only for task management function */ 1031 io_req->fcp_rsp_code = rsp_info[3]; 1032 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO, 1033 "fcp_rsp_code = %d\n", io_req->fcp_rsp_code); 1034 /* Adjust sense-data location. */ 1035 sense_data += fcp_rsp_len; 1036 } 1037 1038 if (fcp_sns_len > SCSI_SENSE_BUFFERSIZE) { 1039 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO, 1040 "Truncating sense buffer\n"); 1041 fcp_sns_len = SCSI_SENSE_BUFFERSIZE; 1042 } 1043 1044 /* The sense buffer can be NULL for TMF commands */ 1045 if (sc_cmd->sense_buffer) { 1046 memset(sc_cmd->sense_buffer, 0, SCSI_SENSE_BUFFERSIZE); 1047 if (fcp_sns_len) 1048 memcpy(sc_cmd->sense_buffer, sense_data, 1049 fcp_sns_len); 1050 } 1051 } 1052 1053 static void qedf_unmap_sg_list(struct qedf_ctx *qedf, struct qedf_ioreq *io_req) 1054 { 1055 struct scsi_cmnd *sc = io_req->sc_cmd; 1056 1057 if (io_req->bd_tbl->bd_valid && sc && scsi_sg_count(sc)) { 1058 dma_unmap_sg(&qedf->pdev->dev, scsi_sglist(sc), 1059 scsi_sg_count(sc), sc->sc_data_direction); 1060 io_req->bd_tbl->bd_valid = 0; 1061 } 1062 } 1063 1064 void qedf_scsi_completion(struct qedf_ctx *qedf, struct fcoe_cqe *cqe, 1065 struct qedf_ioreq *io_req) 1066 { 1067 u16 xid, rval; 1068 struct e4_fcoe_task_context *task_ctx; 1069 struct scsi_cmnd *sc_cmd; 1070 struct fcoe_cqe_rsp_info *fcp_rsp; 1071 struct qedf_rport *fcport; 1072 int refcount; 1073 u16 scope, qualifier = 0; 1074 u8 fw_residual_flag = 0; 1075 1076 if (!io_req) 1077 return; 1078 if (!cqe) 1079 return; 1080 1081 xid = io_req->xid; 1082 task_ctx = qedf_get_task_mem(&qedf->tasks, xid); 1083 sc_cmd = io_req->sc_cmd; 1084 fcp_rsp = &cqe->cqe_info.rsp_info; 1085 1086 if (!sc_cmd) { 1087 QEDF_WARN(&(qedf->dbg_ctx), "sc_cmd is NULL!\n"); 1088 return; 1089 } 1090 1091 if (!sc_cmd->SCp.ptr) { 1092 QEDF_WARN(&(qedf->dbg_ctx), "SCp.ptr is NULL, returned in " 1093 "another context.\n"); 1094 return; 1095 } 1096 1097 if (!sc_cmd->request) { 1098 QEDF_WARN(&(qedf->dbg_ctx), "sc_cmd->request is NULL, " 1099 "sc_cmd=%p.\n", sc_cmd); 1100 return; 1101 } 1102 1103 if (!sc_cmd->request->special) { 1104 QEDF_WARN(&(qedf->dbg_ctx), "request->special is NULL so " 1105 "request not valid, sc_cmd=%p.\n", sc_cmd); 1106 return; 1107 } 1108 1109 if (!sc_cmd->request->q) { 1110 QEDF_WARN(&(qedf->dbg_ctx), "request->q is NULL so request " 1111 "is not valid, sc_cmd=%p.\n", sc_cmd); 1112 return; 1113 } 1114 1115 fcport = io_req->fcport; 1116 1117 qedf_parse_fcp_rsp(io_req, fcp_rsp); 1118 1119 qedf_unmap_sg_list(qedf, io_req); 1120 1121 /* Check for FCP transport error */ 1122 if (io_req->fcp_rsp_len > 3 && io_req->fcp_rsp_code) { 1123 QEDF_ERR(&(qedf->dbg_ctx), 1124 "FCP I/O protocol failure xid=0x%x fcp_rsp_len=%d " 1125 "fcp_rsp_code=%d.\n", io_req->xid, io_req->fcp_rsp_len, 1126 io_req->fcp_rsp_code); 1127 sc_cmd->result = DID_BUS_BUSY << 16; 1128 goto out; 1129 } 1130 1131 fw_residual_flag = GET_FIELD(cqe->cqe_info.rsp_info.fw_error_flags, 1132 FCOE_CQE_RSP_INFO_FW_UNDERRUN); 1133 if (fw_residual_flag) { 1134 QEDF_ERR(&(qedf->dbg_ctx), 1135 "Firmware detected underrun: xid=0x%x fcp_rsp.flags=0x%02x " 1136 "fcp_resid=%d fw_residual=0x%x.\n", io_req->xid, 1137 fcp_rsp->rsp_flags.flags, io_req->fcp_resid, 1138 cqe->cqe_info.rsp_info.fw_residual); 1139 1140 if (io_req->cdb_status == 0) 1141 sc_cmd->result = (DID_ERROR << 16) | io_req->cdb_status; 1142 else 1143 sc_cmd->result = (DID_OK << 16) | io_req->cdb_status; 1144 1145 /* Abort the command since we did not get all the data */ 1146 init_completion(&io_req->abts_done); 1147 rval = qedf_initiate_abts(io_req, true); 1148 if (rval) { 1149 QEDF_ERR(&(qedf->dbg_ctx), "Failed to queue ABTS.\n"); 1150 sc_cmd->result = (DID_ERROR << 16) | io_req->cdb_status; 1151 } 1152 1153 /* 1154 * Set resid to the whole buffer length so we won't try to resue 1155 * any previously data. 1156 */ 1157 scsi_set_resid(sc_cmd, scsi_bufflen(sc_cmd)); 1158 goto out; 1159 } 1160 1161 switch (io_req->fcp_status) { 1162 case FC_GOOD: 1163 if (io_req->cdb_status == 0) { 1164 /* Good I/O completion */ 1165 sc_cmd->result = DID_OK << 16; 1166 } else { 1167 refcount = kref_read(&io_req->refcount); 1168 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO, 1169 "%d:0:%d:%lld xid=0x%0x op=0x%02x " 1170 "lba=%02x%02x%02x%02x cdb_status=%d " 1171 "fcp_resid=0x%x refcount=%d.\n", 1172 qedf->lport->host->host_no, sc_cmd->device->id, 1173 sc_cmd->device->lun, io_req->xid, 1174 sc_cmd->cmnd[0], sc_cmd->cmnd[2], sc_cmd->cmnd[3], 1175 sc_cmd->cmnd[4], sc_cmd->cmnd[5], 1176 io_req->cdb_status, io_req->fcp_resid, 1177 refcount); 1178 sc_cmd->result = (DID_OK << 16) | io_req->cdb_status; 1179 1180 if (io_req->cdb_status == SAM_STAT_TASK_SET_FULL || 1181 io_req->cdb_status == SAM_STAT_BUSY) { 1182 /* 1183 * Check whether we need to set retry_delay at 1184 * all based on retry_delay module parameter 1185 * and the status qualifier. 1186 */ 1187 1188 /* Upper 2 bits */ 1189 scope = fcp_rsp->retry_delay_timer & 0xC000; 1190 /* Lower 14 bits */ 1191 qualifier = fcp_rsp->retry_delay_timer & 0x3FFF; 1192 1193 if (qedf_retry_delay && 1194 scope > 0 && qualifier > 0 && 1195 qualifier <= 0x3FEF) { 1196 /* Check we don't go over the max */ 1197 if (qualifier > QEDF_RETRY_DELAY_MAX) 1198 qualifier = 1199 QEDF_RETRY_DELAY_MAX; 1200 fcport->retry_delay_timestamp = 1201 jiffies + (qualifier * HZ / 10); 1202 } 1203 /* Record stats */ 1204 if (io_req->cdb_status == 1205 SAM_STAT_TASK_SET_FULL) 1206 qedf->task_set_fulls++; 1207 else 1208 qedf->busy++; 1209 } 1210 } 1211 if (io_req->fcp_resid) 1212 scsi_set_resid(sc_cmd, io_req->fcp_resid); 1213 break; 1214 default: 1215 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO, "fcp_status=%d.\n", 1216 io_req->fcp_status); 1217 break; 1218 } 1219 1220 out: 1221 if (qedf_io_tracing) 1222 qedf_trace_io(fcport, io_req, QEDF_IO_TRACE_RSP); 1223 1224 io_req->sc_cmd = NULL; 1225 sc_cmd->SCp.ptr = NULL; 1226 sc_cmd->scsi_done(sc_cmd); 1227 kref_put(&io_req->refcount, qedf_release_cmd); 1228 } 1229 1230 /* Return a SCSI command in some other context besides a normal completion */ 1231 void qedf_scsi_done(struct qedf_ctx *qedf, struct qedf_ioreq *io_req, 1232 int result) 1233 { 1234 u16 xid; 1235 struct scsi_cmnd *sc_cmd; 1236 int refcount; 1237 1238 if (!io_req) 1239 return; 1240 1241 xid = io_req->xid; 1242 sc_cmd = io_req->sc_cmd; 1243 1244 if (!sc_cmd) { 1245 QEDF_WARN(&(qedf->dbg_ctx), "sc_cmd is NULL!\n"); 1246 return; 1247 } 1248 1249 if (!sc_cmd->SCp.ptr) { 1250 QEDF_WARN(&(qedf->dbg_ctx), "SCp.ptr is NULL, returned in " 1251 "another context.\n"); 1252 return; 1253 } 1254 1255 qedf_unmap_sg_list(qedf, io_req); 1256 1257 sc_cmd->result = result << 16; 1258 refcount = kref_read(&io_req->refcount); 1259 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO, "%d:0:%d:%lld: Completing " 1260 "sc_cmd=%p result=0x%08x op=0x%02x lba=0x%02x%02x%02x%02x, " 1261 "allowed=%d retries=%d refcount=%d.\n", 1262 qedf->lport->host->host_no, sc_cmd->device->id, 1263 sc_cmd->device->lun, sc_cmd, sc_cmd->result, sc_cmd->cmnd[0], 1264 sc_cmd->cmnd[2], sc_cmd->cmnd[3], sc_cmd->cmnd[4], 1265 sc_cmd->cmnd[5], sc_cmd->allowed, sc_cmd->retries, 1266 refcount); 1267 1268 /* 1269 * Set resid to the whole buffer length so we won't try to resue any 1270 * previously read data 1271 */ 1272 scsi_set_resid(sc_cmd, scsi_bufflen(sc_cmd)); 1273 1274 if (qedf_io_tracing) 1275 qedf_trace_io(io_req->fcport, io_req, QEDF_IO_TRACE_RSP); 1276 1277 io_req->sc_cmd = NULL; 1278 sc_cmd->SCp.ptr = NULL; 1279 sc_cmd->scsi_done(sc_cmd); 1280 kref_put(&io_req->refcount, qedf_release_cmd); 1281 } 1282 1283 /* 1284 * Handle warning type CQE completions. This is mainly used for REC timer 1285 * popping. 1286 */ 1287 void qedf_process_warning_compl(struct qedf_ctx *qedf, struct fcoe_cqe *cqe, 1288 struct qedf_ioreq *io_req) 1289 { 1290 int rval, i; 1291 struct qedf_rport *fcport = io_req->fcport; 1292 u64 err_warn_bit_map; 1293 u8 err_warn = 0xff; 1294 1295 if (!cqe) 1296 return; 1297 1298 QEDF_ERR(&(io_req->fcport->qedf->dbg_ctx), "Warning CQE, " 1299 "xid=0x%x\n", io_req->xid); 1300 QEDF_ERR(&(io_req->fcport->qedf->dbg_ctx), 1301 "err_warn_bitmap=%08x:%08x\n", 1302 le32_to_cpu(cqe->cqe_info.err_info.err_warn_bitmap_hi), 1303 le32_to_cpu(cqe->cqe_info.err_info.err_warn_bitmap_lo)); 1304 QEDF_ERR(&(io_req->fcport->qedf->dbg_ctx), "tx_buff_off=%08x, " 1305 "rx_buff_off=%08x, rx_id=%04x\n", 1306 le32_to_cpu(cqe->cqe_info.err_info.tx_buf_off), 1307 le32_to_cpu(cqe->cqe_info.err_info.rx_buf_off), 1308 le32_to_cpu(cqe->cqe_info.err_info.rx_id)); 1309 1310 /* Normalize the error bitmap value to an just an unsigned int */ 1311 err_warn_bit_map = (u64) 1312 ((u64)cqe->cqe_info.err_info.err_warn_bitmap_hi << 32) | 1313 (u64)cqe->cqe_info.err_info.err_warn_bitmap_lo; 1314 for (i = 0; i < 64; i++) { 1315 if (err_warn_bit_map & (u64)((u64)1 << i)) { 1316 err_warn = i; 1317 break; 1318 } 1319 } 1320 1321 /* Check if REC TOV expired if this is a tape device */ 1322 if (fcport->dev_type == QEDF_RPORT_TYPE_TAPE) { 1323 if (err_warn == 1324 FCOE_WARNING_CODE_REC_TOV_TIMER_EXPIRATION) { 1325 QEDF_ERR(&(qedf->dbg_ctx), "REC timer expired.\n"); 1326 if (!test_bit(QEDF_CMD_SRR_SENT, &io_req->flags)) { 1327 io_req->rx_buf_off = 1328 cqe->cqe_info.err_info.rx_buf_off; 1329 io_req->tx_buf_off = 1330 cqe->cqe_info.err_info.tx_buf_off; 1331 io_req->rx_id = cqe->cqe_info.err_info.rx_id; 1332 rval = qedf_send_rec(io_req); 1333 /* 1334 * We only want to abort the io_req if we 1335 * can't queue the REC command as we want to 1336 * keep the exchange open for recovery. 1337 */ 1338 if (rval) 1339 goto send_abort; 1340 } 1341 return; 1342 } 1343 } 1344 1345 send_abort: 1346 init_completion(&io_req->abts_done); 1347 rval = qedf_initiate_abts(io_req, true); 1348 if (rval) 1349 QEDF_ERR(&(qedf->dbg_ctx), "Failed to queue ABTS.\n"); 1350 } 1351 1352 /* Cleanup a command when we receive an error detection completion */ 1353 void qedf_process_error_detect(struct qedf_ctx *qedf, struct fcoe_cqe *cqe, 1354 struct qedf_ioreq *io_req) 1355 { 1356 int rval; 1357 1358 if (!cqe) 1359 return; 1360 1361 QEDF_ERR(&(io_req->fcport->qedf->dbg_ctx), "Error detection CQE, " 1362 "xid=0x%x\n", io_req->xid); 1363 QEDF_ERR(&(io_req->fcport->qedf->dbg_ctx), 1364 "err_warn_bitmap=%08x:%08x\n", 1365 le32_to_cpu(cqe->cqe_info.err_info.err_warn_bitmap_hi), 1366 le32_to_cpu(cqe->cqe_info.err_info.err_warn_bitmap_lo)); 1367 QEDF_ERR(&(io_req->fcport->qedf->dbg_ctx), "tx_buff_off=%08x, " 1368 "rx_buff_off=%08x, rx_id=%04x\n", 1369 le32_to_cpu(cqe->cqe_info.err_info.tx_buf_off), 1370 le32_to_cpu(cqe->cqe_info.err_info.rx_buf_off), 1371 le32_to_cpu(cqe->cqe_info.err_info.rx_id)); 1372 1373 if (qedf->stop_io_on_error) { 1374 qedf_stop_all_io(qedf); 1375 return; 1376 } 1377 1378 init_completion(&io_req->abts_done); 1379 rval = qedf_initiate_abts(io_req, true); 1380 if (rval) 1381 QEDF_ERR(&(qedf->dbg_ctx), "Failed to queue ABTS.\n"); 1382 } 1383 1384 static void qedf_flush_els_req(struct qedf_ctx *qedf, 1385 struct qedf_ioreq *els_req) 1386 { 1387 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO, 1388 "Flushing ELS request xid=0x%x refcount=%d.\n", els_req->xid, 1389 kref_read(&els_req->refcount)); 1390 1391 /* 1392 * Need to distinguish this from a timeout when calling the 1393 * els_req->cb_func. 1394 */ 1395 els_req->event = QEDF_IOREQ_EV_ELS_FLUSH; 1396 1397 /* Cancel the timer */ 1398 cancel_delayed_work_sync(&els_req->timeout_work); 1399 1400 /* Call callback function to complete command */ 1401 if (els_req->cb_func && els_req->cb_arg) { 1402 els_req->cb_func(els_req->cb_arg); 1403 els_req->cb_arg = NULL; 1404 } 1405 1406 /* Release kref for original initiate_els */ 1407 kref_put(&els_req->refcount, qedf_release_cmd); 1408 } 1409 1410 /* A value of -1 for lun is a wild card that means flush all 1411 * active SCSI I/Os for the target. 1412 */ 1413 void qedf_flush_active_ios(struct qedf_rport *fcport, int lun) 1414 { 1415 struct qedf_ioreq *io_req; 1416 struct qedf_ctx *qedf; 1417 struct qedf_cmd_mgr *cmd_mgr; 1418 int i, rc; 1419 1420 if (!fcport) 1421 return; 1422 1423 qedf = fcport->qedf; 1424 cmd_mgr = qedf->cmd_mgr; 1425 1426 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO, "Flush active i/o's.\n"); 1427 1428 for (i = 0; i < FCOE_PARAMS_NUM_TASKS; i++) { 1429 io_req = &cmd_mgr->cmds[i]; 1430 1431 if (!io_req) 1432 continue; 1433 if (io_req->fcport != fcport) 1434 continue; 1435 if (io_req->cmd_type == QEDF_ELS) { 1436 rc = kref_get_unless_zero(&io_req->refcount); 1437 if (!rc) { 1438 QEDF_ERR(&(qedf->dbg_ctx), 1439 "Could not get kref for io_req=0x%p.\n", 1440 io_req); 1441 continue; 1442 } 1443 qedf_flush_els_req(qedf, io_req); 1444 /* 1445 * Release the kref and go back to the top of the 1446 * loop. 1447 */ 1448 goto free_cmd; 1449 } 1450 1451 if (!io_req->sc_cmd) 1452 continue; 1453 if (lun > 0) { 1454 if (io_req->sc_cmd->device->lun != 1455 (u64)lun) 1456 continue; 1457 } 1458 1459 /* 1460 * Use kref_get_unless_zero in the unlikely case the command 1461 * we're about to flush was completed in the normal SCSI path 1462 */ 1463 rc = kref_get_unless_zero(&io_req->refcount); 1464 if (!rc) { 1465 QEDF_ERR(&(qedf->dbg_ctx), "Could not get kref for " 1466 "io_req=0x%p\n", io_req); 1467 continue; 1468 } 1469 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO, 1470 "Cleanup xid=0x%x.\n", io_req->xid); 1471 1472 /* Cleanup task and return I/O mid-layer */ 1473 qedf_initiate_cleanup(io_req, true); 1474 1475 free_cmd: 1476 kref_put(&io_req->refcount, qedf_release_cmd); 1477 } 1478 } 1479 1480 /* 1481 * Initiate a ABTS middle path command. Note that we don't have to initialize 1482 * the task context for an ABTS task. 1483 */ 1484 int qedf_initiate_abts(struct qedf_ioreq *io_req, bool return_scsi_cmd_on_abts) 1485 { 1486 struct fc_lport *lport; 1487 struct qedf_rport *fcport = io_req->fcport; 1488 struct fc_rport_priv *rdata; 1489 struct qedf_ctx *qedf; 1490 u16 xid; 1491 u32 r_a_tov = 0; 1492 int rc = 0; 1493 unsigned long flags; 1494 struct fcoe_wqe *sqe; 1495 u16 sqe_idx; 1496 1497 /* Sanity check qedf_rport before dereferencing any pointers */ 1498 if (!test_bit(QEDF_RPORT_SESSION_READY, &fcport->flags)) { 1499 QEDF_ERR(NULL, "tgt not offloaded\n"); 1500 rc = 1; 1501 goto abts_err; 1502 } 1503 1504 rdata = fcport->rdata; 1505 r_a_tov = rdata->r_a_tov; 1506 qedf = fcport->qedf; 1507 lport = qedf->lport; 1508 1509 if (lport->state != LPORT_ST_READY || !(lport->link_up)) { 1510 QEDF_ERR(&(qedf->dbg_ctx), "link is not ready\n"); 1511 rc = 1; 1512 goto abts_err; 1513 } 1514 1515 if (atomic_read(&qedf->link_down_tmo_valid) > 0) { 1516 QEDF_ERR(&(qedf->dbg_ctx), "link_down_tmo active.\n"); 1517 rc = 1; 1518 goto abts_err; 1519 } 1520 1521 /* Ensure room on SQ */ 1522 if (!atomic_read(&fcport->free_sqes)) { 1523 QEDF_ERR(&(qedf->dbg_ctx), "No SQ entries available\n"); 1524 rc = 1; 1525 goto abts_err; 1526 } 1527 1528 1529 kref_get(&io_req->refcount); 1530 1531 xid = io_req->xid; 1532 qedf->control_requests++; 1533 qedf->packet_aborts++; 1534 1535 /* Set the return CPU to be the same as the request one */ 1536 io_req->cpu = smp_processor_id(); 1537 1538 /* Set the command type to abort */ 1539 io_req->cmd_type = QEDF_ABTS; 1540 io_req->return_scsi_cmd_on_abts = return_scsi_cmd_on_abts; 1541 1542 set_bit(QEDF_CMD_IN_ABORT, &io_req->flags); 1543 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_SCSI_TM, "ABTS io_req xid = " 1544 "0x%x\n", xid); 1545 1546 qedf_cmd_timer_set(qedf, io_req, QEDF_ABORT_TIMEOUT * HZ); 1547 1548 spin_lock_irqsave(&fcport->rport_lock, flags); 1549 1550 sqe_idx = qedf_get_sqe_idx(fcport); 1551 sqe = &fcport->sq[sqe_idx]; 1552 memset(sqe, 0, sizeof(struct fcoe_wqe)); 1553 io_req->task_params->sqe = sqe; 1554 1555 init_initiator_abort_fcoe_task(io_req->task_params); 1556 qedf_ring_doorbell(fcport); 1557 1558 spin_unlock_irqrestore(&fcport->rport_lock, flags); 1559 1560 return rc; 1561 abts_err: 1562 /* 1563 * If the ABTS task fails to queue then we need to cleanup the 1564 * task at the firmware. 1565 */ 1566 qedf_initiate_cleanup(io_req, return_scsi_cmd_on_abts); 1567 return rc; 1568 } 1569 1570 void qedf_process_abts_compl(struct qedf_ctx *qedf, struct fcoe_cqe *cqe, 1571 struct qedf_ioreq *io_req) 1572 { 1573 uint32_t r_ctl; 1574 uint16_t xid; 1575 1576 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_SCSI_TM, "Entered with xid = " 1577 "0x%x cmd_type = %d\n", io_req->xid, io_req->cmd_type); 1578 1579 cancel_delayed_work(&io_req->timeout_work); 1580 1581 xid = io_req->xid; 1582 r_ctl = cqe->cqe_info.abts_info.r_ctl; 1583 1584 switch (r_ctl) { 1585 case FC_RCTL_BA_ACC: 1586 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_SCSI_TM, 1587 "ABTS response - ACC Send RRQ after R_A_TOV\n"); 1588 io_req->event = QEDF_IOREQ_EV_ABORT_SUCCESS; 1589 /* 1590 * Dont release this cmd yet. It will be relesed 1591 * after we get RRQ response 1592 */ 1593 kref_get(&io_req->refcount); 1594 queue_delayed_work(qedf->dpc_wq, &io_req->rrq_work, 1595 msecs_to_jiffies(qedf->lport->r_a_tov)); 1596 break; 1597 /* For error cases let the cleanup return the command */ 1598 case FC_RCTL_BA_RJT: 1599 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_SCSI_TM, 1600 "ABTS response - RJT\n"); 1601 io_req->event = QEDF_IOREQ_EV_ABORT_FAILED; 1602 break; 1603 default: 1604 QEDF_ERR(&(qedf->dbg_ctx), "Unknown ABTS response\n"); 1605 break; 1606 } 1607 1608 clear_bit(QEDF_CMD_IN_ABORT, &io_req->flags); 1609 1610 if (io_req->sc_cmd) { 1611 if (io_req->return_scsi_cmd_on_abts) 1612 qedf_scsi_done(qedf, io_req, DID_ERROR); 1613 } 1614 1615 /* Notify eh_abort handler that ABTS is complete */ 1616 complete(&io_req->abts_done); 1617 1618 kref_put(&io_req->refcount, qedf_release_cmd); 1619 } 1620 1621 int qedf_init_mp_req(struct qedf_ioreq *io_req) 1622 { 1623 struct qedf_mp_req *mp_req; 1624 struct scsi_sge *mp_req_bd; 1625 struct scsi_sge *mp_resp_bd; 1626 struct qedf_ctx *qedf = io_req->fcport->qedf; 1627 dma_addr_t addr; 1628 uint64_t sz; 1629 1630 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_MP_REQ, "Entered.\n"); 1631 1632 mp_req = (struct qedf_mp_req *)&(io_req->mp_req); 1633 memset(mp_req, 0, sizeof(struct qedf_mp_req)); 1634 1635 if (io_req->cmd_type != QEDF_ELS) { 1636 mp_req->req_len = sizeof(struct fcp_cmnd); 1637 io_req->data_xfer_len = mp_req->req_len; 1638 } else 1639 mp_req->req_len = io_req->data_xfer_len; 1640 1641 mp_req->req_buf = dma_alloc_coherent(&qedf->pdev->dev, QEDF_PAGE_SIZE, 1642 &mp_req->req_buf_dma, GFP_KERNEL); 1643 if (!mp_req->req_buf) { 1644 QEDF_ERR(&(qedf->dbg_ctx), "Unable to alloc MP req buffer\n"); 1645 qedf_free_mp_resc(io_req); 1646 return -ENOMEM; 1647 } 1648 1649 mp_req->resp_buf = dma_alloc_coherent(&qedf->pdev->dev, 1650 QEDF_PAGE_SIZE, &mp_req->resp_buf_dma, GFP_KERNEL); 1651 if (!mp_req->resp_buf) { 1652 QEDF_ERR(&(qedf->dbg_ctx), "Unable to alloc TM resp " 1653 "buffer\n"); 1654 qedf_free_mp_resc(io_req); 1655 return -ENOMEM; 1656 } 1657 1658 /* Allocate and map mp_req_bd and mp_resp_bd */ 1659 sz = sizeof(struct scsi_sge); 1660 mp_req->mp_req_bd = dma_alloc_coherent(&qedf->pdev->dev, sz, 1661 &mp_req->mp_req_bd_dma, GFP_KERNEL); 1662 if (!mp_req->mp_req_bd) { 1663 QEDF_ERR(&(qedf->dbg_ctx), "Unable to alloc MP req bd\n"); 1664 qedf_free_mp_resc(io_req); 1665 return -ENOMEM; 1666 } 1667 1668 mp_req->mp_resp_bd = dma_alloc_coherent(&qedf->pdev->dev, sz, 1669 &mp_req->mp_resp_bd_dma, GFP_KERNEL); 1670 if (!mp_req->mp_resp_bd) { 1671 QEDF_ERR(&(qedf->dbg_ctx), "Unable to alloc MP resp bd\n"); 1672 qedf_free_mp_resc(io_req); 1673 return -ENOMEM; 1674 } 1675 1676 /* Fill bd table */ 1677 addr = mp_req->req_buf_dma; 1678 mp_req_bd = mp_req->mp_req_bd; 1679 mp_req_bd->sge_addr.lo = U64_LO(addr); 1680 mp_req_bd->sge_addr.hi = U64_HI(addr); 1681 mp_req_bd->sge_len = QEDF_PAGE_SIZE; 1682 1683 /* 1684 * MP buffer is either a task mgmt command or an ELS. 1685 * So the assumption is that it consumes a single bd 1686 * entry in the bd table 1687 */ 1688 mp_resp_bd = mp_req->mp_resp_bd; 1689 addr = mp_req->resp_buf_dma; 1690 mp_resp_bd->sge_addr.lo = U64_LO(addr); 1691 mp_resp_bd->sge_addr.hi = U64_HI(addr); 1692 mp_resp_bd->sge_len = QEDF_PAGE_SIZE; 1693 1694 return 0; 1695 } 1696 1697 /* 1698 * Last ditch effort to clear the port if it's stuck. Used only after a 1699 * cleanup task times out. 1700 */ 1701 static void qedf_drain_request(struct qedf_ctx *qedf) 1702 { 1703 if (test_bit(QEDF_DRAIN_ACTIVE, &qedf->flags)) { 1704 QEDF_ERR(&(qedf->dbg_ctx), "MCP drain already active.\n"); 1705 return; 1706 } 1707 1708 /* Set bit to return all queuecommand requests as busy */ 1709 set_bit(QEDF_DRAIN_ACTIVE, &qedf->flags); 1710 1711 /* Call qed drain request for function. Should be synchronous */ 1712 qed_ops->common->drain(qedf->cdev); 1713 1714 /* Settle time for CQEs to be returned */ 1715 msleep(100); 1716 1717 /* Unplug and continue */ 1718 clear_bit(QEDF_DRAIN_ACTIVE, &qedf->flags); 1719 } 1720 1721 /* 1722 * Returns SUCCESS if the cleanup task does not timeout, otherwise return 1723 * FAILURE. 1724 */ 1725 int qedf_initiate_cleanup(struct qedf_ioreq *io_req, 1726 bool return_scsi_cmd_on_abts) 1727 { 1728 struct qedf_rport *fcport; 1729 struct qedf_ctx *qedf; 1730 uint16_t xid; 1731 struct e4_fcoe_task_context *task; 1732 int tmo = 0; 1733 int rc = SUCCESS; 1734 unsigned long flags; 1735 struct fcoe_wqe *sqe; 1736 u16 sqe_idx; 1737 1738 fcport = io_req->fcport; 1739 if (!fcport) { 1740 QEDF_ERR(NULL, "fcport is NULL.\n"); 1741 return SUCCESS; 1742 } 1743 1744 /* Sanity check qedf_rport before dereferencing any pointers */ 1745 if (!test_bit(QEDF_RPORT_SESSION_READY, &fcport->flags)) { 1746 QEDF_ERR(NULL, "tgt not offloaded\n"); 1747 rc = 1; 1748 return SUCCESS; 1749 } 1750 1751 qedf = fcport->qedf; 1752 if (!qedf) { 1753 QEDF_ERR(NULL, "qedf is NULL.\n"); 1754 return SUCCESS; 1755 } 1756 1757 if (!test_bit(QEDF_CMD_OUTSTANDING, &io_req->flags) || 1758 test_bit(QEDF_CMD_IN_CLEANUP, &io_req->flags)) { 1759 QEDF_ERR(&(qedf->dbg_ctx), "io_req xid=0x%x already in " 1760 "cleanup processing or already completed.\n", 1761 io_req->xid); 1762 return SUCCESS; 1763 } 1764 1765 /* Ensure room on SQ */ 1766 if (!atomic_read(&fcport->free_sqes)) { 1767 QEDF_ERR(&(qedf->dbg_ctx), "No SQ entries available\n"); 1768 return FAILED; 1769 } 1770 1771 1772 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO, "Entered xid=0x%x\n", 1773 io_req->xid); 1774 1775 /* Cleanup cmds re-use the same TID as the original I/O */ 1776 xid = io_req->xid; 1777 io_req->cmd_type = QEDF_CLEANUP; 1778 io_req->return_scsi_cmd_on_abts = return_scsi_cmd_on_abts; 1779 1780 /* Set the return CPU to be the same as the request one */ 1781 io_req->cpu = smp_processor_id(); 1782 1783 set_bit(QEDF_CMD_IN_CLEANUP, &io_req->flags); 1784 1785 task = qedf_get_task_mem(&qedf->tasks, xid); 1786 1787 init_completion(&io_req->tm_done); 1788 1789 spin_lock_irqsave(&fcport->rport_lock, flags); 1790 1791 sqe_idx = qedf_get_sqe_idx(fcport); 1792 sqe = &fcport->sq[sqe_idx]; 1793 memset(sqe, 0, sizeof(struct fcoe_wqe)); 1794 io_req->task_params->sqe = sqe; 1795 1796 init_initiator_cleanup_fcoe_task(io_req->task_params); 1797 qedf_ring_doorbell(fcport); 1798 1799 spin_unlock_irqrestore(&fcport->rport_lock, flags); 1800 1801 tmo = wait_for_completion_timeout(&io_req->tm_done, 1802 QEDF_CLEANUP_TIMEOUT * HZ); 1803 1804 if (!tmo) { 1805 rc = FAILED; 1806 /* Timeout case */ 1807 QEDF_ERR(&(qedf->dbg_ctx), "Cleanup command timeout, " 1808 "xid=%x.\n", io_req->xid); 1809 clear_bit(QEDF_CMD_IN_CLEANUP, &io_req->flags); 1810 /* Issue a drain request if cleanup task times out */ 1811 QEDF_ERR(&(qedf->dbg_ctx), "Issuing MCP drain request.\n"); 1812 qedf_drain_request(qedf); 1813 } 1814 1815 if (io_req->sc_cmd) { 1816 if (io_req->return_scsi_cmd_on_abts) 1817 qedf_scsi_done(qedf, io_req, DID_ERROR); 1818 } 1819 1820 if (rc == SUCCESS) 1821 io_req->event = QEDF_IOREQ_EV_CLEANUP_SUCCESS; 1822 else 1823 io_req->event = QEDF_IOREQ_EV_CLEANUP_FAILED; 1824 1825 return rc; 1826 } 1827 1828 void qedf_process_cleanup_compl(struct qedf_ctx *qedf, struct fcoe_cqe *cqe, 1829 struct qedf_ioreq *io_req) 1830 { 1831 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_IO, "Entered xid = 0x%x\n", 1832 io_req->xid); 1833 1834 clear_bit(QEDF_CMD_IN_CLEANUP, &io_req->flags); 1835 1836 /* Complete so we can finish cleaning up the I/O */ 1837 complete(&io_req->tm_done); 1838 } 1839 1840 static int qedf_execute_tmf(struct qedf_rport *fcport, struct scsi_cmnd *sc_cmd, 1841 uint8_t tm_flags) 1842 { 1843 struct qedf_ioreq *io_req; 1844 struct e4_fcoe_task_context *task; 1845 struct qedf_ctx *qedf = fcport->qedf; 1846 struct fc_lport *lport = qedf->lport; 1847 int rc = 0; 1848 uint16_t xid; 1849 int tmo = 0; 1850 unsigned long flags; 1851 struct fcoe_wqe *sqe; 1852 u16 sqe_idx; 1853 1854 if (!sc_cmd) { 1855 QEDF_ERR(&(qedf->dbg_ctx), "invalid arg\n"); 1856 return FAILED; 1857 } 1858 1859 if (!test_bit(QEDF_RPORT_SESSION_READY, &fcport->flags)) { 1860 QEDF_ERR(&(qedf->dbg_ctx), "fcport not offloaded\n"); 1861 rc = FAILED; 1862 return FAILED; 1863 } 1864 1865 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_SCSI_TM, "portid = 0x%x " 1866 "tm_flags = %d\n", fcport->rdata->ids.port_id, tm_flags); 1867 1868 io_req = qedf_alloc_cmd(fcport, QEDF_TASK_MGMT_CMD); 1869 if (!io_req) { 1870 QEDF_ERR(&(qedf->dbg_ctx), "Failed TMF"); 1871 rc = -EAGAIN; 1872 goto reset_tmf_err; 1873 } 1874 1875 if (tm_flags == FCP_TMF_LUN_RESET) 1876 qedf->lun_resets++; 1877 else if (tm_flags == FCP_TMF_TGT_RESET) 1878 qedf->target_resets++; 1879 1880 /* Initialize rest of io_req fields */ 1881 io_req->sc_cmd = sc_cmd; 1882 io_req->fcport = fcport; 1883 io_req->cmd_type = QEDF_TASK_MGMT_CMD; 1884 1885 /* Set the return CPU to be the same as the request one */ 1886 io_req->cpu = smp_processor_id(); 1887 1888 /* Set TM flags */ 1889 io_req->io_req_flags = QEDF_READ; 1890 io_req->data_xfer_len = 0; 1891 io_req->tm_flags = tm_flags; 1892 1893 /* Default is to return a SCSI command when an error occurs */ 1894 io_req->return_scsi_cmd_on_abts = true; 1895 1896 /* Obtain exchange id */ 1897 xid = io_req->xid; 1898 1899 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_SCSI_TM, "TMF io_req xid = " 1900 "0x%x\n", xid); 1901 1902 /* Initialize task context for this IO request */ 1903 task = qedf_get_task_mem(&qedf->tasks, xid); 1904 1905 init_completion(&io_req->tm_done); 1906 1907 spin_lock_irqsave(&fcport->rport_lock, flags); 1908 1909 sqe_idx = qedf_get_sqe_idx(fcport); 1910 sqe = &fcport->sq[sqe_idx]; 1911 memset(sqe, 0, sizeof(struct fcoe_wqe)); 1912 1913 qedf_init_task(fcport, lport, io_req, task, sqe); 1914 qedf_ring_doorbell(fcport); 1915 1916 spin_unlock_irqrestore(&fcport->rport_lock, flags); 1917 1918 tmo = wait_for_completion_timeout(&io_req->tm_done, 1919 QEDF_TM_TIMEOUT * HZ); 1920 1921 if (!tmo) { 1922 rc = FAILED; 1923 QEDF_ERR(&(qedf->dbg_ctx), "wait for tm_cmpl timeout!\n"); 1924 } else { 1925 /* Check TMF response code */ 1926 if (io_req->fcp_rsp_code == 0) 1927 rc = SUCCESS; 1928 else 1929 rc = FAILED; 1930 } 1931 1932 if (tm_flags == FCP_TMF_LUN_RESET) 1933 qedf_flush_active_ios(fcport, (int)sc_cmd->device->lun); 1934 else 1935 qedf_flush_active_ios(fcport, -1); 1936 1937 kref_put(&io_req->refcount, qedf_release_cmd); 1938 1939 if (rc != SUCCESS) { 1940 QEDF_ERR(&(qedf->dbg_ctx), "task mgmt command failed...\n"); 1941 rc = FAILED; 1942 } else { 1943 QEDF_ERR(&(qedf->dbg_ctx), "task mgmt command success...\n"); 1944 rc = SUCCESS; 1945 } 1946 reset_tmf_err: 1947 return rc; 1948 } 1949 1950 int qedf_initiate_tmf(struct scsi_cmnd *sc_cmd, u8 tm_flags) 1951 { 1952 struct fc_rport *rport = starget_to_rport(scsi_target(sc_cmd->device)); 1953 struct fc_rport_libfc_priv *rp = rport->dd_data; 1954 struct qedf_rport *fcport = (struct qedf_rport *)&rp[1]; 1955 struct qedf_ctx *qedf; 1956 struct fc_lport *lport; 1957 int rc = SUCCESS; 1958 int rval; 1959 1960 rval = fc_remote_port_chkready(rport); 1961 1962 if (rval) { 1963 QEDF_ERR(NULL, "device_reset rport not ready\n"); 1964 rc = FAILED; 1965 goto tmf_err; 1966 } 1967 1968 if (fcport == NULL) { 1969 QEDF_ERR(NULL, "device_reset: rport is NULL\n"); 1970 rc = FAILED; 1971 goto tmf_err; 1972 } 1973 1974 qedf = fcport->qedf; 1975 lport = qedf->lport; 1976 1977 if (test_bit(QEDF_UNLOADING, &qedf->flags) || 1978 test_bit(QEDF_DBG_STOP_IO, &qedf->flags)) { 1979 rc = SUCCESS; 1980 goto tmf_err; 1981 } 1982 1983 if (lport->state != LPORT_ST_READY || !(lport->link_up)) { 1984 QEDF_ERR(&(qedf->dbg_ctx), "link is not ready\n"); 1985 rc = FAILED; 1986 goto tmf_err; 1987 } 1988 1989 rc = qedf_execute_tmf(fcport, sc_cmd, tm_flags); 1990 1991 tmf_err: 1992 return rc; 1993 } 1994 1995 void qedf_process_tmf_compl(struct qedf_ctx *qedf, struct fcoe_cqe *cqe, 1996 struct qedf_ioreq *io_req) 1997 { 1998 struct fcoe_cqe_rsp_info *fcp_rsp; 1999 2000 fcp_rsp = &cqe->cqe_info.rsp_info; 2001 qedf_parse_fcp_rsp(io_req, fcp_rsp); 2002 2003 io_req->sc_cmd = NULL; 2004 complete(&io_req->tm_done); 2005 } 2006 2007 void qedf_process_unsol_compl(struct qedf_ctx *qedf, uint16_t que_idx, 2008 struct fcoe_cqe *cqe) 2009 { 2010 unsigned long flags; 2011 uint16_t tmp; 2012 uint16_t pktlen = cqe->cqe_info.unsolic_info.pkt_len; 2013 u32 payload_len, crc; 2014 struct fc_frame_header *fh; 2015 struct fc_frame *fp; 2016 struct qedf_io_work *io_work; 2017 u32 bdq_idx; 2018 void *bdq_addr; 2019 struct scsi_bd *p_bd_info; 2020 2021 p_bd_info = &cqe->cqe_info.unsolic_info.bd_info; 2022 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_UNSOL, 2023 "address.hi=%x, address.lo=%x, opaque_data.hi=%x, opaque_data.lo=%x, bdq_prod_idx=%u, len=%u\n", 2024 le32_to_cpu(p_bd_info->address.hi), 2025 le32_to_cpu(p_bd_info->address.lo), 2026 le32_to_cpu(p_bd_info->opaque.fcoe_opaque.hi), 2027 le32_to_cpu(p_bd_info->opaque.fcoe_opaque.lo), 2028 qedf->bdq_prod_idx, pktlen); 2029 2030 bdq_idx = le32_to_cpu(p_bd_info->opaque.fcoe_opaque.lo); 2031 if (bdq_idx >= QEDF_BDQ_SIZE) { 2032 QEDF_ERR(&(qedf->dbg_ctx), "bdq_idx is out of range %d.\n", 2033 bdq_idx); 2034 goto increment_prod; 2035 } 2036 2037 bdq_addr = qedf->bdq[bdq_idx].buf_addr; 2038 if (!bdq_addr) { 2039 QEDF_ERR(&(qedf->dbg_ctx), "bdq_addr is NULL, dropping " 2040 "unsolicited packet.\n"); 2041 goto increment_prod; 2042 } 2043 2044 if (qedf_dump_frames) { 2045 QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_UNSOL, 2046 "BDQ frame is at addr=%p.\n", bdq_addr); 2047 print_hex_dump(KERN_WARNING, "bdq ", DUMP_PREFIX_OFFSET, 16, 1, 2048 (void *)bdq_addr, pktlen, false); 2049 } 2050 2051 /* Allocate frame */ 2052 payload_len = pktlen - sizeof(struct fc_frame_header); 2053 fp = fc_frame_alloc(qedf->lport, payload_len); 2054 if (!fp) { 2055 QEDF_ERR(&(qedf->dbg_ctx), "Could not allocate fp.\n"); 2056 goto increment_prod; 2057 } 2058 2059 /* Copy data from BDQ buffer into fc_frame struct */ 2060 fh = (struct fc_frame_header *)fc_frame_header_get(fp); 2061 memcpy(fh, (void *)bdq_addr, pktlen); 2062 2063 /* Initialize the frame so libfc sees it as a valid frame */ 2064 crc = fcoe_fc_crc(fp); 2065 fc_frame_init(fp); 2066 fr_dev(fp) = qedf->lport; 2067 fr_sof(fp) = FC_SOF_I3; 2068 fr_eof(fp) = FC_EOF_T; 2069 fr_crc(fp) = cpu_to_le32(~crc); 2070 2071 /* 2072 * We need to return the frame back up to libfc in a non-atomic 2073 * context 2074 */ 2075 io_work = mempool_alloc(qedf->io_mempool, GFP_ATOMIC); 2076 if (!io_work) { 2077 QEDF_WARN(&(qedf->dbg_ctx), "Could not allocate " 2078 "work for I/O completion.\n"); 2079 fc_frame_free(fp); 2080 goto increment_prod; 2081 } 2082 memset(io_work, 0, sizeof(struct qedf_io_work)); 2083 2084 INIT_WORK(&io_work->work, qedf_fp_io_handler); 2085 2086 /* Copy contents of CQE for deferred processing */ 2087 memcpy(&io_work->cqe, cqe, sizeof(struct fcoe_cqe)); 2088 2089 io_work->qedf = qedf; 2090 io_work->fp = fp; 2091 2092 queue_work_on(smp_processor_id(), qedf_io_wq, &io_work->work); 2093 increment_prod: 2094 spin_lock_irqsave(&qedf->hba_lock, flags); 2095 2096 /* Increment producer to let f/w know we've handled the frame */ 2097 qedf->bdq_prod_idx++; 2098 2099 /* Producer index wraps at uint16_t boundary */ 2100 if (qedf->bdq_prod_idx == 0xffff) 2101 qedf->bdq_prod_idx = 0; 2102 2103 writew(qedf->bdq_prod_idx, qedf->bdq_primary_prod); 2104 tmp = readw(qedf->bdq_primary_prod); 2105 writew(qedf->bdq_prod_idx, qedf->bdq_secondary_prod); 2106 tmp = readw(qedf->bdq_secondary_prod); 2107 2108 spin_unlock_irqrestore(&qedf->hba_lock, flags); 2109 } 2110