1 /** 2 * Copyright (C) 2005 - 2010 ServerEngines 3 * All rights reserved. 4 * 5 * This program is free software; you can redistribute it and/or 6 * modify it under the terms of the GNU General Public License version 2 7 * as published by the Free Software Foundation. The full GNU General 8 * Public License is included in this distribution in the file called COPYING. 9 * 10 * Written by: Jayamohan Kallickal (jayamohank@serverengines.com) 11 * 12 * Contact Information: 13 * linux-drivers@serverengines.com 14 * 15 * ServerEngines 16 * 209 N. Fair Oaks Ave 17 * Sunnyvale, CA 94085 18 * 19 */ 20 #include <linux/reboot.h> 21 #include <linux/delay.h> 22 #include <linux/slab.h> 23 #include <linux/interrupt.h> 24 #include <linux/blkdev.h> 25 #include <linux/pci.h> 26 #include <linux/string.h> 27 #include <linux/kernel.h> 28 #include <linux/semaphore.h> 29 #include <linux/iscsi_boot_sysfs.h> 30 31 #include <scsi/libiscsi.h> 32 #include <scsi/scsi_transport_iscsi.h> 33 #include <scsi/scsi_transport.h> 34 #include <scsi/scsi_cmnd.h> 35 #include <scsi/scsi_device.h> 36 #include <scsi/scsi_host.h> 37 #include <scsi/scsi.h> 38 #include "be_main.h" 39 #include "be_iscsi.h" 40 #include "be_mgmt.h" 41 42 static unsigned int be_iopoll_budget = 10; 43 static unsigned int be_max_phys_size = 64; 44 static unsigned int enable_msix = 1; 45 static unsigned int gcrashmode = 0; 46 static unsigned int num_hba = 0; 47 48 MODULE_DEVICE_TABLE(pci, beiscsi_pci_id_table); 49 MODULE_DESCRIPTION(DRV_DESC " " BUILD_STR); 50 MODULE_AUTHOR("ServerEngines Corporation"); 51 MODULE_LICENSE("GPL"); 52 module_param(be_iopoll_budget, int, 0); 53 module_param(enable_msix, int, 0); 54 module_param(be_max_phys_size, uint, S_IRUGO); 55 MODULE_PARM_DESC(be_max_phys_size, "Maximum Size (In Kilobytes) of physically" 56 "contiguous memory that can be allocated." 57 "Range is 16 - 128"); 58 59 static int beiscsi_slave_configure(struct scsi_device *sdev) 60 { 61 blk_queue_max_segment_size(sdev->request_queue, 65536); 62 return 0; 63 } 64 65 static int beiscsi_eh_abort(struct scsi_cmnd *sc) 66 { 67 struct iscsi_cls_session *cls_session; 68 struct iscsi_task *aborted_task = (struct iscsi_task *)sc->SCp.ptr; 69 struct beiscsi_io_task *aborted_io_task; 70 struct iscsi_conn *conn; 71 struct beiscsi_conn *beiscsi_conn; 72 struct beiscsi_hba *phba; 73 struct iscsi_session *session; 74 struct invalidate_command_table *inv_tbl; 75 struct be_dma_mem nonemb_cmd; 76 unsigned int cid, tag, num_invalidate; 77 78 cls_session = starget_to_session(scsi_target(sc->device)); 79 session = cls_session->dd_data; 80 81 spin_lock_bh(&session->lock); 82 if (!aborted_task || !aborted_task->sc) { 83 /* we raced */ 84 spin_unlock_bh(&session->lock); 85 return SUCCESS; 86 } 87 88 aborted_io_task = aborted_task->dd_data; 89 if (!aborted_io_task->scsi_cmnd) { 90 /* raced or invalid command */ 91 spin_unlock_bh(&session->lock); 92 return SUCCESS; 93 } 94 spin_unlock_bh(&session->lock); 95 conn = aborted_task->conn; 96 beiscsi_conn = conn->dd_data; 97 phba = beiscsi_conn->phba; 98 99 /* invalidate iocb */ 100 cid = beiscsi_conn->beiscsi_conn_cid; 101 inv_tbl = phba->inv_tbl; 102 memset(inv_tbl, 0x0, sizeof(*inv_tbl)); 103 inv_tbl->cid = cid; 104 inv_tbl->icd = aborted_io_task->psgl_handle->sgl_index; 105 num_invalidate = 1; 106 nonemb_cmd.va = pci_alloc_consistent(phba->ctrl.pdev, 107 sizeof(struct invalidate_commands_params_in), 108 &nonemb_cmd.dma); 109 if (nonemb_cmd.va == NULL) { 110 SE_DEBUG(DBG_LVL_1, 111 "Failed to allocate memory for" 112 "mgmt_invalidate_icds\n"); 113 return FAILED; 114 } 115 nonemb_cmd.size = sizeof(struct invalidate_commands_params_in); 116 117 tag = mgmt_invalidate_icds(phba, inv_tbl, num_invalidate, 118 cid, &nonemb_cmd); 119 if (!tag) { 120 shost_printk(KERN_WARNING, phba->shost, 121 "mgmt_invalidate_icds could not be" 122 " submitted\n"); 123 pci_free_consistent(phba->ctrl.pdev, nonemb_cmd.size, 124 nonemb_cmd.va, nonemb_cmd.dma); 125 126 return FAILED; 127 } else { 128 wait_event_interruptible(phba->ctrl.mcc_wait[tag], 129 phba->ctrl.mcc_numtag[tag]); 130 free_mcc_tag(&phba->ctrl, tag); 131 } 132 pci_free_consistent(phba->ctrl.pdev, nonemb_cmd.size, 133 nonemb_cmd.va, nonemb_cmd.dma); 134 return iscsi_eh_abort(sc); 135 } 136 137 static int beiscsi_eh_device_reset(struct scsi_cmnd *sc) 138 { 139 struct iscsi_task *abrt_task; 140 struct beiscsi_io_task *abrt_io_task; 141 struct iscsi_conn *conn; 142 struct beiscsi_conn *beiscsi_conn; 143 struct beiscsi_hba *phba; 144 struct iscsi_session *session; 145 struct iscsi_cls_session *cls_session; 146 struct invalidate_command_table *inv_tbl; 147 struct be_dma_mem nonemb_cmd; 148 unsigned int cid, tag, i, num_invalidate; 149 int rc = FAILED; 150 151 /* invalidate iocbs */ 152 cls_session = starget_to_session(scsi_target(sc->device)); 153 session = cls_session->dd_data; 154 spin_lock_bh(&session->lock); 155 if (!session->leadconn || session->state != ISCSI_STATE_LOGGED_IN) 156 goto unlock; 157 158 conn = session->leadconn; 159 beiscsi_conn = conn->dd_data; 160 phba = beiscsi_conn->phba; 161 cid = beiscsi_conn->beiscsi_conn_cid; 162 inv_tbl = phba->inv_tbl; 163 memset(inv_tbl, 0x0, sizeof(*inv_tbl) * BE2_CMDS_PER_CXN); 164 num_invalidate = 0; 165 for (i = 0; i < conn->session->cmds_max; i++) { 166 abrt_task = conn->session->cmds[i]; 167 abrt_io_task = abrt_task->dd_data; 168 if (!abrt_task->sc || abrt_task->state == ISCSI_TASK_FREE) 169 continue; 170 171 if (abrt_task->sc->device->lun != abrt_task->sc->device->lun) 172 continue; 173 174 inv_tbl->cid = cid; 175 inv_tbl->icd = abrt_io_task->psgl_handle->sgl_index; 176 num_invalidate++; 177 inv_tbl++; 178 } 179 spin_unlock_bh(&session->lock); 180 inv_tbl = phba->inv_tbl; 181 182 nonemb_cmd.va = pci_alloc_consistent(phba->ctrl.pdev, 183 sizeof(struct invalidate_commands_params_in), 184 &nonemb_cmd.dma); 185 if (nonemb_cmd.va == NULL) { 186 SE_DEBUG(DBG_LVL_1, 187 "Failed to allocate memory for" 188 "mgmt_invalidate_icds\n"); 189 return FAILED; 190 } 191 nonemb_cmd.size = sizeof(struct invalidate_commands_params_in); 192 memset(nonemb_cmd.va, 0, nonemb_cmd.size); 193 tag = mgmt_invalidate_icds(phba, inv_tbl, num_invalidate, 194 cid, &nonemb_cmd); 195 if (!tag) { 196 shost_printk(KERN_WARNING, phba->shost, 197 "mgmt_invalidate_icds could not be" 198 " submitted\n"); 199 pci_free_consistent(phba->ctrl.pdev, nonemb_cmd.size, 200 nonemb_cmd.va, nonemb_cmd.dma); 201 return FAILED; 202 } else { 203 wait_event_interruptible(phba->ctrl.mcc_wait[tag], 204 phba->ctrl.mcc_numtag[tag]); 205 free_mcc_tag(&phba->ctrl, tag); 206 } 207 pci_free_consistent(phba->ctrl.pdev, nonemb_cmd.size, 208 nonemb_cmd.va, nonemb_cmd.dma); 209 return iscsi_eh_device_reset(sc); 210 unlock: 211 spin_unlock_bh(&session->lock); 212 return rc; 213 } 214 215 static ssize_t beiscsi_show_boot_tgt_info(void *data, int type, char *buf) 216 { 217 struct beiscsi_hba *phba = data; 218 char *str = buf; 219 int rc; 220 221 switch (type) { 222 case ISCSI_BOOT_TGT_NAME: 223 rc = sprintf(buf, "%.*s\n", 224 (int)strlen(phba->boot_sess.target_name), 225 (char *)&phba->boot_sess.target_name); 226 break; 227 case ISCSI_BOOT_TGT_IP_ADDR: 228 if (phba->boot_sess.conn_list[0].dest_ipaddr.ip_type == 0x1) 229 rc = sprintf(buf, "%pI4\n", 230 (char *)&phba->boot_sess.conn_list[0]. 231 dest_ipaddr.ip_address); 232 else 233 rc = sprintf(str, "%pI6\n", 234 (char *)&phba->boot_sess.conn_list[0]. 235 dest_ipaddr.ip_address); 236 break; 237 case ISCSI_BOOT_TGT_PORT: 238 rc = sprintf(str, "%d\n", phba->boot_sess.conn_list[0]. 239 dest_port); 240 break; 241 242 case ISCSI_BOOT_TGT_CHAP_NAME: 243 rc = sprintf(str, "%.*s\n", 244 phba->boot_sess.conn_list[0]. 245 negotiated_login_options.auth_data.chap. 246 target_chap_name_length, 247 (char *)&phba->boot_sess.conn_list[0]. 248 negotiated_login_options.auth_data.chap. 249 target_chap_name); 250 break; 251 case ISCSI_BOOT_TGT_CHAP_SECRET: 252 rc = sprintf(str, "%.*s\n", 253 phba->boot_sess.conn_list[0]. 254 negotiated_login_options.auth_data.chap. 255 target_secret_length, 256 (char *)&phba->boot_sess.conn_list[0]. 257 negotiated_login_options.auth_data.chap. 258 target_secret); 259 260 break; 261 case ISCSI_BOOT_TGT_REV_CHAP_NAME: 262 rc = sprintf(str, "%.*s\n", 263 phba->boot_sess.conn_list[0]. 264 negotiated_login_options.auth_data.chap. 265 intr_chap_name_length, 266 (char *)&phba->boot_sess.conn_list[0]. 267 negotiated_login_options.auth_data.chap. 268 intr_chap_name); 269 270 break; 271 case ISCSI_BOOT_TGT_REV_CHAP_SECRET: 272 rc = sprintf(str, "%.*s\n", 273 phba->boot_sess.conn_list[0]. 274 negotiated_login_options.auth_data.chap. 275 intr_secret_length, 276 (char *)&phba->boot_sess.conn_list[0]. 277 negotiated_login_options.auth_data.chap. 278 intr_secret); 279 break; 280 case ISCSI_BOOT_TGT_FLAGS: 281 rc = sprintf(str, "2\n"); 282 break; 283 case ISCSI_BOOT_TGT_NIC_ASSOC: 284 rc = sprintf(str, "0\n"); 285 break; 286 default: 287 rc = -ENOSYS; 288 break; 289 } 290 return rc; 291 } 292 293 static ssize_t beiscsi_show_boot_ini_info(void *data, int type, char *buf) 294 { 295 struct beiscsi_hba *phba = data; 296 char *str = buf; 297 int rc; 298 299 switch (type) { 300 case ISCSI_BOOT_INI_INITIATOR_NAME: 301 rc = sprintf(str, "%s\n", phba->boot_sess.initiator_iscsiname); 302 break; 303 default: 304 rc = -ENOSYS; 305 break; 306 } 307 return rc; 308 } 309 310 static ssize_t beiscsi_show_boot_eth_info(void *data, int type, char *buf) 311 { 312 struct beiscsi_hba *phba = data; 313 char *str = buf; 314 int rc; 315 316 switch (type) { 317 case ISCSI_BOOT_ETH_FLAGS: 318 rc = sprintf(str, "2\n"); 319 break; 320 case ISCSI_BOOT_ETH_INDEX: 321 rc = sprintf(str, "0\n"); 322 break; 323 case ISCSI_BOOT_ETH_MAC: 324 rc = beiscsi_get_macaddr(buf, phba); 325 if (rc < 0) { 326 SE_DEBUG(DBG_LVL_1, "beiscsi_get_macaddr Failed\n"); 327 return rc; 328 } 329 break; 330 default: 331 rc = -ENOSYS; 332 break; 333 } 334 return rc; 335 } 336 337 338 static mode_t beiscsi_tgt_get_attr_visibility(void *data, int type) 339 { 340 int rc; 341 342 switch (type) { 343 case ISCSI_BOOT_TGT_NAME: 344 case ISCSI_BOOT_TGT_IP_ADDR: 345 case ISCSI_BOOT_TGT_PORT: 346 case ISCSI_BOOT_TGT_CHAP_NAME: 347 case ISCSI_BOOT_TGT_CHAP_SECRET: 348 case ISCSI_BOOT_TGT_REV_CHAP_NAME: 349 case ISCSI_BOOT_TGT_REV_CHAP_SECRET: 350 case ISCSI_BOOT_TGT_NIC_ASSOC: 351 case ISCSI_BOOT_TGT_FLAGS: 352 rc = S_IRUGO; 353 break; 354 default: 355 rc = 0; 356 break; 357 } 358 return rc; 359 } 360 361 static mode_t beiscsi_ini_get_attr_visibility(void *data, int type) 362 { 363 int rc; 364 365 switch (type) { 366 case ISCSI_BOOT_INI_INITIATOR_NAME: 367 rc = S_IRUGO; 368 break; 369 default: 370 rc = 0; 371 break; 372 } 373 return rc; 374 } 375 376 377 static mode_t beiscsi_eth_get_attr_visibility(void *data, int type) 378 { 379 int rc; 380 381 switch (type) { 382 case ISCSI_BOOT_ETH_FLAGS: 383 case ISCSI_BOOT_ETH_MAC: 384 case ISCSI_BOOT_ETH_INDEX: 385 rc = S_IRUGO; 386 break; 387 default: 388 rc = 0; 389 break; 390 } 391 return rc; 392 } 393 394 static int beiscsi_setup_boot_info(struct beiscsi_hba *phba) 395 { 396 struct iscsi_boot_kobj *boot_kobj; 397 398 phba->boot_kset = iscsi_boot_create_host_kset(phba->shost->host_no); 399 if (!phba->boot_kset) 400 return -ENOMEM; 401 402 /* get boot info using mgmt cmd */ 403 boot_kobj = iscsi_boot_create_target(phba->boot_kset, 0, phba, 404 beiscsi_show_boot_tgt_info, 405 beiscsi_tgt_get_attr_visibility); 406 if (!boot_kobj) 407 goto free_kset; 408 409 boot_kobj = iscsi_boot_create_initiator(phba->boot_kset, 0, phba, 410 beiscsi_show_boot_ini_info, 411 beiscsi_ini_get_attr_visibility); 412 if (!boot_kobj) 413 goto free_kset; 414 415 boot_kobj = iscsi_boot_create_ethernet(phba->boot_kset, 0, phba, 416 beiscsi_show_boot_eth_info, 417 beiscsi_eth_get_attr_visibility); 418 if (!boot_kobj) 419 goto free_kset; 420 return 0; 421 422 free_kset: 423 iscsi_boot_destroy_kset(phba->boot_kset); 424 return -ENOMEM; 425 } 426 427 /*------------------- PCI Driver operations and data ----------------- */ 428 static DEFINE_PCI_DEVICE_TABLE(beiscsi_pci_id_table) = { 429 { PCI_DEVICE(BE_VENDOR_ID, BE_DEVICE_ID1) }, 430 { PCI_DEVICE(BE_VENDOR_ID, BE_DEVICE_ID2) }, 431 { PCI_DEVICE(BE_VENDOR_ID, OC_DEVICE_ID1) }, 432 { PCI_DEVICE(BE_VENDOR_ID, OC_DEVICE_ID2) }, 433 { PCI_DEVICE(BE_VENDOR_ID, OC_DEVICE_ID3) }, 434 { 0 } 435 }; 436 MODULE_DEVICE_TABLE(pci, beiscsi_pci_id_table); 437 438 static struct scsi_host_template beiscsi_sht = { 439 .module = THIS_MODULE, 440 .name = "ServerEngines 10Gbe open-iscsi Initiator Driver", 441 .proc_name = DRV_NAME, 442 .queuecommand = iscsi_queuecommand, 443 .change_queue_depth = iscsi_change_queue_depth, 444 .slave_configure = beiscsi_slave_configure, 445 .target_alloc = iscsi_target_alloc, 446 .eh_abort_handler = beiscsi_eh_abort, 447 .eh_device_reset_handler = beiscsi_eh_device_reset, 448 .eh_target_reset_handler = iscsi_eh_session_reset, 449 .sg_tablesize = BEISCSI_SGLIST_ELEMENTS, 450 .can_queue = BE2_IO_DEPTH, 451 .this_id = -1, 452 .max_sectors = BEISCSI_MAX_SECTORS, 453 .cmd_per_lun = BEISCSI_CMD_PER_LUN, 454 .use_clustering = ENABLE_CLUSTERING, 455 }; 456 457 static struct scsi_transport_template *beiscsi_scsi_transport; 458 459 static struct beiscsi_hba *beiscsi_hba_alloc(struct pci_dev *pcidev) 460 { 461 struct beiscsi_hba *phba; 462 struct Scsi_Host *shost; 463 464 shost = iscsi_host_alloc(&beiscsi_sht, sizeof(*phba), 0); 465 if (!shost) { 466 dev_err(&pcidev->dev, "beiscsi_hba_alloc -" 467 "iscsi_host_alloc failed\n"); 468 return NULL; 469 } 470 shost->dma_boundary = pcidev->dma_mask; 471 shost->max_id = BE2_MAX_SESSIONS; 472 shost->max_channel = 0; 473 shost->max_cmd_len = BEISCSI_MAX_CMD_LEN; 474 shost->max_lun = BEISCSI_NUM_MAX_LUN; 475 shost->transportt = beiscsi_scsi_transport; 476 phba = iscsi_host_priv(shost); 477 memset(phba, 0, sizeof(*phba)); 478 phba->shost = shost; 479 phba->pcidev = pci_dev_get(pcidev); 480 pci_set_drvdata(pcidev, phba); 481 482 if (iscsi_host_add(shost, &phba->pcidev->dev)) 483 goto free_devices; 484 485 if (beiscsi_setup_boot_info(phba)) 486 /* 487 * log error but continue, because we may not be using 488 * iscsi boot. 489 */ 490 shost_printk(KERN_ERR, phba->shost, "Could not set up " 491 "iSCSI boot info."); 492 493 return phba; 494 495 free_devices: 496 pci_dev_put(phba->pcidev); 497 iscsi_host_free(phba->shost); 498 return NULL; 499 } 500 501 static void beiscsi_unmap_pci_function(struct beiscsi_hba *phba) 502 { 503 if (phba->csr_va) { 504 iounmap(phba->csr_va); 505 phba->csr_va = NULL; 506 } 507 if (phba->db_va) { 508 iounmap(phba->db_va); 509 phba->db_va = NULL; 510 } 511 if (phba->pci_va) { 512 iounmap(phba->pci_va); 513 phba->pci_va = NULL; 514 } 515 } 516 517 static int beiscsi_map_pci_bars(struct beiscsi_hba *phba, 518 struct pci_dev *pcidev) 519 { 520 u8 __iomem *addr; 521 int pcicfg_reg; 522 523 addr = ioremap_nocache(pci_resource_start(pcidev, 2), 524 pci_resource_len(pcidev, 2)); 525 if (addr == NULL) 526 return -ENOMEM; 527 phba->ctrl.csr = addr; 528 phba->csr_va = addr; 529 phba->csr_pa.u.a64.address = pci_resource_start(pcidev, 2); 530 531 addr = ioremap_nocache(pci_resource_start(pcidev, 4), 128 * 1024); 532 if (addr == NULL) 533 goto pci_map_err; 534 phba->ctrl.db = addr; 535 phba->db_va = addr; 536 phba->db_pa.u.a64.address = pci_resource_start(pcidev, 4); 537 538 if (phba->generation == BE_GEN2) 539 pcicfg_reg = 1; 540 else 541 pcicfg_reg = 0; 542 543 addr = ioremap_nocache(pci_resource_start(pcidev, pcicfg_reg), 544 pci_resource_len(pcidev, pcicfg_reg)); 545 546 if (addr == NULL) 547 goto pci_map_err; 548 phba->ctrl.pcicfg = addr; 549 phba->pci_va = addr; 550 phba->pci_pa.u.a64.address = pci_resource_start(pcidev, pcicfg_reg); 551 return 0; 552 553 pci_map_err: 554 beiscsi_unmap_pci_function(phba); 555 return -ENOMEM; 556 } 557 558 static int beiscsi_enable_pci(struct pci_dev *pcidev) 559 { 560 int ret; 561 562 ret = pci_enable_device(pcidev); 563 if (ret) { 564 dev_err(&pcidev->dev, "beiscsi_enable_pci - enable device " 565 "failed. Returning -ENODEV\n"); 566 return ret; 567 } 568 569 pci_set_master(pcidev); 570 if (pci_set_consistent_dma_mask(pcidev, DMA_BIT_MASK(64))) { 571 ret = pci_set_consistent_dma_mask(pcidev, DMA_BIT_MASK(32)); 572 if (ret) { 573 dev_err(&pcidev->dev, "Could not set PCI DMA Mask\n"); 574 pci_disable_device(pcidev); 575 return ret; 576 } 577 } 578 return 0; 579 } 580 581 static int be_ctrl_init(struct beiscsi_hba *phba, struct pci_dev *pdev) 582 { 583 struct be_ctrl_info *ctrl = &phba->ctrl; 584 struct be_dma_mem *mbox_mem_alloc = &ctrl->mbox_mem_alloced; 585 struct be_dma_mem *mbox_mem_align = &ctrl->mbox_mem; 586 int status = 0; 587 588 ctrl->pdev = pdev; 589 status = beiscsi_map_pci_bars(phba, pdev); 590 if (status) 591 return status; 592 mbox_mem_alloc->size = sizeof(struct be_mcc_mailbox) + 16; 593 mbox_mem_alloc->va = pci_alloc_consistent(pdev, 594 mbox_mem_alloc->size, 595 &mbox_mem_alloc->dma); 596 if (!mbox_mem_alloc->va) { 597 beiscsi_unmap_pci_function(phba); 598 status = -ENOMEM; 599 return status; 600 } 601 602 mbox_mem_align->size = sizeof(struct be_mcc_mailbox); 603 mbox_mem_align->va = PTR_ALIGN(mbox_mem_alloc->va, 16); 604 mbox_mem_align->dma = PTR_ALIGN(mbox_mem_alloc->dma, 16); 605 memset(mbox_mem_align->va, 0, sizeof(struct be_mcc_mailbox)); 606 spin_lock_init(&ctrl->mbox_lock); 607 spin_lock_init(&phba->ctrl.mcc_lock); 608 spin_lock_init(&phba->ctrl.mcc_cq_lock); 609 610 return status; 611 } 612 613 static void beiscsi_get_params(struct beiscsi_hba *phba) 614 { 615 phba->params.ios_per_ctrl = (phba->fw_config.iscsi_icd_count 616 - (phba->fw_config.iscsi_cid_count 617 + BE2_TMFS 618 + BE2_NOPOUT_REQ)); 619 phba->params.cxns_per_ctrl = phba->fw_config.iscsi_cid_count; 620 phba->params.asyncpdus_per_ctrl = phba->fw_config.iscsi_cid_count * 2; 621 phba->params.icds_per_ctrl = phba->fw_config.iscsi_icd_count;; 622 phba->params.num_sge_per_io = BE2_SGE; 623 phba->params.defpdu_hdr_sz = BE2_DEFPDU_HDR_SZ; 624 phba->params.defpdu_data_sz = BE2_DEFPDU_DATA_SZ; 625 phba->params.eq_timer = 64; 626 phba->params.num_eq_entries = 627 (((BE2_CMDS_PER_CXN * 2 + phba->fw_config.iscsi_cid_count * 2 628 + BE2_TMFS) / 512) + 1) * 512; 629 phba->params.num_eq_entries = (phba->params.num_eq_entries < 1024) 630 ? 1024 : phba->params.num_eq_entries; 631 SE_DEBUG(DBG_LVL_8, "phba->params.num_eq_entries=%d\n", 632 phba->params.num_eq_entries); 633 phba->params.num_cq_entries = 634 (((BE2_CMDS_PER_CXN * 2 + phba->fw_config.iscsi_cid_count * 2 635 + BE2_TMFS) / 512) + 1) * 512; 636 phba->params.wrbs_per_cxn = 256; 637 } 638 639 static void hwi_ring_eq_db(struct beiscsi_hba *phba, 640 unsigned int id, unsigned int clr_interrupt, 641 unsigned int num_processed, 642 unsigned char rearm, unsigned char event) 643 { 644 u32 val = 0; 645 val |= id & DB_EQ_RING_ID_MASK; 646 if (rearm) 647 val |= 1 << DB_EQ_REARM_SHIFT; 648 if (clr_interrupt) 649 val |= 1 << DB_EQ_CLR_SHIFT; 650 if (event) 651 val |= 1 << DB_EQ_EVNT_SHIFT; 652 val |= num_processed << DB_EQ_NUM_POPPED_SHIFT; 653 iowrite32(val, phba->db_va + DB_EQ_OFFSET); 654 } 655 656 /** 657 * be_isr_mcc - The isr routine of the driver. 658 * @irq: Not used 659 * @dev_id: Pointer to host adapter structure 660 */ 661 static irqreturn_t be_isr_mcc(int irq, void *dev_id) 662 { 663 struct beiscsi_hba *phba; 664 struct be_eq_entry *eqe = NULL; 665 struct be_queue_info *eq; 666 struct be_queue_info *mcc; 667 unsigned int num_eq_processed; 668 struct be_eq_obj *pbe_eq; 669 unsigned long flags; 670 671 pbe_eq = dev_id; 672 eq = &pbe_eq->q; 673 phba = pbe_eq->phba; 674 mcc = &phba->ctrl.mcc_obj.cq; 675 eqe = queue_tail_node(eq); 676 if (!eqe) 677 SE_DEBUG(DBG_LVL_1, "eqe is NULL\n"); 678 679 num_eq_processed = 0; 680 681 while (eqe->dw[offsetof(struct amap_eq_entry, valid) / 32] 682 & EQE_VALID_MASK) { 683 if (((eqe->dw[offsetof(struct amap_eq_entry, 684 resource_id) / 32] & 685 EQE_RESID_MASK) >> 16) == mcc->id) { 686 spin_lock_irqsave(&phba->isr_lock, flags); 687 phba->todo_mcc_cq = 1; 688 spin_unlock_irqrestore(&phba->isr_lock, flags); 689 } 690 AMAP_SET_BITS(struct amap_eq_entry, valid, eqe, 0); 691 queue_tail_inc(eq); 692 eqe = queue_tail_node(eq); 693 num_eq_processed++; 694 } 695 if (phba->todo_mcc_cq) 696 queue_work(phba->wq, &phba->work_cqs); 697 if (num_eq_processed) 698 hwi_ring_eq_db(phba, eq->id, 1, num_eq_processed, 1, 1); 699 700 return IRQ_HANDLED; 701 } 702 703 /** 704 * be_isr_msix - The isr routine of the driver. 705 * @irq: Not used 706 * @dev_id: Pointer to host adapter structure 707 */ 708 static irqreturn_t be_isr_msix(int irq, void *dev_id) 709 { 710 struct beiscsi_hba *phba; 711 struct be_eq_entry *eqe = NULL; 712 struct be_queue_info *eq; 713 struct be_queue_info *cq; 714 unsigned int num_eq_processed; 715 struct be_eq_obj *pbe_eq; 716 unsigned long flags; 717 718 pbe_eq = dev_id; 719 eq = &pbe_eq->q; 720 cq = pbe_eq->cq; 721 eqe = queue_tail_node(eq); 722 if (!eqe) 723 SE_DEBUG(DBG_LVL_1, "eqe is NULL\n"); 724 725 phba = pbe_eq->phba; 726 num_eq_processed = 0; 727 if (blk_iopoll_enabled) { 728 while (eqe->dw[offsetof(struct amap_eq_entry, valid) / 32] 729 & EQE_VALID_MASK) { 730 if (!blk_iopoll_sched_prep(&pbe_eq->iopoll)) 731 blk_iopoll_sched(&pbe_eq->iopoll); 732 733 AMAP_SET_BITS(struct amap_eq_entry, valid, eqe, 0); 734 queue_tail_inc(eq); 735 eqe = queue_tail_node(eq); 736 num_eq_processed++; 737 } 738 if (num_eq_processed) 739 hwi_ring_eq_db(phba, eq->id, 1, num_eq_processed, 0, 1); 740 741 return IRQ_HANDLED; 742 } else { 743 while (eqe->dw[offsetof(struct amap_eq_entry, valid) / 32] 744 & EQE_VALID_MASK) { 745 spin_lock_irqsave(&phba->isr_lock, flags); 746 phba->todo_cq = 1; 747 spin_unlock_irqrestore(&phba->isr_lock, flags); 748 AMAP_SET_BITS(struct amap_eq_entry, valid, eqe, 0); 749 queue_tail_inc(eq); 750 eqe = queue_tail_node(eq); 751 num_eq_processed++; 752 } 753 if (phba->todo_cq) 754 queue_work(phba->wq, &phba->work_cqs); 755 756 if (num_eq_processed) 757 hwi_ring_eq_db(phba, eq->id, 1, num_eq_processed, 1, 1); 758 759 return IRQ_HANDLED; 760 } 761 } 762 763 /** 764 * be_isr - The isr routine of the driver. 765 * @irq: Not used 766 * @dev_id: Pointer to host adapter structure 767 */ 768 static irqreturn_t be_isr(int irq, void *dev_id) 769 { 770 struct beiscsi_hba *phba; 771 struct hwi_controller *phwi_ctrlr; 772 struct hwi_context_memory *phwi_context; 773 struct be_eq_entry *eqe = NULL; 774 struct be_queue_info *eq; 775 struct be_queue_info *cq; 776 struct be_queue_info *mcc; 777 unsigned long flags, index; 778 unsigned int num_mcceq_processed, num_ioeq_processed; 779 struct be_ctrl_info *ctrl; 780 struct be_eq_obj *pbe_eq; 781 int isr; 782 783 phba = dev_id; 784 ctrl = &phba->ctrl;; 785 isr = ioread32(ctrl->csr + CEV_ISR0_OFFSET + 786 (PCI_FUNC(ctrl->pdev->devfn) * CEV_ISR_SIZE)); 787 if (!isr) 788 return IRQ_NONE; 789 790 phwi_ctrlr = phba->phwi_ctrlr; 791 phwi_context = phwi_ctrlr->phwi_ctxt; 792 pbe_eq = &phwi_context->be_eq[0]; 793 794 eq = &phwi_context->be_eq[0].q; 795 mcc = &phba->ctrl.mcc_obj.cq; 796 index = 0; 797 eqe = queue_tail_node(eq); 798 if (!eqe) 799 SE_DEBUG(DBG_LVL_1, "eqe is NULL\n"); 800 801 num_ioeq_processed = 0; 802 num_mcceq_processed = 0; 803 if (blk_iopoll_enabled) { 804 while (eqe->dw[offsetof(struct amap_eq_entry, valid) / 32] 805 & EQE_VALID_MASK) { 806 if (((eqe->dw[offsetof(struct amap_eq_entry, 807 resource_id) / 32] & 808 EQE_RESID_MASK) >> 16) == mcc->id) { 809 spin_lock_irqsave(&phba->isr_lock, flags); 810 phba->todo_mcc_cq = 1; 811 spin_unlock_irqrestore(&phba->isr_lock, flags); 812 num_mcceq_processed++; 813 } else { 814 if (!blk_iopoll_sched_prep(&pbe_eq->iopoll)) 815 blk_iopoll_sched(&pbe_eq->iopoll); 816 num_ioeq_processed++; 817 } 818 AMAP_SET_BITS(struct amap_eq_entry, valid, eqe, 0); 819 queue_tail_inc(eq); 820 eqe = queue_tail_node(eq); 821 } 822 if (num_ioeq_processed || num_mcceq_processed) { 823 if (phba->todo_mcc_cq) 824 queue_work(phba->wq, &phba->work_cqs); 825 826 if ((num_mcceq_processed) && (!num_ioeq_processed)) 827 hwi_ring_eq_db(phba, eq->id, 0, 828 (num_ioeq_processed + 829 num_mcceq_processed) , 1, 1); 830 else 831 hwi_ring_eq_db(phba, eq->id, 0, 832 (num_ioeq_processed + 833 num_mcceq_processed), 0, 1); 834 835 return IRQ_HANDLED; 836 } else 837 return IRQ_NONE; 838 } else { 839 cq = &phwi_context->be_cq[0]; 840 while (eqe->dw[offsetof(struct amap_eq_entry, valid) / 32] 841 & EQE_VALID_MASK) { 842 843 if (((eqe->dw[offsetof(struct amap_eq_entry, 844 resource_id) / 32] & 845 EQE_RESID_MASK) >> 16) != cq->id) { 846 spin_lock_irqsave(&phba->isr_lock, flags); 847 phba->todo_mcc_cq = 1; 848 spin_unlock_irqrestore(&phba->isr_lock, flags); 849 } else { 850 spin_lock_irqsave(&phba->isr_lock, flags); 851 phba->todo_cq = 1; 852 spin_unlock_irqrestore(&phba->isr_lock, flags); 853 } 854 AMAP_SET_BITS(struct amap_eq_entry, valid, eqe, 0); 855 queue_tail_inc(eq); 856 eqe = queue_tail_node(eq); 857 num_ioeq_processed++; 858 } 859 if (phba->todo_cq || phba->todo_mcc_cq) 860 queue_work(phba->wq, &phba->work_cqs); 861 862 if (num_ioeq_processed) { 863 hwi_ring_eq_db(phba, eq->id, 0, 864 num_ioeq_processed, 1, 1); 865 return IRQ_HANDLED; 866 } else 867 return IRQ_NONE; 868 } 869 } 870 871 static int beiscsi_init_irqs(struct beiscsi_hba *phba) 872 { 873 struct pci_dev *pcidev = phba->pcidev; 874 struct hwi_controller *phwi_ctrlr; 875 struct hwi_context_memory *phwi_context; 876 int ret, msix_vec, i, j; 877 char desc[32]; 878 879 phwi_ctrlr = phba->phwi_ctrlr; 880 phwi_context = phwi_ctrlr->phwi_ctxt; 881 882 if (phba->msix_enabled) { 883 for (i = 0; i < phba->num_cpus; i++) { 884 sprintf(desc, "beiscsi_msix_%04x", i); 885 msix_vec = phba->msix_entries[i].vector; 886 ret = request_irq(msix_vec, be_isr_msix, 0, desc, 887 &phwi_context->be_eq[i]); 888 if (ret) { 889 shost_printk(KERN_ERR, phba->shost, 890 "beiscsi_init_irqs-Failed to" 891 "register msix for i = %d\n", i); 892 if (!i) 893 return ret; 894 goto free_msix_irqs; 895 } 896 } 897 msix_vec = phba->msix_entries[i].vector; 898 ret = request_irq(msix_vec, be_isr_mcc, 0, "beiscsi_msix_mcc", 899 &phwi_context->be_eq[i]); 900 if (ret) { 901 shost_printk(KERN_ERR, phba->shost, "beiscsi_init_irqs-" 902 "Failed to register beiscsi_msix_mcc\n"); 903 i++; 904 goto free_msix_irqs; 905 } 906 907 } else { 908 ret = request_irq(pcidev->irq, be_isr, IRQF_SHARED, 909 "beiscsi", phba); 910 if (ret) { 911 shost_printk(KERN_ERR, phba->shost, "beiscsi_init_irqs-" 912 "Failed to register irq\\n"); 913 return ret; 914 } 915 } 916 return 0; 917 free_msix_irqs: 918 for (j = i - 1; j == 0; j++) 919 free_irq(msix_vec, &phwi_context->be_eq[j]); 920 return ret; 921 } 922 923 static void hwi_ring_cq_db(struct beiscsi_hba *phba, 924 unsigned int id, unsigned int num_processed, 925 unsigned char rearm, unsigned char event) 926 { 927 u32 val = 0; 928 val |= id & DB_CQ_RING_ID_MASK; 929 if (rearm) 930 val |= 1 << DB_CQ_REARM_SHIFT; 931 val |= num_processed << DB_CQ_NUM_POPPED_SHIFT; 932 iowrite32(val, phba->db_va + DB_CQ_OFFSET); 933 } 934 935 static unsigned int 936 beiscsi_process_async_pdu(struct beiscsi_conn *beiscsi_conn, 937 struct beiscsi_hba *phba, 938 unsigned short cid, 939 struct pdu_base *ppdu, 940 unsigned long pdu_len, 941 void *pbuffer, unsigned long buf_len) 942 { 943 struct iscsi_conn *conn = beiscsi_conn->conn; 944 struct iscsi_session *session = conn->session; 945 struct iscsi_task *task; 946 struct beiscsi_io_task *io_task; 947 struct iscsi_hdr *login_hdr; 948 949 switch (ppdu->dw[offsetof(struct amap_pdu_base, opcode) / 32] & 950 PDUBASE_OPCODE_MASK) { 951 case ISCSI_OP_NOOP_IN: 952 pbuffer = NULL; 953 buf_len = 0; 954 break; 955 case ISCSI_OP_ASYNC_EVENT: 956 break; 957 case ISCSI_OP_REJECT: 958 WARN_ON(!pbuffer); 959 WARN_ON(!(buf_len == 48)); 960 SE_DEBUG(DBG_LVL_1, "In ISCSI_OP_REJECT\n"); 961 break; 962 case ISCSI_OP_LOGIN_RSP: 963 case ISCSI_OP_TEXT_RSP: 964 task = conn->login_task; 965 io_task = task->dd_data; 966 login_hdr = (struct iscsi_hdr *)ppdu; 967 login_hdr->itt = io_task->libiscsi_itt; 968 break; 969 default: 970 shost_printk(KERN_WARNING, phba->shost, 971 "Unrecognized opcode 0x%x in async msg\n", 972 (ppdu-> 973 dw[offsetof(struct amap_pdu_base, opcode) / 32] 974 & PDUBASE_OPCODE_MASK)); 975 return 1; 976 } 977 978 spin_lock_bh(&session->lock); 979 __iscsi_complete_pdu(conn, (struct iscsi_hdr *)ppdu, pbuffer, buf_len); 980 spin_unlock_bh(&session->lock); 981 return 0; 982 } 983 984 static struct sgl_handle *alloc_io_sgl_handle(struct beiscsi_hba *phba) 985 { 986 struct sgl_handle *psgl_handle; 987 988 if (phba->io_sgl_hndl_avbl) { 989 SE_DEBUG(DBG_LVL_8, 990 "In alloc_io_sgl_handle,io_sgl_alloc_index=%d\n", 991 phba->io_sgl_alloc_index); 992 psgl_handle = phba->io_sgl_hndl_base[phba-> 993 io_sgl_alloc_index]; 994 phba->io_sgl_hndl_base[phba->io_sgl_alloc_index] = NULL; 995 phba->io_sgl_hndl_avbl--; 996 if (phba->io_sgl_alloc_index == (phba->params. 997 ios_per_ctrl - 1)) 998 phba->io_sgl_alloc_index = 0; 999 else 1000 phba->io_sgl_alloc_index++; 1001 } else 1002 psgl_handle = NULL; 1003 return psgl_handle; 1004 } 1005 1006 static void 1007 free_io_sgl_handle(struct beiscsi_hba *phba, struct sgl_handle *psgl_handle) 1008 { 1009 SE_DEBUG(DBG_LVL_8, "In free_,io_sgl_free_index=%d\n", 1010 phba->io_sgl_free_index); 1011 if (phba->io_sgl_hndl_base[phba->io_sgl_free_index]) { 1012 /* 1013 * this can happen if clean_task is called on a task that 1014 * failed in xmit_task or alloc_pdu. 1015 */ 1016 SE_DEBUG(DBG_LVL_8, 1017 "Double Free in IO SGL io_sgl_free_index=%d," 1018 "value there=%p\n", phba->io_sgl_free_index, 1019 phba->io_sgl_hndl_base[phba->io_sgl_free_index]); 1020 return; 1021 } 1022 phba->io_sgl_hndl_base[phba->io_sgl_free_index] = psgl_handle; 1023 phba->io_sgl_hndl_avbl++; 1024 if (phba->io_sgl_free_index == (phba->params.ios_per_ctrl - 1)) 1025 phba->io_sgl_free_index = 0; 1026 else 1027 phba->io_sgl_free_index++; 1028 } 1029 1030 /** 1031 * alloc_wrb_handle - To allocate a wrb handle 1032 * @phba: The hba pointer 1033 * @cid: The cid to use for allocation 1034 * 1035 * This happens under session_lock until submission to chip 1036 */ 1037 struct wrb_handle *alloc_wrb_handle(struct beiscsi_hba *phba, unsigned int cid) 1038 { 1039 struct hwi_wrb_context *pwrb_context; 1040 struct hwi_controller *phwi_ctrlr; 1041 struct wrb_handle *pwrb_handle, *pwrb_handle_tmp; 1042 1043 phwi_ctrlr = phba->phwi_ctrlr; 1044 pwrb_context = &phwi_ctrlr->wrb_context[cid]; 1045 if (pwrb_context->wrb_handles_available >= 2) { 1046 pwrb_handle = pwrb_context->pwrb_handle_base[ 1047 pwrb_context->alloc_index]; 1048 pwrb_context->wrb_handles_available--; 1049 if (pwrb_context->alloc_index == 1050 (phba->params.wrbs_per_cxn - 1)) 1051 pwrb_context->alloc_index = 0; 1052 else 1053 pwrb_context->alloc_index++; 1054 pwrb_handle_tmp = pwrb_context->pwrb_handle_base[ 1055 pwrb_context->alloc_index]; 1056 pwrb_handle->nxt_wrb_index = pwrb_handle_tmp->wrb_index; 1057 } else 1058 pwrb_handle = NULL; 1059 return pwrb_handle; 1060 } 1061 1062 /** 1063 * free_wrb_handle - To free the wrb handle back to pool 1064 * @phba: The hba pointer 1065 * @pwrb_context: The context to free from 1066 * @pwrb_handle: The wrb_handle to free 1067 * 1068 * This happens under session_lock until submission to chip 1069 */ 1070 static void 1071 free_wrb_handle(struct beiscsi_hba *phba, struct hwi_wrb_context *pwrb_context, 1072 struct wrb_handle *pwrb_handle) 1073 { 1074 pwrb_context->pwrb_handle_base[pwrb_context->free_index] = pwrb_handle; 1075 pwrb_context->wrb_handles_available++; 1076 if (pwrb_context->free_index == (phba->params.wrbs_per_cxn - 1)) 1077 pwrb_context->free_index = 0; 1078 else 1079 pwrb_context->free_index++; 1080 1081 SE_DEBUG(DBG_LVL_8, 1082 "FREE WRB: pwrb_handle=%p free_index=0x%x" 1083 "wrb_handles_available=%d\n", 1084 pwrb_handle, pwrb_context->free_index, 1085 pwrb_context->wrb_handles_available); 1086 } 1087 1088 static struct sgl_handle *alloc_mgmt_sgl_handle(struct beiscsi_hba *phba) 1089 { 1090 struct sgl_handle *psgl_handle; 1091 1092 if (phba->eh_sgl_hndl_avbl) { 1093 psgl_handle = phba->eh_sgl_hndl_base[phba->eh_sgl_alloc_index]; 1094 phba->eh_sgl_hndl_base[phba->eh_sgl_alloc_index] = NULL; 1095 SE_DEBUG(DBG_LVL_8, "mgmt_sgl_alloc_index=%d=0x%x\n", 1096 phba->eh_sgl_alloc_index, phba->eh_sgl_alloc_index); 1097 phba->eh_sgl_hndl_avbl--; 1098 if (phba->eh_sgl_alloc_index == 1099 (phba->params.icds_per_ctrl - phba->params.ios_per_ctrl - 1100 1)) 1101 phba->eh_sgl_alloc_index = 0; 1102 else 1103 phba->eh_sgl_alloc_index++; 1104 } else 1105 psgl_handle = NULL; 1106 return psgl_handle; 1107 } 1108 1109 void 1110 free_mgmt_sgl_handle(struct beiscsi_hba *phba, struct sgl_handle *psgl_handle) 1111 { 1112 1113 SE_DEBUG(DBG_LVL_8, "In free_mgmt_sgl_handle,eh_sgl_free_index=%d\n", 1114 phba->eh_sgl_free_index); 1115 if (phba->eh_sgl_hndl_base[phba->eh_sgl_free_index]) { 1116 /* 1117 * this can happen if clean_task is called on a task that 1118 * failed in xmit_task or alloc_pdu. 1119 */ 1120 SE_DEBUG(DBG_LVL_8, 1121 "Double Free in eh SGL ,eh_sgl_free_index=%d\n", 1122 phba->eh_sgl_free_index); 1123 return; 1124 } 1125 phba->eh_sgl_hndl_base[phba->eh_sgl_free_index] = psgl_handle; 1126 phba->eh_sgl_hndl_avbl++; 1127 if (phba->eh_sgl_free_index == 1128 (phba->params.icds_per_ctrl - phba->params.ios_per_ctrl - 1)) 1129 phba->eh_sgl_free_index = 0; 1130 else 1131 phba->eh_sgl_free_index++; 1132 } 1133 1134 static void 1135 be_complete_io(struct beiscsi_conn *beiscsi_conn, 1136 struct iscsi_task *task, struct sol_cqe *psol) 1137 { 1138 struct beiscsi_io_task *io_task = task->dd_data; 1139 struct be_status_bhs *sts_bhs = 1140 (struct be_status_bhs *)io_task->cmd_bhs; 1141 struct iscsi_conn *conn = beiscsi_conn->conn; 1142 unsigned int sense_len; 1143 unsigned char *sense; 1144 u32 resid = 0, exp_cmdsn, max_cmdsn; 1145 u8 rsp, status, flags; 1146 1147 exp_cmdsn = (psol-> 1148 dw[offsetof(struct amap_sol_cqe, i_exp_cmd_sn) / 32] 1149 & SOL_EXP_CMD_SN_MASK); 1150 max_cmdsn = ((psol-> 1151 dw[offsetof(struct amap_sol_cqe, i_exp_cmd_sn) / 32] 1152 & SOL_EXP_CMD_SN_MASK) + 1153 ((psol->dw[offsetof(struct amap_sol_cqe, i_cmd_wnd) 1154 / 32] & SOL_CMD_WND_MASK) >> 24) - 1); 1155 rsp = ((psol->dw[offsetof(struct amap_sol_cqe, i_resp) / 32] 1156 & SOL_RESP_MASK) >> 16); 1157 status = ((psol->dw[offsetof(struct amap_sol_cqe, i_sts) / 32] 1158 & SOL_STS_MASK) >> 8); 1159 flags = ((psol->dw[offsetof(struct amap_sol_cqe, i_flags) / 32] 1160 & SOL_FLAGS_MASK) >> 24) | 0x80; 1161 1162 task->sc->result = (DID_OK << 16) | status; 1163 if (rsp != ISCSI_STATUS_CMD_COMPLETED) { 1164 task->sc->result = DID_ERROR << 16; 1165 goto unmap; 1166 } 1167 1168 /* bidi not initially supported */ 1169 if (flags & (ISCSI_FLAG_CMD_UNDERFLOW | ISCSI_FLAG_CMD_OVERFLOW)) { 1170 resid = (psol->dw[offsetof(struct amap_sol_cqe, i_res_cnt) / 1171 32] & SOL_RES_CNT_MASK); 1172 1173 if (!status && (flags & ISCSI_FLAG_CMD_OVERFLOW)) 1174 task->sc->result = DID_ERROR << 16; 1175 1176 if (flags & ISCSI_FLAG_CMD_UNDERFLOW) { 1177 scsi_set_resid(task->sc, resid); 1178 if (!status && (scsi_bufflen(task->sc) - resid < 1179 task->sc->underflow)) 1180 task->sc->result = DID_ERROR << 16; 1181 } 1182 } 1183 1184 if (status == SAM_STAT_CHECK_CONDITION) { 1185 unsigned short *slen = (unsigned short *)sts_bhs->sense_info; 1186 sense = sts_bhs->sense_info + sizeof(unsigned short); 1187 sense_len = cpu_to_be16(*slen); 1188 memcpy(task->sc->sense_buffer, sense, 1189 min_t(u16, sense_len, SCSI_SENSE_BUFFERSIZE)); 1190 } 1191 1192 if (io_task->cmd_bhs->iscsi_hdr.flags & ISCSI_FLAG_CMD_READ) { 1193 if (psol->dw[offsetof(struct amap_sol_cqe, i_res_cnt) / 32] 1194 & SOL_RES_CNT_MASK) 1195 conn->rxdata_octets += (psol-> 1196 dw[offsetof(struct amap_sol_cqe, i_res_cnt) / 32] 1197 & SOL_RES_CNT_MASK); 1198 } 1199 unmap: 1200 scsi_dma_unmap(io_task->scsi_cmnd); 1201 iscsi_complete_scsi_task(task, exp_cmdsn, max_cmdsn); 1202 } 1203 1204 static void 1205 be_complete_logout(struct beiscsi_conn *beiscsi_conn, 1206 struct iscsi_task *task, struct sol_cqe *psol) 1207 { 1208 struct iscsi_logout_rsp *hdr; 1209 struct beiscsi_io_task *io_task = task->dd_data; 1210 struct iscsi_conn *conn = beiscsi_conn->conn; 1211 1212 hdr = (struct iscsi_logout_rsp *)task->hdr; 1213 hdr->opcode = ISCSI_OP_LOGOUT_RSP; 1214 hdr->t2wait = 5; 1215 hdr->t2retain = 0; 1216 hdr->flags = ((psol->dw[offsetof(struct amap_sol_cqe, i_flags) / 32] 1217 & SOL_FLAGS_MASK) >> 24) | 0x80; 1218 hdr->response = (psol->dw[offsetof(struct amap_sol_cqe, i_resp) / 1219 32] & SOL_RESP_MASK); 1220 hdr->exp_cmdsn = cpu_to_be32(psol-> 1221 dw[offsetof(struct amap_sol_cqe, i_exp_cmd_sn) / 32] 1222 & SOL_EXP_CMD_SN_MASK); 1223 hdr->max_cmdsn = be32_to_cpu((psol-> 1224 dw[offsetof(struct amap_sol_cqe, i_exp_cmd_sn) / 32] 1225 & SOL_EXP_CMD_SN_MASK) + 1226 ((psol->dw[offsetof(struct amap_sol_cqe, i_cmd_wnd) 1227 / 32] & SOL_CMD_WND_MASK) >> 24) - 1); 1228 hdr->dlength[0] = 0; 1229 hdr->dlength[1] = 0; 1230 hdr->dlength[2] = 0; 1231 hdr->hlength = 0; 1232 hdr->itt = io_task->libiscsi_itt; 1233 __iscsi_complete_pdu(conn, (struct iscsi_hdr *)hdr, NULL, 0); 1234 } 1235 1236 static void 1237 be_complete_tmf(struct beiscsi_conn *beiscsi_conn, 1238 struct iscsi_task *task, struct sol_cqe *psol) 1239 { 1240 struct iscsi_tm_rsp *hdr; 1241 struct iscsi_conn *conn = beiscsi_conn->conn; 1242 struct beiscsi_io_task *io_task = task->dd_data; 1243 1244 hdr = (struct iscsi_tm_rsp *)task->hdr; 1245 hdr->opcode = ISCSI_OP_SCSI_TMFUNC_RSP; 1246 hdr->flags = ((psol->dw[offsetof(struct amap_sol_cqe, i_flags) / 32] 1247 & SOL_FLAGS_MASK) >> 24) | 0x80; 1248 hdr->response = (psol->dw[offsetof(struct amap_sol_cqe, i_resp) / 1249 32] & SOL_RESP_MASK); 1250 hdr->exp_cmdsn = cpu_to_be32(psol->dw[offsetof(struct amap_sol_cqe, 1251 i_exp_cmd_sn) / 32] & SOL_EXP_CMD_SN_MASK); 1252 hdr->max_cmdsn = be32_to_cpu((psol->dw[offsetof(struct amap_sol_cqe, 1253 i_exp_cmd_sn) / 32] & SOL_EXP_CMD_SN_MASK) + 1254 ((psol->dw[offsetof(struct amap_sol_cqe, i_cmd_wnd) 1255 / 32] & SOL_CMD_WND_MASK) >> 24) - 1); 1256 hdr->itt = io_task->libiscsi_itt; 1257 __iscsi_complete_pdu(conn, (struct iscsi_hdr *)hdr, NULL, 0); 1258 } 1259 1260 static void 1261 hwi_complete_drvr_msgs(struct beiscsi_conn *beiscsi_conn, 1262 struct beiscsi_hba *phba, struct sol_cqe *psol) 1263 { 1264 struct hwi_wrb_context *pwrb_context; 1265 struct wrb_handle *pwrb_handle = NULL; 1266 struct hwi_controller *phwi_ctrlr; 1267 struct iscsi_task *task; 1268 struct beiscsi_io_task *io_task; 1269 struct iscsi_conn *conn = beiscsi_conn->conn; 1270 struct iscsi_session *session = conn->session; 1271 1272 phwi_ctrlr = phba->phwi_ctrlr; 1273 pwrb_context = &phwi_ctrlr->wrb_context[((psol-> 1274 dw[offsetof(struct amap_sol_cqe, cid) / 32] & 1275 SOL_CID_MASK) >> 6) - 1276 phba->fw_config.iscsi_cid_start]; 1277 pwrb_handle = pwrb_context->pwrb_handle_basestd[((psol-> 1278 dw[offsetof(struct amap_sol_cqe, wrb_index) / 1279 32] & SOL_WRB_INDEX_MASK) >> 16)]; 1280 task = pwrb_handle->pio_handle; 1281 1282 io_task = task->dd_data; 1283 spin_lock(&phba->mgmt_sgl_lock); 1284 free_mgmt_sgl_handle(phba, io_task->psgl_handle); 1285 spin_unlock(&phba->mgmt_sgl_lock); 1286 spin_lock_bh(&session->lock); 1287 free_wrb_handle(phba, pwrb_context, pwrb_handle); 1288 spin_unlock_bh(&session->lock); 1289 } 1290 1291 static void 1292 be_complete_nopin_resp(struct beiscsi_conn *beiscsi_conn, 1293 struct iscsi_task *task, struct sol_cqe *psol) 1294 { 1295 struct iscsi_nopin *hdr; 1296 struct iscsi_conn *conn = beiscsi_conn->conn; 1297 struct beiscsi_io_task *io_task = task->dd_data; 1298 1299 hdr = (struct iscsi_nopin *)task->hdr; 1300 hdr->flags = ((psol->dw[offsetof(struct amap_sol_cqe, i_flags) / 32] 1301 & SOL_FLAGS_MASK) >> 24) | 0x80; 1302 hdr->exp_cmdsn = cpu_to_be32(psol->dw[offsetof(struct amap_sol_cqe, 1303 i_exp_cmd_sn) / 32] & SOL_EXP_CMD_SN_MASK); 1304 hdr->max_cmdsn = be32_to_cpu((psol->dw[offsetof(struct amap_sol_cqe, 1305 i_exp_cmd_sn) / 32] & SOL_EXP_CMD_SN_MASK) + 1306 ((psol->dw[offsetof(struct amap_sol_cqe, i_cmd_wnd) 1307 / 32] & SOL_CMD_WND_MASK) >> 24) - 1); 1308 hdr->opcode = ISCSI_OP_NOOP_IN; 1309 hdr->itt = io_task->libiscsi_itt; 1310 __iscsi_complete_pdu(conn, (struct iscsi_hdr *)hdr, NULL, 0); 1311 } 1312 1313 static void hwi_complete_cmd(struct beiscsi_conn *beiscsi_conn, 1314 struct beiscsi_hba *phba, struct sol_cqe *psol) 1315 { 1316 struct hwi_wrb_context *pwrb_context; 1317 struct wrb_handle *pwrb_handle; 1318 struct iscsi_wrb *pwrb = NULL; 1319 struct hwi_controller *phwi_ctrlr; 1320 struct iscsi_task *task; 1321 unsigned int type; 1322 struct iscsi_conn *conn = beiscsi_conn->conn; 1323 struct iscsi_session *session = conn->session; 1324 1325 phwi_ctrlr = phba->phwi_ctrlr; 1326 pwrb_context = &phwi_ctrlr->wrb_context[((psol->dw[offsetof 1327 (struct amap_sol_cqe, cid) / 32] 1328 & SOL_CID_MASK) >> 6) - 1329 phba->fw_config.iscsi_cid_start]; 1330 pwrb_handle = pwrb_context->pwrb_handle_basestd[((psol-> 1331 dw[offsetof(struct amap_sol_cqe, wrb_index) / 1332 32] & SOL_WRB_INDEX_MASK) >> 16)]; 1333 task = pwrb_handle->pio_handle; 1334 pwrb = pwrb_handle->pwrb; 1335 type = (pwrb->dw[offsetof(struct amap_iscsi_wrb, type) / 32] & 1336 WRB_TYPE_MASK) >> 28; 1337 1338 spin_lock_bh(&session->lock); 1339 switch (type) { 1340 case HWH_TYPE_IO: 1341 case HWH_TYPE_IO_RD: 1342 if ((task->hdr->opcode & ISCSI_OPCODE_MASK) == 1343 ISCSI_OP_NOOP_OUT) 1344 be_complete_nopin_resp(beiscsi_conn, task, psol); 1345 else 1346 be_complete_io(beiscsi_conn, task, psol); 1347 break; 1348 1349 case HWH_TYPE_LOGOUT: 1350 if ((task->hdr->opcode & ISCSI_OPCODE_MASK) == ISCSI_OP_LOGOUT) 1351 be_complete_logout(beiscsi_conn, task, psol); 1352 else 1353 be_complete_tmf(beiscsi_conn, task, psol); 1354 1355 break; 1356 1357 case HWH_TYPE_LOGIN: 1358 SE_DEBUG(DBG_LVL_1, 1359 "\t\t No HWH_TYPE_LOGIN Expected in hwi_complete_cmd" 1360 "- Solicited path\n"); 1361 break; 1362 1363 case HWH_TYPE_NOP: 1364 be_complete_nopin_resp(beiscsi_conn, task, psol); 1365 break; 1366 1367 default: 1368 shost_printk(KERN_WARNING, phba->shost, 1369 "In hwi_complete_cmd, unknown type = %d" 1370 "wrb_index 0x%x CID 0x%x\n", type, 1371 ((psol->dw[offsetof(struct amap_iscsi_wrb, 1372 type) / 32] & SOL_WRB_INDEX_MASK) >> 16), 1373 ((psol->dw[offsetof(struct amap_sol_cqe, 1374 cid) / 32] & SOL_CID_MASK) >> 6)); 1375 break; 1376 } 1377 1378 spin_unlock_bh(&session->lock); 1379 } 1380 1381 static struct list_head *hwi_get_async_busy_list(struct hwi_async_pdu_context 1382 *pasync_ctx, unsigned int is_header, 1383 unsigned int host_write_ptr) 1384 { 1385 if (is_header) 1386 return &pasync_ctx->async_entry[host_write_ptr]. 1387 header_busy_list; 1388 else 1389 return &pasync_ctx->async_entry[host_write_ptr].data_busy_list; 1390 } 1391 1392 static struct async_pdu_handle * 1393 hwi_get_async_handle(struct beiscsi_hba *phba, 1394 struct beiscsi_conn *beiscsi_conn, 1395 struct hwi_async_pdu_context *pasync_ctx, 1396 struct i_t_dpdu_cqe *pdpdu_cqe, unsigned int *pcq_index) 1397 { 1398 struct be_bus_address phys_addr; 1399 struct list_head *pbusy_list; 1400 struct async_pdu_handle *pasync_handle = NULL; 1401 int buffer_len = 0; 1402 unsigned char buffer_index = -1; 1403 unsigned char is_header = 0; 1404 1405 phys_addr.u.a32.address_lo = 1406 pdpdu_cqe->dw[offsetof(struct amap_i_t_dpdu_cqe, db_addr_lo) / 32] - 1407 ((pdpdu_cqe->dw[offsetof(struct amap_i_t_dpdu_cqe, dpl) / 32] 1408 & PDUCQE_DPL_MASK) >> 16); 1409 phys_addr.u.a32.address_hi = 1410 pdpdu_cqe->dw[offsetof(struct amap_i_t_dpdu_cqe, db_addr_hi) / 32]; 1411 1412 phys_addr.u.a64.address = 1413 *((unsigned long long *)(&phys_addr.u.a64.address)); 1414 1415 switch (pdpdu_cqe->dw[offsetof(struct amap_i_t_dpdu_cqe, code) / 32] 1416 & PDUCQE_CODE_MASK) { 1417 case UNSOL_HDR_NOTIFY: 1418 is_header = 1; 1419 1420 pbusy_list = hwi_get_async_busy_list(pasync_ctx, 1, 1421 (pdpdu_cqe->dw[offsetof(struct amap_i_t_dpdu_cqe, 1422 index) / 32] & PDUCQE_INDEX_MASK)); 1423 1424 buffer_len = (unsigned int)(phys_addr.u.a64.address - 1425 pasync_ctx->async_header.pa_base.u.a64.address); 1426 1427 buffer_index = buffer_len / 1428 pasync_ctx->async_header.buffer_size; 1429 1430 break; 1431 case UNSOL_DATA_NOTIFY: 1432 pbusy_list = hwi_get_async_busy_list(pasync_ctx, 0, (pdpdu_cqe-> 1433 dw[offsetof(struct amap_i_t_dpdu_cqe, 1434 index) / 32] & PDUCQE_INDEX_MASK)); 1435 buffer_len = (unsigned long)(phys_addr.u.a64.address - 1436 pasync_ctx->async_data.pa_base.u. 1437 a64.address); 1438 buffer_index = buffer_len / pasync_ctx->async_data.buffer_size; 1439 break; 1440 default: 1441 pbusy_list = NULL; 1442 shost_printk(KERN_WARNING, phba->shost, 1443 "Unexpected code=%d\n", 1444 pdpdu_cqe->dw[offsetof(struct amap_i_t_dpdu_cqe, 1445 code) / 32] & PDUCQE_CODE_MASK); 1446 return NULL; 1447 } 1448 1449 WARN_ON(!(buffer_index <= pasync_ctx->async_data.num_entries)); 1450 WARN_ON(list_empty(pbusy_list)); 1451 list_for_each_entry(pasync_handle, pbusy_list, link) { 1452 WARN_ON(pasync_handle->consumed); 1453 if (pasync_handle->index == buffer_index) 1454 break; 1455 } 1456 1457 WARN_ON(!pasync_handle); 1458 1459 pasync_handle->cri = (unsigned short)beiscsi_conn->beiscsi_conn_cid - 1460 phba->fw_config.iscsi_cid_start; 1461 pasync_handle->is_header = is_header; 1462 pasync_handle->buffer_len = ((pdpdu_cqe-> 1463 dw[offsetof(struct amap_i_t_dpdu_cqe, dpl) / 32] 1464 & PDUCQE_DPL_MASK) >> 16); 1465 1466 *pcq_index = (pdpdu_cqe->dw[offsetof(struct amap_i_t_dpdu_cqe, 1467 index) / 32] & PDUCQE_INDEX_MASK); 1468 return pasync_handle; 1469 } 1470 1471 static unsigned int 1472 hwi_update_async_writables(struct hwi_async_pdu_context *pasync_ctx, 1473 unsigned int is_header, unsigned int cq_index) 1474 { 1475 struct list_head *pbusy_list; 1476 struct async_pdu_handle *pasync_handle; 1477 unsigned int num_entries, writables = 0; 1478 unsigned int *pep_read_ptr, *pwritables; 1479 1480 1481 if (is_header) { 1482 pep_read_ptr = &pasync_ctx->async_header.ep_read_ptr; 1483 pwritables = &pasync_ctx->async_header.writables; 1484 num_entries = pasync_ctx->async_header.num_entries; 1485 } else { 1486 pep_read_ptr = &pasync_ctx->async_data.ep_read_ptr; 1487 pwritables = &pasync_ctx->async_data.writables; 1488 num_entries = pasync_ctx->async_data.num_entries; 1489 } 1490 1491 while ((*pep_read_ptr) != cq_index) { 1492 (*pep_read_ptr)++; 1493 *pep_read_ptr = (*pep_read_ptr) % num_entries; 1494 1495 pbusy_list = hwi_get_async_busy_list(pasync_ctx, is_header, 1496 *pep_read_ptr); 1497 if (writables == 0) 1498 WARN_ON(list_empty(pbusy_list)); 1499 1500 if (!list_empty(pbusy_list)) { 1501 pasync_handle = list_entry(pbusy_list->next, 1502 struct async_pdu_handle, 1503 link); 1504 WARN_ON(!pasync_handle); 1505 pasync_handle->consumed = 1; 1506 } 1507 1508 writables++; 1509 } 1510 1511 if (!writables) { 1512 SE_DEBUG(DBG_LVL_1, 1513 "Duplicate notification received - index 0x%x!!\n", 1514 cq_index); 1515 WARN_ON(1); 1516 } 1517 1518 *pwritables = *pwritables + writables; 1519 return 0; 1520 } 1521 1522 static unsigned int hwi_free_async_msg(struct beiscsi_hba *phba, 1523 unsigned int cri) 1524 { 1525 struct hwi_controller *phwi_ctrlr; 1526 struct hwi_async_pdu_context *pasync_ctx; 1527 struct async_pdu_handle *pasync_handle, *tmp_handle; 1528 struct list_head *plist; 1529 unsigned int i = 0; 1530 1531 phwi_ctrlr = phba->phwi_ctrlr; 1532 pasync_ctx = HWI_GET_ASYNC_PDU_CTX(phwi_ctrlr); 1533 1534 plist = &pasync_ctx->async_entry[cri].wait_queue.list; 1535 1536 list_for_each_entry_safe(pasync_handle, tmp_handle, plist, link) { 1537 list_del(&pasync_handle->link); 1538 1539 if (i == 0) { 1540 list_add_tail(&pasync_handle->link, 1541 &pasync_ctx->async_header.free_list); 1542 pasync_ctx->async_header.free_entries++; 1543 i++; 1544 } else { 1545 list_add_tail(&pasync_handle->link, 1546 &pasync_ctx->async_data.free_list); 1547 pasync_ctx->async_data.free_entries++; 1548 i++; 1549 } 1550 } 1551 1552 INIT_LIST_HEAD(&pasync_ctx->async_entry[cri].wait_queue.list); 1553 pasync_ctx->async_entry[cri].wait_queue.hdr_received = 0; 1554 pasync_ctx->async_entry[cri].wait_queue.bytes_received = 0; 1555 return 0; 1556 } 1557 1558 static struct phys_addr * 1559 hwi_get_ring_address(struct hwi_async_pdu_context *pasync_ctx, 1560 unsigned int is_header, unsigned int host_write_ptr) 1561 { 1562 struct phys_addr *pasync_sge = NULL; 1563 1564 if (is_header) 1565 pasync_sge = pasync_ctx->async_header.ring_base; 1566 else 1567 pasync_sge = pasync_ctx->async_data.ring_base; 1568 1569 return pasync_sge + host_write_ptr; 1570 } 1571 1572 static void hwi_post_async_buffers(struct beiscsi_hba *phba, 1573 unsigned int is_header) 1574 { 1575 struct hwi_controller *phwi_ctrlr; 1576 struct hwi_async_pdu_context *pasync_ctx; 1577 struct async_pdu_handle *pasync_handle; 1578 struct list_head *pfree_link, *pbusy_list; 1579 struct phys_addr *pasync_sge; 1580 unsigned int ring_id, num_entries; 1581 unsigned int host_write_num; 1582 unsigned int writables; 1583 unsigned int i = 0; 1584 u32 doorbell = 0; 1585 1586 phwi_ctrlr = phba->phwi_ctrlr; 1587 pasync_ctx = HWI_GET_ASYNC_PDU_CTX(phwi_ctrlr); 1588 1589 if (is_header) { 1590 num_entries = pasync_ctx->async_header.num_entries; 1591 writables = min(pasync_ctx->async_header.writables, 1592 pasync_ctx->async_header.free_entries); 1593 pfree_link = pasync_ctx->async_header.free_list.next; 1594 host_write_num = pasync_ctx->async_header.host_write_ptr; 1595 ring_id = phwi_ctrlr->default_pdu_hdr.id; 1596 } else { 1597 num_entries = pasync_ctx->async_data.num_entries; 1598 writables = min(pasync_ctx->async_data.writables, 1599 pasync_ctx->async_data.free_entries); 1600 pfree_link = pasync_ctx->async_data.free_list.next; 1601 host_write_num = pasync_ctx->async_data.host_write_ptr; 1602 ring_id = phwi_ctrlr->default_pdu_data.id; 1603 } 1604 1605 writables = (writables / 8) * 8; 1606 if (writables) { 1607 for (i = 0; i < writables; i++) { 1608 pbusy_list = 1609 hwi_get_async_busy_list(pasync_ctx, is_header, 1610 host_write_num); 1611 pasync_handle = 1612 list_entry(pfree_link, struct async_pdu_handle, 1613 link); 1614 WARN_ON(!pasync_handle); 1615 pasync_handle->consumed = 0; 1616 1617 pfree_link = pfree_link->next; 1618 1619 pasync_sge = hwi_get_ring_address(pasync_ctx, 1620 is_header, host_write_num); 1621 1622 pasync_sge->hi = pasync_handle->pa.u.a32.address_lo; 1623 pasync_sge->lo = pasync_handle->pa.u.a32.address_hi; 1624 1625 list_move(&pasync_handle->link, pbusy_list); 1626 1627 host_write_num++; 1628 host_write_num = host_write_num % num_entries; 1629 } 1630 1631 if (is_header) { 1632 pasync_ctx->async_header.host_write_ptr = 1633 host_write_num; 1634 pasync_ctx->async_header.free_entries -= writables; 1635 pasync_ctx->async_header.writables -= writables; 1636 pasync_ctx->async_header.busy_entries += writables; 1637 } else { 1638 pasync_ctx->async_data.host_write_ptr = host_write_num; 1639 pasync_ctx->async_data.free_entries -= writables; 1640 pasync_ctx->async_data.writables -= writables; 1641 pasync_ctx->async_data.busy_entries += writables; 1642 } 1643 1644 doorbell |= ring_id & DB_DEF_PDU_RING_ID_MASK; 1645 doorbell |= 1 << DB_DEF_PDU_REARM_SHIFT; 1646 doorbell |= 0 << DB_DEF_PDU_EVENT_SHIFT; 1647 doorbell |= (writables & DB_DEF_PDU_CQPROC_MASK) 1648 << DB_DEF_PDU_CQPROC_SHIFT; 1649 1650 iowrite32(doorbell, phba->db_va + DB_RXULP0_OFFSET); 1651 } 1652 } 1653 1654 static void hwi_flush_default_pdu_buffer(struct beiscsi_hba *phba, 1655 struct beiscsi_conn *beiscsi_conn, 1656 struct i_t_dpdu_cqe *pdpdu_cqe) 1657 { 1658 struct hwi_controller *phwi_ctrlr; 1659 struct hwi_async_pdu_context *pasync_ctx; 1660 struct async_pdu_handle *pasync_handle = NULL; 1661 unsigned int cq_index = -1; 1662 1663 phwi_ctrlr = phba->phwi_ctrlr; 1664 pasync_ctx = HWI_GET_ASYNC_PDU_CTX(phwi_ctrlr); 1665 1666 pasync_handle = hwi_get_async_handle(phba, beiscsi_conn, pasync_ctx, 1667 pdpdu_cqe, &cq_index); 1668 BUG_ON(pasync_handle->is_header != 0); 1669 if (pasync_handle->consumed == 0) 1670 hwi_update_async_writables(pasync_ctx, pasync_handle->is_header, 1671 cq_index); 1672 1673 hwi_free_async_msg(phba, pasync_handle->cri); 1674 hwi_post_async_buffers(phba, pasync_handle->is_header); 1675 } 1676 1677 static unsigned int 1678 hwi_fwd_async_msg(struct beiscsi_conn *beiscsi_conn, 1679 struct beiscsi_hba *phba, 1680 struct hwi_async_pdu_context *pasync_ctx, unsigned short cri) 1681 { 1682 struct list_head *plist; 1683 struct async_pdu_handle *pasync_handle; 1684 void *phdr = NULL; 1685 unsigned int hdr_len = 0, buf_len = 0; 1686 unsigned int status, index = 0, offset = 0; 1687 void *pfirst_buffer = NULL; 1688 unsigned int num_buf = 0; 1689 1690 plist = &pasync_ctx->async_entry[cri].wait_queue.list; 1691 1692 list_for_each_entry(pasync_handle, plist, link) { 1693 if (index == 0) { 1694 phdr = pasync_handle->pbuffer; 1695 hdr_len = pasync_handle->buffer_len; 1696 } else { 1697 buf_len = pasync_handle->buffer_len; 1698 if (!num_buf) { 1699 pfirst_buffer = pasync_handle->pbuffer; 1700 num_buf++; 1701 } 1702 memcpy(pfirst_buffer + offset, 1703 pasync_handle->pbuffer, buf_len); 1704 offset = buf_len; 1705 } 1706 index++; 1707 } 1708 1709 status = beiscsi_process_async_pdu(beiscsi_conn, phba, 1710 (beiscsi_conn->beiscsi_conn_cid - 1711 phba->fw_config.iscsi_cid_start), 1712 phdr, hdr_len, pfirst_buffer, 1713 buf_len); 1714 1715 if (status == 0) 1716 hwi_free_async_msg(phba, cri); 1717 return 0; 1718 } 1719 1720 static unsigned int 1721 hwi_gather_async_pdu(struct beiscsi_conn *beiscsi_conn, 1722 struct beiscsi_hba *phba, 1723 struct async_pdu_handle *pasync_handle) 1724 { 1725 struct hwi_async_pdu_context *pasync_ctx; 1726 struct hwi_controller *phwi_ctrlr; 1727 unsigned int bytes_needed = 0, status = 0; 1728 unsigned short cri = pasync_handle->cri; 1729 struct pdu_base *ppdu; 1730 1731 phwi_ctrlr = phba->phwi_ctrlr; 1732 pasync_ctx = HWI_GET_ASYNC_PDU_CTX(phwi_ctrlr); 1733 1734 list_del(&pasync_handle->link); 1735 if (pasync_handle->is_header) { 1736 pasync_ctx->async_header.busy_entries--; 1737 if (pasync_ctx->async_entry[cri].wait_queue.hdr_received) { 1738 hwi_free_async_msg(phba, cri); 1739 BUG(); 1740 } 1741 1742 pasync_ctx->async_entry[cri].wait_queue.bytes_received = 0; 1743 pasync_ctx->async_entry[cri].wait_queue.hdr_received = 1; 1744 pasync_ctx->async_entry[cri].wait_queue.hdr_len = 1745 (unsigned short)pasync_handle->buffer_len; 1746 list_add_tail(&pasync_handle->link, 1747 &pasync_ctx->async_entry[cri].wait_queue.list); 1748 1749 ppdu = pasync_handle->pbuffer; 1750 bytes_needed = ((((ppdu->dw[offsetof(struct amap_pdu_base, 1751 data_len_hi) / 32] & PDUBASE_DATALENHI_MASK) << 8) & 1752 0xFFFF0000) | ((be16_to_cpu((ppdu-> 1753 dw[offsetof(struct amap_pdu_base, data_len_lo) / 32] 1754 & PDUBASE_DATALENLO_MASK) >> 16)) & 0x0000FFFF)); 1755 1756 if (status == 0) { 1757 pasync_ctx->async_entry[cri].wait_queue.bytes_needed = 1758 bytes_needed; 1759 1760 if (bytes_needed == 0) 1761 status = hwi_fwd_async_msg(beiscsi_conn, phba, 1762 pasync_ctx, cri); 1763 } 1764 } else { 1765 pasync_ctx->async_data.busy_entries--; 1766 if (pasync_ctx->async_entry[cri].wait_queue.hdr_received) { 1767 list_add_tail(&pasync_handle->link, 1768 &pasync_ctx->async_entry[cri].wait_queue. 1769 list); 1770 pasync_ctx->async_entry[cri].wait_queue. 1771 bytes_received += 1772 (unsigned short)pasync_handle->buffer_len; 1773 1774 if (pasync_ctx->async_entry[cri].wait_queue. 1775 bytes_received >= 1776 pasync_ctx->async_entry[cri].wait_queue. 1777 bytes_needed) 1778 status = hwi_fwd_async_msg(beiscsi_conn, phba, 1779 pasync_ctx, cri); 1780 } 1781 } 1782 return status; 1783 } 1784 1785 static void hwi_process_default_pdu_ring(struct beiscsi_conn *beiscsi_conn, 1786 struct beiscsi_hba *phba, 1787 struct i_t_dpdu_cqe *pdpdu_cqe) 1788 { 1789 struct hwi_controller *phwi_ctrlr; 1790 struct hwi_async_pdu_context *pasync_ctx; 1791 struct async_pdu_handle *pasync_handle = NULL; 1792 unsigned int cq_index = -1; 1793 1794 phwi_ctrlr = phba->phwi_ctrlr; 1795 pasync_ctx = HWI_GET_ASYNC_PDU_CTX(phwi_ctrlr); 1796 pasync_handle = hwi_get_async_handle(phba, beiscsi_conn, pasync_ctx, 1797 pdpdu_cqe, &cq_index); 1798 1799 if (pasync_handle->consumed == 0) 1800 hwi_update_async_writables(pasync_ctx, pasync_handle->is_header, 1801 cq_index); 1802 hwi_gather_async_pdu(beiscsi_conn, phba, pasync_handle); 1803 hwi_post_async_buffers(phba, pasync_handle->is_header); 1804 } 1805 1806 static void beiscsi_process_mcc_isr(struct beiscsi_hba *phba) 1807 { 1808 struct be_queue_info *mcc_cq; 1809 struct be_mcc_compl *mcc_compl; 1810 unsigned int num_processed = 0; 1811 1812 mcc_cq = &phba->ctrl.mcc_obj.cq; 1813 mcc_compl = queue_tail_node(mcc_cq); 1814 mcc_compl->flags = le32_to_cpu(mcc_compl->flags); 1815 while (mcc_compl->flags & CQE_FLAGS_VALID_MASK) { 1816 1817 if (num_processed >= 32) { 1818 hwi_ring_cq_db(phba, mcc_cq->id, 1819 num_processed, 0, 0); 1820 num_processed = 0; 1821 } 1822 if (mcc_compl->flags & CQE_FLAGS_ASYNC_MASK) { 1823 /* Interpret flags as an async trailer */ 1824 if (is_link_state_evt(mcc_compl->flags)) 1825 /* Interpret compl as a async link evt */ 1826 beiscsi_async_link_state_process(phba, 1827 (struct be_async_event_link_state *) mcc_compl); 1828 else 1829 SE_DEBUG(DBG_LVL_1, 1830 " Unsupported Async Event, flags" 1831 " = 0x%08x\n", mcc_compl->flags); 1832 } else if (mcc_compl->flags & CQE_FLAGS_COMPLETED_MASK) { 1833 be_mcc_compl_process_isr(&phba->ctrl, mcc_compl); 1834 atomic_dec(&phba->ctrl.mcc_obj.q.used); 1835 } 1836 1837 mcc_compl->flags = 0; 1838 queue_tail_inc(mcc_cq); 1839 mcc_compl = queue_tail_node(mcc_cq); 1840 mcc_compl->flags = le32_to_cpu(mcc_compl->flags); 1841 num_processed++; 1842 } 1843 1844 if (num_processed > 0) 1845 hwi_ring_cq_db(phba, mcc_cq->id, num_processed, 1, 0); 1846 1847 } 1848 1849 static unsigned int beiscsi_process_cq(struct be_eq_obj *pbe_eq) 1850 { 1851 struct be_queue_info *cq; 1852 struct sol_cqe *sol; 1853 struct dmsg_cqe *dmsg; 1854 unsigned int num_processed = 0; 1855 unsigned int tot_nump = 0; 1856 struct beiscsi_conn *beiscsi_conn; 1857 struct beiscsi_endpoint *beiscsi_ep; 1858 struct iscsi_endpoint *ep; 1859 struct beiscsi_hba *phba; 1860 1861 cq = pbe_eq->cq; 1862 sol = queue_tail_node(cq); 1863 phba = pbe_eq->phba; 1864 1865 while (sol->dw[offsetof(struct amap_sol_cqe, valid) / 32] & 1866 CQE_VALID_MASK) { 1867 be_dws_le_to_cpu(sol, sizeof(struct sol_cqe)); 1868 1869 ep = phba->ep_array[(u32) ((sol-> 1870 dw[offsetof(struct amap_sol_cqe, cid) / 32] & 1871 SOL_CID_MASK) >> 6) - 1872 phba->fw_config.iscsi_cid_start]; 1873 1874 beiscsi_ep = ep->dd_data; 1875 beiscsi_conn = beiscsi_ep->conn; 1876 1877 if (num_processed >= 32) { 1878 hwi_ring_cq_db(phba, cq->id, 1879 num_processed, 0, 0); 1880 tot_nump += num_processed; 1881 num_processed = 0; 1882 } 1883 1884 switch ((u32) sol->dw[offsetof(struct amap_sol_cqe, code) / 1885 32] & CQE_CODE_MASK) { 1886 case SOL_CMD_COMPLETE: 1887 hwi_complete_cmd(beiscsi_conn, phba, sol); 1888 break; 1889 case DRIVERMSG_NOTIFY: 1890 SE_DEBUG(DBG_LVL_8, "Received DRIVERMSG_NOTIFY\n"); 1891 dmsg = (struct dmsg_cqe *)sol; 1892 hwi_complete_drvr_msgs(beiscsi_conn, phba, sol); 1893 break; 1894 case UNSOL_HDR_NOTIFY: 1895 SE_DEBUG(DBG_LVL_8, "Received UNSOL_HDR_ NOTIFY\n"); 1896 hwi_process_default_pdu_ring(beiscsi_conn, phba, 1897 (struct i_t_dpdu_cqe *)sol); 1898 break; 1899 case UNSOL_DATA_NOTIFY: 1900 SE_DEBUG(DBG_LVL_8, "Received UNSOL_DATA_NOTIFY\n"); 1901 hwi_process_default_pdu_ring(beiscsi_conn, phba, 1902 (struct i_t_dpdu_cqe *)sol); 1903 break; 1904 case CXN_INVALIDATE_INDEX_NOTIFY: 1905 case CMD_INVALIDATED_NOTIFY: 1906 case CXN_INVALIDATE_NOTIFY: 1907 SE_DEBUG(DBG_LVL_1, 1908 "Ignoring CQ Error notification for cmd/cxn" 1909 "invalidate\n"); 1910 break; 1911 case SOL_CMD_KILLED_DATA_DIGEST_ERR: 1912 case CMD_KILLED_INVALID_STATSN_RCVD: 1913 case CMD_KILLED_INVALID_R2T_RCVD: 1914 case CMD_CXN_KILLED_LUN_INVALID: 1915 case CMD_CXN_KILLED_ICD_INVALID: 1916 case CMD_CXN_KILLED_ITT_INVALID: 1917 case CMD_CXN_KILLED_SEQ_OUTOFORDER: 1918 case CMD_CXN_KILLED_INVALID_DATASN_RCVD: 1919 SE_DEBUG(DBG_LVL_1, 1920 "CQ Error notification for cmd.. " 1921 "code %d cid 0x%x\n", 1922 sol->dw[offsetof(struct amap_sol_cqe, code) / 1923 32] & CQE_CODE_MASK, 1924 (sol->dw[offsetof(struct amap_sol_cqe, cid) / 1925 32] & SOL_CID_MASK)); 1926 break; 1927 case UNSOL_DATA_DIGEST_ERROR_NOTIFY: 1928 SE_DEBUG(DBG_LVL_1, 1929 "Digest error on def pdu ring, dropping..\n"); 1930 hwi_flush_default_pdu_buffer(phba, beiscsi_conn, 1931 (struct i_t_dpdu_cqe *) sol); 1932 break; 1933 case CXN_KILLED_PDU_SIZE_EXCEEDS_DSL: 1934 case CXN_KILLED_BURST_LEN_MISMATCH: 1935 case CXN_KILLED_AHS_RCVD: 1936 case CXN_KILLED_HDR_DIGEST_ERR: 1937 case CXN_KILLED_UNKNOWN_HDR: 1938 case CXN_KILLED_STALE_ITT_TTT_RCVD: 1939 case CXN_KILLED_INVALID_ITT_TTT_RCVD: 1940 case CXN_KILLED_TIMED_OUT: 1941 case CXN_KILLED_FIN_RCVD: 1942 case CXN_KILLED_BAD_UNSOL_PDU_RCVD: 1943 case CXN_KILLED_BAD_WRB_INDEX_ERROR: 1944 case CXN_KILLED_OVER_RUN_RESIDUAL: 1945 case CXN_KILLED_UNDER_RUN_RESIDUAL: 1946 case CXN_KILLED_CMND_DATA_NOT_ON_SAME_CONN: 1947 SE_DEBUG(DBG_LVL_1, "CQ Error %d, reset CID " 1948 "0x%x...\n", 1949 sol->dw[offsetof(struct amap_sol_cqe, code) / 1950 32] & CQE_CODE_MASK, 1951 (sol->dw[offsetof(struct amap_sol_cqe, cid) / 1952 32] & CQE_CID_MASK)); 1953 iscsi_conn_failure(beiscsi_conn->conn, 1954 ISCSI_ERR_CONN_FAILED); 1955 break; 1956 case CXN_KILLED_RST_SENT: 1957 case CXN_KILLED_RST_RCVD: 1958 SE_DEBUG(DBG_LVL_1, "CQ Error %d, reset" 1959 "received/sent on CID 0x%x...\n", 1960 sol->dw[offsetof(struct amap_sol_cqe, code) / 1961 32] & CQE_CODE_MASK, 1962 (sol->dw[offsetof(struct amap_sol_cqe, cid) / 1963 32] & CQE_CID_MASK)); 1964 iscsi_conn_failure(beiscsi_conn->conn, 1965 ISCSI_ERR_CONN_FAILED); 1966 break; 1967 default: 1968 SE_DEBUG(DBG_LVL_1, "CQ Error Invalid code= %d " 1969 "received on CID 0x%x...\n", 1970 sol->dw[offsetof(struct amap_sol_cqe, code) / 1971 32] & CQE_CODE_MASK, 1972 (sol->dw[offsetof(struct amap_sol_cqe, cid) / 1973 32] & CQE_CID_MASK)); 1974 break; 1975 } 1976 1977 AMAP_SET_BITS(struct amap_sol_cqe, valid, sol, 0); 1978 queue_tail_inc(cq); 1979 sol = queue_tail_node(cq); 1980 num_processed++; 1981 } 1982 1983 if (num_processed > 0) { 1984 tot_nump += num_processed; 1985 hwi_ring_cq_db(phba, cq->id, num_processed, 1, 0); 1986 } 1987 return tot_nump; 1988 } 1989 1990 void beiscsi_process_all_cqs(struct work_struct *work) 1991 { 1992 unsigned long flags; 1993 struct hwi_controller *phwi_ctrlr; 1994 struct hwi_context_memory *phwi_context; 1995 struct be_eq_obj *pbe_eq; 1996 struct beiscsi_hba *phba = 1997 container_of(work, struct beiscsi_hba, work_cqs); 1998 1999 phwi_ctrlr = phba->phwi_ctrlr; 2000 phwi_context = phwi_ctrlr->phwi_ctxt; 2001 if (phba->msix_enabled) 2002 pbe_eq = &phwi_context->be_eq[phba->num_cpus]; 2003 else 2004 pbe_eq = &phwi_context->be_eq[0]; 2005 2006 if (phba->todo_mcc_cq) { 2007 spin_lock_irqsave(&phba->isr_lock, flags); 2008 phba->todo_mcc_cq = 0; 2009 spin_unlock_irqrestore(&phba->isr_lock, flags); 2010 beiscsi_process_mcc_isr(phba); 2011 } 2012 2013 if (phba->todo_cq) { 2014 spin_lock_irqsave(&phba->isr_lock, flags); 2015 phba->todo_cq = 0; 2016 spin_unlock_irqrestore(&phba->isr_lock, flags); 2017 beiscsi_process_cq(pbe_eq); 2018 } 2019 } 2020 2021 static int be_iopoll(struct blk_iopoll *iop, int budget) 2022 { 2023 static unsigned int ret; 2024 struct beiscsi_hba *phba; 2025 struct be_eq_obj *pbe_eq; 2026 2027 pbe_eq = container_of(iop, struct be_eq_obj, iopoll); 2028 ret = beiscsi_process_cq(pbe_eq); 2029 if (ret < budget) { 2030 phba = pbe_eq->phba; 2031 blk_iopoll_complete(iop); 2032 SE_DEBUG(DBG_LVL_8, "rearm pbe_eq->q.id =%d\n", pbe_eq->q.id); 2033 hwi_ring_eq_db(phba, pbe_eq->q.id, 0, 0, 1, 1); 2034 } 2035 return ret; 2036 } 2037 2038 static void 2039 hwi_write_sgl(struct iscsi_wrb *pwrb, struct scatterlist *sg, 2040 unsigned int num_sg, struct beiscsi_io_task *io_task) 2041 { 2042 struct iscsi_sge *psgl; 2043 unsigned int sg_len, index; 2044 unsigned int sge_len = 0; 2045 unsigned long long addr; 2046 struct scatterlist *l_sg; 2047 unsigned int offset; 2048 2049 AMAP_SET_BITS(struct amap_iscsi_wrb, iscsi_bhs_addr_lo, pwrb, 2050 io_task->bhs_pa.u.a32.address_lo); 2051 AMAP_SET_BITS(struct amap_iscsi_wrb, iscsi_bhs_addr_hi, pwrb, 2052 io_task->bhs_pa.u.a32.address_hi); 2053 2054 l_sg = sg; 2055 for (index = 0; (index < num_sg) && (index < 2); index++, 2056 sg = sg_next(sg)) { 2057 if (index == 0) { 2058 sg_len = sg_dma_len(sg); 2059 addr = (u64) sg_dma_address(sg); 2060 AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_addr_lo, pwrb, 2061 ((u32)(addr & 0xFFFFFFFF))); 2062 AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_addr_hi, pwrb, 2063 ((u32)(addr >> 32))); 2064 AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_len, pwrb, 2065 sg_len); 2066 sge_len = sg_len; 2067 } else { 2068 AMAP_SET_BITS(struct amap_iscsi_wrb, sge1_r2t_offset, 2069 pwrb, sge_len); 2070 sg_len = sg_dma_len(sg); 2071 addr = (u64) sg_dma_address(sg); 2072 AMAP_SET_BITS(struct amap_iscsi_wrb, sge1_addr_lo, pwrb, 2073 ((u32)(addr & 0xFFFFFFFF))); 2074 AMAP_SET_BITS(struct amap_iscsi_wrb, sge1_addr_hi, pwrb, 2075 ((u32)(addr >> 32))); 2076 AMAP_SET_BITS(struct amap_iscsi_wrb, sge1_len, pwrb, 2077 sg_len); 2078 } 2079 } 2080 psgl = (struct iscsi_sge *)io_task->psgl_handle->pfrag; 2081 memset(psgl, 0, sizeof(*psgl) * BE2_SGE); 2082 2083 AMAP_SET_BITS(struct amap_iscsi_sge, len, psgl, io_task->bhs_len - 2); 2084 2085 AMAP_SET_BITS(struct amap_iscsi_sge, addr_hi, psgl, 2086 io_task->bhs_pa.u.a32.address_hi); 2087 AMAP_SET_BITS(struct amap_iscsi_sge, addr_lo, psgl, 2088 io_task->bhs_pa.u.a32.address_lo); 2089 2090 if (num_sg == 1) { 2091 AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_last, pwrb, 2092 1); 2093 AMAP_SET_BITS(struct amap_iscsi_wrb, sge1_last, pwrb, 2094 0); 2095 } else if (num_sg == 2) { 2096 AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_last, pwrb, 2097 0); 2098 AMAP_SET_BITS(struct amap_iscsi_wrb, sge1_last, pwrb, 2099 1); 2100 } else { 2101 AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_last, pwrb, 2102 0); 2103 AMAP_SET_BITS(struct amap_iscsi_wrb, sge1_last, pwrb, 2104 0); 2105 } 2106 sg = l_sg; 2107 psgl++; 2108 psgl++; 2109 offset = 0; 2110 for (index = 0; index < num_sg; index++, sg = sg_next(sg), psgl++) { 2111 sg_len = sg_dma_len(sg); 2112 addr = (u64) sg_dma_address(sg); 2113 AMAP_SET_BITS(struct amap_iscsi_sge, addr_lo, psgl, 2114 (addr & 0xFFFFFFFF)); 2115 AMAP_SET_BITS(struct amap_iscsi_sge, addr_hi, psgl, 2116 (addr >> 32)); 2117 AMAP_SET_BITS(struct amap_iscsi_sge, len, psgl, sg_len); 2118 AMAP_SET_BITS(struct amap_iscsi_sge, sge_offset, psgl, offset); 2119 AMAP_SET_BITS(struct amap_iscsi_sge, last_sge, psgl, 0); 2120 offset += sg_len; 2121 } 2122 psgl--; 2123 AMAP_SET_BITS(struct amap_iscsi_sge, last_sge, psgl, 1); 2124 } 2125 2126 static void hwi_write_buffer(struct iscsi_wrb *pwrb, struct iscsi_task *task) 2127 { 2128 struct iscsi_sge *psgl; 2129 unsigned long long addr; 2130 struct beiscsi_io_task *io_task = task->dd_data; 2131 struct beiscsi_conn *beiscsi_conn = io_task->conn; 2132 struct beiscsi_hba *phba = beiscsi_conn->phba; 2133 2134 io_task->bhs_len = sizeof(struct be_nonio_bhs) - 2; 2135 AMAP_SET_BITS(struct amap_iscsi_wrb, iscsi_bhs_addr_lo, pwrb, 2136 io_task->bhs_pa.u.a32.address_lo); 2137 AMAP_SET_BITS(struct amap_iscsi_wrb, iscsi_bhs_addr_hi, pwrb, 2138 io_task->bhs_pa.u.a32.address_hi); 2139 2140 if (task->data) { 2141 if (task->data_count) { 2142 AMAP_SET_BITS(struct amap_iscsi_wrb, dsp, pwrb, 1); 2143 addr = (u64) pci_map_single(phba->pcidev, 2144 task->data, 2145 task->data_count, 1); 2146 } else { 2147 AMAP_SET_BITS(struct amap_iscsi_wrb, dsp, pwrb, 0); 2148 addr = 0; 2149 } 2150 AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_addr_lo, pwrb, 2151 ((u32)(addr & 0xFFFFFFFF))); 2152 AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_addr_hi, pwrb, 2153 ((u32)(addr >> 32))); 2154 AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_len, pwrb, 2155 task->data_count); 2156 2157 AMAP_SET_BITS(struct amap_iscsi_wrb, sge0_last, pwrb, 1); 2158 } else { 2159 AMAP_SET_BITS(struct amap_iscsi_wrb, dsp, pwrb, 0); 2160 addr = 0; 2161 } 2162 2163 psgl = (struct iscsi_sge *)io_task->psgl_handle->pfrag; 2164 2165 AMAP_SET_BITS(struct amap_iscsi_sge, len, psgl, io_task->bhs_len); 2166 2167 AMAP_SET_BITS(struct amap_iscsi_sge, addr_hi, psgl, 2168 io_task->bhs_pa.u.a32.address_hi); 2169 AMAP_SET_BITS(struct amap_iscsi_sge, addr_lo, psgl, 2170 io_task->bhs_pa.u.a32.address_lo); 2171 if (task->data) { 2172 psgl++; 2173 AMAP_SET_BITS(struct amap_iscsi_sge, addr_hi, psgl, 0); 2174 AMAP_SET_BITS(struct amap_iscsi_sge, addr_lo, psgl, 0); 2175 AMAP_SET_BITS(struct amap_iscsi_sge, len, psgl, 0); 2176 AMAP_SET_BITS(struct amap_iscsi_sge, sge_offset, psgl, 0); 2177 AMAP_SET_BITS(struct amap_iscsi_sge, rsvd0, psgl, 0); 2178 AMAP_SET_BITS(struct amap_iscsi_sge, last_sge, psgl, 0); 2179 2180 psgl++; 2181 if (task->data) { 2182 AMAP_SET_BITS(struct amap_iscsi_sge, addr_lo, psgl, 2183 ((u32)(addr & 0xFFFFFFFF))); 2184 AMAP_SET_BITS(struct amap_iscsi_sge, addr_hi, psgl, 2185 ((u32)(addr >> 32))); 2186 } 2187 AMAP_SET_BITS(struct amap_iscsi_sge, len, psgl, 0x106); 2188 } 2189 AMAP_SET_BITS(struct amap_iscsi_sge, last_sge, psgl, 1); 2190 } 2191 2192 static void beiscsi_find_mem_req(struct beiscsi_hba *phba) 2193 { 2194 unsigned int num_cq_pages, num_async_pdu_buf_pages; 2195 unsigned int num_async_pdu_data_pages, wrb_sz_per_cxn; 2196 unsigned int num_async_pdu_buf_sgl_pages, num_async_pdu_data_sgl_pages; 2197 2198 num_cq_pages = PAGES_REQUIRED(phba->params.num_cq_entries * \ 2199 sizeof(struct sol_cqe)); 2200 num_async_pdu_buf_pages = 2201 PAGES_REQUIRED(phba->params.asyncpdus_per_ctrl * \ 2202 phba->params.defpdu_hdr_sz); 2203 num_async_pdu_buf_sgl_pages = 2204 PAGES_REQUIRED(phba->params.asyncpdus_per_ctrl * \ 2205 sizeof(struct phys_addr)); 2206 num_async_pdu_data_pages = 2207 PAGES_REQUIRED(phba->params.asyncpdus_per_ctrl * \ 2208 phba->params.defpdu_data_sz); 2209 num_async_pdu_data_sgl_pages = 2210 PAGES_REQUIRED(phba->params.asyncpdus_per_ctrl * \ 2211 sizeof(struct phys_addr)); 2212 2213 phba->params.hwi_ws_sz = sizeof(struct hwi_controller); 2214 2215 phba->mem_req[ISCSI_MEM_GLOBAL_HEADER] = 2 * 2216 BE_ISCSI_PDU_HEADER_SIZE; 2217 phba->mem_req[HWI_MEM_ADDN_CONTEXT] = 2218 sizeof(struct hwi_context_memory); 2219 2220 2221 phba->mem_req[HWI_MEM_WRB] = sizeof(struct iscsi_wrb) 2222 * (phba->params.wrbs_per_cxn) 2223 * phba->params.cxns_per_ctrl; 2224 wrb_sz_per_cxn = sizeof(struct wrb_handle) * 2225 (phba->params.wrbs_per_cxn); 2226 phba->mem_req[HWI_MEM_WRBH] = roundup_pow_of_two((wrb_sz_per_cxn) * 2227 phba->params.cxns_per_ctrl); 2228 2229 phba->mem_req[HWI_MEM_SGLH] = sizeof(struct sgl_handle) * 2230 phba->params.icds_per_ctrl; 2231 phba->mem_req[HWI_MEM_SGE] = sizeof(struct iscsi_sge) * 2232 phba->params.num_sge_per_io * phba->params.icds_per_ctrl; 2233 2234 phba->mem_req[HWI_MEM_ASYNC_HEADER_BUF] = 2235 num_async_pdu_buf_pages * PAGE_SIZE; 2236 phba->mem_req[HWI_MEM_ASYNC_DATA_BUF] = 2237 num_async_pdu_data_pages * PAGE_SIZE; 2238 phba->mem_req[HWI_MEM_ASYNC_HEADER_RING] = 2239 num_async_pdu_buf_sgl_pages * PAGE_SIZE; 2240 phba->mem_req[HWI_MEM_ASYNC_DATA_RING] = 2241 num_async_pdu_data_sgl_pages * PAGE_SIZE; 2242 phba->mem_req[HWI_MEM_ASYNC_HEADER_HANDLE] = 2243 phba->params.asyncpdus_per_ctrl * 2244 sizeof(struct async_pdu_handle); 2245 phba->mem_req[HWI_MEM_ASYNC_DATA_HANDLE] = 2246 phba->params.asyncpdus_per_ctrl * 2247 sizeof(struct async_pdu_handle); 2248 phba->mem_req[HWI_MEM_ASYNC_PDU_CONTEXT] = 2249 sizeof(struct hwi_async_pdu_context) + 2250 (phba->params.cxns_per_ctrl * sizeof(struct hwi_async_entry)); 2251 } 2252 2253 static int beiscsi_alloc_mem(struct beiscsi_hba *phba) 2254 { 2255 struct be_mem_descriptor *mem_descr; 2256 dma_addr_t bus_add; 2257 struct mem_array *mem_arr, *mem_arr_orig; 2258 unsigned int i, j, alloc_size, curr_alloc_size; 2259 2260 phba->phwi_ctrlr = kmalloc(phba->params.hwi_ws_sz, GFP_KERNEL); 2261 if (!phba->phwi_ctrlr) 2262 return -ENOMEM; 2263 2264 phba->init_mem = kcalloc(SE_MEM_MAX, sizeof(*mem_descr), 2265 GFP_KERNEL); 2266 if (!phba->init_mem) { 2267 kfree(phba->phwi_ctrlr); 2268 return -ENOMEM; 2269 } 2270 2271 mem_arr_orig = kmalloc(sizeof(*mem_arr_orig) * BEISCSI_MAX_FRAGS_INIT, 2272 GFP_KERNEL); 2273 if (!mem_arr_orig) { 2274 kfree(phba->init_mem); 2275 kfree(phba->phwi_ctrlr); 2276 return -ENOMEM; 2277 } 2278 2279 mem_descr = phba->init_mem; 2280 for (i = 0; i < SE_MEM_MAX; i++) { 2281 j = 0; 2282 mem_arr = mem_arr_orig; 2283 alloc_size = phba->mem_req[i]; 2284 memset(mem_arr, 0, sizeof(struct mem_array) * 2285 BEISCSI_MAX_FRAGS_INIT); 2286 curr_alloc_size = min(be_max_phys_size * 1024, alloc_size); 2287 do { 2288 mem_arr->virtual_address = pci_alloc_consistent( 2289 phba->pcidev, 2290 curr_alloc_size, 2291 &bus_add); 2292 if (!mem_arr->virtual_address) { 2293 if (curr_alloc_size <= BE_MIN_MEM_SIZE) 2294 goto free_mem; 2295 if (curr_alloc_size - 2296 rounddown_pow_of_two(curr_alloc_size)) 2297 curr_alloc_size = rounddown_pow_of_two 2298 (curr_alloc_size); 2299 else 2300 curr_alloc_size = curr_alloc_size / 2; 2301 } else { 2302 mem_arr->bus_address.u. 2303 a64.address = (__u64) bus_add; 2304 mem_arr->size = curr_alloc_size; 2305 alloc_size -= curr_alloc_size; 2306 curr_alloc_size = min(be_max_phys_size * 2307 1024, alloc_size); 2308 j++; 2309 mem_arr++; 2310 } 2311 } while (alloc_size); 2312 mem_descr->num_elements = j; 2313 mem_descr->size_in_bytes = phba->mem_req[i]; 2314 mem_descr->mem_array = kmalloc(sizeof(*mem_arr) * j, 2315 GFP_KERNEL); 2316 if (!mem_descr->mem_array) 2317 goto free_mem; 2318 2319 memcpy(mem_descr->mem_array, mem_arr_orig, 2320 sizeof(struct mem_array) * j); 2321 mem_descr++; 2322 } 2323 kfree(mem_arr_orig); 2324 return 0; 2325 free_mem: 2326 mem_descr->num_elements = j; 2327 while ((i) || (j)) { 2328 for (j = mem_descr->num_elements; j > 0; j--) { 2329 pci_free_consistent(phba->pcidev, 2330 mem_descr->mem_array[j - 1].size, 2331 mem_descr->mem_array[j - 1]. 2332 virtual_address, 2333 (unsigned long)mem_descr-> 2334 mem_array[j - 1]. 2335 bus_address.u.a64.address); 2336 } 2337 if (i) { 2338 i--; 2339 kfree(mem_descr->mem_array); 2340 mem_descr--; 2341 } 2342 } 2343 kfree(mem_arr_orig); 2344 kfree(phba->init_mem); 2345 kfree(phba->phwi_ctrlr); 2346 return -ENOMEM; 2347 } 2348 2349 static int beiscsi_get_memory(struct beiscsi_hba *phba) 2350 { 2351 beiscsi_find_mem_req(phba); 2352 return beiscsi_alloc_mem(phba); 2353 } 2354 2355 static void iscsi_init_global_templates(struct beiscsi_hba *phba) 2356 { 2357 struct pdu_data_out *pdata_out; 2358 struct pdu_nop_out *pnop_out; 2359 struct be_mem_descriptor *mem_descr; 2360 2361 mem_descr = phba->init_mem; 2362 mem_descr += ISCSI_MEM_GLOBAL_HEADER; 2363 pdata_out = 2364 (struct pdu_data_out *)mem_descr->mem_array[0].virtual_address; 2365 memset(pdata_out, 0, BE_ISCSI_PDU_HEADER_SIZE); 2366 2367 AMAP_SET_BITS(struct amap_pdu_data_out, opcode, pdata_out, 2368 IIOC_SCSI_DATA); 2369 2370 pnop_out = 2371 (struct pdu_nop_out *)((unsigned char *)mem_descr->mem_array[0]. 2372 virtual_address + BE_ISCSI_PDU_HEADER_SIZE); 2373 2374 memset(pnop_out, 0, BE_ISCSI_PDU_HEADER_SIZE); 2375 AMAP_SET_BITS(struct amap_pdu_nop_out, ttt, pnop_out, 0xFFFFFFFF); 2376 AMAP_SET_BITS(struct amap_pdu_nop_out, f_bit, pnop_out, 1); 2377 AMAP_SET_BITS(struct amap_pdu_nop_out, i_bit, pnop_out, 0); 2378 } 2379 2380 static void beiscsi_init_wrb_handle(struct beiscsi_hba *phba) 2381 { 2382 struct be_mem_descriptor *mem_descr_wrbh, *mem_descr_wrb; 2383 struct wrb_handle *pwrb_handle; 2384 struct hwi_controller *phwi_ctrlr; 2385 struct hwi_wrb_context *pwrb_context; 2386 struct iscsi_wrb *pwrb; 2387 unsigned int num_cxn_wrbh; 2388 unsigned int num_cxn_wrb, j, idx, index; 2389 2390 mem_descr_wrbh = phba->init_mem; 2391 mem_descr_wrbh += HWI_MEM_WRBH; 2392 2393 mem_descr_wrb = phba->init_mem; 2394 mem_descr_wrb += HWI_MEM_WRB; 2395 2396 idx = 0; 2397 pwrb_handle = mem_descr_wrbh->mem_array[idx].virtual_address; 2398 num_cxn_wrbh = ((mem_descr_wrbh->mem_array[idx].size) / 2399 ((sizeof(struct wrb_handle)) * 2400 phba->params.wrbs_per_cxn)); 2401 phwi_ctrlr = phba->phwi_ctrlr; 2402 2403 for (index = 0; index < phba->params.cxns_per_ctrl * 2; index += 2) { 2404 pwrb_context = &phwi_ctrlr->wrb_context[index]; 2405 pwrb_context->pwrb_handle_base = 2406 kzalloc(sizeof(struct wrb_handle *) * 2407 phba->params.wrbs_per_cxn, GFP_KERNEL); 2408 pwrb_context->pwrb_handle_basestd = 2409 kzalloc(sizeof(struct wrb_handle *) * 2410 phba->params.wrbs_per_cxn, GFP_KERNEL); 2411 if (num_cxn_wrbh) { 2412 pwrb_context->alloc_index = 0; 2413 pwrb_context->wrb_handles_available = 0; 2414 for (j = 0; j < phba->params.wrbs_per_cxn; j++) { 2415 pwrb_context->pwrb_handle_base[j] = pwrb_handle; 2416 pwrb_context->pwrb_handle_basestd[j] = 2417 pwrb_handle; 2418 pwrb_context->wrb_handles_available++; 2419 pwrb_handle->wrb_index = j; 2420 pwrb_handle++; 2421 } 2422 pwrb_context->free_index = 0; 2423 num_cxn_wrbh--; 2424 } else { 2425 idx++; 2426 pwrb_handle = 2427 mem_descr_wrbh->mem_array[idx].virtual_address; 2428 num_cxn_wrbh = 2429 ((mem_descr_wrbh->mem_array[idx].size) / 2430 ((sizeof(struct wrb_handle)) * 2431 phba->params.wrbs_per_cxn)); 2432 pwrb_context->alloc_index = 0; 2433 for (j = 0; j < phba->params.wrbs_per_cxn; j++) { 2434 pwrb_context->pwrb_handle_base[j] = pwrb_handle; 2435 pwrb_context->pwrb_handle_basestd[j] = 2436 pwrb_handle; 2437 pwrb_context->wrb_handles_available++; 2438 pwrb_handle->wrb_index = j; 2439 pwrb_handle++; 2440 } 2441 pwrb_context->free_index = 0; 2442 num_cxn_wrbh--; 2443 } 2444 } 2445 idx = 0; 2446 pwrb = mem_descr_wrb->mem_array[idx].virtual_address; 2447 num_cxn_wrb = (mem_descr_wrb->mem_array[idx].size) / 2448 ((sizeof(struct iscsi_wrb) * 2449 phba->params.wrbs_per_cxn)); 2450 for (index = 0; index < phba->params.cxns_per_ctrl * 2; index += 2) { 2451 pwrb_context = &phwi_ctrlr->wrb_context[index]; 2452 if (num_cxn_wrb) { 2453 for (j = 0; j < phba->params.wrbs_per_cxn; j++) { 2454 pwrb_handle = pwrb_context->pwrb_handle_base[j]; 2455 pwrb_handle->pwrb = pwrb; 2456 pwrb++; 2457 } 2458 num_cxn_wrb--; 2459 } else { 2460 idx++; 2461 pwrb = mem_descr_wrb->mem_array[idx].virtual_address; 2462 num_cxn_wrb = (mem_descr_wrb->mem_array[idx].size) / 2463 ((sizeof(struct iscsi_wrb) * 2464 phba->params.wrbs_per_cxn)); 2465 for (j = 0; j < phba->params.wrbs_per_cxn; j++) { 2466 pwrb_handle = pwrb_context->pwrb_handle_base[j]; 2467 pwrb_handle->pwrb = pwrb; 2468 pwrb++; 2469 } 2470 num_cxn_wrb--; 2471 } 2472 } 2473 } 2474 2475 static void hwi_init_async_pdu_ctx(struct beiscsi_hba *phba) 2476 { 2477 struct hwi_controller *phwi_ctrlr; 2478 struct hba_parameters *p = &phba->params; 2479 struct hwi_async_pdu_context *pasync_ctx; 2480 struct async_pdu_handle *pasync_header_h, *pasync_data_h; 2481 unsigned int index; 2482 struct be_mem_descriptor *mem_descr; 2483 2484 mem_descr = (struct be_mem_descriptor *)phba->init_mem; 2485 mem_descr += HWI_MEM_ASYNC_PDU_CONTEXT; 2486 2487 phwi_ctrlr = phba->phwi_ctrlr; 2488 phwi_ctrlr->phwi_ctxt->pasync_ctx = (struct hwi_async_pdu_context *) 2489 mem_descr->mem_array[0].virtual_address; 2490 pasync_ctx = phwi_ctrlr->phwi_ctxt->pasync_ctx; 2491 memset(pasync_ctx, 0, sizeof(*pasync_ctx)); 2492 2493 pasync_ctx->async_header.num_entries = p->asyncpdus_per_ctrl; 2494 pasync_ctx->async_header.buffer_size = p->defpdu_hdr_sz; 2495 pasync_ctx->async_data.buffer_size = p->defpdu_data_sz; 2496 pasync_ctx->async_data.num_entries = p->asyncpdus_per_ctrl; 2497 2498 mem_descr = (struct be_mem_descriptor *)phba->init_mem; 2499 mem_descr += HWI_MEM_ASYNC_HEADER_BUF; 2500 if (mem_descr->mem_array[0].virtual_address) { 2501 SE_DEBUG(DBG_LVL_8, 2502 "hwi_init_async_pdu_ctx HWI_MEM_ASYNC_HEADER_BUF" 2503 "va=%p\n", mem_descr->mem_array[0].virtual_address); 2504 } else 2505 shost_printk(KERN_WARNING, phba->shost, 2506 "No Virtual address\n"); 2507 2508 pasync_ctx->async_header.va_base = 2509 mem_descr->mem_array[0].virtual_address; 2510 2511 pasync_ctx->async_header.pa_base.u.a64.address = 2512 mem_descr->mem_array[0].bus_address.u.a64.address; 2513 2514 mem_descr = (struct be_mem_descriptor *)phba->init_mem; 2515 mem_descr += HWI_MEM_ASYNC_HEADER_RING; 2516 if (mem_descr->mem_array[0].virtual_address) { 2517 SE_DEBUG(DBG_LVL_8, 2518 "hwi_init_async_pdu_ctx HWI_MEM_ASYNC_HEADER_RING" 2519 "va=%p\n", mem_descr->mem_array[0].virtual_address); 2520 } else 2521 shost_printk(KERN_WARNING, phba->shost, 2522 "No Virtual address\n"); 2523 pasync_ctx->async_header.ring_base = 2524 mem_descr->mem_array[0].virtual_address; 2525 2526 mem_descr = (struct be_mem_descriptor *)phba->init_mem; 2527 mem_descr += HWI_MEM_ASYNC_HEADER_HANDLE; 2528 if (mem_descr->mem_array[0].virtual_address) { 2529 SE_DEBUG(DBG_LVL_8, 2530 "hwi_init_async_pdu_ctx HWI_MEM_ASYNC_HEADER_HANDLE" 2531 "va=%p\n", mem_descr->mem_array[0].virtual_address); 2532 } else 2533 shost_printk(KERN_WARNING, phba->shost, 2534 "No Virtual address\n"); 2535 2536 pasync_ctx->async_header.handle_base = 2537 mem_descr->mem_array[0].virtual_address; 2538 pasync_ctx->async_header.writables = 0; 2539 INIT_LIST_HEAD(&pasync_ctx->async_header.free_list); 2540 2541 mem_descr = (struct be_mem_descriptor *)phba->init_mem; 2542 mem_descr += HWI_MEM_ASYNC_DATA_BUF; 2543 if (mem_descr->mem_array[0].virtual_address) { 2544 SE_DEBUG(DBG_LVL_8, 2545 "hwi_init_async_pdu_ctx HWI_MEM_ASYNC_DATA_BUF" 2546 "va=%p\n", mem_descr->mem_array[0].virtual_address); 2547 } else 2548 shost_printk(KERN_WARNING, phba->shost, 2549 "No Virtual address\n"); 2550 pasync_ctx->async_data.va_base = 2551 mem_descr->mem_array[0].virtual_address; 2552 pasync_ctx->async_data.pa_base.u.a64.address = 2553 mem_descr->mem_array[0].bus_address.u.a64.address; 2554 2555 mem_descr = (struct be_mem_descriptor *)phba->init_mem; 2556 mem_descr += HWI_MEM_ASYNC_DATA_RING; 2557 if (mem_descr->mem_array[0].virtual_address) { 2558 SE_DEBUG(DBG_LVL_8, 2559 "hwi_init_async_pdu_ctx HWI_MEM_ASYNC_DATA_RING" 2560 "va=%p\n", mem_descr->mem_array[0].virtual_address); 2561 } else 2562 shost_printk(KERN_WARNING, phba->shost, 2563 "No Virtual address\n"); 2564 2565 pasync_ctx->async_data.ring_base = 2566 mem_descr->mem_array[0].virtual_address; 2567 2568 mem_descr = (struct be_mem_descriptor *)phba->init_mem; 2569 mem_descr += HWI_MEM_ASYNC_DATA_HANDLE; 2570 if (!mem_descr->mem_array[0].virtual_address) 2571 shost_printk(KERN_WARNING, phba->shost, 2572 "No Virtual address\n"); 2573 2574 pasync_ctx->async_data.handle_base = 2575 mem_descr->mem_array[0].virtual_address; 2576 pasync_ctx->async_data.writables = 0; 2577 INIT_LIST_HEAD(&pasync_ctx->async_data.free_list); 2578 2579 pasync_header_h = 2580 (struct async_pdu_handle *)pasync_ctx->async_header.handle_base; 2581 pasync_data_h = 2582 (struct async_pdu_handle *)pasync_ctx->async_data.handle_base; 2583 2584 for (index = 0; index < p->asyncpdus_per_ctrl; index++) { 2585 pasync_header_h->cri = -1; 2586 pasync_header_h->index = (char)index; 2587 INIT_LIST_HEAD(&pasync_header_h->link); 2588 pasync_header_h->pbuffer = 2589 (void *)((unsigned long) 2590 (pasync_ctx->async_header.va_base) + 2591 (p->defpdu_hdr_sz * index)); 2592 2593 pasync_header_h->pa.u.a64.address = 2594 pasync_ctx->async_header.pa_base.u.a64.address + 2595 (p->defpdu_hdr_sz * index); 2596 2597 list_add_tail(&pasync_header_h->link, 2598 &pasync_ctx->async_header.free_list); 2599 pasync_header_h++; 2600 pasync_ctx->async_header.free_entries++; 2601 pasync_ctx->async_header.writables++; 2602 2603 INIT_LIST_HEAD(&pasync_ctx->async_entry[index].wait_queue.list); 2604 INIT_LIST_HEAD(&pasync_ctx->async_entry[index]. 2605 header_busy_list); 2606 pasync_data_h->cri = -1; 2607 pasync_data_h->index = (char)index; 2608 INIT_LIST_HEAD(&pasync_data_h->link); 2609 pasync_data_h->pbuffer = 2610 (void *)((unsigned long) 2611 (pasync_ctx->async_data.va_base) + 2612 (p->defpdu_data_sz * index)); 2613 2614 pasync_data_h->pa.u.a64.address = 2615 pasync_ctx->async_data.pa_base.u.a64.address + 2616 (p->defpdu_data_sz * index); 2617 2618 list_add_tail(&pasync_data_h->link, 2619 &pasync_ctx->async_data.free_list); 2620 pasync_data_h++; 2621 pasync_ctx->async_data.free_entries++; 2622 pasync_ctx->async_data.writables++; 2623 2624 INIT_LIST_HEAD(&pasync_ctx->async_entry[index].data_busy_list); 2625 } 2626 2627 pasync_ctx->async_header.host_write_ptr = 0; 2628 pasync_ctx->async_header.ep_read_ptr = -1; 2629 pasync_ctx->async_data.host_write_ptr = 0; 2630 pasync_ctx->async_data.ep_read_ptr = -1; 2631 } 2632 2633 static int 2634 be_sgl_create_contiguous(void *virtual_address, 2635 u64 physical_address, u32 length, 2636 struct be_dma_mem *sgl) 2637 { 2638 WARN_ON(!virtual_address); 2639 WARN_ON(!physical_address); 2640 WARN_ON(!length > 0); 2641 WARN_ON(!sgl); 2642 2643 sgl->va = virtual_address; 2644 sgl->dma = (unsigned long)physical_address; 2645 sgl->size = length; 2646 2647 return 0; 2648 } 2649 2650 static void be_sgl_destroy_contiguous(struct be_dma_mem *sgl) 2651 { 2652 memset(sgl, 0, sizeof(*sgl)); 2653 } 2654 2655 static void 2656 hwi_build_be_sgl_arr(struct beiscsi_hba *phba, 2657 struct mem_array *pmem, struct be_dma_mem *sgl) 2658 { 2659 if (sgl->va) 2660 be_sgl_destroy_contiguous(sgl); 2661 2662 be_sgl_create_contiguous(pmem->virtual_address, 2663 pmem->bus_address.u.a64.address, 2664 pmem->size, sgl); 2665 } 2666 2667 static void 2668 hwi_build_be_sgl_by_offset(struct beiscsi_hba *phba, 2669 struct mem_array *pmem, struct be_dma_mem *sgl) 2670 { 2671 if (sgl->va) 2672 be_sgl_destroy_contiguous(sgl); 2673 2674 be_sgl_create_contiguous((unsigned char *)pmem->virtual_address, 2675 pmem->bus_address.u.a64.address, 2676 pmem->size, sgl); 2677 } 2678 2679 static int be_fill_queue(struct be_queue_info *q, 2680 u16 len, u16 entry_size, void *vaddress) 2681 { 2682 struct be_dma_mem *mem = &q->dma_mem; 2683 2684 memset(q, 0, sizeof(*q)); 2685 q->len = len; 2686 q->entry_size = entry_size; 2687 mem->size = len * entry_size; 2688 mem->va = vaddress; 2689 if (!mem->va) 2690 return -ENOMEM; 2691 memset(mem->va, 0, mem->size); 2692 return 0; 2693 } 2694 2695 static int beiscsi_create_eqs(struct beiscsi_hba *phba, 2696 struct hwi_context_memory *phwi_context) 2697 { 2698 unsigned int i, num_eq_pages; 2699 int ret, eq_for_mcc; 2700 struct be_queue_info *eq; 2701 struct be_dma_mem *mem; 2702 void *eq_vaddress; 2703 dma_addr_t paddr; 2704 2705 num_eq_pages = PAGES_REQUIRED(phba->params.num_eq_entries * \ 2706 sizeof(struct be_eq_entry)); 2707 2708 if (phba->msix_enabled) 2709 eq_for_mcc = 1; 2710 else 2711 eq_for_mcc = 0; 2712 for (i = 0; i < (phba->num_cpus + eq_for_mcc); i++) { 2713 eq = &phwi_context->be_eq[i].q; 2714 mem = &eq->dma_mem; 2715 phwi_context->be_eq[i].phba = phba; 2716 eq_vaddress = pci_alloc_consistent(phba->pcidev, 2717 num_eq_pages * PAGE_SIZE, 2718 &paddr); 2719 if (!eq_vaddress) 2720 goto create_eq_error; 2721 2722 mem->va = eq_vaddress; 2723 ret = be_fill_queue(eq, phba->params.num_eq_entries, 2724 sizeof(struct be_eq_entry), eq_vaddress); 2725 if (ret) { 2726 shost_printk(KERN_ERR, phba->shost, 2727 "be_fill_queue Failed for EQ\n"); 2728 goto create_eq_error; 2729 } 2730 2731 mem->dma = paddr; 2732 ret = beiscsi_cmd_eq_create(&phba->ctrl, eq, 2733 phwi_context->cur_eqd); 2734 if (ret) { 2735 shost_printk(KERN_ERR, phba->shost, 2736 "beiscsi_cmd_eq_create" 2737 "Failedfor EQ\n"); 2738 goto create_eq_error; 2739 } 2740 SE_DEBUG(DBG_LVL_8, "eqid = %d\n", phwi_context->be_eq[i].q.id); 2741 } 2742 return 0; 2743 create_eq_error: 2744 for (i = 0; i < (phba->num_cpus + 1); i++) { 2745 eq = &phwi_context->be_eq[i].q; 2746 mem = &eq->dma_mem; 2747 if (mem->va) 2748 pci_free_consistent(phba->pcidev, num_eq_pages 2749 * PAGE_SIZE, 2750 mem->va, mem->dma); 2751 } 2752 return ret; 2753 } 2754 2755 static int beiscsi_create_cqs(struct beiscsi_hba *phba, 2756 struct hwi_context_memory *phwi_context) 2757 { 2758 unsigned int i, num_cq_pages; 2759 int ret; 2760 struct be_queue_info *cq, *eq; 2761 struct be_dma_mem *mem; 2762 struct be_eq_obj *pbe_eq; 2763 void *cq_vaddress; 2764 dma_addr_t paddr; 2765 2766 num_cq_pages = PAGES_REQUIRED(phba->params.num_cq_entries * \ 2767 sizeof(struct sol_cqe)); 2768 2769 for (i = 0; i < phba->num_cpus; i++) { 2770 cq = &phwi_context->be_cq[i]; 2771 eq = &phwi_context->be_eq[i].q; 2772 pbe_eq = &phwi_context->be_eq[i]; 2773 pbe_eq->cq = cq; 2774 pbe_eq->phba = phba; 2775 mem = &cq->dma_mem; 2776 cq_vaddress = pci_alloc_consistent(phba->pcidev, 2777 num_cq_pages * PAGE_SIZE, 2778 &paddr); 2779 if (!cq_vaddress) 2780 goto create_cq_error; 2781 ret = be_fill_queue(cq, phba->params.num_cq_entries, 2782 sizeof(struct sol_cqe), cq_vaddress); 2783 if (ret) { 2784 shost_printk(KERN_ERR, phba->shost, 2785 "be_fill_queue Failed for ISCSI CQ\n"); 2786 goto create_cq_error; 2787 } 2788 2789 mem->dma = paddr; 2790 ret = beiscsi_cmd_cq_create(&phba->ctrl, cq, eq, false, 2791 false, 0); 2792 if (ret) { 2793 shost_printk(KERN_ERR, phba->shost, 2794 "beiscsi_cmd_eq_create" 2795 "Failed for ISCSI CQ\n"); 2796 goto create_cq_error; 2797 } 2798 SE_DEBUG(DBG_LVL_8, "iscsi cq_id is %d for eq_id %d\n", 2799 cq->id, eq->id); 2800 SE_DEBUG(DBG_LVL_8, "ISCSI CQ CREATED\n"); 2801 } 2802 return 0; 2803 2804 create_cq_error: 2805 for (i = 0; i < phba->num_cpus; i++) { 2806 cq = &phwi_context->be_cq[i]; 2807 mem = &cq->dma_mem; 2808 if (mem->va) 2809 pci_free_consistent(phba->pcidev, num_cq_pages 2810 * PAGE_SIZE, 2811 mem->va, mem->dma); 2812 } 2813 return ret; 2814 2815 } 2816 2817 static int 2818 beiscsi_create_def_hdr(struct beiscsi_hba *phba, 2819 struct hwi_context_memory *phwi_context, 2820 struct hwi_controller *phwi_ctrlr, 2821 unsigned int def_pdu_ring_sz) 2822 { 2823 unsigned int idx; 2824 int ret; 2825 struct be_queue_info *dq, *cq; 2826 struct be_dma_mem *mem; 2827 struct be_mem_descriptor *mem_descr; 2828 void *dq_vaddress; 2829 2830 idx = 0; 2831 dq = &phwi_context->be_def_hdrq; 2832 cq = &phwi_context->be_cq[0]; 2833 mem = &dq->dma_mem; 2834 mem_descr = phba->init_mem; 2835 mem_descr += HWI_MEM_ASYNC_HEADER_RING; 2836 dq_vaddress = mem_descr->mem_array[idx].virtual_address; 2837 ret = be_fill_queue(dq, mem_descr->mem_array[0].size / 2838 sizeof(struct phys_addr), 2839 sizeof(struct phys_addr), dq_vaddress); 2840 if (ret) { 2841 shost_printk(KERN_ERR, phba->shost, 2842 "be_fill_queue Failed for DEF PDU HDR\n"); 2843 return ret; 2844 } 2845 mem->dma = (unsigned long)mem_descr->mem_array[idx]. 2846 bus_address.u.a64.address; 2847 ret = be_cmd_create_default_pdu_queue(&phba->ctrl, cq, dq, 2848 def_pdu_ring_sz, 2849 phba->params.defpdu_hdr_sz); 2850 if (ret) { 2851 shost_printk(KERN_ERR, phba->shost, 2852 "be_cmd_create_default_pdu_queue Failed DEFHDR\n"); 2853 return ret; 2854 } 2855 phwi_ctrlr->default_pdu_hdr.id = phwi_context->be_def_hdrq.id; 2856 SE_DEBUG(DBG_LVL_8, "iscsi def pdu id is %d\n", 2857 phwi_context->be_def_hdrq.id); 2858 hwi_post_async_buffers(phba, 1); 2859 return 0; 2860 } 2861 2862 static int 2863 beiscsi_create_def_data(struct beiscsi_hba *phba, 2864 struct hwi_context_memory *phwi_context, 2865 struct hwi_controller *phwi_ctrlr, 2866 unsigned int def_pdu_ring_sz) 2867 { 2868 unsigned int idx; 2869 int ret; 2870 struct be_queue_info *dataq, *cq; 2871 struct be_dma_mem *mem; 2872 struct be_mem_descriptor *mem_descr; 2873 void *dq_vaddress; 2874 2875 idx = 0; 2876 dataq = &phwi_context->be_def_dataq; 2877 cq = &phwi_context->be_cq[0]; 2878 mem = &dataq->dma_mem; 2879 mem_descr = phba->init_mem; 2880 mem_descr += HWI_MEM_ASYNC_DATA_RING; 2881 dq_vaddress = mem_descr->mem_array[idx].virtual_address; 2882 ret = be_fill_queue(dataq, mem_descr->mem_array[0].size / 2883 sizeof(struct phys_addr), 2884 sizeof(struct phys_addr), dq_vaddress); 2885 if (ret) { 2886 shost_printk(KERN_ERR, phba->shost, 2887 "be_fill_queue Failed for DEF PDU DATA\n"); 2888 return ret; 2889 } 2890 mem->dma = (unsigned long)mem_descr->mem_array[idx]. 2891 bus_address.u.a64.address; 2892 ret = be_cmd_create_default_pdu_queue(&phba->ctrl, cq, dataq, 2893 def_pdu_ring_sz, 2894 phba->params.defpdu_data_sz); 2895 if (ret) { 2896 shost_printk(KERN_ERR, phba->shost, 2897 "be_cmd_create_default_pdu_queue Failed" 2898 " for DEF PDU DATA\n"); 2899 return ret; 2900 } 2901 phwi_ctrlr->default_pdu_data.id = phwi_context->be_def_dataq.id; 2902 SE_DEBUG(DBG_LVL_8, "iscsi def data id is %d\n", 2903 phwi_context->be_def_dataq.id); 2904 hwi_post_async_buffers(phba, 0); 2905 SE_DEBUG(DBG_LVL_8, "DEFAULT PDU DATA RING CREATED\n"); 2906 return 0; 2907 } 2908 2909 static int 2910 beiscsi_post_pages(struct beiscsi_hba *phba) 2911 { 2912 struct be_mem_descriptor *mem_descr; 2913 struct mem_array *pm_arr; 2914 unsigned int page_offset, i; 2915 struct be_dma_mem sgl; 2916 int status; 2917 2918 mem_descr = phba->init_mem; 2919 mem_descr += HWI_MEM_SGE; 2920 pm_arr = mem_descr->mem_array; 2921 2922 page_offset = (sizeof(struct iscsi_sge) * phba->params.num_sge_per_io * 2923 phba->fw_config.iscsi_icd_start) / PAGE_SIZE; 2924 for (i = 0; i < mem_descr->num_elements; i++) { 2925 hwi_build_be_sgl_arr(phba, pm_arr, &sgl); 2926 status = be_cmd_iscsi_post_sgl_pages(&phba->ctrl, &sgl, 2927 page_offset, 2928 (pm_arr->size / PAGE_SIZE)); 2929 page_offset += pm_arr->size / PAGE_SIZE; 2930 if (status != 0) { 2931 shost_printk(KERN_ERR, phba->shost, 2932 "post sgl failed.\n"); 2933 return status; 2934 } 2935 pm_arr++; 2936 } 2937 SE_DEBUG(DBG_LVL_8, "POSTED PAGES\n"); 2938 return 0; 2939 } 2940 2941 static void be_queue_free(struct beiscsi_hba *phba, struct be_queue_info *q) 2942 { 2943 struct be_dma_mem *mem = &q->dma_mem; 2944 if (mem->va) 2945 pci_free_consistent(phba->pcidev, mem->size, 2946 mem->va, mem->dma); 2947 } 2948 2949 static int be_queue_alloc(struct beiscsi_hba *phba, struct be_queue_info *q, 2950 u16 len, u16 entry_size) 2951 { 2952 struct be_dma_mem *mem = &q->dma_mem; 2953 2954 memset(q, 0, sizeof(*q)); 2955 q->len = len; 2956 q->entry_size = entry_size; 2957 mem->size = len * entry_size; 2958 mem->va = pci_alloc_consistent(phba->pcidev, mem->size, &mem->dma); 2959 if (!mem->va) 2960 return -ENOMEM; 2961 memset(mem->va, 0, mem->size); 2962 return 0; 2963 } 2964 2965 static int 2966 beiscsi_create_wrb_rings(struct beiscsi_hba *phba, 2967 struct hwi_context_memory *phwi_context, 2968 struct hwi_controller *phwi_ctrlr) 2969 { 2970 unsigned int wrb_mem_index, offset, size, num_wrb_rings; 2971 u64 pa_addr_lo; 2972 unsigned int idx, num, i; 2973 struct mem_array *pwrb_arr; 2974 void *wrb_vaddr; 2975 struct be_dma_mem sgl; 2976 struct be_mem_descriptor *mem_descr; 2977 int status; 2978 2979 idx = 0; 2980 mem_descr = phba->init_mem; 2981 mem_descr += HWI_MEM_WRB; 2982 pwrb_arr = kmalloc(sizeof(*pwrb_arr) * phba->params.cxns_per_ctrl, 2983 GFP_KERNEL); 2984 if (!pwrb_arr) { 2985 shost_printk(KERN_ERR, phba->shost, 2986 "Memory alloc failed in create wrb ring.\n"); 2987 return -ENOMEM; 2988 } 2989 wrb_vaddr = mem_descr->mem_array[idx].virtual_address; 2990 pa_addr_lo = mem_descr->mem_array[idx].bus_address.u.a64.address; 2991 num_wrb_rings = mem_descr->mem_array[idx].size / 2992 (phba->params.wrbs_per_cxn * sizeof(struct iscsi_wrb)); 2993 2994 for (num = 0; num < phba->params.cxns_per_ctrl; num++) { 2995 if (num_wrb_rings) { 2996 pwrb_arr[num].virtual_address = wrb_vaddr; 2997 pwrb_arr[num].bus_address.u.a64.address = pa_addr_lo; 2998 pwrb_arr[num].size = phba->params.wrbs_per_cxn * 2999 sizeof(struct iscsi_wrb); 3000 wrb_vaddr += pwrb_arr[num].size; 3001 pa_addr_lo += pwrb_arr[num].size; 3002 num_wrb_rings--; 3003 } else { 3004 idx++; 3005 wrb_vaddr = mem_descr->mem_array[idx].virtual_address; 3006 pa_addr_lo = mem_descr->mem_array[idx].\ 3007 bus_address.u.a64.address; 3008 num_wrb_rings = mem_descr->mem_array[idx].size / 3009 (phba->params.wrbs_per_cxn * 3010 sizeof(struct iscsi_wrb)); 3011 pwrb_arr[num].virtual_address = wrb_vaddr; 3012 pwrb_arr[num].bus_address.u.a64.address\ 3013 = pa_addr_lo; 3014 pwrb_arr[num].size = phba->params.wrbs_per_cxn * 3015 sizeof(struct iscsi_wrb); 3016 wrb_vaddr += pwrb_arr[num].size; 3017 pa_addr_lo += pwrb_arr[num].size; 3018 num_wrb_rings--; 3019 } 3020 } 3021 for (i = 0; i < phba->params.cxns_per_ctrl; i++) { 3022 wrb_mem_index = 0; 3023 offset = 0; 3024 size = 0; 3025 3026 hwi_build_be_sgl_by_offset(phba, &pwrb_arr[i], &sgl); 3027 status = be_cmd_wrbq_create(&phba->ctrl, &sgl, 3028 &phwi_context->be_wrbq[i]); 3029 if (status != 0) { 3030 shost_printk(KERN_ERR, phba->shost, 3031 "wrbq create failed."); 3032 kfree(pwrb_arr); 3033 return status; 3034 } 3035 phwi_ctrlr->wrb_context[i * 2].cid = phwi_context->be_wrbq[i]. 3036 id; 3037 } 3038 kfree(pwrb_arr); 3039 return 0; 3040 } 3041 3042 static void free_wrb_handles(struct beiscsi_hba *phba) 3043 { 3044 unsigned int index; 3045 struct hwi_controller *phwi_ctrlr; 3046 struct hwi_wrb_context *pwrb_context; 3047 3048 phwi_ctrlr = phba->phwi_ctrlr; 3049 for (index = 0; index < phba->params.cxns_per_ctrl * 2; index += 2) { 3050 pwrb_context = &phwi_ctrlr->wrb_context[index]; 3051 kfree(pwrb_context->pwrb_handle_base); 3052 kfree(pwrb_context->pwrb_handle_basestd); 3053 } 3054 } 3055 3056 static void be_mcc_queues_destroy(struct beiscsi_hba *phba) 3057 { 3058 struct be_queue_info *q; 3059 struct be_ctrl_info *ctrl = &phba->ctrl; 3060 3061 q = &phba->ctrl.mcc_obj.q; 3062 if (q->created) 3063 beiscsi_cmd_q_destroy(ctrl, q, QTYPE_MCCQ); 3064 be_queue_free(phba, q); 3065 3066 q = &phba->ctrl.mcc_obj.cq; 3067 if (q->created) 3068 beiscsi_cmd_q_destroy(ctrl, q, QTYPE_CQ); 3069 be_queue_free(phba, q); 3070 } 3071 3072 static void hwi_cleanup(struct beiscsi_hba *phba) 3073 { 3074 struct be_queue_info *q; 3075 struct be_ctrl_info *ctrl = &phba->ctrl; 3076 struct hwi_controller *phwi_ctrlr; 3077 struct hwi_context_memory *phwi_context; 3078 int i, eq_num; 3079 3080 phwi_ctrlr = phba->phwi_ctrlr; 3081 phwi_context = phwi_ctrlr->phwi_ctxt; 3082 for (i = 0; i < phba->params.cxns_per_ctrl; i++) { 3083 q = &phwi_context->be_wrbq[i]; 3084 if (q->created) 3085 beiscsi_cmd_q_destroy(ctrl, q, QTYPE_WRBQ); 3086 } 3087 free_wrb_handles(phba); 3088 3089 q = &phwi_context->be_def_hdrq; 3090 if (q->created) 3091 beiscsi_cmd_q_destroy(ctrl, q, QTYPE_DPDUQ); 3092 3093 q = &phwi_context->be_def_dataq; 3094 if (q->created) 3095 beiscsi_cmd_q_destroy(ctrl, q, QTYPE_DPDUQ); 3096 3097 beiscsi_cmd_q_destroy(ctrl, NULL, QTYPE_SGL); 3098 3099 for (i = 0; i < (phba->num_cpus); i++) { 3100 q = &phwi_context->be_cq[i]; 3101 if (q->created) 3102 beiscsi_cmd_q_destroy(ctrl, q, QTYPE_CQ); 3103 } 3104 if (phba->msix_enabled) 3105 eq_num = 1; 3106 else 3107 eq_num = 0; 3108 for (i = 0; i < (phba->num_cpus + eq_num); i++) { 3109 q = &phwi_context->be_eq[i].q; 3110 if (q->created) 3111 beiscsi_cmd_q_destroy(ctrl, q, QTYPE_EQ); 3112 } 3113 be_mcc_queues_destroy(phba); 3114 } 3115 3116 static int be_mcc_queues_create(struct beiscsi_hba *phba, 3117 struct hwi_context_memory *phwi_context) 3118 { 3119 struct be_queue_info *q, *cq; 3120 struct be_ctrl_info *ctrl = &phba->ctrl; 3121 3122 /* Alloc MCC compl queue */ 3123 cq = &phba->ctrl.mcc_obj.cq; 3124 if (be_queue_alloc(phba, cq, MCC_CQ_LEN, 3125 sizeof(struct be_mcc_compl))) 3126 goto err; 3127 /* Ask BE to create MCC compl queue; */ 3128 if (phba->msix_enabled) { 3129 if (beiscsi_cmd_cq_create(ctrl, cq, &phwi_context->be_eq 3130 [phba->num_cpus].q, false, true, 0)) 3131 goto mcc_cq_free; 3132 } else { 3133 if (beiscsi_cmd_cq_create(ctrl, cq, &phwi_context->be_eq[0].q, 3134 false, true, 0)) 3135 goto mcc_cq_free; 3136 } 3137 3138 /* Alloc MCC queue */ 3139 q = &phba->ctrl.mcc_obj.q; 3140 if (be_queue_alloc(phba, q, MCC_Q_LEN, sizeof(struct be_mcc_wrb))) 3141 goto mcc_cq_destroy; 3142 3143 /* Ask BE to create MCC queue */ 3144 if (beiscsi_cmd_mccq_create(phba, q, cq)) 3145 goto mcc_q_free; 3146 3147 return 0; 3148 3149 mcc_q_free: 3150 be_queue_free(phba, q); 3151 mcc_cq_destroy: 3152 beiscsi_cmd_q_destroy(ctrl, cq, QTYPE_CQ); 3153 mcc_cq_free: 3154 be_queue_free(phba, cq); 3155 err: 3156 return -ENOMEM; 3157 } 3158 3159 static int find_num_cpus(void) 3160 { 3161 int num_cpus = 0; 3162 3163 num_cpus = num_online_cpus(); 3164 if (num_cpus >= MAX_CPUS) 3165 num_cpus = MAX_CPUS - 1; 3166 3167 SE_DEBUG(DBG_LVL_8, "num_cpus = %d\n", num_cpus); 3168 return num_cpus; 3169 } 3170 3171 static int hwi_init_port(struct beiscsi_hba *phba) 3172 { 3173 struct hwi_controller *phwi_ctrlr; 3174 struct hwi_context_memory *phwi_context; 3175 unsigned int def_pdu_ring_sz; 3176 struct be_ctrl_info *ctrl = &phba->ctrl; 3177 int status; 3178 3179 def_pdu_ring_sz = 3180 phba->params.asyncpdus_per_ctrl * sizeof(struct phys_addr); 3181 phwi_ctrlr = phba->phwi_ctrlr; 3182 phwi_context = phwi_ctrlr->phwi_ctxt; 3183 phwi_context->max_eqd = 0; 3184 phwi_context->min_eqd = 0; 3185 phwi_context->cur_eqd = 64; 3186 be_cmd_fw_initialize(&phba->ctrl); 3187 3188 status = beiscsi_create_eqs(phba, phwi_context); 3189 if (status != 0) { 3190 shost_printk(KERN_ERR, phba->shost, "EQ not created\n"); 3191 goto error; 3192 } 3193 3194 status = be_mcc_queues_create(phba, phwi_context); 3195 if (status != 0) 3196 goto error; 3197 3198 status = mgmt_check_supported_fw(ctrl, phba); 3199 if (status != 0) { 3200 shost_printk(KERN_ERR, phba->shost, 3201 "Unsupported fw version\n"); 3202 goto error; 3203 } 3204 3205 status = beiscsi_create_cqs(phba, phwi_context); 3206 if (status != 0) { 3207 shost_printk(KERN_ERR, phba->shost, "CQ not created\n"); 3208 goto error; 3209 } 3210 3211 status = beiscsi_create_def_hdr(phba, phwi_context, phwi_ctrlr, 3212 def_pdu_ring_sz); 3213 if (status != 0) { 3214 shost_printk(KERN_ERR, phba->shost, 3215 "Default Header not created\n"); 3216 goto error; 3217 } 3218 3219 status = beiscsi_create_def_data(phba, phwi_context, 3220 phwi_ctrlr, def_pdu_ring_sz); 3221 if (status != 0) { 3222 shost_printk(KERN_ERR, phba->shost, 3223 "Default Data not created\n"); 3224 goto error; 3225 } 3226 3227 status = beiscsi_post_pages(phba); 3228 if (status != 0) { 3229 shost_printk(KERN_ERR, phba->shost, "Post SGL Pages Failed\n"); 3230 goto error; 3231 } 3232 3233 status = beiscsi_create_wrb_rings(phba, phwi_context, phwi_ctrlr); 3234 if (status != 0) { 3235 shost_printk(KERN_ERR, phba->shost, 3236 "WRB Rings not created\n"); 3237 goto error; 3238 } 3239 3240 SE_DEBUG(DBG_LVL_8, "hwi_init_port success\n"); 3241 return 0; 3242 3243 error: 3244 shost_printk(KERN_ERR, phba->shost, "hwi_init_port failed"); 3245 hwi_cleanup(phba); 3246 return -ENOMEM; 3247 } 3248 3249 static int hwi_init_controller(struct beiscsi_hba *phba) 3250 { 3251 struct hwi_controller *phwi_ctrlr; 3252 3253 phwi_ctrlr = phba->phwi_ctrlr; 3254 if (1 == phba->init_mem[HWI_MEM_ADDN_CONTEXT].num_elements) { 3255 phwi_ctrlr->phwi_ctxt = (struct hwi_context_memory *)phba-> 3256 init_mem[HWI_MEM_ADDN_CONTEXT].mem_array[0].virtual_address; 3257 SE_DEBUG(DBG_LVL_8, " phwi_ctrlr->phwi_ctxt=%p\n", 3258 phwi_ctrlr->phwi_ctxt); 3259 } else { 3260 shost_printk(KERN_ERR, phba->shost, 3261 "HWI_MEM_ADDN_CONTEXT is more than one element." 3262 "Failing to load\n"); 3263 return -ENOMEM; 3264 } 3265 3266 iscsi_init_global_templates(phba); 3267 beiscsi_init_wrb_handle(phba); 3268 hwi_init_async_pdu_ctx(phba); 3269 if (hwi_init_port(phba) != 0) { 3270 shost_printk(KERN_ERR, phba->shost, 3271 "hwi_init_controller failed\n"); 3272 return -ENOMEM; 3273 } 3274 return 0; 3275 } 3276 3277 static void beiscsi_free_mem(struct beiscsi_hba *phba) 3278 { 3279 struct be_mem_descriptor *mem_descr; 3280 int i, j; 3281 3282 mem_descr = phba->init_mem; 3283 i = 0; 3284 j = 0; 3285 for (i = 0; i < SE_MEM_MAX; i++) { 3286 for (j = mem_descr->num_elements; j > 0; j--) { 3287 pci_free_consistent(phba->pcidev, 3288 mem_descr->mem_array[j - 1].size, 3289 mem_descr->mem_array[j - 1].virtual_address, 3290 (unsigned long)mem_descr->mem_array[j - 1]. 3291 bus_address.u.a64.address); 3292 } 3293 kfree(mem_descr->mem_array); 3294 mem_descr++; 3295 } 3296 kfree(phba->init_mem); 3297 kfree(phba->phwi_ctrlr); 3298 } 3299 3300 static int beiscsi_init_controller(struct beiscsi_hba *phba) 3301 { 3302 int ret = -ENOMEM; 3303 3304 ret = beiscsi_get_memory(phba); 3305 if (ret < 0) { 3306 shost_printk(KERN_ERR, phba->shost, "beiscsi_dev_probe -" 3307 "Failed in beiscsi_alloc_memory\n"); 3308 return ret; 3309 } 3310 3311 ret = hwi_init_controller(phba); 3312 if (ret) 3313 goto free_init; 3314 SE_DEBUG(DBG_LVL_8, "Return success from beiscsi_init_controller"); 3315 return 0; 3316 3317 free_init: 3318 beiscsi_free_mem(phba); 3319 return -ENOMEM; 3320 } 3321 3322 static int beiscsi_init_sgl_handle(struct beiscsi_hba *phba) 3323 { 3324 struct be_mem_descriptor *mem_descr_sglh, *mem_descr_sg; 3325 struct sgl_handle *psgl_handle; 3326 struct iscsi_sge *pfrag; 3327 unsigned int arr_index, i, idx; 3328 3329 phba->io_sgl_hndl_avbl = 0; 3330 phba->eh_sgl_hndl_avbl = 0; 3331 3332 mem_descr_sglh = phba->init_mem; 3333 mem_descr_sglh += HWI_MEM_SGLH; 3334 if (1 == mem_descr_sglh->num_elements) { 3335 phba->io_sgl_hndl_base = kzalloc(sizeof(struct sgl_handle *) * 3336 phba->params.ios_per_ctrl, 3337 GFP_KERNEL); 3338 if (!phba->io_sgl_hndl_base) { 3339 shost_printk(KERN_ERR, phba->shost, 3340 "Mem Alloc Failed. Failing to load\n"); 3341 return -ENOMEM; 3342 } 3343 phba->eh_sgl_hndl_base = kzalloc(sizeof(struct sgl_handle *) * 3344 (phba->params.icds_per_ctrl - 3345 phba->params.ios_per_ctrl), 3346 GFP_KERNEL); 3347 if (!phba->eh_sgl_hndl_base) { 3348 kfree(phba->io_sgl_hndl_base); 3349 shost_printk(KERN_ERR, phba->shost, 3350 "Mem Alloc Failed. Failing to load\n"); 3351 return -ENOMEM; 3352 } 3353 } else { 3354 shost_printk(KERN_ERR, phba->shost, 3355 "HWI_MEM_SGLH is more than one element." 3356 "Failing to load\n"); 3357 return -ENOMEM; 3358 } 3359 3360 arr_index = 0; 3361 idx = 0; 3362 while (idx < mem_descr_sglh->num_elements) { 3363 psgl_handle = mem_descr_sglh->mem_array[idx].virtual_address; 3364 3365 for (i = 0; i < (mem_descr_sglh->mem_array[idx].size / 3366 sizeof(struct sgl_handle)); i++) { 3367 if (arr_index < phba->params.ios_per_ctrl) { 3368 phba->io_sgl_hndl_base[arr_index] = psgl_handle; 3369 phba->io_sgl_hndl_avbl++; 3370 arr_index++; 3371 } else { 3372 phba->eh_sgl_hndl_base[arr_index - 3373 phba->params.ios_per_ctrl] = 3374 psgl_handle; 3375 arr_index++; 3376 phba->eh_sgl_hndl_avbl++; 3377 } 3378 psgl_handle++; 3379 } 3380 idx++; 3381 } 3382 SE_DEBUG(DBG_LVL_8, 3383 "phba->io_sgl_hndl_avbl=%d" 3384 "phba->eh_sgl_hndl_avbl=%d\n", 3385 phba->io_sgl_hndl_avbl, 3386 phba->eh_sgl_hndl_avbl); 3387 mem_descr_sg = phba->init_mem; 3388 mem_descr_sg += HWI_MEM_SGE; 3389 SE_DEBUG(DBG_LVL_8, "\n mem_descr_sg->num_elements=%d\n", 3390 mem_descr_sg->num_elements); 3391 arr_index = 0; 3392 idx = 0; 3393 while (idx < mem_descr_sg->num_elements) { 3394 pfrag = mem_descr_sg->mem_array[idx].virtual_address; 3395 3396 for (i = 0; 3397 i < (mem_descr_sg->mem_array[idx].size) / 3398 (sizeof(struct iscsi_sge) * phba->params.num_sge_per_io); 3399 i++) { 3400 if (arr_index < phba->params.ios_per_ctrl) 3401 psgl_handle = phba->io_sgl_hndl_base[arr_index]; 3402 else 3403 psgl_handle = phba->eh_sgl_hndl_base[arr_index - 3404 phba->params.ios_per_ctrl]; 3405 psgl_handle->pfrag = pfrag; 3406 AMAP_SET_BITS(struct amap_iscsi_sge, addr_hi, pfrag, 0); 3407 AMAP_SET_BITS(struct amap_iscsi_sge, addr_lo, pfrag, 0); 3408 pfrag += phba->params.num_sge_per_io; 3409 psgl_handle->sgl_index = 3410 phba->fw_config.iscsi_icd_start + arr_index++; 3411 } 3412 idx++; 3413 } 3414 phba->io_sgl_free_index = 0; 3415 phba->io_sgl_alloc_index = 0; 3416 phba->eh_sgl_free_index = 0; 3417 phba->eh_sgl_alloc_index = 0; 3418 return 0; 3419 } 3420 3421 static int hba_setup_cid_tbls(struct beiscsi_hba *phba) 3422 { 3423 int i, new_cid; 3424 3425 phba->cid_array = kzalloc(sizeof(void *) * phba->params.cxns_per_ctrl, 3426 GFP_KERNEL); 3427 if (!phba->cid_array) { 3428 shost_printk(KERN_ERR, phba->shost, 3429 "Failed to allocate memory in " 3430 "hba_setup_cid_tbls\n"); 3431 return -ENOMEM; 3432 } 3433 phba->ep_array = kzalloc(sizeof(struct iscsi_endpoint *) * 3434 phba->params.cxns_per_ctrl * 2, GFP_KERNEL); 3435 if (!phba->ep_array) { 3436 shost_printk(KERN_ERR, phba->shost, 3437 "Failed to allocate memory in " 3438 "hba_setup_cid_tbls\n"); 3439 kfree(phba->cid_array); 3440 return -ENOMEM; 3441 } 3442 new_cid = phba->fw_config.iscsi_cid_start; 3443 for (i = 0; i < phba->params.cxns_per_ctrl; i++) { 3444 phba->cid_array[i] = new_cid; 3445 new_cid += 2; 3446 } 3447 phba->avlbl_cids = phba->params.cxns_per_ctrl; 3448 return 0; 3449 } 3450 3451 static void hwi_enable_intr(struct beiscsi_hba *phba) 3452 { 3453 struct be_ctrl_info *ctrl = &phba->ctrl; 3454 struct hwi_controller *phwi_ctrlr; 3455 struct hwi_context_memory *phwi_context; 3456 struct be_queue_info *eq; 3457 u8 __iomem *addr; 3458 u32 reg, i; 3459 u32 enabled; 3460 3461 phwi_ctrlr = phba->phwi_ctrlr; 3462 phwi_context = phwi_ctrlr->phwi_ctxt; 3463 3464 addr = (u8 __iomem *) ((u8 __iomem *) ctrl->pcicfg + 3465 PCICFG_MEMBAR_CTRL_INT_CTRL_OFFSET); 3466 reg = ioread32(addr); 3467 SE_DEBUG(DBG_LVL_8, "reg =x%08x\n", reg); 3468 3469 enabled = reg & MEMBAR_CTRL_INT_CTRL_HOSTINTR_MASK; 3470 if (!enabled) { 3471 reg |= MEMBAR_CTRL_INT_CTRL_HOSTINTR_MASK; 3472 SE_DEBUG(DBG_LVL_8, "reg =x%08x addr=%p\n", reg, addr); 3473 iowrite32(reg, addr); 3474 if (!phba->msix_enabled) { 3475 eq = &phwi_context->be_eq[0].q; 3476 SE_DEBUG(DBG_LVL_8, "eq->id=%d\n", eq->id); 3477 hwi_ring_eq_db(phba, eq->id, 0, 0, 1, 1); 3478 } else { 3479 for (i = 0; i <= phba->num_cpus; i++) { 3480 eq = &phwi_context->be_eq[i].q; 3481 SE_DEBUG(DBG_LVL_8, "eq->id=%d\n", eq->id); 3482 hwi_ring_eq_db(phba, eq->id, 0, 0, 1, 1); 3483 } 3484 } 3485 } 3486 } 3487 3488 static void hwi_disable_intr(struct beiscsi_hba *phba) 3489 { 3490 struct be_ctrl_info *ctrl = &phba->ctrl; 3491 3492 u8 __iomem *addr = ctrl->pcicfg + PCICFG_MEMBAR_CTRL_INT_CTRL_OFFSET; 3493 u32 reg = ioread32(addr); 3494 3495 u32 enabled = reg & MEMBAR_CTRL_INT_CTRL_HOSTINTR_MASK; 3496 if (enabled) { 3497 reg &= ~MEMBAR_CTRL_INT_CTRL_HOSTINTR_MASK; 3498 iowrite32(reg, addr); 3499 } else 3500 shost_printk(KERN_WARNING, phba->shost, 3501 "In hwi_disable_intr, Already Disabled\n"); 3502 } 3503 3504 static int beiscsi_get_boot_info(struct beiscsi_hba *phba) 3505 { 3506 struct be_cmd_resp_get_boot_target *boot_resp; 3507 struct be_cmd_resp_get_session *session_resp; 3508 struct be_mcc_wrb *wrb; 3509 struct be_dma_mem nonemb_cmd; 3510 unsigned int tag, wrb_num; 3511 unsigned short status, extd_status; 3512 struct be_queue_info *mccq = &phba->ctrl.mcc_obj.q; 3513 3514 tag = beiscsi_get_boot_target(phba); 3515 if (!tag) { 3516 SE_DEBUG(DBG_LVL_1, "be_cmd_get_mac_addr Failed\n"); 3517 return -EAGAIN; 3518 } else 3519 wait_event_interruptible(phba->ctrl.mcc_wait[tag], 3520 phba->ctrl.mcc_numtag[tag]); 3521 3522 wrb_num = (phba->ctrl.mcc_numtag[tag] & 0x00FF0000) >> 16; 3523 extd_status = (phba->ctrl.mcc_numtag[tag] & 0x0000FF00) >> 8; 3524 status = phba->ctrl.mcc_numtag[tag] & 0x000000FF; 3525 if (status || extd_status) { 3526 SE_DEBUG(DBG_LVL_1, "be_cmd_get_mac_addr Failed" 3527 " status = %d extd_status = %d\n", 3528 status, extd_status); 3529 free_mcc_tag(&phba->ctrl, tag); 3530 return -EBUSY; 3531 } 3532 wrb = queue_get_wrb(mccq, wrb_num); 3533 free_mcc_tag(&phba->ctrl, tag); 3534 boot_resp = embedded_payload(wrb); 3535 3536 if (boot_resp->boot_session_handle < 0) { 3537 printk(KERN_ERR "No Boot Session for this pci_func," 3538 "session Hndl = %d\n", boot_resp->boot_session_handle); 3539 return -ENXIO; 3540 } 3541 3542 nonemb_cmd.va = pci_alloc_consistent(phba->ctrl.pdev, 3543 sizeof(*session_resp), 3544 &nonemb_cmd.dma); 3545 if (nonemb_cmd.va == NULL) { 3546 SE_DEBUG(DBG_LVL_1, 3547 "Failed to allocate memory for" 3548 "beiscsi_get_session_info\n"); 3549 return -ENOMEM; 3550 } 3551 3552 memset(nonemb_cmd.va, 0, sizeof(*session_resp)); 3553 tag = beiscsi_get_session_info(phba, 3554 boot_resp->boot_session_handle, &nonemb_cmd); 3555 if (!tag) { 3556 SE_DEBUG(DBG_LVL_1, "beiscsi_get_session_info" 3557 " Failed\n"); 3558 goto boot_freemem; 3559 } else 3560 wait_event_interruptible(phba->ctrl.mcc_wait[tag], 3561 phba->ctrl.mcc_numtag[tag]); 3562 3563 wrb_num = (phba->ctrl.mcc_numtag[tag] & 0x00FF0000) >> 16; 3564 extd_status = (phba->ctrl.mcc_numtag[tag] & 0x0000FF00) >> 8; 3565 status = phba->ctrl.mcc_numtag[tag] & 0x000000FF; 3566 if (status || extd_status) { 3567 SE_DEBUG(DBG_LVL_1, "beiscsi_get_session_info Failed" 3568 " status = %d extd_status = %d\n", 3569 status, extd_status); 3570 free_mcc_tag(&phba->ctrl, tag); 3571 goto boot_freemem; 3572 } 3573 wrb = queue_get_wrb(mccq, wrb_num); 3574 free_mcc_tag(&phba->ctrl, tag); 3575 session_resp = nonemb_cmd.va ; 3576 memcpy(&phba->boot_sess, &session_resp->session_info, 3577 sizeof(struct mgmt_session_info)); 3578 pci_free_consistent(phba->ctrl.pdev, nonemb_cmd.size, 3579 nonemb_cmd.va, nonemb_cmd.dma); 3580 return 0; 3581 boot_freemem: 3582 pci_free_consistent(phba->ctrl.pdev, nonemb_cmd.size, 3583 nonemb_cmd.va, nonemb_cmd.dma); 3584 return -ENOMEM; 3585 } 3586 3587 static int beiscsi_init_port(struct beiscsi_hba *phba) 3588 { 3589 int ret; 3590 3591 ret = beiscsi_init_controller(phba); 3592 if (ret < 0) { 3593 shost_printk(KERN_ERR, phba->shost, 3594 "beiscsi_dev_probe - Failed in" 3595 "beiscsi_init_controller\n"); 3596 return ret; 3597 } 3598 ret = beiscsi_init_sgl_handle(phba); 3599 if (ret < 0) { 3600 shost_printk(KERN_ERR, phba->shost, 3601 "beiscsi_dev_probe - Failed in" 3602 "beiscsi_init_sgl_handle\n"); 3603 goto do_cleanup_ctrlr; 3604 } 3605 3606 if (hba_setup_cid_tbls(phba)) { 3607 shost_printk(KERN_ERR, phba->shost, 3608 "Failed in hba_setup_cid_tbls\n"); 3609 kfree(phba->io_sgl_hndl_base); 3610 kfree(phba->eh_sgl_hndl_base); 3611 goto do_cleanup_ctrlr; 3612 } 3613 3614 return ret; 3615 3616 do_cleanup_ctrlr: 3617 hwi_cleanup(phba); 3618 return ret; 3619 } 3620 3621 static void hwi_purge_eq(struct beiscsi_hba *phba) 3622 { 3623 struct hwi_controller *phwi_ctrlr; 3624 struct hwi_context_memory *phwi_context; 3625 struct be_queue_info *eq; 3626 struct be_eq_entry *eqe = NULL; 3627 int i, eq_msix; 3628 unsigned int num_processed; 3629 3630 phwi_ctrlr = phba->phwi_ctrlr; 3631 phwi_context = phwi_ctrlr->phwi_ctxt; 3632 if (phba->msix_enabled) 3633 eq_msix = 1; 3634 else 3635 eq_msix = 0; 3636 3637 for (i = 0; i < (phba->num_cpus + eq_msix); i++) { 3638 eq = &phwi_context->be_eq[i].q; 3639 eqe = queue_tail_node(eq); 3640 num_processed = 0; 3641 while (eqe->dw[offsetof(struct amap_eq_entry, valid) / 32] 3642 & EQE_VALID_MASK) { 3643 AMAP_SET_BITS(struct amap_eq_entry, valid, eqe, 0); 3644 queue_tail_inc(eq); 3645 eqe = queue_tail_node(eq); 3646 num_processed++; 3647 } 3648 3649 if (num_processed) 3650 hwi_ring_eq_db(phba, eq->id, 1, num_processed, 1, 1); 3651 } 3652 } 3653 3654 static void beiscsi_clean_port(struct beiscsi_hba *phba) 3655 { 3656 int mgmt_status; 3657 3658 mgmt_status = mgmt_epfw_cleanup(phba, CMD_CONNECTION_CHUTE_0); 3659 if (mgmt_status) 3660 shost_printk(KERN_WARNING, phba->shost, 3661 "mgmt_epfw_cleanup FAILED\n"); 3662 3663 hwi_purge_eq(phba); 3664 hwi_cleanup(phba); 3665 kfree(phba->io_sgl_hndl_base); 3666 kfree(phba->eh_sgl_hndl_base); 3667 kfree(phba->cid_array); 3668 kfree(phba->ep_array); 3669 } 3670 3671 void 3672 beiscsi_offload_connection(struct beiscsi_conn *beiscsi_conn, 3673 struct beiscsi_offload_params *params) 3674 { 3675 struct wrb_handle *pwrb_handle; 3676 struct iscsi_target_context_update_wrb *pwrb = NULL; 3677 struct be_mem_descriptor *mem_descr; 3678 struct beiscsi_hba *phba = beiscsi_conn->phba; 3679 u32 doorbell = 0; 3680 3681 /* 3682 * We can always use 0 here because it is reserved by libiscsi for 3683 * login/startup related tasks. 3684 */ 3685 pwrb_handle = alloc_wrb_handle(phba, (beiscsi_conn->beiscsi_conn_cid - 3686 phba->fw_config.iscsi_cid_start)); 3687 pwrb = (struct iscsi_target_context_update_wrb *)pwrb_handle->pwrb; 3688 memset(pwrb, 0, sizeof(*pwrb)); 3689 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, 3690 max_burst_length, pwrb, params->dw[offsetof 3691 (struct amap_beiscsi_offload_params, 3692 max_burst_length) / 32]); 3693 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, 3694 max_send_data_segment_length, pwrb, 3695 params->dw[offsetof(struct amap_beiscsi_offload_params, 3696 max_send_data_segment_length) / 32]); 3697 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, 3698 first_burst_length, 3699 pwrb, 3700 params->dw[offsetof(struct amap_beiscsi_offload_params, 3701 first_burst_length) / 32]); 3702 3703 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, erl, pwrb, 3704 (params->dw[offsetof(struct amap_beiscsi_offload_params, 3705 erl) / 32] & OFFLD_PARAMS_ERL)); 3706 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, dde, pwrb, 3707 (params->dw[offsetof(struct amap_beiscsi_offload_params, 3708 dde) / 32] & OFFLD_PARAMS_DDE) >> 2); 3709 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, hde, pwrb, 3710 (params->dw[offsetof(struct amap_beiscsi_offload_params, 3711 hde) / 32] & OFFLD_PARAMS_HDE) >> 3); 3712 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, ir2t, pwrb, 3713 (params->dw[offsetof(struct amap_beiscsi_offload_params, 3714 ir2t) / 32] & OFFLD_PARAMS_IR2T) >> 4); 3715 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, imd, pwrb, 3716 (params->dw[offsetof(struct amap_beiscsi_offload_params, 3717 imd) / 32] & OFFLD_PARAMS_IMD) >> 5); 3718 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, stat_sn, 3719 pwrb, 3720 (params->dw[offsetof(struct amap_beiscsi_offload_params, 3721 exp_statsn) / 32] + 1)); 3722 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, type, pwrb, 3723 0x7); 3724 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, wrb_idx, 3725 pwrb, pwrb_handle->wrb_index); 3726 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, ptr2nextwrb, 3727 pwrb, pwrb_handle->nxt_wrb_index); 3728 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, 3729 session_state, pwrb, 0); 3730 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, compltonack, 3731 pwrb, 1); 3732 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, notpredblq, 3733 pwrb, 0); 3734 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, mode, pwrb, 3735 0); 3736 3737 mem_descr = phba->init_mem; 3738 mem_descr += ISCSI_MEM_GLOBAL_HEADER; 3739 3740 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, 3741 pad_buffer_addr_hi, pwrb, 3742 mem_descr->mem_array[0].bus_address.u.a32.address_hi); 3743 AMAP_SET_BITS(struct amap_iscsi_target_context_update_wrb, 3744 pad_buffer_addr_lo, pwrb, 3745 mem_descr->mem_array[0].bus_address.u.a32.address_lo); 3746 3747 be_dws_le_to_cpu(pwrb, sizeof(struct iscsi_target_context_update_wrb)); 3748 3749 doorbell |= beiscsi_conn->beiscsi_conn_cid & DB_WRB_POST_CID_MASK; 3750 doorbell |= (pwrb_handle->wrb_index & DB_DEF_PDU_WRB_INDEX_MASK) 3751 << DB_DEF_PDU_WRB_INDEX_SHIFT; 3752 doorbell |= 1 << DB_DEF_PDU_NUM_POSTED_SHIFT; 3753 3754 iowrite32(doorbell, phba->db_va + DB_TXULP0_OFFSET); 3755 } 3756 3757 static void beiscsi_parse_pdu(struct iscsi_conn *conn, itt_t itt, 3758 int *index, int *age) 3759 { 3760 *index = (int)itt; 3761 if (age) 3762 *age = conn->session->age; 3763 } 3764 3765 /** 3766 * beiscsi_alloc_pdu - allocates pdu and related resources 3767 * @task: libiscsi task 3768 * @opcode: opcode of pdu for task 3769 * 3770 * This is called with the session lock held. It will allocate 3771 * the wrb and sgl if needed for the command. And it will prep 3772 * the pdu's itt. beiscsi_parse_pdu will later translate 3773 * the pdu itt to the libiscsi task itt. 3774 */ 3775 static int beiscsi_alloc_pdu(struct iscsi_task *task, uint8_t opcode) 3776 { 3777 struct beiscsi_io_task *io_task = task->dd_data; 3778 struct iscsi_conn *conn = task->conn; 3779 struct beiscsi_conn *beiscsi_conn = conn->dd_data; 3780 struct beiscsi_hba *phba = beiscsi_conn->phba; 3781 struct hwi_wrb_context *pwrb_context; 3782 struct hwi_controller *phwi_ctrlr; 3783 itt_t itt; 3784 struct beiscsi_session *beiscsi_sess = beiscsi_conn->beiscsi_sess; 3785 dma_addr_t paddr; 3786 3787 io_task->cmd_bhs = pci_pool_alloc(beiscsi_sess->bhs_pool, 3788 GFP_KERNEL, &paddr); 3789 if (!io_task->cmd_bhs) 3790 return -ENOMEM; 3791 io_task->bhs_pa.u.a64.address = paddr; 3792 io_task->libiscsi_itt = (itt_t)task->itt; 3793 io_task->conn = beiscsi_conn; 3794 3795 task->hdr = (struct iscsi_hdr *)&io_task->cmd_bhs->iscsi_hdr; 3796 task->hdr_max = sizeof(struct be_cmd_bhs); 3797 io_task->psgl_handle = NULL; 3798 io_task->psgl_handle = NULL; 3799 3800 if (task->sc) { 3801 spin_lock(&phba->io_sgl_lock); 3802 io_task->psgl_handle = alloc_io_sgl_handle(phba); 3803 spin_unlock(&phba->io_sgl_lock); 3804 if (!io_task->psgl_handle) 3805 goto free_hndls; 3806 io_task->pwrb_handle = alloc_wrb_handle(phba, 3807 beiscsi_conn->beiscsi_conn_cid - 3808 phba->fw_config.iscsi_cid_start); 3809 if (!io_task->pwrb_handle) 3810 goto free_io_hndls; 3811 } else { 3812 io_task->scsi_cmnd = NULL; 3813 if ((opcode & ISCSI_OPCODE_MASK) == ISCSI_OP_LOGIN) { 3814 if (!beiscsi_conn->login_in_progress) { 3815 spin_lock(&phba->mgmt_sgl_lock); 3816 io_task->psgl_handle = (struct sgl_handle *) 3817 alloc_mgmt_sgl_handle(phba); 3818 spin_unlock(&phba->mgmt_sgl_lock); 3819 if (!io_task->psgl_handle) 3820 goto free_hndls; 3821 3822 beiscsi_conn->login_in_progress = 1; 3823 beiscsi_conn->plogin_sgl_handle = 3824 io_task->psgl_handle; 3825 io_task->pwrb_handle = 3826 alloc_wrb_handle(phba, 3827 beiscsi_conn->beiscsi_conn_cid - 3828 phba->fw_config.iscsi_cid_start); 3829 if (!io_task->pwrb_handle) 3830 goto free_io_hndls; 3831 beiscsi_conn->plogin_wrb_handle = 3832 io_task->pwrb_handle; 3833 3834 } else { 3835 io_task->psgl_handle = 3836 beiscsi_conn->plogin_sgl_handle; 3837 io_task->pwrb_handle = 3838 beiscsi_conn->plogin_wrb_handle; 3839 } 3840 } else { 3841 spin_lock(&phba->mgmt_sgl_lock); 3842 io_task->psgl_handle = alloc_mgmt_sgl_handle(phba); 3843 spin_unlock(&phba->mgmt_sgl_lock); 3844 if (!io_task->psgl_handle) 3845 goto free_hndls; 3846 io_task->pwrb_handle = 3847 alloc_wrb_handle(phba, 3848 beiscsi_conn->beiscsi_conn_cid - 3849 phba->fw_config.iscsi_cid_start); 3850 if (!io_task->pwrb_handle) 3851 goto free_mgmt_hndls; 3852 3853 } 3854 } 3855 itt = (itt_t) cpu_to_be32(((unsigned int)io_task->pwrb_handle-> 3856 wrb_index << 16) | (unsigned int) 3857 (io_task->psgl_handle->sgl_index)); 3858 io_task->pwrb_handle->pio_handle = task; 3859 3860 io_task->cmd_bhs->iscsi_hdr.itt = itt; 3861 return 0; 3862 3863 free_io_hndls: 3864 spin_lock(&phba->io_sgl_lock); 3865 free_io_sgl_handle(phba, io_task->psgl_handle); 3866 spin_unlock(&phba->io_sgl_lock); 3867 goto free_hndls; 3868 free_mgmt_hndls: 3869 spin_lock(&phba->mgmt_sgl_lock); 3870 free_mgmt_sgl_handle(phba, io_task->psgl_handle); 3871 spin_unlock(&phba->mgmt_sgl_lock); 3872 free_hndls: 3873 phwi_ctrlr = phba->phwi_ctrlr; 3874 pwrb_context = &phwi_ctrlr->wrb_context[ 3875 beiscsi_conn->beiscsi_conn_cid - 3876 phba->fw_config.iscsi_cid_start]; 3877 if (io_task->pwrb_handle) 3878 free_wrb_handle(phba, pwrb_context, io_task->pwrb_handle); 3879 io_task->pwrb_handle = NULL; 3880 pci_pool_free(beiscsi_sess->bhs_pool, io_task->cmd_bhs, 3881 io_task->bhs_pa.u.a64.address); 3882 SE_DEBUG(DBG_LVL_1, "Alloc of SGL_ICD Failed\n"); 3883 return -ENOMEM; 3884 } 3885 3886 static void beiscsi_cleanup_task(struct iscsi_task *task) 3887 { 3888 struct beiscsi_io_task *io_task = task->dd_data; 3889 struct iscsi_conn *conn = task->conn; 3890 struct beiscsi_conn *beiscsi_conn = conn->dd_data; 3891 struct beiscsi_hba *phba = beiscsi_conn->phba; 3892 struct beiscsi_session *beiscsi_sess = beiscsi_conn->beiscsi_sess; 3893 struct hwi_wrb_context *pwrb_context; 3894 struct hwi_controller *phwi_ctrlr; 3895 3896 phwi_ctrlr = phba->phwi_ctrlr; 3897 pwrb_context = &phwi_ctrlr->wrb_context[beiscsi_conn->beiscsi_conn_cid 3898 - phba->fw_config.iscsi_cid_start]; 3899 if (io_task->pwrb_handle) { 3900 free_wrb_handle(phba, pwrb_context, io_task->pwrb_handle); 3901 io_task->pwrb_handle = NULL; 3902 } 3903 3904 if (io_task->cmd_bhs) { 3905 pci_pool_free(beiscsi_sess->bhs_pool, io_task->cmd_bhs, 3906 io_task->bhs_pa.u.a64.address); 3907 } 3908 3909 if (task->sc) { 3910 if (io_task->psgl_handle) { 3911 spin_lock(&phba->io_sgl_lock); 3912 free_io_sgl_handle(phba, io_task->psgl_handle); 3913 spin_unlock(&phba->io_sgl_lock); 3914 io_task->psgl_handle = NULL; 3915 } 3916 } else { 3917 if ((task->hdr->opcode & ISCSI_OPCODE_MASK) == ISCSI_OP_LOGIN) 3918 return; 3919 if (io_task->psgl_handle) { 3920 spin_lock(&phba->mgmt_sgl_lock); 3921 free_mgmt_sgl_handle(phba, io_task->psgl_handle); 3922 spin_unlock(&phba->mgmt_sgl_lock); 3923 io_task->psgl_handle = NULL; 3924 } 3925 } 3926 } 3927 3928 static int beiscsi_iotask(struct iscsi_task *task, struct scatterlist *sg, 3929 unsigned int num_sg, unsigned int xferlen, 3930 unsigned int writedir) 3931 { 3932 3933 struct beiscsi_io_task *io_task = task->dd_data; 3934 struct iscsi_conn *conn = task->conn; 3935 struct beiscsi_conn *beiscsi_conn = conn->dd_data; 3936 struct beiscsi_hba *phba = beiscsi_conn->phba; 3937 struct iscsi_wrb *pwrb = NULL; 3938 unsigned int doorbell = 0; 3939 3940 pwrb = io_task->pwrb_handle->pwrb; 3941 io_task->cmd_bhs->iscsi_hdr.exp_statsn = 0; 3942 io_task->bhs_len = sizeof(struct be_cmd_bhs); 3943 3944 if (writedir) { 3945 memset(&io_task->cmd_bhs->iscsi_data_pdu, 0, 48); 3946 AMAP_SET_BITS(struct amap_pdu_data_out, itt, 3947 &io_task->cmd_bhs->iscsi_data_pdu, 3948 (unsigned int)io_task->cmd_bhs->iscsi_hdr.itt); 3949 AMAP_SET_BITS(struct amap_pdu_data_out, opcode, 3950 &io_task->cmd_bhs->iscsi_data_pdu, 3951 ISCSI_OPCODE_SCSI_DATA_OUT); 3952 AMAP_SET_BITS(struct amap_pdu_data_out, final_bit, 3953 &io_task->cmd_bhs->iscsi_data_pdu, 1); 3954 AMAP_SET_BITS(struct amap_iscsi_wrb, type, pwrb, 3955 INI_WR_CMD); 3956 AMAP_SET_BITS(struct amap_iscsi_wrb, dsp, pwrb, 1); 3957 } else { 3958 AMAP_SET_BITS(struct amap_iscsi_wrb, type, pwrb, 3959 INI_RD_CMD); 3960 AMAP_SET_BITS(struct amap_iscsi_wrb, dsp, pwrb, 0); 3961 } 3962 memcpy(&io_task->cmd_bhs->iscsi_data_pdu. 3963 dw[offsetof(struct amap_pdu_data_out, lun) / 32], 3964 io_task->cmd_bhs->iscsi_hdr.lun, sizeof(struct scsi_lun)); 3965 3966 AMAP_SET_BITS(struct amap_iscsi_wrb, lun, pwrb, 3967 cpu_to_be16((unsigned short)io_task->cmd_bhs->iscsi_hdr. 3968 lun[0])); 3969 AMAP_SET_BITS(struct amap_iscsi_wrb, r2t_exp_dtl, pwrb, xferlen); 3970 AMAP_SET_BITS(struct amap_iscsi_wrb, wrb_idx, pwrb, 3971 io_task->pwrb_handle->wrb_index); 3972 AMAP_SET_BITS(struct amap_iscsi_wrb, cmdsn_itt, pwrb, 3973 be32_to_cpu(task->cmdsn)); 3974 AMAP_SET_BITS(struct amap_iscsi_wrb, sgl_icd_idx, pwrb, 3975 io_task->psgl_handle->sgl_index); 3976 3977 hwi_write_sgl(pwrb, sg, num_sg, io_task); 3978 3979 AMAP_SET_BITS(struct amap_iscsi_wrb, ptr2nextwrb, pwrb, 3980 io_task->pwrb_handle->nxt_wrb_index); 3981 be_dws_le_to_cpu(pwrb, sizeof(struct iscsi_wrb)); 3982 3983 doorbell |= beiscsi_conn->beiscsi_conn_cid & DB_WRB_POST_CID_MASK; 3984 doorbell |= (io_task->pwrb_handle->wrb_index & 3985 DB_DEF_PDU_WRB_INDEX_MASK) << DB_DEF_PDU_WRB_INDEX_SHIFT; 3986 doorbell |= 1 << DB_DEF_PDU_NUM_POSTED_SHIFT; 3987 3988 iowrite32(doorbell, phba->db_va + DB_TXULP0_OFFSET); 3989 return 0; 3990 } 3991 3992 static int beiscsi_mtask(struct iscsi_task *task) 3993 { 3994 struct beiscsi_io_task *io_task = task->dd_data; 3995 struct iscsi_conn *conn = task->conn; 3996 struct beiscsi_conn *beiscsi_conn = conn->dd_data; 3997 struct beiscsi_hba *phba = beiscsi_conn->phba; 3998 struct iscsi_wrb *pwrb = NULL; 3999 unsigned int doorbell = 0; 4000 unsigned int cid; 4001 4002 cid = beiscsi_conn->beiscsi_conn_cid; 4003 pwrb = io_task->pwrb_handle->pwrb; 4004 memset(pwrb, 0, sizeof(*pwrb)); 4005 AMAP_SET_BITS(struct amap_iscsi_wrb, cmdsn_itt, pwrb, 4006 be32_to_cpu(task->cmdsn)); 4007 AMAP_SET_BITS(struct amap_iscsi_wrb, wrb_idx, pwrb, 4008 io_task->pwrb_handle->wrb_index); 4009 AMAP_SET_BITS(struct amap_iscsi_wrb, sgl_icd_idx, pwrb, 4010 io_task->psgl_handle->sgl_index); 4011 4012 switch (task->hdr->opcode & ISCSI_OPCODE_MASK) { 4013 case ISCSI_OP_LOGIN: 4014 AMAP_SET_BITS(struct amap_iscsi_wrb, type, pwrb, 4015 TGT_DM_CMD); 4016 AMAP_SET_BITS(struct amap_iscsi_wrb, dmsg, pwrb, 0); 4017 AMAP_SET_BITS(struct amap_iscsi_wrb, cmdsn_itt, pwrb, 1); 4018 hwi_write_buffer(pwrb, task); 4019 break; 4020 case ISCSI_OP_NOOP_OUT: 4021 AMAP_SET_BITS(struct amap_iscsi_wrb, type, pwrb, 4022 INI_RD_CMD); 4023 if (task->hdr->ttt == ISCSI_RESERVED_TAG) 4024 AMAP_SET_BITS(struct amap_iscsi_wrb, dmsg, pwrb, 0); 4025 else 4026 AMAP_SET_BITS(struct amap_iscsi_wrb, dmsg, pwrb, 1); 4027 hwi_write_buffer(pwrb, task); 4028 break; 4029 case ISCSI_OP_TEXT: 4030 AMAP_SET_BITS(struct amap_iscsi_wrb, type, pwrb, 4031 TGT_DM_CMD); 4032 AMAP_SET_BITS(struct amap_iscsi_wrb, dmsg, pwrb, 0); 4033 hwi_write_buffer(pwrb, task); 4034 break; 4035 case ISCSI_OP_SCSI_TMFUNC: 4036 AMAP_SET_BITS(struct amap_iscsi_wrb, type, pwrb, 4037 INI_TMF_CMD); 4038 AMAP_SET_BITS(struct amap_iscsi_wrb, dmsg, pwrb, 0); 4039 hwi_write_buffer(pwrb, task); 4040 break; 4041 case ISCSI_OP_LOGOUT: 4042 AMAP_SET_BITS(struct amap_iscsi_wrb, dmsg, pwrb, 0); 4043 AMAP_SET_BITS(struct amap_iscsi_wrb, type, pwrb, 4044 HWH_TYPE_LOGOUT); 4045 hwi_write_buffer(pwrb, task); 4046 break; 4047 4048 default: 4049 SE_DEBUG(DBG_LVL_1, "opcode =%d Not supported\n", 4050 task->hdr->opcode & ISCSI_OPCODE_MASK); 4051 return -EINVAL; 4052 } 4053 4054 AMAP_SET_BITS(struct amap_iscsi_wrb, r2t_exp_dtl, pwrb, 4055 task->data_count); 4056 AMAP_SET_BITS(struct amap_iscsi_wrb, ptr2nextwrb, pwrb, 4057 io_task->pwrb_handle->nxt_wrb_index); 4058 be_dws_le_to_cpu(pwrb, sizeof(struct iscsi_wrb)); 4059 4060 doorbell |= cid & DB_WRB_POST_CID_MASK; 4061 doorbell |= (io_task->pwrb_handle->wrb_index & 4062 DB_DEF_PDU_WRB_INDEX_MASK) << DB_DEF_PDU_WRB_INDEX_SHIFT; 4063 doorbell |= 1 << DB_DEF_PDU_NUM_POSTED_SHIFT; 4064 iowrite32(doorbell, phba->db_va + DB_TXULP0_OFFSET); 4065 return 0; 4066 } 4067 4068 static int beiscsi_task_xmit(struct iscsi_task *task) 4069 { 4070 struct beiscsi_io_task *io_task = task->dd_data; 4071 struct scsi_cmnd *sc = task->sc; 4072 struct scatterlist *sg; 4073 int num_sg; 4074 unsigned int writedir = 0, xferlen = 0; 4075 4076 if (!sc) 4077 return beiscsi_mtask(task); 4078 4079 io_task->scsi_cmnd = sc; 4080 num_sg = scsi_dma_map(sc); 4081 if (num_sg < 0) { 4082 SE_DEBUG(DBG_LVL_1, " scsi_dma_map Failed\n") 4083 return num_sg; 4084 } 4085 xferlen = scsi_bufflen(sc); 4086 sg = scsi_sglist(sc); 4087 if (sc->sc_data_direction == DMA_TO_DEVICE) { 4088 writedir = 1; 4089 SE_DEBUG(DBG_LVL_4, "task->imm_count=0x%08x\n", 4090 task->imm_count); 4091 } else 4092 writedir = 0; 4093 return beiscsi_iotask(task, sg, num_sg, xferlen, writedir); 4094 } 4095 4096 static void beiscsi_remove(struct pci_dev *pcidev) 4097 { 4098 struct beiscsi_hba *phba = NULL; 4099 struct hwi_controller *phwi_ctrlr; 4100 struct hwi_context_memory *phwi_context; 4101 struct be_eq_obj *pbe_eq; 4102 unsigned int i, msix_vec; 4103 u8 *real_offset = 0; 4104 u32 value = 0; 4105 4106 phba = (struct beiscsi_hba *)pci_get_drvdata(pcidev); 4107 if (!phba) { 4108 dev_err(&pcidev->dev, "beiscsi_remove called with no phba\n"); 4109 return; 4110 } 4111 4112 phwi_ctrlr = phba->phwi_ctrlr; 4113 phwi_context = phwi_ctrlr->phwi_ctxt; 4114 hwi_disable_intr(phba); 4115 if (phba->msix_enabled) { 4116 for (i = 0; i <= phba->num_cpus; i++) { 4117 msix_vec = phba->msix_entries[i].vector; 4118 free_irq(msix_vec, &phwi_context->be_eq[i]); 4119 } 4120 } else 4121 if (phba->pcidev->irq) 4122 free_irq(phba->pcidev->irq, phba); 4123 pci_disable_msix(phba->pcidev); 4124 destroy_workqueue(phba->wq); 4125 if (blk_iopoll_enabled) 4126 for (i = 0; i < phba->num_cpus; i++) { 4127 pbe_eq = &phwi_context->be_eq[i]; 4128 blk_iopoll_disable(&pbe_eq->iopoll); 4129 } 4130 4131 beiscsi_clean_port(phba); 4132 beiscsi_free_mem(phba); 4133 real_offset = (u8 *)phba->csr_va + MPU_EP_SEMAPHORE; 4134 4135 value = readl((void *)real_offset); 4136 4137 if (value & 0x00010000) { 4138 value &= 0xfffeffff; 4139 writel(value, (void *)real_offset); 4140 } 4141 beiscsi_unmap_pci_function(phba); 4142 pci_free_consistent(phba->pcidev, 4143 phba->ctrl.mbox_mem_alloced.size, 4144 phba->ctrl.mbox_mem_alloced.va, 4145 phba->ctrl.mbox_mem_alloced.dma); 4146 iscsi_host_remove(phba->shost); 4147 pci_dev_put(phba->pcidev); 4148 iscsi_host_free(phba->shost); 4149 iscsi_boot_destroy_kset(phba->boot_kset); 4150 } 4151 4152 static void beiscsi_msix_enable(struct beiscsi_hba *phba) 4153 { 4154 int i, status; 4155 4156 for (i = 0; i <= phba->num_cpus; i++) 4157 phba->msix_entries[i].entry = i; 4158 4159 status = pci_enable_msix(phba->pcidev, phba->msix_entries, 4160 (phba->num_cpus + 1)); 4161 if (!status) 4162 phba->msix_enabled = true; 4163 4164 return; 4165 } 4166 4167 static int __devinit beiscsi_dev_probe(struct pci_dev *pcidev, 4168 const struct pci_device_id *id) 4169 { 4170 struct beiscsi_hba *phba = NULL; 4171 struct hwi_controller *phwi_ctrlr; 4172 struct hwi_context_memory *phwi_context; 4173 struct be_eq_obj *pbe_eq; 4174 int ret, num_cpus, i; 4175 u8 *real_offset = 0; 4176 u32 value = 0; 4177 4178 ret = beiscsi_enable_pci(pcidev); 4179 if (ret < 0) { 4180 dev_err(&pcidev->dev, "beiscsi_dev_probe-" 4181 " Failed to enable pci device\n"); 4182 return ret; 4183 } 4184 4185 phba = beiscsi_hba_alloc(pcidev); 4186 if (!phba) { 4187 dev_err(&pcidev->dev, "beiscsi_dev_probe-" 4188 " Failed in beiscsi_hba_alloc\n"); 4189 goto disable_pci; 4190 } 4191 4192 switch (pcidev->device) { 4193 case BE_DEVICE_ID1: 4194 case OC_DEVICE_ID1: 4195 case OC_DEVICE_ID2: 4196 phba->generation = BE_GEN2; 4197 break; 4198 case BE_DEVICE_ID2: 4199 case OC_DEVICE_ID3: 4200 phba->generation = BE_GEN3; 4201 break; 4202 default: 4203 phba->generation = 0; 4204 } 4205 4206 if (enable_msix) 4207 num_cpus = find_num_cpus(); 4208 else 4209 num_cpus = 1; 4210 phba->num_cpus = num_cpus; 4211 SE_DEBUG(DBG_LVL_8, "num_cpus = %d\n", phba->num_cpus); 4212 4213 if (enable_msix) 4214 beiscsi_msix_enable(phba); 4215 ret = be_ctrl_init(phba, pcidev); 4216 if (ret) { 4217 shost_printk(KERN_ERR, phba->shost, "beiscsi_dev_probe-" 4218 "Failed in be_ctrl_init\n"); 4219 goto hba_free; 4220 } 4221 4222 if (!num_hba) { 4223 real_offset = (u8 *)phba->csr_va + MPU_EP_SEMAPHORE; 4224 value = readl((void *)real_offset); 4225 if (value & 0x00010000) { 4226 gcrashmode++; 4227 shost_printk(KERN_ERR, phba->shost, 4228 "Loading Driver in crashdump mode\n"); 4229 ret = beiscsi_pci_soft_reset(phba); 4230 if (ret) { 4231 shost_printk(KERN_ERR, phba->shost, 4232 "Reset Failed. Aborting Crashdump\n"); 4233 goto hba_free; 4234 } 4235 ret = be_chk_reset_complete(phba); 4236 if (ret) { 4237 shost_printk(KERN_ERR, phba->shost, 4238 "Failed to get out of reset." 4239 "Aborting Crashdump\n"); 4240 goto hba_free; 4241 } 4242 } else { 4243 value |= 0x00010000; 4244 writel(value, (void *)real_offset); 4245 num_hba++; 4246 } 4247 } 4248 4249 spin_lock_init(&phba->io_sgl_lock); 4250 spin_lock_init(&phba->mgmt_sgl_lock); 4251 spin_lock_init(&phba->isr_lock); 4252 ret = mgmt_get_fw_config(&phba->ctrl, phba); 4253 if (ret != 0) { 4254 shost_printk(KERN_ERR, phba->shost, 4255 "Error getting fw config\n"); 4256 goto free_port; 4257 } 4258 phba->shost->max_id = phba->fw_config.iscsi_cid_count; 4259 beiscsi_get_params(phba); 4260 phba->shost->can_queue = phba->params.ios_per_ctrl; 4261 ret = beiscsi_init_port(phba); 4262 if (ret < 0) { 4263 shost_printk(KERN_ERR, phba->shost, "beiscsi_dev_probe-" 4264 "Failed in beiscsi_init_port\n"); 4265 goto free_port; 4266 } 4267 4268 for (i = 0; i < MAX_MCC_CMD ; i++) { 4269 init_waitqueue_head(&phba->ctrl.mcc_wait[i + 1]); 4270 phba->ctrl.mcc_tag[i] = i + 1; 4271 phba->ctrl.mcc_numtag[i + 1] = 0; 4272 phba->ctrl.mcc_tag_available++; 4273 } 4274 4275 phba->ctrl.mcc_alloc_index = phba->ctrl.mcc_free_index = 0; 4276 4277 snprintf(phba->wq_name, sizeof(phba->wq_name), "beiscsi_q_irq%u", 4278 phba->shost->host_no); 4279 phba->wq = create_workqueue(phba->wq_name); 4280 if (!phba->wq) { 4281 shost_printk(KERN_ERR, phba->shost, "beiscsi_dev_probe-" 4282 "Failed to allocate work queue\n"); 4283 goto free_twq; 4284 } 4285 4286 INIT_WORK(&phba->work_cqs, beiscsi_process_all_cqs); 4287 4288 phwi_ctrlr = phba->phwi_ctrlr; 4289 phwi_context = phwi_ctrlr->phwi_ctxt; 4290 if (blk_iopoll_enabled) { 4291 for (i = 0; i < phba->num_cpus; i++) { 4292 pbe_eq = &phwi_context->be_eq[i]; 4293 blk_iopoll_init(&pbe_eq->iopoll, be_iopoll_budget, 4294 be_iopoll); 4295 blk_iopoll_enable(&pbe_eq->iopoll); 4296 } 4297 } 4298 ret = beiscsi_init_irqs(phba); 4299 if (ret < 0) { 4300 shost_printk(KERN_ERR, phba->shost, "beiscsi_dev_probe-" 4301 "Failed to beiscsi_init_irqs\n"); 4302 goto free_blkenbld; 4303 } 4304 hwi_enable_intr(phba); 4305 ret = beiscsi_get_boot_info(phba); 4306 if (ret < 0) { 4307 shost_printk(KERN_ERR, phba->shost, "beiscsi_dev_probe-" 4308 "No Boot Devices !!!!!\n"); 4309 } 4310 SE_DEBUG(DBG_LVL_8, "\n\n\n SUCCESS - DRIVER LOADED\n\n\n"); 4311 return 0; 4312 4313 free_blkenbld: 4314 destroy_workqueue(phba->wq); 4315 if (blk_iopoll_enabled) 4316 for (i = 0; i < phba->num_cpus; i++) { 4317 pbe_eq = &phwi_context->be_eq[i]; 4318 blk_iopoll_disable(&pbe_eq->iopoll); 4319 } 4320 free_twq: 4321 beiscsi_clean_port(phba); 4322 beiscsi_free_mem(phba); 4323 free_port: 4324 real_offset = (u8 *)phba->csr_va + MPU_EP_SEMAPHORE; 4325 4326 value = readl((void *)real_offset); 4327 4328 if (value & 0x00010000) { 4329 value &= 0xfffeffff; 4330 writel(value, (void *)real_offset); 4331 } 4332 4333 pci_free_consistent(phba->pcidev, 4334 phba->ctrl.mbox_mem_alloced.size, 4335 phba->ctrl.mbox_mem_alloced.va, 4336 phba->ctrl.mbox_mem_alloced.dma); 4337 beiscsi_unmap_pci_function(phba); 4338 hba_free: 4339 if (phba->msix_enabled) 4340 pci_disable_msix(phba->pcidev); 4341 iscsi_host_remove(phba->shost); 4342 pci_dev_put(phba->pcidev); 4343 iscsi_host_free(phba->shost); 4344 disable_pci: 4345 pci_disable_device(pcidev); 4346 return ret; 4347 } 4348 4349 struct iscsi_transport beiscsi_iscsi_transport = { 4350 .owner = THIS_MODULE, 4351 .name = DRV_NAME, 4352 .caps = CAP_RECOVERY_L0 | CAP_HDRDGST | CAP_TEXT_NEGO | 4353 CAP_MULTI_R2T | CAP_DATADGST | CAP_DATA_PATH_OFFLOAD, 4354 .param_mask = ISCSI_MAX_RECV_DLENGTH | 4355 ISCSI_MAX_XMIT_DLENGTH | 4356 ISCSI_HDRDGST_EN | 4357 ISCSI_DATADGST_EN | 4358 ISCSI_INITIAL_R2T_EN | 4359 ISCSI_MAX_R2T | 4360 ISCSI_IMM_DATA_EN | 4361 ISCSI_FIRST_BURST | 4362 ISCSI_MAX_BURST | 4363 ISCSI_PDU_INORDER_EN | 4364 ISCSI_DATASEQ_INORDER_EN | 4365 ISCSI_ERL | 4366 ISCSI_CONN_PORT | 4367 ISCSI_CONN_ADDRESS | 4368 ISCSI_EXP_STATSN | 4369 ISCSI_PERSISTENT_PORT | 4370 ISCSI_PERSISTENT_ADDRESS | 4371 ISCSI_TARGET_NAME | ISCSI_TPGT | 4372 ISCSI_USERNAME | ISCSI_PASSWORD | 4373 ISCSI_USERNAME_IN | ISCSI_PASSWORD_IN | 4374 ISCSI_FAST_ABORT | ISCSI_ABORT_TMO | 4375 ISCSI_LU_RESET_TMO | 4376 ISCSI_PING_TMO | ISCSI_RECV_TMO | 4377 ISCSI_IFACE_NAME | ISCSI_INITIATOR_NAME, 4378 .host_param_mask = ISCSI_HOST_HWADDRESS | ISCSI_HOST_IPADDRESS | 4379 ISCSI_HOST_INITIATOR_NAME, 4380 .create_session = beiscsi_session_create, 4381 .destroy_session = beiscsi_session_destroy, 4382 .create_conn = beiscsi_conn_create, 4383 .bind_conn = beiscsi_conn_bind, 4384 .destroy_conn = iscsi_conn_teardown, 4385 .set_param = beiscsi_set_param, 4386 .get_conn_param = beiscsi_conn_get_param, 4387 .get_session_param = iscsi_session_get_param, 4388 .get_host_param = beiscsi_get_host_param, 4389 .start_conn = beiscsi_conn_start, 4390 .stop_conn = iscsi_conn_stop, 4391 .send_pdu = iscsi_conn_send_pdu, 4392 .xmit_task = beiscsi_task_xmit, 4393 .cleanup_task = beiscsi_cleanup_task, 4394 .alloc_pdu = beiscsi_alloc_pdu, 4395 .parse_pdu_itt = beiscsi_parse_pdu, 4396 .get_stats = beiscsi_conn_get_stats, 4397 .ep_connect = beiscsi_ep_connect, 4398 .ep_poll = beiscsi_ep_poll, 4399 .ep_disconnect = beiscsi_ep_disconnect, 4400 .session_recovery_timedout = iscsi_session_recovery_timedout, 4401 }; 4402 4403 static struct pci_driver beiscsi_pci_driver = { 4404 .name = DRV_NAME, 4405 .probe = beiscsi_dev_probe, 4406 .remove = beiscsi_remove, 4407 .id_table = beiscsi_pci_id_table 4408 }; 4409 4410 4411 static int __init beiscsi_module_init(void) 4412 { 4413 int ret; 4414 4415 beiscsi_scsi_transport = 4416 iscsi_register_transport(&beiscsi_iscsi_transport); 4417 if (!beiscsi_scsi_transport) { 4418 SE_DEBUG(DBG_LVL_1, 4419 "beiscsi_module_init - Unable to register beiscsi" 4420 "transport.\n"); 4421 return -ENOMEM; 4422 } 4423 SE_DEBUG(DBG_LVL_8, "In beiscsi_module_init, tt=%p\n", 4424 &beiscsi_iscsi_transport); 4425 4426 ret = pci_register_driver(&beiscsi_pci_driver); 4427 if (ret) { 4428 SE_DEBUG(DBG_LVL_1, 4429 "beiscsi_module_init - Unable to register" 4430 "beiscsi pci driver.\n"); 4431 goto unregister_iscsi_transport; 4432 } 4433 return 0; 4434 4435 unregister_iscsi_transport: 4436 iscsi_unregister_transport(&beiscsi_iscsi_transport); 4437 return ret; 4438 } 4439 4440 static void __exit beiscsi_module_exit(void) 4441 { 4442 pci_unregister_driver(&beiscsi_pci_driver); 4443 iscsi_unregister_transport(&beiscsi_iscsi_transport); 4444 } 4445 4446 module_init(beiscsi_module_init); 4447 module_exit(beiscsi_module_exit); 4448