123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782 |
- // SPDX-License-Identifier: GPL-2.0
- /*
- * Copyright (C) 2021 Broadcom. All Rights Reserved. The term
- * “Broadcom” refers to Broadcom Inc. and/or its subsidiaries.
- */
- #include "efclib.h"
- #include "../libefc_sli/sli4.h"
- #include "efc_cmds.h"
- #include "efc_sm.h"
- static void
- efc_nport_free_resources(struct efc_nport *nport, int evt, void *data)
- {
- struct efc *efc = nport->efc;
- /* Clear the nport attached flag */
- nport->attached = false;
- /* Free the service parameters buffer */
- if (nport->dma.virt) {
- dma_free_coherent(&efc->pci->dev, nport->dma.size,
- nport->dma.virt, nport->dma.phys);
- memset(&nport->dma, 0, sizeof(struct efc_dma));
- }
- /* Free the SLI resources */
- sli_resource_free(efc->sli, SLI4_RSRC_VPI, nport->indicator);
- efc_nport_cb(efc, evt, nport);
- }
- static int
- efc_nport_get_mbox_status(struct efc_nport *nport, u8 *mqe, int status)
- {
- struct efc *efc = nport->efc;
- struct sli4_mbox_command_header *hdr =
- (struct sli4_mbox_command_header *)mqe;
- if (status || le16_to_cpu(hdr->status)) {
- efc_log_debug(efc, "bad status vpi=%#x st=%x hdr=%x\n",
- nport->indicator, status, le16_to_cpu(hdr->status));
- return -EIO;
- }
- return 0;
- }
- static int
- efc_nport_free_unreg_vpi_cb(struct efc *efc, int status, u8 *mqe, void *arg)
- {
- struct efc_nport *nport = arg;
- int evt = EFC_EVT_NPORT_FREE_OK;
- int rc;
- rc = efc_nport_get_mbox_status(nport, mqe, status);
- if (rc)
- evt = EFC_EVT_NPORT_FREE_FAIL;
- efc_nport_free_resources(nport, evt, mqe);
- return rc;
- }
- static void
- efc_nport_free_unreg_vpi(struct efc_nport *nport)
- {
- struct efc *efc = nport->efc;
- int rc;
- u8 data[SLI4_BMBX_SIZE];
- rc = sli_cmd_unreg_vpi(efc->sli, data, nport->indicator,
- SLI4_UNREG_TYPE_PORT);
- if (rc) {
- efc_log_err(efc, "UNREG_VPI format failure\n");
- efc_nport_free_resources(nport, EFC_EVT_NPORT_FREE_FAIL, data);
- return;
- }
- rc = efc->tt.issue_mbox_rqst(efc->base, data,
- efc_nport_free_unreg_vpi_cb, nport);
- if (rc) {
- efc_log_err(efc, "UNREG_VPI command failure\n");
- efc_nport_free_resources(nport, EFC_EVT_NPORT_FREE_FAIL, data);
- }
- }
- static void
- efc_nport_send_evt(struct efc_nport *nport, int evt, void *data)
- {
- struct efc *efc = nport->efc;
- /* Now inform the registered callbacks */
- efc_nport_cb(efc, evt, nport);
- /* Set the nport attached flag */
- if (evt == EFC_EVT_NPORT_ATTACH_OK)
- nport->attached = true;
- /* If there is a pending free request, then handle it now */
- if (nport->free_req_pending)
- efc_nport_free_unreg_vpi(nport);
- }
- static int
- efc_nport_alloc_init_vpi_cb(struct efc *efc, int status, u8 *mqe, void *arg)
- {
- struct efc_nport *nport = arg;
- if (efc_nport_get_mbox_status(nport, mqe, status)) {
- efc_nport_free_resources(nport, EFC_EVT_NPORT_ALLOC_FAIL, mqe);
- return -EIO;
- }
- efc_nport_send_evt(nport, EFC_EVT_NPORT_ALLOC_OK, mqe);
- return 0;
- }
- static void
- efc_nport_alloc_init_vpi(struct efc_nport *nport)
- {
- struct efc *efc = nport->efc;
- u8 data[SLI4_BMBX_SIZE];
- int rc;
- /* If there is a pending free request, then handle it now */
- if (nport->free_req_pending) {
- efc_nport_free_resources(nport, EFC_EVT_NPORT_FREE_OK, data);
- return;
- }
- rc = sli_cmd_init_vpi(efc->sli, data,
- nport->indicator, nport->domain->indicator);
- if (rc) {
- efc_log_err(efc, "INIT_VPI format failure\n");
- efc_nport_free_resources(nport, EFC_EVT_NPORT_ALLOC_FAIL, data);
- return;
- }
- rc = efc->tt.issue_mbox_rqst(efc->base, data,
- efc_nport_alloc_init_vpi_cb, nport);
- if (rc) {
- efc_log_err(efc, "INIT_VPI command failure\n");
- efc_nport_free_resources(nport, EFC_EVT_NPORT_ALLOC_FAIL, data);
- }
- }
- static int
- efc_nport_alloc_read_sparm64_cb(struct efc *efc, int status, u8 *mqe, void *arg)
- {
- struct efc_nport *nport = arg;
- u8 *payload = NULL;
- if (efc_nport_get_mbox_status(nport, mqe, status)) {
- efc_nport_free_resources(nport, EFC_EVT_NPORT_ALLOC_FAIL, mqe);
- return -EIO;
- }
- payload = nport->dma.virt;
- memcpy(&nport->sli_wwpn, payload + SLI4_READ_SPARM64_WWPN_OFFSET,
- sizeof(nport->sli_wwpn));
- memcpy(&nport->sli_wwnn, payload + SLI4_READ_SPARM64_WWNN_OFFSET,
- sizeof(nport->sli_wwnn));
- dma_free_coherent(&efc->pci->dev, nport->dma.size, nport->dma.virt,
- nport->dma.phys);
- memset(&nport->dma, 0, sizeof(struct efc_dma));
- efc_nport_alloc_init_vpi(nport);
- return 0;
- }
- static void
- efc_nport_alloc_read_sparm64(struct efc *efc, struct efc_nport *nport)
- {
- u8 data[SLI4_BMBX_SIZE];
- int rc;
- /* Allocate memory for the service parameters */
- nport->dma.size = EFC_SPARAM_DMA_SZ;
- nport->dma.virt = dma_alloc_coherent(&efc->pci->dev,
- nport->dma.size, &nport->dma.phys,
- GFP_KERNEL);
- if (!nport->dma.virt) {
- efc_log_err(efc, "Failed to allocate DMA memory\n");
- efc_nport_free_resources(nport, EFC_EVT_NPORT_ALLOC_FAIL, data);
- return;
- }
- rc = sli_cmd_read_sparm64(efc->sli, data,
- &nport->dma, nport->indicator);
- if (rc) {
- efc_log_err(efc, "READ_SPARM64 format failure\n");
- efc_nport_free_resources(nport, EFC_EVT_NPORT_ALLOC_FAIL, data);
- return;
- }
- rc = efc->tt.issue_mbox_rqst(efc->base, data,
- efc_nport_alloc_read_sparm64_cb, nport);
- if (rc) {
- efc_log_err(efc, "READ_SPARM64 command failure\n");
- efc_nport_free_resources(nport, EFC_EVT_NPORT_ALLOC_FAIL, data);
- }
- }
- int
- efc_cmd_nport_alloc(struct efc *efc, struct efc_nport *nport,
- struct efc_domain *domain, u8 *wwpn)
- {
- u32 index;
- nport->indicator = U32_MAX;
- nport->free_req_pending = false;
- if (wwpn)
- memcpy(&nport->sli_wwpn, wwpn, sizeof(nport->sli_wwpn));
- /*
- * allocate a VPI object for the port and stores it in the
- * indicator field of the port object.
- */
- if (sli_resource_alloc(efc->sli, SLI4_RSRC_VPI,
- &nport->indicator, &index)) {
- efc_log_err(efc, "VPI allocation failure\n");
- return -EIO;
- }
- if (domain) {
- /*
- * If the WWPN is NULL, fetch the default
- * WWPN and WWNN before initializing the VPI
- */
- if (!wwpn)
- efc_nport_alloc_read_sparm64(efc, nport);
- else
- efc_nport_alloc_init_vpi(nport);
- } else if (!wwpn) {
- /* domain NULL and wwpn non-NULL */
- efc_log_err(efc, "need WWN for physical port\n");
- sli_resource_free(efc->sli, SLI4_RSRC_VPI, nport->indicator);
- return -EIO;
- }
- return 0;
- }
- static int
- efc_nport_attach_reg_vpi_cb(struct efc *efc, int status, u8 *mqe,
- void *arg)
- {
- struct efc_nport *nport = arg;
- nport->attaching = false;
- if (efc_nport_get_mbox_status(nport, mqe, status)) {
- efc_nport_free_resources(nport, EFC_EVT_NPORT_ATTACH_FAIL, mqe);
- return -EIO;
- }
- efc_nport_send_evt(nport, EFC_EVT_NPORT_ATTACH_OK, mqe);
- return 0;
- }
- int
- efc_cmd_nport_attach(struct efc *efc, struct efc_nport *nport, u32 fc_id)
- {
- u8 buf[SLI4_BMBX_SIZE];
- int rc = 0;
- if (!nport) {
- efc_log_err(efc, "bad param(s) nport=%p\n", nport);
- return -EIO;
- }
- nport->fc_id = fc_id;
- /* register previously-allocated VPI with the device */
- rc = sli_cmd_reg_vpi(efc->sli, buf, nport->fc_id,
- nport->sli_wwpn, nport->indicator,
- nport->domain->indicator, false);
- if (rc) {
- efc_log_err(efc, "REG_VPI format failure\n");
- efc_nport_free_resources(nport, EFC_EVT_NPORT_ATTACH_FAIL, buf);
- return rc;
- }
- rc = efc->tt.issue_mbox_rqst(efc->base, buf,
- efc_nport_attach_reg_vpi_cb, nport);
- if (rc) {
- efc_log_err(efc, "REG_VPI command failure\n");
- efc_nport_free_resources(nport, EFC_EVT_NPORT_ATTACH_FAIL, buf);
- } else {
- nport->attaching = true;
- }
- return rc;
- }
- int
- efc_cmd_nport_free(struct efc *efc, struct efc_nport *nport)
- {
- if (!nport) {
- efc_log_err(efc, "bad parameter(s) nport=%p\n", nport);
- return -EIO;
- }
- /* Issue the UNREG_VPI command to free the assigned VPI context */
- if (nport->attached)
- efc_nport_free_unreg_vpi(nport);
- else if (nport->attaching)
- nport->free_req_pending = true;
- else
- efc_sm_post_event(&nport->sm, EFC_EVT_NPORT_FREE_OK, NULL);
- return 0;
- }
- static int
- efc_domain_get_mbox_status(struct efc_domain *domain, u8 *mqe, int status)
- {
- struct efc *efc = domain->efc;
- struct sli4_mbox_command_header *hdr =
- (struct sli4_mbox_command_header *)mqe;
- if (status || le16_to_cpu(hdr->status)) {
- efc_log_debug(efc, "bad status vfi=%#x st=%x hdr=%x\n",
- domain->indicator, status,
- le16_to_cpu(hdr->status));
- return -EIO;
- }
- return 0;
- }
- static void
- efc_domain_free_resources(struct efc_domain *domain, int evt, void *data)
- {
- struct efc *efc = domain->efc;
- /* Free the service parameters buffer */
- if (domain->dma.virt) {
- dma_free_coherent(&efc->pci->dev,
- domain->dma.size, domain->dma.virt,
- domain->dma.phys);
- memset(&domain->dma, 0, sizeof(struct efc_dma));
- }
- /* Free the SLI resources */
- sli_resource_free(efc->sli, SLI4_RSRC_VFI, domain->indicator);
- efc_domain_cb(efc, evt, domain);
- }
- static void
- efc_domain_send_nport_evt(struct efc_domain *domain,
- int port_evt, int domain_evt, void *data)
- {
- struct efc *efc = domain->efc;
- /* Send alloc/attach ok to the physical nport */
- efc_nport_send_evt(domain->nport, port_evt, NULL);
- /* Now inform the registered callbacks */
- efc_domain_cb(efc, domain_evt, domain);
- }
- static int
- efc_domain_alloc_read_sparm64_cb(struct efc *efc, int status, u8 *mqe,
- void *arg)
- {
- struct efc_domain *domain = arg;
- if (efc_domain_get_mbox_status(domain, mqe, status)) {
- efc_domain_free_resources(domain,
- EFC_HW_DOMAIN_ALLOC_FAIL, mqe);
- return -EIO;
- }
- efc_domain_send_nport_evt(domain, EFC_EVT_NPORT_ALLOC_OK,
- EFC_HW_DOMAIN_ALLOC_OK, mqe);
- return 0;
- }
- static void
- efc_domain_alloc_read_sparm64(struct efc_domain *domain)
- {
- struct efc *efc = domain->efc;
- u8 data[SLI4_BMBX_SIZE];
- int rc;
- rc = sli_cmd_read_sparm64(efc->sli, data, &domain->dma, 0);
- if (rc) {
- efc_log_err(efc, "READ_SPARM64 format failure\n");
- efc_domain_free_resources(domain,
- EFC_HW_DOMAIN_ALLOC_FAIL, data);
- return;
- }
- rc = efc->tt.issue_mbox_rqst(efc->base, data,
- efc_domain_alloc_read_sparm64_cb, domain);
- if (rc) {
- efc_log_err(efc, "READ_SPARM64 command failure\n");
- efc_domain_free_resources(domain,
- EFC_HW_DOMAIN_ALLOC_FAIL, data);
- }
- }
- static int
- efc_domain_alloc_init_vfi_cb(struct efc *efc, int status, u8 *mqe,
- void *arg)
- {
- struct efc_domain *domain = arg;
- if (efc_domain_get_mbox_status(domain, mqe, status)) {
- efc_domain_free_resources(domain,
- EFC_HW_DOMAIN_ALLOC_FAIL, mqe);
- return -EIO;
- }
- efc_domain_alloc_read_sparm64(domain);
- return 0;
- }
- static void
- efc_domain_alloc_init_vfi(struct efc_domain *domain)
- {
- struct efc *efc = domain->efc;
- struct efc_nport *nport = domain->nport;
- u8 data[SLI4_BMBX_SIZE];
- int rc;
- /*
- * For FC, the HW alread registered an FCFI.
- * Copy FCF information into the domain and jump to INIT_VFI.
- */
- domain->fcf_indicator = efc->fcfi;
- rc = sli_cmd_init_vfi(efc->sli, data, domain->indicator,
- domain->fcf_indicator, nport->indicator);
- if (rc) {
- efc_log_err(efc, "INIT_VFI format failure\n");
- efc_domain_free_resources(domain,
- EFC_HW_DOMAIN_ALLOC_FAIL, data);
- return;
- }
- efc_log_err(efc, "%s issue mbox\n", __func__);
- rc = efc->tt.issue_mbox_rqst(efc->base, data,
- efc_domain_alloc_init_vfi_cb, domain);
- if (rc) {
- efc_log_err(efc, "INIT_VFI command failure\n");
- efc_domain_free_resources(domain,
- EFC_HW_DOMAIN_ALLOC_FAIL, data);
- }
- }
- int
- efc_cmd_domain_alloc(struct efc *efc, struct efc_domain *domain, u32 fcf)
- {
- u32 index;
- if (!domain || !domain->nport) {
- efc_log_err(efc, "bad parameter(s) domain=%p nport=%p\n",
- domain, domain ? domain->nport : NULL);
- return -EIO;
- }
- /* allocate memory for the service parameters */
- domain->dma.size = EFC_SPARAM_DMA_SZ;
- domain->dma.virt = dma_alloc_coherent(&efc->pci->dev,
- domain->dma.size,
- &domain->dma.phys, GFP_KERNEL);
- if (!domain->dma.virt) {
- efc_log_err(efc, "Failed to allocate DMA memory\n");
- return -EIO;
- }
- domain->fcf = fcf;
- domain->fcf_indicator = U32_MAX;
- domain->indicator = U32_MAX;
- if (sli_resource_alloc(efc->sli, SLI4_RSRC_VFI, &domain->indicator,
- &index)) {
- efc_log_err(efc, "VFI allocation failure\n");
- dma_free_coherent(&efc->pci->dev,
- domain->dma.size, domain->dma.virt,
- domain->dma.phys);
- memset(&domain->dma, 0, sizeof(struct efc_dma));
- return -EIO;
- }
- efc_domain_alloc_init_vfi(domain);
- return 0;
- }
- static int
- efc_domain_attach_reg_vfi_cb(struct efc *efc, int status, u8 *mqe,
- void *arg)
- {
- struct efc_domain *domain = arg;
- if (efc_domain_get_mbox_status(domain, mqe, status)) {
- efc_domain_free_resources(domain,
- EFC_HW_DOMAIN_ATTACH_FAIL, mqe);
- return -EIO;
- }
- efc_domain_send_nport_evt(domain, EFC_EVT_NPORT_ATTACH_OK,
- EFC_HW_DOMAIN_ATTACH_OK, mqe);
- return 0;
- }
- int
- efc_cmd_domain_attach(struct efc *efc, struct efc_domain *domain, u32 fc_id)
- {
- u8 buf[SLI4_BMBX_SIZE];
- int rc = 0;
- if (!domain) {
- efc_log_err(efc, "bad param(s) domain=%p\n", domain);
- return -EIO;
- }
- domain->nport->fc_id = fc_id;
- rc = sli_cmd_reg_vfi(efc->sli, buf, SLI4_BMBX_SIZE, domain->indicator,
- domain->fcf_indicator, domain->dma,
- domain->nport->indicator, domain->nport->sli_wwpn,
- domain->nport->fc_id);
- if (rc) {
- efc_log_err(efc, "REG_VFI format failure\n");
- goto cleanup;
- }
- rc = efc->tt.issue_mbox_rqst(efc->base, buf,
- efc_domain_attach_reg_vfi_cb, domain);
- if (rc) {
- efc_log_err(efc, "REG_VFI command failure\n");
- goto cleanup;
- }
- return rc;
- cleanup:
- efc_domain_free_resources(domain, EFC_HW_DOMAIN_ATTACH_FAIL, buf);
- return rc;
- }
- static int
- efc_domain_free_unreg_vfi_cb(struct efc *efc, int status, u8 *mqe, void *arg)
- {
- struct efc_domain *domain = arg;
- int evt = EFC_HW_DOMAIN_FREE_OK;
- int rc;
- rc = efc_domain_get_mbox_status(domain, mqe, status);
- if (rc) {
- evt = EFC_HW_DOMAIN_FREE_FAIL;
- rc = -EIO;
- }
- efc_domain_free_resources(domain, evt, mqe);
- return rc;
- }
- static void
- efc_domain_free_unreg_vfi(struct efc_domain *domain)
- {
- struct efc *efc = domain->efc;
- int rc;
- u8 data[SLI4_BMBX_SIZE];
- rc = sli_cmd_unreg_vfi(efc->sli, data, domain->indicator,
- SLI4_UNREG_TYPE_DOMAIN);
- if (rc) {
- efc_log_err(efc, "UNREG_VFI format failure\n");
- goto cleanup;
- }
- rc = efc->tt.issue_mbox_rqst(efc->base, data,
- efc_domain_free_unreg_vfi_cb, domain);
- if (rc) {
- efc_log_err(efc, "UNREG_VFI command failure\n");
- goto cleanup;
- }
- return;
- cleanup:
- efc_domain_free_resources(domain, EFC_HW_DOMAIN_FREE_FAIL, data);
- }
- int
- efc_cmd_domain_free(struct efc *efc, struct efc_domain *domain)
- {
- if (!domain) {
- efc_log_err(efc, "bad parameter(s) domain=%p\n", domain);
- return -EIO;
- }
- efc_domain_free_unreg_vfi(domain);
- return 0;
- }
- int
- efc_cmd_node_alloc(struct efc *efc, struct efc_remote_node *rnode, u32 fc_addr,
- struct efc_nport *nport)
- {
- /* Check for invalid indicator */
- if (rnode->indicator != U32_MAX) {
- efc_log_err(efc,
- "RPI allocation failure addr=%#x rpi=%#x\n",
- fc_addr, rnode->indicator);
- return -EIO;
- }
- /* NULL SLI port indicates an unallocated remote node */
- rnode->nport = NULL;
- if (sli_resource_alloc(efc->sli, SLI4_RSRC_RPI,
- &rnode->indicator, &rnode->index)) {
- efc_log_err(efc, "RPI allocation failure addr=%#x\n",
- fc_addr);
- return -EIO;
- }
- rnode->fc_id = fc_addr;
- rnode->nport = nport;
- return 0;
- }
- static int
- efc_cmd_node_attach_cb(struct efc *efc, int status, u8 *mqe, void *arg)
- {
- struct efc_remote_node *rnode = arg;
- struct sli4_mbox_command_header *hdr =
- (struct sli4_mbox_command_header *)mqe;
- int evt = 0;
- if (status || le16_to_cpu(hdr->status)) {
- efc_log_debug(efc, "bad status cqe=%#x mqe=%#x\n", status,
- le16_to_cpu(hdr->status));
- rnode->attached = false;
- evt = EFC_EVT_NODE_ATTACH_FAIL;
- } else {
- rnode->attached = true;
- evt = EFC_EVT_NODE_ATTACH_OK;
- }
- efc_remote_node_cb(efc, evt, rnode);
- return 0;
- }
- int
- efc_cmd_node_attach(struct efc *efc, struct efc_remote_node *rnode,
- struct efc_dma *sparms)
- {
- int rc = -EIO;
- u8 buf[SLI4_BMBX_SIZE];
- if (!rnode || !sparms) {
- efc_log_err(efc, "bad parameter(s) rnode=%p sparms=%p\n",
- rnode, sparms);
- return -EIO;
- }
- /*
- * If the attach count is non-zero, this RPI has already been reg'd.
- * Otherwise, register the RPI
- */
- if (rnode->index == U32_MAX) {
- efc_log_err(efc, "bad parameter rnode->index invalid\n");
- return -EIO;
- }
- /* Update a remote node object with the remote port's service params */
- if (!sli_cmd_reg_rpi(efc->sli, buf, rnode->indicator,
- rnode->nport->indicator, rnode->fc_id, sparms, 0, 0))
- rc = efc->tt.issue_mbox_rqst(efc->base, buf,
- efc_cmd_node_attach_cb, rnode);
- return rc;
- }
- int
- efc_node_free_resources(struct efc *efc, struct efc_remote_node *rnode)
- {
- int rc = 0;
- if (!rnode) {
- efc_log_err(efc, "bad parameter rnode=%p\n", rnode);
- return -EIO;
- }
- if (rnode->nport) {
- if (rnode->attached) {
- efc_log_err(efc, "rnode is still attached\n");
- return -EIO;
- }
- if (rnode->indicator != U32_MAX) {
- if (sli_resource_free(efc->sli, SLI4_RSRC_RPI,
- rnode->indicator)) {
- efc_log_err(efc,
- "RPI free fail RPI %d addr=%#x\n",
- rnode->indicator, rnode->fc_id);
- rc = -EIO;
- } else {
- rnode->indicator = U32_MAX;
- rnode->index = U32_MAX;
- }
- }
- }
- return rc;
- }
- static int
- efc_cmd_node_free_cb(struct efc *efc, int status, u8 *mqe, void *arg)
- {
- struct efc_remote_node *rnode = arg;
- struct sli4_mbox_command_header *hdr =
- (struct sli4_mbox_command_header *)mqe;
- int evt = EFC_EVT_NODE_FREE_FAIL;
- int rc = 0;
- if (status || le16_to_cpu(hdr->status)) {
- efc_log_debug(efc, "bad status cqe=%#x mqe=%#x\n", status,
- le16_to_cpu(hdr->status));
- /*
- * In certain cases, a non-zero MQE status is OK (all must be
- * true):
- * - node is attached
- * - status is 0x1400
- */
- if (!rnode->attached ||
- (le16_to_cpu(hdr->status) != SLI4_MBX_STATUS_RPI_NOT_REG))
- rc = -EIO;
- }
- if (!rc) {
- rnode->attached = false;
- evt = EFC_EVT_NODE_FREE_OK;
- }
- efc_remote_node_cb(efc, evt, rnode);
- return rc;
- }
- int
- efc_cmd_node_detach(struct efc *efc, struct efc_remote_node *rnode)
- {
- u8 buf[SLI4_BMBX_SIZE];
- int rc = -EIO;
- if (!rnode) {
- efc_log_err(efc, "bad parameter rnode=%p\n", rnode);
- return -EIO;
- }
- if (rnode->nport) {
- if (!rnode->attached)
- return -EIO;
- rc = -EIO;
- if (!sli_cmd_unreg_rpi(efc->sli, buf, rnode->indicator,
- SLI4_RSRC_RPI, U32_MAX))
- rc = efc->tt.issue_mbox_rqst(efc->base, buf,
- efc_cmd_node_free_cb, rnode);
- if (rc != 0) {
- efc_log_err(efc, "UNREG_RPI failed\n");
- rc = -EIO;
- }
- }
- return rc;
- }
|