^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) /*******************************************************************
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) * This file is part of the Emulex Linux Device Driver for *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Fibre Channel Host Bus Adapters. *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) * Copyright (C) 2017-2019 Broadcom. All Rights Reserved. The term *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * “Broadcom” refers to Broadcom Inc. and/or its subsidiaries. *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * Copyright (C) 2009-2015 Emulex. All rights reserved. *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * EMULEX and SLI are trademarks of Emulex. *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) * www.broadcom.com *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) * *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) * This program is free software; you can redistribute it and/or *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) * modify it under the terms of version 2 of the GNU General *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) * Public License as published by the Free Software Foundation. *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) * This program is distributed in the hope that it will be useful. *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) * ALL EXPRESS OR IMPLIED CONDITIONS, REPRESENTATIONS AND *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) * WARRANTIES, INCLUDING ANY IMPLIED WARRANTY OF MERCHANTABILITY, *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) * FITNESS FOR A PARTICULAR PURPOSE, OR NON-INFRINGEMENT, ARE *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) * DISCLAIMED, EXCEPT TO THE EXTENT THAT SUCH DISCLAIMERS ARE HELD *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) * TO BE LEGALLY INVALID. See the GNU General Public License for *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) * more details, a copy of which can be found in the file COPYING *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) * included with this package. *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) *******************************************************************/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) #include <linux/interrupt.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #include <linux/mempool.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #include <linux/pci.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) #include <linux/list.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) #include <linux/bsg-lib.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) #include <linux/vmalloc.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) #include <scsi/scsi.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) #include <scsi/scsi_host.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) #include <scsi/scsi_transport_fc.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) #include <scsi/scsi_bsg_fc.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) #include <scsi/fc/fc_fs.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) #include "lpfc_hw4.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) #include "lpfc_hw.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) #include "lpfc_sli.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) #include "lpfc_sli4.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) #include "lpfc_nl.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) #include "lpfc_bsg.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) #include "lpfc_disc.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) #include "lpfc_scsi.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) #include "lpfc.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) #include "lpfc_logmsg.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) #include "lpfc_crtn.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) #include "lpfc_debugfs.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) #include "lpfc_vport.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) #include "lpfc_version.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) struct lpfc_bsg_event {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) struct list_head node;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) struct kref kref;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) wait_queue_head_t wq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) /* Event type and waiter identifiers */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) uint32_t type_mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) uint32_t req_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) uint32_t reg_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) /* next two flags are here for the auto-delete logic */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) unsigned long wait_time_stamp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) int waiting;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) /* seen and not seen events */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) struct list_head events_to_get;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) struct list_head events_to_see;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) /* driver data associated with the job */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) void *dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) struct lpfc_bsg_iocb {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) struct lpfc_iocbq *cmdiocbq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) struct lpfc_dmabuf *rmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) struct lpfc_nodelist *ndlp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) struct lpfc_bsg_mbox {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) LPFC_MBOXQ_t *pmboxq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) MAILBOX_t *mb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) struct lpfc_dmabuf *dmabuffers; /* for BIU diags */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) uint8_t *ext; /* extended mailbox data */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) uint32_t mbOffset; /* from app */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) uint32_t inExtWLen; /* from app */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) uint32_t outExtWLen; /* from app */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) #define MENLO_DID 0x0000FC0E
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) struct lpfc_bsg_menlo {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) struct lpfc_iocbq *cmdiocbq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) struct lpfc_dmabuf *rmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) #define TYPE_EVT 1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) #define TYPE_IOCB 2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) #define TYPE_MBOX 3
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) #define TYPE_MENLO 4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) struct bsg_job_data {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) uint32_t type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) struct bsg_job *set_job; /* job waiting for this iocb to finish */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) union {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) struct lpfc_bsg_event *evt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) struct lpfc_bsg_iocb iocb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) struct lpfc_bsg_mbox mbox;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) struct lpfc_bsg_menlo menlo;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) } context_un;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) struct event_data {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) struct list_head node;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) uint32_t type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) uint32_t immed_dat;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) void *data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) uint32_t len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) #define BUF_SZ_4K 4096
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) #define SLI_CT_ELX_LOOPBACK 0x10
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) enum ELX_LOOPBACK_CMD {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) ELX_LOOPBACK_XRI_SETUP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) ELX_LOOPBACK_DATA,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) #define ELX_LOOPBACK_HEADER_SZ \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) (size_t)(&((struct lpfc_sli_ct_request *)NULL)->un)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) struct lpfc_dmabufext {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) struct lpfc_dmabuf dma;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) uint32_t size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) uint32_t flag;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) lpfc_free_bsg_buffers(struct lpfc_hba *phba, struct lpfc_dmabuf *mlist)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) struct lpfc_dmabuf *mlast, *next_mlast;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) if (mlist) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) list_for_each_entry_safe(mlast, next_mlast, &mlist->list,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) list) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) lpfc_mbuf_free(phba, mlast->virt, mlast->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) list_del(&mlast->list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) kfree(mlast);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) lpfc_mbuf_free(phba, mlist->virt, mlist->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) kfree(mlist);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) static struct lpfc_dmabuf *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) lpfc_alloc_bsg_buffers(struct lpfc_hba *phba, unsigned int size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) int outbound_buffers, struct ulp_bde64 *bpl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) int *bpl_entries)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) struct lpfc_dmabuf *mlist = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) struct lpfc_dmabuf *mp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) unsigned int bytes_left = size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) /* Verify we can support the size specified */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) if (!size || (size > (*bpl_entries * LPFC_BPL_SIZE)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) /* Determine the number of dma buffers to allocate */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) *bpl_entries = (size % LPFC_BPL_SIZE ? size/LPFC_BPL_SIZE + 1 :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) size/LPFC_BPL_SIZE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) /* Allocate dma buffer and place in BPL passed */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) while (bytes_left) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) /* Allocate dma buffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) mp = kmalloc(sizeof(struct lpfc_dmabuf), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) if (!mp) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) if (mlist)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) lpfc_free_bsg_buffers(phba, mlist);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) INIT_LIST_HEAD(&mp->list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) mp->virt = lpfc_mbuf_alloc(phba, MEM_PRI, &(mp->phys));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) if (!mp->virt) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) kfree(mp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) if (mlist)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) lpfc_free_bsg_buffers(phba, mlist);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) /* Queue it to a linked list */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) if (!mlist)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) mlist = mp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) list_add_tail(&mp->list, &mlist->list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) /* Add buffer to buffer pointer list */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) if (outbound_buffers)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) bpl->tus.f.bdeFlags = BUFF_TYPE_BDE_64;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) bpl->tus.f.bdeFlags = BUFF_TYPE_BDE_64I;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) bpl->addrLow = le32_to_cpu(putPaddrLow(mp->phys));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) bpl->addrHigh = le32_to_cpu(putPaddrHigh(mp->phys));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) bpl->tus.f.bdeSize = (uint16_t)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) (bytes_left >= LPFC_BPL_SIZE ? LPFC_BPL_SIZE :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) bytes_left);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) bytes_left -= bpl->tus.f.bdeSize;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) bpl->tus.w = le32_to_cpu(bpl->tus.w);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) bpl++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) return mlist;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) static unsigned int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) lpfc_bsg_copy_data(struct lpfc_dmabuf *dma_buffers,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) struct bsg_buffer *bsg_buffers,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) unsigned int bytes_to_transfer, int to_buffers)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) struct lpfc_dmabuf *mp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) unsigned int transfer_bytes, bytes_copied = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) unsigned int sg_offset, dma_offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) unsigned char *dma_address, *sg_address;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) LIST_HEAD(temp_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) struct sg_mapping_iter miter;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) unsigned int sg_flags = SG_MITER_ATOMIC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) bool sg_valid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) list_splice_init(&dma_buffers->list, &temp_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) list_add(&dma_buffers->list, &temp_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) sg_offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) if (to_buffers)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) sg_flags |= SG_MITER_FROM_SG;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) sg_flags |= SG_MITER_TO_SG;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) sg_miter_start(&miter, bsg_buffers->sg_list, bsg_buffers->sg_cnt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) sg_flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) local_irq_save(flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) sg_valid = sg_miter_next(&miter);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) list_for_each_entry(mp, &temp_list, list) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) dma_offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) while (bytes_to_transfer && sg_valid &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) (dma_offset < LPFC_BPL_SIZE)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) dma_address = mp->virt + dma_offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) if (sg_offset) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) /* Continue previous partial transfer of sg */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) sg_address = miter.addr + sg_offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) transfer_bytes = miter.length - sg_offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) sg_address = miter.addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) transfer_bytes = miter.length;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) if (bytes_to_transfer < transfer_bytes)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) transfer_bytes = bytes_to_transfer;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) if (transfer_bytes > (LPFC_BPL_SIZE - dma_offset))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) transfer_bytes = LPFC_BPL_SIZE - dma_offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) if (to_buffers)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) memcpy(dma_address, sg_address, transfer_bytes);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) memcpy(sg_address, dma_address, transfer_bytes);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) dma_offset += transfer_bytes;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) sg_offset += transfer_bytes;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) bytes_to_transfer -= transfer_bytes;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) bytes_copied += transfer_bytes;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) if (sg_offset >= miter.length) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) sg_offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) sg_valid = sg_miter_next(&miter);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) sg_miter_stop(&miter);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) local_irq_restore(flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) list_del_init(&dma_buffers->list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) list_splice(&temp_list, &dma_buffers->list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) return bytes_copied;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) * lpfc_bsg_send_mgmt_cmd_cmp - lpfc_bsg_send_mgmt_cmd's completion handler
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) * @cmdiocbq: Pointer to command iocb.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) * @rspiocbq: Pointer to response iocb.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) * This function is the completion handler for iocbs issued using
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) * lpfc_bsg_send_mgmt_cmd function. This function is called by the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) * ring event handler function without any lock held. This function
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) * can be called from both worker thread context and interrupt
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) * context. This function also can be called from another thread which
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) * cleans up the SLI layer objects.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) * This function copies the contents of the response iocb to the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) * response iocb memory object provided by the caller of
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) * lpfc_sli_issue_iocb_wait and then wakes up the thread which
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) * sleeps for the iocb completion.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) lpfc_bsg_send_mgmt_cmd_cmp(struct lpfc_hba *phba,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) struct lpfc_iocbq *cmdiocbq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) struct lpfc_iocbq *rspiocbq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) struct bsg_job_data *dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) struct bsg_job *job;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) struct fc_bsg_reply *bsg_reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) IOCB_t *rsp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) struct lpfc_dmabuf *bmp, *cmp, *rmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) struct lpfc_nodelist *ndlp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) struct lpfc_bsg_iocb *iocb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) unsigned int rsp_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) int rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) dd_data = cmdiocbq->context1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) /* Determine if job has been aborted */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) spin_lock_irqsave(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) job = dd_data->set_job;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) if (job) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) /* Prevent timeout handling from trying to abort job */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) job->dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) /* Close the timeout handler abort window */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) spin_lock_irqsave(&phba->hbalock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) cmdiocbq->iocb_flag &= ~LPFC_IO_CMD_OUTSTANDING;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) spin_unlock_irqrestore(&phba->hbalock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) iocb = &dd_data->context_un.iocb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) ndlp = iocb->ndlp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) rmp = iocb->rmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) cmp = cmdiocbq->context2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) bmp = cmdiocbq->context3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) rsp = &rspiocbq->iocb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) /* Copy the completed data or set the error status */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) if (job) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) if (rsp->ulpStatus) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) if (rsp->ulpStatus == IOSTAT_LOCAL_REJECT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) switch (rsp->un.ulpWord[4] & IOERR_PARAM_MASK) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) case IOERR_SEQUENCE_TIMEOUT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) rc = -ETIMEDOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) case IOERR_INVALID_RPI:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) rc = -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) rc = -EACCES;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) rc = -EACCES;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) rsp_size = rsp->un.genreq64.bdl.bdeSize;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) bsg_reply->reply_payload_rcv_len =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) lpfc_bsg_copy_data(rmp, &job->reply_payload,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) rsp_size, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) lpfc_free_bsg_buffers(phba, cmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) lpfc_free_bsg_buffers(phba, rmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) lpfc_mbuf_free(phba, bmp->virt, bmp->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) kfree(bmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) lpfc_sli_release_iocbq(phba, cmdiocbq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) lpfc_nlp_put(ndlp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) kfree(dd_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) /* Complete the job if the job is still active */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) if (job) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) bsg_reply->result = rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) bsg_job_done(job, bsg_reply->result,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) bsg_reply->reply_payload_rcv_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) * lpfc_bsg_send_mgmt_cmd - send a CT command from a bsg request
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) * @job: fc_bsg_job to handle
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) lpfc_bsg_send_mgmt_cmd(struct bsg_job *job)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) struct lpfc_vport *vport = shost_priv(fc_bsg_to_shost(job));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) struct lpfc_hba *phba = vport->phba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) struct lpfc_rport_data *rdata = fc_bsg_to_rport(job)->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) struct lpfc_nodelist *ndlp = rdata->pnode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) struct fc_bsg_reply *bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) struct ulp_bde64 *bpl = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) uint32_t timeout;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) struct lpfc_iocbq *cmdiocbq = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) IOCB_t *cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) struct lpfc_dmabuf *bmp = NULL, *cmp = NULL, *rmp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) int request_nseg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) int reply_nseg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) struct bsg_job_data *dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) uint32_t creg_val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) int rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) int iocb_stat;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) /* in case no data is transferred */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) bsg_reply->reply_payload_rcv_len = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) /* allocate our bsg tracking structure */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) dd_data = kmalloc(sizeof(struct bsg_job_data), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) if (!dd_data) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) "2733 Failed allocation of dd_data\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) goto no_dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) if (!lpfc_nlp_get(ndlp)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) rc = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) goto no_ndlp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) if (ndlp->nlp_flag & NLP_ELS_SND_MASK) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) rc = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) goto free_ndlp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) cmdiocbq = lpfc_sli_get_iocbq(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) if (!cmdiocbq) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) goto free_ndlp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) cmd = &cmdiocbq->iocb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) bmp = kmalloc(sizeof(struct lpfc_dmabuf), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) if (!bmp) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) goto free_cmdiocbq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) bmp->virt = lpfc_mbuf_alloc(phba, 0, &bmp->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) if (!bmp->virt) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) goto free_bmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) INIT_LIST_HEAD(&bmp->list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) bpl = (struct ulp_bde64 *) bmp->virt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) request_nseg = LPFC_BPL_SIZE/sizeof(struct ulp_bde64);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) cmp = lpfc_alloc_bsg_buffers(phba, job->request_payload.payload_len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) 1, bpl, &request_nseg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) if (!cmp) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) goto free_bmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) lpfc_bsg_copy_data(cmp, &job->request_payload,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) job->request_payload.payload_len, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) bpl += request_nseg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) reply_nseg = LPFC_BPL_SIZE/sizeof(struct ulp_bde64) - request_nseg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) rmp = lpfc_alloc_bsg_buffers(phba, job->reply_payload.payload_len, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) bpl, &reply_nseg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) if (!rmp) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) goto free_cmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) cmd->un.genreq64.bdl.ulpIoTag32 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) cmd->un.genreq64.bdl.addrHigh = putPaddrHigh(bmp->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) cmd->un.genreq64.bdl.addrLow = putPaddrLow(bmp->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) cmd->un.genreq64.bdl.bdeFlags = BUFF_TYPE_BLP_64;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) cmd->un.genreq64.bdl.bdeSize =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) (request_nseg + reply_nseg) * sizeof(struct ulp_bde64);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) cmd->ulpCommand = CMD_GEN_REQUEST64_CR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) cmd->un.genreq64.w5.hcsw.Fctl = (SI | LA);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) cmd->un.genreq64.w5.hcsw.Dfctl = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) cmd->un.genreq64.w5.hcsw.Rctl = FC_RCTL_DD_UNSOL_CTL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) cmd->un.genreq64.w5.hcsw.Type = FC_TYPE_CT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) cmd->ulpBdeCount = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) cmd->ulpLe = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) cmd->ulpClass = CLASS3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) cmd->ulpContext = ndlp->nlp_rpi;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) if (phba->sli_rev == LPFC_SLI_REV4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) cmd->ulpContext = phba->sli4_hba.rpi_ids[ndlp->nlp_rpi];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) cmd->ulpOwner = OWN_CHIP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) cmdiocbq->vport = phba->pport;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) cmdiocbq->context3 = bmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) cmdiocbq->iocb_flag |= LPFC_IO_LIBDFC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) timeout = phba->fc_ratov * 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) cmd->ulpTimeout = timeout;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) cmdiocbq->iocb_cmpl = lpfc_bsg_send_mgmt_cmd_cmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) cmdiocbq->context1 = dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) cmdiocbq->context2 = cmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) cmdiocbq->context3 = bmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) cmdiocbq->context_un.ndlp = ndlp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) dd_data->type = TYPE_IOCB;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) dd_data->set_job = job;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) dd_data->context_un.iocb.cmdiocbq = cmdiocbq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) dd_data->context_un.iocb.ndlp = ndlp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) dd_data->context_un.iocb.rmp = rmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) job->dd_data = dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) if (phba->cfg_poll & DISABLE_FCP_RING_INT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) if (lpfc_readl(phba->HCregaddr, &creg_val)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) rc = -EIO ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) goto free_rmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) creg_val |= (HC_R0INT_ENA << LPFC_FCP_RING);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) writel(creg_val, phba->HCregaddr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) readl(phba->HCregaddr); /* flush */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) iocb_stat = lpfc_sli_issue_iocb(phba, LPFC_ELS_RING, cmdiocbq, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) if (iocb_stat == IOCB_SUCCESS) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) spin_lock_irqsave(&phba->hbalock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) /* make sure the I/O had not been completed yet */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) if (cmdiocbq->iocb_flag & LPFC_IO_LIBDFC) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) /* open up abort window to timeout handler */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) cmdiocbq->iocb_flag |= LPFC_IO_CMD_OUTSTANDING;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) spin_unlock_irqrestore(&phba->hbalock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) return 0; /* done for now */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) } else if (iocb_stat == IOCB_BUSY) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) rc = -EAGAIN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) rc = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) /* iocb failed so cleanup */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) job->dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) free_rmp:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) lpfc_free_bsg_buffers(phba, rmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) free_cmp:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) lpfc_free_bsg_buffers(phba, cmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) free_bmp:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) if (bmp->virt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) lpfc_mbuf_free(phba, bmp->virt, bmp->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) kfree(bmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) free_cmdiocbq:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) lpfc_sli_release_iocbq(phba, cmdiocbq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) free_ndlp:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) lpfc_nlp_put(ndlp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) no_ndlp:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) kfree(dd_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) no_dd_data:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) /* make error code available to userspace */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) bsg_reply->result = rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) job->dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) * lpfc_bsg_rport_els_cmp - lpfc_bsg_rport_els's completion handler
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) * @cmdiocbq: Pointer to command iocb.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) * @rspiocbq: Pointer to response iocb.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) * This function is the completion handler for iocbs issued using
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) * lpfc_bsg_rport_els_cmp function. This function is called by the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) * ring event handler function without any lock held. This function
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) * can be called from both worker thread context and interrupt
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) * context. This function also can be called from other thread which
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) * cleans up the SLI layer objects.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) * This function copies the contents of the response iocb to the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) * response iocb memory object provided by the caller of
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) * lpfc_sli_issue_iocb_wait and then wakes up the thread which
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) * sleeps for the iocb completion.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) lpfc_bsg_rport_els_cmp(struct lpfc_hba *phba,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) struct lpfc_iocbq *cmdiocbq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) struct lpfc_iocbq *rspiocbq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) struct bsg_job_data *dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) struct bsg_job *job;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) struct fc_bsg_reply *bsg_reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) IOCB_t *rsp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) struct lpfc_nodelist *ndlp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) struct lpfc_dmabuf *pcmd = NULL, *prsp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) struct fc_bsg_ctels_reply *els_reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) uint8_t *rjt_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) unsigned int rsp_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) int rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) dd_data = cmdiocbq->context1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) ndlp = dd_data->context_un.iocb.ndlp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) cmdiocbq->context1 = ndlp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) /* Determine if job has been aborted */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) spin_lock_irqsave(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) job = dd_data->set_job;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) if (job) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) /* Prevent timeout handling from trying to abort job */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) job->dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606) /* Close the timeout handler abort window */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607) spin_lock_irqsave(&phba->hbalock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) cmdiocbq->iocb_flag &= ~LPFC_IO_CMD_OUTSTANDING;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609) spin_unlock_irqrestore(&phba->hbalock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611) rsp = &rspiocbq->iocb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612) pcmd = (struct lpfc_dmabuf *)cmdiocbq->context2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613) prsp = (struct lpfc_dmabuf *)pcmd->list.next;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615) /* Copy the completed job data or determine the job status if job is
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616) * still active
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619) if (job) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620) if (rsp->ulpStatus == IOSTAT_SUCCESS) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621) rsp_size = rsp->un.elsreq64.bdl.bdeSize;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) bsg_reply->reply_payload_rcv_len =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623) sg_copy_from_buffer(job->reply_payload.sg_list,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624) job->reply_payload.sg_cnt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625) prsp->virt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626) rsp_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627) } else if (rsp->ulpStatus == IOSTAT_LS_RJT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628) bsg_reply->reply_payload_rcv_len =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629) sizeof(struct fc_bsg_ctels_reply);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630) /* LS_RJT data returned in word 4 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631) rjt_data = (uint8_t *)&rsp->un.ulpWord[4];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632) els_reply = &bsg_reply->reply_data.ctels_reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633) els_reply->status = FC_CTELS_STATUS_REJECT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634) els_reply->rjt_data.action = rjt_data[3];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 635) els_reply->rjt_data.reason_code = rjt_data[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 636) els_reply->rjt_data.reason_explanation = rjt_data[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 637) els_reply->rjt_data.vendor_unique = rjt_data[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 638) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 639) rc = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 640) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 641) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 642)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 643) lpfc_nlp_put(ndlp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 644) lpfc_els_free_iocb(phba, cmdiocbq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 645) kfree(dd_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 646)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 647) /* Complete the job if the job is still active */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 648)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 649) if (job) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 650) bsg_reply->result = rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 651) bsg_job_done(job, bsg_reply->result,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 652) bsg_reply->reply_payload_rcv_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 653) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 654) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 655) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 656)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 657) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 658) * lpfc_bsg_rport_els - send an ELS command from a bsg request
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 659) * @job: fc_bsg_job to handle
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 660) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 661) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 662) lpfc_bsg_rport_els(struct bsg_job *job)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 663) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 664) struct lpfc_vport *vport = shost_priv(fc_bsg_to_shost(job));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 665) struct lpfc_hba *phba = vport->phba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 666) struct lpfc_rport_data *rdata = fc_bsg_to_rport(job)->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 667) struct lpfc_nodelist *ndlp = rdata->pnode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 668) struct fc_bsg_request *bsg_request = job->request;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 669) struct fc_bsg_reply *bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 670) uint32_t elscmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 671) uint32_t cmdsize;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 672) struct lpfc_iocbq *cmdiocbq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 673) uint16_t rpi = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 674) struct bsg_job_data *dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 675) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 676) uint32_t creg_val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 677) int rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 678)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 679) /* in case no data is transferred */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 680) bsg_reply->reply_payload_rcv_len = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 681)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 682) /* verify the els command is not greater than the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 683) * maximum ELS transfer size.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 684) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 685)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 686) if (job->request_payload.payload_len > FCELSSIZE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 687) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 688) goto no_dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 689) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 690)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 691) /* allocate our bsg tracking structure */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 692) dd_data = kmalloc(sizeof(struct bsg_job_data), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 693) if (!dd_data) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 694) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 695) "2735 Failed allocation of dd_data\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 696) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 697) goto no_dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 698) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 699)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 700) elscmd = bsg_request->rqst_data.r_els.els_code;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 701) cmdsize = job->request_payload.payload_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 702)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 703) if (!lpfc_nlp_get(ndlp)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 704) rc = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 705) goto free_dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 706) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 707)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 708) /* We will use the allocated dma buffers by prep els iocb for command
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 709) * and response to ensure if the job times out and the request is freed,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 710) * we won't be dma into memory that is no longer allocated to for the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 711) * request.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 712) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 713)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 714) cmdiocbq = lpfc_prep_els_iocb(vport, 1, cmdsize, 0, ndlp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 715) ndlp->nlp_DID, elscmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 716) if (!cmdiocbq) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 717) rc = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 718) goto release_ndlp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 719) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 720)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 721) rpi = ndlp->nlp_rpi;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 722)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 723) /* Transfer the request payload to allocated command dma buffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 724)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 725) sg_copy_to_buffer(job->request_payload.sg_list,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 726) job->request_payload.sg_cnt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 727) ((struct lpfc_dmabuf *)cmdiocbq->context2)->virt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 728) cmdsize);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 729)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 730) if (phba->sli_rev == LPFC_SLI_REV4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 731) cmdiocbq->iocb.ulpContext = phba->sli4_hba.rpi_ids[rpi];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 732) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 733) cmdiocbq->iocb.ulpContext = rpi;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 734) cmdiocbq->iocb_flag |= LPFC_IO_LIBDFC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 735) cmdiocbq->context1 = dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 736) cmdiocbq->context_un.ndlp = ndlp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 737) cmdiocbq->iocb_cmpl = lpfc_bsg_rport_els_cmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 738) dd_data->type = TYPE_IOCB;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 739) dd_data->set_job = job;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 740) dd_data->context_un.iocb.cmdiocbq = cmdiocbq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 741) dd_data->context_un.iocb.ndlp = ndlp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 742) dd_data->context_un.iocb.rmp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 743) job->dd_data = dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 744)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 745) if (phba->cfg_poll & DISABLE_FCP_RING_INT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 746) if (lpfc_readl(phba->HCregaddr, &creg_val)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 747) rc = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 748) goto linkdown_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 749) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 750) creg_val |= (HC_R0INT_ENA << LPFC_FCP_RING);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 751) writel(creg_val, phba->HCregaddr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 752) readl(phba->HCregaddr); /* flush */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 753) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 754)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 755) rc = lpfc_sli_issue_iocb(phba, LPFC_ELS_RING, cmdiocbq, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 756)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 757) if (rc == IOCB_SUCCESS) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 758) spin_lock_irqsave(&phba->hbalock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 759) /* make sure the I/O had not been completed/released */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 760) if (cmdiocbq->iocb_flag & LPFC_IO_LIBDFC) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 761) /* open up abort window to timeout handler */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 762) cmdiocbq->iocb_flag |= LPFC_IO_CMD_OUTSTANDING;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 763) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 764) spin_unlock_irqrestore(&phba->hbalock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 765) return 0; /* done for now */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 766) } else if (rc == IOCB_BUSY) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 767) rc = -EAGAIN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 768) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 769) rc = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 770) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 771)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 772) /* iocb failed so cleanup */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 773) job->dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 774)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 775) linkdown_err:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 776) cmdiocbq->context1 = ndlp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 777) lpfc_els_free_iocb(phba, cmdiocbq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 778)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 779) release_ndlp:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 780) lpfc_nlp_put(ndlp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 781)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 782) free_dd_data:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 783) kfree(dd_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 784)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 785) no_dd_data:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 786) /* make error code available to userspace */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 787) bsg_reply->result = rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 788) job->dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 789) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 790) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 791)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 792) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 793) * lpfc_bsg_event_free - frees an allocated event structure
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 794) * @kref: Pointer to a kref.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 795) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 796) * Called from kref_put. Back cast the kref into an event structure address.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 797) * Free any events to get, delete associated nodes, free any events to see,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 798) * free any data then free the event itself.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 799) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 800) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 801) lpfc_bsg_event_free(struct kref *kref)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 802) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 803) struct lpfc_bsg_event *evt = container_of(kref, struct lpfc_bsg_event,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 804) kref);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 805) struct event_data *ed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 806)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 807) list_del(&evt->node);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 808)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 809) while (!list_empty(&evt->events_to_get)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 810) ed = list_entry(evt->events_to_get.next, typeof(*ed), node);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 811) list_del(&ed->node);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 812) kfree(ed->data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 813) kfree(ed);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 814) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 815)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 816) while (!list_empty(&evt->events_to_see)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 817) ed = list_entry(evt->events_to_see.next, typeof(*ed), node);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 818) list_del(&ed->node);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 819) kfree(ed->data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 820) kfree(ed);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 821) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 822)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 823) kfree(evt->dd_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 824) kfree(evt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 825) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 826)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 827) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 828) * lpfc_bsg_event_ref - increments the kref for an event
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 829) * @evt: Pointer to an event structure.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 830) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 831) static inline void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 832) lpfc_bsg_event_ref(struct lpfc_bsg_event *evt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 833) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 834) kref_get(&evt->kref);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 835) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 836)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 837) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 838) * lpfc_bsg_event_unref - Uses kref_put to free an event structure
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 839) * @evt: Pointer to an event structure.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 840) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 841) static inline void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 842) lpfc_bsg_event_unref(struct lpfc_bsg_event *evt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 843) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 844) kref_put(&evt->kref, lpfc_bsg_event_free);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 845) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 846)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 847) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 848) * lpfc_bsg_event_new - allocate and initialize a event structure
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 849) * @ev_mask: Mask of events.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 850) * @ev_reg_id: Event reg id.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 851) * @ev_req_id: Event request id.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 852) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 853) static struct lpfc_bsg_event *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 854) lpfc_bsg_event_new(uint32_t ev_mask, int ev_reg_id, uint32_t ev_req_id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 855) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 856) struct lpfc_bsg_event *evt = kzalloc(sizeof(*evt), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 857)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 858) if (!evt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 859) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 860)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 861) INIT_LIST_HEAD(&evt->events_to_get);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 862) INIT_LIST_HEAD(&evt->events_to_see);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 863) evt->type_mask = ev_mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 864) evt->req_id = ev_req_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 865) evt->reg_id = ev_reg_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 866) evt->wait_time_stamp = jiffies;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 867) evt->dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 868) init_waitqueue_head(&evt->wq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 869) kref_init(&evt->kref);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 870) return evt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 871) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 872)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 873) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 874) * diag_cmd_data_free - Frees an lpfc dma buffer extension
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 875) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 876) * @mlist: Pointer to an lpfc dma buffer extension.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 877) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 878) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 879) diag_cmd_data_free(struct lpfc_hba *phba, struct lpfc_dmabufext *mlist)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 880) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 881) struct lpfc_dmabufext *mlast;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 882) struct pci_dev *pcidev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 883) struct list_head head, *curr, *next;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 884)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 885) if ((!mlist) || (!lpfc_is_link_up(phba) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 886) (phba->link_flag & LS_LOOPBACK_MODE))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 887) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 888) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 889)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 890) pcidev = phba->pcidev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 891) list_add_tail(&head, &mlist->dma.list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 892)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 893) list_for_each_safe(curr, next, &head) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 894) mlast = list_entry(curr, struct lpfc_dmabufext , dma.list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 895) if (mlast->dma.virt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 896) dma_free_coherent(&pcidev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 897) mlast->size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 898) mlast->dma.virt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 899) mlast->dma.phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 900) kfree(mlast);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 901) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 902) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 903) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 904)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 905) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 906) * lpfc_bsg_ct_unsol_event - process an unsolicited CT command
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 907) * @phba:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 908) * @pring:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 909) * @piocbq:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 910) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 911) * This function is called when an unsolicited CT command is received. It
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 912) * forwards the event to any processes registered to receive CT events.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 913) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 914) int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 915) lpfc_bsg_ct_unsol_event(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 916) struct lpfc_iocbq *piocbq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 917) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 918) uint32_t evt_req_id = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 919) uint32_t cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 920) struct lpfc_dmabuf *dmabuf = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 921) struct lpfc_bsg_event *evt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 922) struct event_data *evt_dat = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 923) struct lpfc_iocbq *iocbq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 924) size_t offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 925) struct list_head head;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 926) struct ulp_bde64 *bde;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 927) dma_addr_t dma_addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 928) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 929) struct lpfc_dmabuf *bdeBuf1 = piocbq->context2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 930) struct lpfc_dmabuf *bdeBuf2 = piocbq->context3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 931) struct lpfc_hbq_entry *hbqe;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 932) struct lpfc_sli_ct_request *ct_req;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 933) struct bsg_job *job = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 934) struct fc_bsg_reply *bsg_reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 935) struct bsg_job_data *dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 936) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 937) int size = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 938)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 939) INIT_LIST_HEAD(&head);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 940) list_add_tail(&head, &piocbq->list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 941)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 942) if (piocbq->iocb.ulpBdeCount == 0 ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 943) piocbq->iocb.un.cont64[0].tus.f.bdeSize == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 944) goto error_ct_unsol_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 945)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 946) if (phba->link_state == LPFC_HBA_ERROR ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 947) (!(phba->sli.sli_flag & LPFC_SLI_ACTIVE)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 948) goto error_ct_unsol_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 949)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 950) if (phba->sli3_options & LPFC_SLI3_HBQ_ENABLED)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 951) dmabuf = bdeBuf1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 952) else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 953) dma_addr = getPaddr(piocbq->iocb.un.cont64[0].addrHigh,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 954) piocbq->iocb.un.cont64[0].addrLow);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 955) dmabuf = lpfc_sli_ringpostbuf_get(phba, pring, dma_addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 956) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 957) if (dmabuf == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 958) goto error_ct_unsol_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 959) ct_req = (struct lpfc_sli_ct_request *)dmabuf->virt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 960) evt_req_id = ct_req->FsType;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 961) cmd = ct_req->CommandResponse.bits.CmdRsp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 962) if (!(phba->sli3_options & LPFC_SLI3_HBQ_ENABLED))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 963) lpfc_sli_ringpostbuf_put(phba, pring, dmabuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 964)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 965) spin_lock_irqsave(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 966) list_for_each_entry(evt, &phba->ct_ev_waiters, node) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 967) if (!(evt->type_mask & FC_REG_CT_EVENT) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 968) evt->req_id != evt_req_id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 969) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 970)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 971) lpfc_bsg_event_ref(evt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 972) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 973) evt_dat = kzalloc(sizeof(*evt_dat), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 974) if (evt_dat == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 975) spin_lock_irqsave(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 976) lpfc_bsg_event_unref(evt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 977) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 978) "2614 Memory allocation failed for "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 979) "CT event\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 980) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 981) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 982)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 983) if (phba->sli3_options & LPFC_SLI3_HBQ_ENABLED) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 984) /* take accumulated byte count from the last iocbq */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 985) iocbq = list_entry(head.prev, typeof(*iocbq), list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 986) evt_dat->len = iocbq->iocb.unsli3.rcvsli3.acc_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 987) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 988) list_for_each_entry(iocbq, &head, list) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 989) for (i = 0; i < iocbq->iocb.ulpBdeCount; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 990) evt_dat->len +=
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 991) iocbq->iocb.un.cont64[i].tus.f.bdeSize;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 992) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 993) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 994)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 995) evt_dat->data = kzalloc(evt_dat->len, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 996) if (evt_dat->data == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 997) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 998) "2615 Memory allocation failed for "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 999) "CT event data, size %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1000) evt_dat->len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1001) kfree(evt_dat);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1002) spin_lock_irqsave(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1003) lpfc_bsg_event_unref(evt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1004) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1005) goto error_ct_unsol_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1006) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1007)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1008) list_for_each_entry(iocbq, &head, list) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1009) size = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1010) if (phba->sli3_options & LPFC_SLI3_HBQ_ENABLED) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1011) bdeBuf1 = iocbq->context2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1012) bdeBuf2 = iocbq->context3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1013) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1014) for (i = 0; i < iocbq->iocb.ulpBdeCount; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1015) if (phba->sli3_options &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1016) LPFC_SLI3_HBQ_ENABLED) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1017) if (i == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1018) hbqe = (struct lpfc_hbq_entry *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1019) &iocbq->iocb.un.ulpWord[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1020) size = hbqe->bde.tus.f.bdeSize;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1021) dmabuf = bdeBuf1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1022) } else if (i == 1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1023) hbqe = (struct lpfc_hbq_entry *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1024) &iocbq->iocb.unsli3.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1025) sli3Words[4];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1026) size = hbqe->bde.tus.f.bdeSize;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1027) dmabuf = bdeBuf2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1028) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1029) if ((offset + size) > evt_dat->len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1030) size = evt_dat->len - offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1031) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1032) size = iocbq->iocb.un.cont64[i].
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1033) tus.f.bdeSize;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1034) bde = &iocbq->iocb.un.cont64[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1035) dma_addr = getPaddr(bde->addrHigh,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1036) bde->addrLow);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1037) dmabuf = lpfc_sli_ringpostbuf_get(phba,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1038) pring, dma_addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1039) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1040) if (!dmabuf) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1041) lpfc_printf_log(phba, KERN_ERR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1042) LOG_LIBDFC, "2616 No dmabuf "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1043) "found for iocbq x%px\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1044) iocbq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1045) kfree(evt_dat->data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1046) kfree(evt_dat);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1047) spin_lock_irqsave(&phba->ct_ev_lock,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1048) flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1049) lpfc_bsg_event_unref(evt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1050) spin_unlock_irqrestore(
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1051) &phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1052) goto error_ct_unsol_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1053) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1054) memcpy((char *)(evt_dat->data) + offset,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1055) dmabuf->virt, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1056) offset += size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1057) if (evt_req_id != SLI_CT_ELX_LOOPBACK &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1058) !(phba->sli3_options &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1059) LPFC_SLI3_HBQ_ENABLED)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1060) lpfc_sli_ringpostbuf_put(phba, pring,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1061) dmabuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1062) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1063) switch (cmd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1064) case ELX_LOOPBACK_DATA:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1065) if (phba->sli_rev <
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1066) LPFC_SLI_REV4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1067) diag_cmd_data_free(phba,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1068) (struct lpfc_dmabufext
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1069) *)dmabuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1070) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1071) case ELX_LOOPBACK_XRI_SETUP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1072) if ((phba->sli_rev ==
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1073) LPFC_SLI_REV2) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1074) (phba->sli3_options &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1075) LPFC_SLI3_HBQ_ENABLED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1076) )) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1077) lpfc_in_buf_free(phba,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1078) dmabuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1079) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1080) lpfc_post_buffer(phba,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1081) pring,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1082) 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1083) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1084) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1085) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1086) if (!(phba->sli3_options &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1087) LPFC_SLI3_HBQ_ENABLED))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1088) lpfc_post_buffer(phba,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1089) pring,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1090) 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1091) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1092) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1093) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1094) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1095) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1096)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1097) spin_lock_irqsave(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1098) if (phba->sli_rev == LPFC_SLI_REV4) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1099) evt_dat->immed_dat = phba->ctx_idx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1100) phba->ctx_idx = (phba->ctx_idx + 1) % LPFC_CT_CTX_MAX;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1101) /* Provide warning for over-run of the ct_ctx array */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1102) if (phba->ct_ctx[evt_dat->immed_dat].valid ==
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1103) UNSOL_VALID)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1104) lpfc_printf_log(phba, KERN_WARNING, LOG_ELS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1105) "2717 CT context array entry "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1106) "[%d] over-run: oxid:x%x, "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1107) "sid:x%x\n", phba->ctx_idx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1108) phba->ct_ctx[
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1109) evt_dat->immed_dat].oxid,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1110) phba->ct_ctx[
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1111) evt_dat->immed_dat].SID);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1112) phba->ct_ctx[evt_dat->immed_dat].rxid =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1113) piocbq->iocb.ulpContext;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1114) phba->ct_ctx[evt_dat->immed_dat].oxid =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1115) piocbq->iocb.unsli3.rcvsli3.ox_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1116) phba->ct_ctx[evt_dat->immed_dat].SID =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1117) piocbq->iocb.un.rcvels.remoteID;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1118) phba->ct_ctx[evt_dat->immed_dat].valid = UNSOL_VALID;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1119) } else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1120) evt_dat->immed_dat = piocbq->iocb.ulpContext;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1121)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1122) evt_dat->type = FC_REG_CT_EVENT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1123) list_add(&evt_dat->node, &evt->events_to_see);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1124) if (evt_req_id == SLI_CT_ELX_LOOPBACK) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1125) wake_up_interruptible(&evt->wq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1126) lpfc_bsg_event_unref(evt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1127) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1128) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1129)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1130) list_move(evt->events_to_see.prev, &evt->events_to_get);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1131)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1132) dd_data = (struct bsg_job_data *)evt->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1133) job = dd_data->set_job;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1134) dd_data->set_job = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1135) lpfc_bsg_event_unref(evt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1136) if (job) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1137) bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1138) bsg_reply->reply_payload_rcv_len = size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1139) /* make error code available to userspace */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1140) bsg_reply->result = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1141) job->dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1142) /* complete the job back to userspace */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1143) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1144) bsg_job_done(job, bsg_reply->result,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1145) bsg_reply->reply_payload_rcv_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1146) spin_lock_irqsave(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1147) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1148) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1149) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1150)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1151) error_ct_unsol_exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1152) if (!list_empty(&head))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1153) list_del(&head);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1154) if ((phba->sli_rev < LPFC_SLI_REV4) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1155) (evt_req_id == SLI_CT_ELX_LOOPBACK))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1156) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1157) return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1158) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1159)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1160) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1161) * lpfc_bsg_ct_unsol_abort - handler ct abort to management plane
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1162) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1163) * @dmabuf: pointer to a dmabuf that describes the FC sequence
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1164) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1165) * This function handles abort to the CT command toward management plane
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1166) * for SLI4 port.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1167) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1168) * If the pending context of a CT command to management plane present, clears
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1169) * such context and returns 1 for handled; otherwise, it returns 0 indicating
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1170) * no context exists.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1171) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1172) int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1173) lpfc_bsg_ct_unsol_abort(struct lpfc_hba *phba, struct hbq_dmabuf *dmabuf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1174) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1175) struct fc_frame_header fc_hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1176) struct fc_frame_header *fc_hdr_ptr = &fc_hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1177) int ctx_idx, handled = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1178) uint16_t oxid, rxid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1179) uint32_t sid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1180)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1181) memcpy(fc_hdr_ptr, dmabuf->hbuf.virt, sizeof(struct fc_frame_header));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1182) sid = sli4_sid_from_fc_hdr(fc_hdr_ptr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1183) oxid = be16_to_cpu(fc_hdr_ptr->fh_ox_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1184) rxid = be16_to_cpu(fc_hdr_ptr->fh_rx_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1185)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1186) for (ctx_idx = 0; ctx_idx < LPFC_CT_CTX_MAX; ctx_idx++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1187) if (phba->ct_ctx[ctx_idx].valid != UNSOL_VALID)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1188) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1189) if (phba->ct_ctx[ctx_idx].rxid != rxid)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1190) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1191) if (phba->ct_ctx[ctx_idx].oxid != oxid)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1192) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1193) if (phba->ct_ctx[ctx_idx].SID != sid)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1194) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1195) phba->ct_ctx[ctx_idx].valid = UNSOL_INVALID;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1196) handled = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1197) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1198) return handled;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1199) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1200)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1201) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1202) * lpfc_bsg_hba_set_event - process a SET_EVENT bsg vendor command
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1203) * @job: SET_EVENT fc_bsg_job
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1204) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1205) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1206) lpfc_bsg_hba_set_event(struct bsg_job *job)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1207) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1208) struct lpfc_vport *vport = shost_priv(fc_bsg_to_shost(job));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1209) struct lpfc_hba *phba = vport->phba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1210) struct fc_bsg_request *bsg_request = job->request;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1211) struct set_ct_event *event_req;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1212) struct lpfc_bsg_event *evt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1213) int rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1214) struct bsg_job_data *dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1215) uint32_t ev_mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1216) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1217)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1218) if (job->request_len <
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1219) sizeof(struct fc_bsg_request) + sizeof(struct set_ct_event)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1220) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1221) "2612 Received SET_CT_EVENT below minimum "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1222) "size\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1223) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1224) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1225) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1226)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1227) event_req = (struct set_ct_event *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1228) bsg_request->rqst_data.h_vendor.vendor_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1229) ev_mask = ((uint32_t)(unsigned long)event_req->type_mask &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1230) FC_REG_EVENT_MASK);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1231) spin_lock_irqsave(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1232) list_for_each_entry(evt, &phba->ct_ev_waiters, node) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1233) if (evt->reg_id == event_req->ev_reg_id) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1234) lpfc_bsg_event_ref(evt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1235) evt->wait_time_stamp = jiffies;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1236) dd_data = (struct bsg_job_data *)evt->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1237) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1238) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1239) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1240) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1241)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1242) if (&evt->node == &phba->ct_ev_waiters) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1243) /* no event waiting struct yet - first call */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1244) dd_data = kmalloc(sizeof(struct bsg_job_data), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1245) if (dd_data == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1246) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1247) "2734 Failed allocation of dd_data\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1248) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1249) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1250) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1251) evt = lpfc_bsg_event_new(ev_mask, event_req->ev_reg_id,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1252) event_req->ev_req_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1253) if (!evt) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1254) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1255) "2617 Failed allocation of event "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1256) "waiter\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1257) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1258) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1259) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1260) dd_data->type = TYPE_EVT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1261) dd_data->set_job = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1262) dd_data->context_un.evt = evt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1263) evt->dd_data = (void *)dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1264) spin_lock_irqsave(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1265) list_add(&evt->node, &phba->ct_ev_waiters);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1266) lpfc_bsg_event_ref(evt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1267) evt->wait_time_stamp = jiffies;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1268) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1269) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1270)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1271) spin_lock_irqsave(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1272) evt->waiting = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1273) dd_data->set_job = job; /* for unsolicited command */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1274) job->dd_data = dd_data; /* for fc transport timeout callback*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1275) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1276) return 0; /* call job done later */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1277)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1278) job_error:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1279) kfree(dd_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1280) job->dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1281) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1282) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1283)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1284) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1285) * lpfc_bsg_hba_get_event - process a GET_EVENT bsg vendor command
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1286) * @job: GET_EVENT fc_bsg_job
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1287) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1288) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1289) lpfc_bsg_hba_get_event(struct bsg_job *job)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1290) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1291) struct lpfc_vport *vport = shost_priv(fc_bsg_to_shost(job));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1292) struct lpfc_hba *phba = vport->phba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1293) struct fc_bsg_request *bsg_request = job->request;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1294) struct fc_bsg_reply *bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1295) struct get_ct_event *event_req;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1296) struct get_ct_event_reply *event_reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1297) struct lpfc_bsg_event *evt, *evt_next;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1298) struct event_data *evt_dat = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1299) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1300) uint32_t rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1301)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1302) if (job->request_len <
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1303) sizeof(struct fc_bsg_request) + sizeof(struct get_ct_event)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1304) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1305) "2613 Received GET_CT_EVENT request below "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1306) "minimum size\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1307) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1308) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1309) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1310)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1311) event_req = (struct get_ct_event *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1312) bsg_request->rqst_data.h_vendor.vendor_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1313)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1314) event_reply = (struct get_ct_event_reply *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1315) bsg_reply->reply_data.vendor_reply.vendor_rsp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1316) spin_lock_irqsave(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1317) list_for_each_entry_safe(evt, evt_next, &phba->ct_ev_waiters, node) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1318) if (evt->reg_id == event_req->ev_reg_id) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1319) if (list_empty(&evt->events_to_get))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1320) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1321) lpfc_bsg_event_ref(evt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1322) evt->wait_time_stamp = jiffies;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1323) evt_dat = list_entry(evt->events_to_get.prev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1324) struct event_data, node);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1325) list_del(&evt_dat->node);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1326) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1327) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1328) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1329) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1330)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1331) /* The app may continue to ask for event data until it gets
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1332) * an error indicating that there isn't anymore
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1333) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1334) if (evt_dat == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1335) bsg_reply->reply_payload_rcv_len = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1336) rc = -ENOENT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1337) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1338) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1339)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1340) if (evt_dat->len > job->request_payload.payload_len) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1341) evt_dat->len = job->request_payload.payload_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1342) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1343) "2618 Truncated event data at %d "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1344) "bytes\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1345) job->request_payload.payload_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1346) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1347)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1348) event_reply->type = evt_dat->type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1349) event_reply->immed_data = evt_dat->immed_dat;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1350) if (evt_dat->len > 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1351) bsg_reply->reply_payload_rcv_len =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1352) sg_copy_from_buffer(job->request_payload.sg_list,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1353) job->request_payload.sg_cnt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1354) evt_dat->data, evt_dat->len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1355) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1356) bsg_reply->reply_payload_rcv_len = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1357)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1358) if (evt_dat) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1359) kfree(evt_dat->data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1360) kfree(evt_dat);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1361) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1362)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1363) spin_lock_irqsave(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1364) lpfc_bsg_event_unref(evt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1365) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1366) job->dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1367) bsg_reply->result = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1368) bsg_job_done(job, bsg_reply->result,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1369) bsg_reply->reply_payload_rcv_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1370) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1371)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1372) job_error:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1373) job->dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1374) bsg_reply->result = rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1375) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1376) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1377)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1378) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1379) * lpfc_issue_ct_rsp_cmp - lpfc_issue_ct_rsp's completion handler
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1380) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1381) * @cmdiocbq: Pointer to command iocb.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1382) * @rspiocbq: Pointer to response iocb.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1383) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1384) * This function is the completion handler for iocbs issued using
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1385) * lpfc_issue_ct_rsp_cmp function. This function is called by the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1386) * ring event handler function without any lock held. This function
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1387) * can be called from both worker thread context and interrupt
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1388) * context. This function also can be called from other thread which
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1389) * cleans up the SLI layer objects.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1390) * This function copy the contents of the response iocb to the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1391) * response iocb memory object provided by the caller of
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1392) * lpfc_sli_issue_iocb_wait and then wakes up the thread which
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1393) * sleeps for the iocb completion.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1394) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1395) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1396) lpfc_issue_ct_rsp_cmp(struct lpfc_hba *phba,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1397) struct lpfc_iocbq *cmdiocbq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1398) struct lpfc_iocbq *rspiocbq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1399) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1400) struct bsg_job_data *dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1401) struct bsg_job *job;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1402) struct fc_bsg_reply *bsg_reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1403) IOCB_t *rsp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1404) struct lpfc_dmabuf *bmp, *cmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1405) struct lpfc_nodelist *ndlp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1406) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1407) int rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1408)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1409) dd_data = cmdiocbq->context1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1410)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1411) /* Determine if job has been aborted */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1412) spin_lock_irqsave(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1413) job = dd_data->set_job;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1414) if (job) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1415) /* Prevent timeout handling from trying to abort job */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1416) job->dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1417) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1418) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1419)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1420) /* Close the timeout handler abort window */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1421) spin_lock_irqsave(&phba->hbalock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1422) cmdiocbq->iocb_flag &= ~LPFC_IO_CMD_OUTSTANDING;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1423) spin_unlock_irqrestore(&phba->hbalock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1424)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1425) ndlp = dd_data->context_un.iocb.ndlp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1426) cmp = cmdiocbq->context2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1427) bmp = cmdiocbq->context3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1428) rsp = &rspiocbq->iocb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1429)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1430) /* Copy the completed job data or set the error status */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1431)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1432) if (job) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1433) bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1434) if (rsp->ulpStatus) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1435) if (rsp->ulpStatus == IOSTAT_LOCAL_REJECT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1436) switch (rsp->un.ulpWord[4] & IOERR_PARAM_MASK) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1437) case IOERR_SEQUENCE_TIMEOUT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1438) rc = -ETIMEDOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1439) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1440) case IOERR_INVALID_RPI:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1441) rc = -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1442) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1443) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1444) rc = -EACCES;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1445) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1446) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1447) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1448) rc = -EACCES;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1449) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1450) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1451) bsg_reply->reply_payload_rcv_len = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1452) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1453) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1454)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1455) lpfc_free_bsg_buffers(phba, cmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1456) lpfc_mbuf_free(phba, bmp->virt, bmp->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1457) kfree(bmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1458) lpfc_sli_release_iocbq(phba, cmdiocbq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1459) lpfc_nlp_put(ndlp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1460) kfree(dd_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1461)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1462) /* Complete the job if the job is still active */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1463)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1464) if (job) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1465) bsg_reply->result = rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1466) bsg_job_done(job, bsg_reply->result,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1467) bsg_reply->reply_payload_rcv_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1468) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1469) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1470) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1471)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1472) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1473) * lpfc_issue_ct_rsp - issue a ct response
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1474) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1475) * @job: Pointer to the job object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1476) * @tag: tag index value into the ports context exchange array.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1477) * @bmp: Pointer to a dma buffer descriptor.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1478) * @num_entry: Number of enties in the bde.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1479) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1480) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1481) lpfc_issue_ct_rsp(struct lpfc_hba *phba, struct bsg_job *job, uint32_t tag,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1482) struct lpfc_dmabuf *cmp, struct lpfc_dmabuf *bmp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1483) int num_entry)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1484) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1485) IOCB_t *icmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1486) struct lpfc_iocbq *ctiocb = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1487) int rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1488) struct lpfc_nodelist *ndlp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1489) struct bsg_job_data *dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1490) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1491) uint32_t creg_val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1492)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1493) /* allocate our bsg tracking structure */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1494) dd_data = kmalloc(sizeof(struct bsg_job_data), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1495) if (!dd_data) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1496) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1497) "2736 Failed allocation of dd_data\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1498) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1499) goto no_dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1500) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1501)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1502) /* Allocate buffer for command iocb */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1503) ctiocb = lpfc_sli_get_iocbq(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1504) if (!ctiocb) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1505) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1506) goto no_ctiocb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1507) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1508)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1509) icmd = &ctiocb->iocb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1510) icmd->un.xseq64.bdl.ulpIoTag32 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1511) icmd->un.xseq64.bdl.addrHigh = putPaddrHigh(bmp->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1512) icmd->un.xseq64.bdl.addrLow = putPaddrLow(bmp->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1513) icmd->un.xseq64.bdl.bdeFlags = BUFF_TYPE_BLP_64;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1514) icmd->un.xseq64.bdl.bdeSize = (num_entry * sizeof(struct ulp_bde64));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1515) icmd->un.xseq64.w5.hcsw.Fctl = (LS | LA);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1516) icmd->un.xseq64.w5.hcsw.Dfctl = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1517) icmd->un.xseq64.w5.hcsw.Rctl = FC_RCTL_DD_SOL_CTL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1518) icmd->un.xseq64.w5.hcsw.Type = FC_TYPE_CT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1519)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1520) /* Fill in rest of iocb */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1521) icmd->ulpCommand = CMD_XMIT_SEQUENCE64_CX;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1522) icmd->ulpBdeCount = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1523) icmd->ulpLe = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1524) icmd->ulpClass = CLASS3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1525) if (phba->sli_rev == LPFC_SLI_REV4) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1526) /* Do not issue unsol response if oxid not marked as valid */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1527) if (phba->ct_ctx[tag].valid != UNSOL_VALID) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1528) rc = IOCB_ERROR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1529) goto issue_ct_rsp_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1530) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1531) icmd->ulpContext = phba->ct_ctx[tag].rxid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1532) icmd->unsli3.rcvsli3.ox_id = phba->ct_ctx[tag].oxid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1533) ndlp = lpfc_findnode_did(phba->pport, phba->ct_ctx[tag].SID);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1534) if (!ndlp) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1535) lpfc_printf_log(phba, KERN_WARNING, LOG_ELS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1536) "2721 ndlp null for oxid %x SID %x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1537) icmd->ulpContext,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1538) phba->ct_ctx[tag].SID);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1539) rc = IOCB_ERROR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1540) goto issue_ct_rsp_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1541) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1542)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1543) /* Check if the ndlp is active */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1544) if (!ndlp || !NLP_CHK_NODE_ACT(ndlp)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1545) rc = IOCB_ERROR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1546) goto issue_ct_rsp_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1547) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1548)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1549) /* get a refernece count so the ndlp doesn't go away while
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1550) * we respond
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1551) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1552) if (!lpfc_nlp_get(ndlp)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1553) rc = IOCB_ERROR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1554) goto issue_ct_rsp_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1555) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1556)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1557) icmd->un.ulpWord[3] =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1558) phba->sli4_hba.rpi_ids[ndlp->nlp_rpi];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1559)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1560) /* The exchange is done, mark the entry as invalid */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1561) phba->ct_ctx[tag].valid = UNSOL_INVALID;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1562) } else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1563) icmd->ulpContext = (ushort) tag;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1564)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1565) icmd->ulpTimeout = phba->fc_ratov * 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1566)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1567) /* Xmit CT response on exchange <xid> */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1568) lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1569) "2722 Xmit CT response on exchange x%x Data: x%x x%x x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1570) icmd->ulpContext, icmd->ulpIoTag, tag, phba->link_state);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1571)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1572) ctiocb->iocb_flag |= LPFC_IO_LIBDFC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1573) ctiocb->vport = phba->pport;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1574) ctiocb->context1 = dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1575) ctiocb->context2 = cmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1576) ctiocb->context3 = bmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1577) ctiocb->context_un.ndlp = ndlp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1578) ctiocb->iocb_cmpl = lpfc_issue_ct_rsp_cmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1579)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1580) dd_data->type = TYPE_IOCB;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1581) dd_data->set_job = job;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1582) dd_data->context_un.iocb.cmdiocbq = ctiocb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1583) dd_data->context_un.iocb.ndlp = ndlp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1584) dd_data->context_un.iocb.rmp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1585) job->dd_data = dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1586)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1587) if (phba->cfg_poll & DISABLE_FCP_RING_INT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1588) if (lpfc_readl(phba->HCregaddr, &creg_val)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1589) rc = -IOCB_ERROR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1590) goto issue_ct_rsp_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1591) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1592) creg_val |= (HC_R0INT_ENA << LPFC_FCP_RING);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1593) writel(creg_val, phba->HCregaddr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1594) readl(phba->HCregaddr); /* flush */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1595) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1596)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1597) rc = lpfc_sli_issue_iocb(phba, LPFC_ELS_RING, ctiocb, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1598)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1599) if (rc == IOCB_SUCCESS) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1600) spin_lock_irqsave(&phba->hbalock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1601) /* make sure the I/O had not been completed/released */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1602) if (ctiocb->iocb_flag & LPFC_IO_LIBDFC) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1603) /* open up abort window to timeout handler */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1604) ctiocb->iocb_flag |= LPFC_IO_CMD_OUTSTANDING;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1605) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1606) spin_unlock_irqrestore(&phba->hbalock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1607) return 0; /* done for now */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1608) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1609)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1610) /* iocb failed so cleanup */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1611) job->dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1612)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1613) issue_ct_rsp_exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1614) lpfc_sli_release_iocbq(phba, ctiocb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1615) no_ctiocb:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1616) kfree(dd_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1617) no_dd_data:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1618) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1619) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1620)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1621) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1622) * lpfc_bsg_send_mgmt_rsp - process a SEND_MGMT_RESP bsg vendor command
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1623) * @job: SEND_MGMT_RESP fc_bsg_job
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1624) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1625) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1626) lpfc_bsg_send_mgmt_rsp(struct bsg_job *job)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1627) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1628) struct lpfc_vport *vport = shost_priv(fc_bsg_to_shost(job));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1629) struct lpfc_hba *phba = vport->phba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1630) struct fc_bsg_request *bsg_request = job->request;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1631) struct fc_bsg_reply *bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1632) struct send_mgmt_resp *mgmt_resp = (struct send_mgmt_resp *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1633) bsg_request->rqst_data.h_vendor.vendor_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1634) struct ulp_bde64 *bpl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1635) struct lpfc_dmabuf *bmp = NULL, *cmp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1636) int bpl_entries;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1637) uint32_t tag = mgmt_resp->tag;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1638) unsigned long reqbfrcnt =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1639) (unsigned long)job->request_payload.payload_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1640) int rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1641)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1642) /* in case no data is transferred */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1643) bsg_reply->reply_payload_rcv_len = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1644)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1645) if (!reqbfrcnt || (reqbfrcnt > (80 * BUF_SZ_4K))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1646) rc = -ERANGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1647) goto send_mgmt_rsp_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1648) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1649)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1650) bmp = kmalloc(sizeof(struct lpfc_dmabuf), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1651) if (!bmp) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1652) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1653) goto send_mgmt_rsp_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1654) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1655)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1656) bmp->virt = lpfc_mbuf_alloc(phba, 0, &bmp->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1657) if (!bmp->virt) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1658) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1659) goto send_mgmt_rsp_free_bmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1660) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1661)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1662) INIT_LIST_HEAD(&bmp->list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1663) bpl = (struct ulp_bde64 *) bmp->virt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1664) bpl_entries = (LPFC_BPL_SIZE/sizeof(struct ulp_bde64));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1665) cmp = lpfc_alloc_bsg_buffers(phba, job->request_payload.payload_len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1666) 1, bpl, &bpl_entries);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1667) if (!cmp) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1668) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1669) goto send_mgmt_rsp_free_bmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1670) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1671) lpfc_bsg_copy_data(cmp, &job->request_payload,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1672) job->request_payload.payload_len, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1673)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1674) rc = lpfc_issue_ct_rsp(phba, job, tag, cmp, bmp, bpl_entries);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1675)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1676) if (rc == IOCB_SUCCESS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1677) return 0; /* done for now */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1678)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1679) rc = -EACCES;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1680)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1681) lpfc_free_bsg_buffers(phba, cmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1682)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1683) send_mgmt_rsp_free_bmp:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1684) if (bmp->virt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1685) lpfc_mbuf_free(phba, bmp->virt, bmp->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1686) kfree(bmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1687) send_mgmt_rsp_exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1688) /* make error code available to userspace */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1689) bsg_reply->result = rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1690) job->dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1691) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1692) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1693)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1694) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1695) * lpfc_bsg_diag_mode_enter - process preparing into device diag loopback mode
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1696) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1697) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1698) * This function is responsible for preparing driver for diag loopback
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1699) * on device.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1700) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1701) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1702) lpfc_bsg_diag_mode_enter(struct lpfc_hba *phba)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1703) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1704) struct lpfc_vport **vports;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1705) struct Scsi_Host *shost;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1706) struct lpfc_sli *psli;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1707) struct lpfc_queue *qp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1708) struct lpfc_sli_ring *pring;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1709) int i = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1710)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1711) psli = &phba->sli;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1712) if (!psli)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1713) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1714)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1715)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1716) if ((phba->link_state == LPFC_HBA_ERROR) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1717) (psli->sli_flag & LPFC_BLOCK_MGMT_IO) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1718) (!(psli->sli_flag & LPFC_SLI_ACTIVE)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1719) return -EACCES;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1720)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1721) vports = lpfc_create_vport_work_array(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1722) if (vports) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1723) for (i = 0; i <= phba->max_vpi && vports[i] != NULL; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1724) shost = lpfc_shost_from_vport(vports[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1725) scsi_block_requests(shost);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1726) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1727) lpfc_destroy_vport_work_array(phba, vports);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1728) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1729) shost = lpfc_shost_from_vport(phba->pport);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1730) scsi_block_requests(shost);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1731) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1732)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1733) if (phba->sli_rev != LPFC_SLI_REV4) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1734) pring = &psli->sli3_ring[LPFC_FCP_RING];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1735) lpfc_emptyq_wait(phba, &pring->txcmplq, &phba->hbalock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1736) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1737) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1738) list_for_each_entry(qp, &phba->sli4_hba.lpfc_wq_list, wq_list) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1739) pring = qp->pring;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1740) if (!pring || (pring->ringno != LPFC_FCP_RING))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1741) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1742) if (!lpfc_emptyq_wait(phba, &pring->txcmplq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1743) &pring->ring_lock))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1744) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1745) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1746) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1747) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1748)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1749) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1750) * lpfc_bsg_diag_mode_exit - exit process from device diag loopback mode
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1751) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1752) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1753) * This function is responsible for driver exit processing of setting up
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1754) * diag loopback mode on device.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1755) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1756) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1757) lpfc_bsg_diag_mode_exit(struct lpfc_hba *phba)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1758) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1759) struct Scsi_Host *shost;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1760) struct lpfc_vport **vports;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1761) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1762)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1763) vports = lpfc_create_vport_work_array(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1764) if (vports) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1765) for (i = 0; i <= phba->max_vpi && vports[i] != NULL; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1766) shost = lpfc_shost_from_vport(vports[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1767) scsi_unblock_requests(shost);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1768) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1769) lpfc_destroy_vport_work_array(phba, vports);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1770) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1771) shost = lpfc_shost_from_vport(phba->pport);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1772) scsi_unblock_requests(shost);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1773) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1774) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1775) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1776)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1777) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1778) * lpfc_sli3_bsg_diag_loopback_mode - process an sli3 bsg vendor command
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1779) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1780) * @job: LPFC_BSG_VENDOR_DIAG_MODE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1781) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1782) * This function is responsible for placing an sli3 port into diagnostic
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1783) * loopback mode in order to perform a diagnostic loopback test.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1784) * All new scsi requests are blocked, a small delay is used to allow the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1785) * scsi requests to complete then the link is brought down. If the link is
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1786) * is placed in loopback mode then scsi requests are again allowed
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1787) * so the scsi mid-layer doesn't give up on the port.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1788) * All of this is done in-line.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1789) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1790) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1791) lpfc_sli3_bsg_diag_loopback_mode(struct lpfc_hba *phba, struct bsg_job *job)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1792) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1793) struct fc_bsg_request *bsg_request = job->request;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1794) struct fc_bsg_reply *bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1795) struct diag_mode_set *loopback_mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1796) uint32_t link_flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1797) uint32_t timeout;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1798) LPFC_MBOXQ_t *pmboxq = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1799) int mbxstatus = MBX_SUCCESS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1800) int i = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1801) int rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1802)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1803) /* no data to return just the return code */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1804) bsg_reply->reply_payload_rcv_len = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1805)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1806) if (job->request_len < sizeof(struct fc_bsg_request) +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1807) sizeof(struct diag_mode_set)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1808) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1809) "2738 Received DIAG MODE request size:%d "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1810) "below the minimum size:%d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1811) job->request_len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1812) (int)(sizeof(struct fc_bsg_request) +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1813) sizeof(struct diag_mode_set)));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1814) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1815) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1816) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1817)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1818) rc = lpfc_bsg_diag_mode_enter(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1819) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1820) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1821)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1822) /* bring the link to diagnostic mode */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1823) loopback_mode = (struct diag_mode_set *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1824) bsg_request->rqst_data.h_vendor.vendor_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1825) link_flags = loopback_mode->type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1826) timeout = loopback_mode->timeout * 100;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1827)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1828) pmboxq = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1829) if (!pmboxq) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1830) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1831) goto loopback_mode_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1832) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1833) memset((void *)pmboxq, 0, sizeof(LPFC_MBOXQ_t));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1834) pmboxq->u.mb.mbxCommand = MBX_DOWN_LINK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1835) pmboxq->u.mb.mbxOwner = OWN_HOST;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1836)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1837) mbxstatus = lpfc_sli_issue_mbox_wait(phba, pmboxq, LPFC_MBOX_TMO);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1838)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1839) if ((mbxstatus == MBX_SUCCESS) && (pmboxq->u.mb.mbxStatus == 0)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1840) /* wait for link down before proceeding */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1841) i = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1842) while (phba->link_state != LPFC_LINK_DOWN) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1843) if (i++ > timeout) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1844) rc = -ETIMEDOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1845) goto loopback_mode_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1846) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1847) msleep(10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1848) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1849)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1850) memset((void *)pmboxq, 0, sizeof(LPFC_MBOXQ_t));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1851) if (link_flags == INTERNAL_LOOP_BACK)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1852) pmboxq->u.mb.un.varInitLnk.link_flags = FLAGS_LOCAL_LB;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1853) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1854) pmboxq->u.mb.un.varInitLnk.link_flags =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1855) FLAGS_TOPOLOGY_MODE_LOOP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1856)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1857) pmboxq->u.mb.mbxCommand = MBX_INIT_LINK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1858) pmboxq->u.mb.mbxOwner = OWN_HOST;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1859)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1860) mbxstatus = lpfc_sli_issue_mbox_wait(phba, pmboxq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1861) LPFC_MBOX_TMO);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1862)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1863) if ((mbxstatus != MBX_SUCCESS) || (pmboxq->u.mb.mbxStatus))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1864) rc = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1865) else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1866) spin_lock_irq(&phba->hbalock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1867) phba->link_flag |= LS_LOOPBACK_MODE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1868) spin_unlock_irq(&phba->hbalock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1869) /* wait for the link attention interrupt */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1870) msleep(100);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1871)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1872) i = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1873) while (phba->link_state != LPFC_HBA_READY) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1874) if (i++ > timeout) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1875) rc = -ETIMEDOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1876) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1877) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1878)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1879) msleep(10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1880) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1881) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1882)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1883) } else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1884) rc = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1885)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1886) loopback_mode_exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1887) lpfc_bsg_diag_mode_exit(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1888)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1889) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1890) * Let SLI layer release mboxq if mbox command completed after timeout.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1891) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1892) if (pmboxq && mbxstatus != MBX_TIMEOUT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1893) mempool_free(pmboxq, phba->mbox_mem_pool);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1894)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1895) job_error:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1896) /* make error code available to userspace */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1897) bsg_reply->result = rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1898) /* complete the job back to userspace if no error */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1899) if (rc == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1900) bsg_job_done(job, bsg_reply->result,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1901) bsg_reply->reply_payload_rcv_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1902) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1903) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1904)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1905) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1906) * lpfc_sli4_bsg_set_link_diag_state - set sli4 link diag state
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1907) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1908) * @diag: Flag for set link to diag or nomral operation state.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1909) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1910) * This function is responsible for issuing a sli4 mailbox command for setting
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1911) * link to either diag state or normal operation state.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1912) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1913) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1914) lpfc_sli4_bsg_set_link_diag_state(struct lpfc_hba *phba, uint32_t diag)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1915) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1916) LPFC_MBOXQ_t *pmboxq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1917) struct lpfc_mbx_set_link_diag_state *link_diag_state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1918) uint32_t req_len, alloc_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1919) int mbxstatus = MBX_SUCCESS, rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1920)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1921) pmboxq = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1922) if (!pmboxq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1923) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1924)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1925) req_len = (sizeof(struct lpfc_mbx_set_link_diag_state) -
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1926) sizeof(struct lpfc_sli4_cfg_mhdr));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1927) alloc_len = lpfc_sli4_config(phba, pmboxq, LPFC_MBOX_SUBSYSTEM_FCOE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1928) LPFC_MBOX_OPCODE_FCOE_LINK_DIAG_STATE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1929) req_len, LPFC_SLI4_MBX_EMBED);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1930) if (alloc_len != req_len) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1931) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1932) goto link_diag_state_set_out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1933) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1934) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1935) "3128 Set link to diagnostic state:x%x (x%x/x%x)\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1936) diag, phba->sli4_hba.lnk_info.lnk_tp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1937) phba->sli4_hba.lnk_info.lnk_no);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1938)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1939) link_diag_state = &pmboxq->u.mqe.un.link_diag_state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1940) bf_set(lpfc_mbx_set_diag_state_diag_bit_valid, &link_diag_state->u.req,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1941) LPFC_DIAG_STATE_DIAG_BIT_VALID_CHANGE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1942) bf_set(lpfc_mbx_set_diag_state_link_num, &link_diag_state->u.req,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1943) phba->sli4_hba.lnk_info.lnk_no);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1944) bf_set(lpfc_mbx_set_diag_state_link_type, &link_diag_state->u.req,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1945) phba->sli4_hba.lnk_info.lnk_tp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1946) if (diag)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1947) bf_set(lpfc_mbx_set_diag_state_diag,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1948) &link_diag_state->u.req, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1949) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1950) bf_set(lpfc_mbx_set_diag_state_diag,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1951) &link_diag_state->u.req, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1952)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1953) mbxstatus = lpfc_sli_issue_mbox_wait(phba, pmboxq, LPFC_MBOX_TMO);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1954)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1955) if ((mbxstatus == MBX_SUCCESS) && (pmboxq->u.mb.mbxStatus == 0))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1956) rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1957) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1958) rc = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1959)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1960) link_diag_state_set_out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1961) if (pmboxq && (mbxstatus != MBX_TIMEOUT))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1962) mempool_free(pmboxq, phba->mbox_mem_pool);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1963)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1964) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1965) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1966)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1967) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1968) * lpfc_sli4_bsg_set_loopback_mode - set sli4 internal loopback diagnostic
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1969) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1970) * @mode: loopback mode to set
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1971) * @link_no: link number for loopback mode to set
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1972) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1973) * This function is responsible for issuing a sli4 mailbox command for setting
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1974) * up loopback diagnostic for a link.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1975) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1976) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1977) lpfc_sli4_bsg_set_loopback_mode(struct lpfc_hba *phba, int mode,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1978) uint32_t link_no)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1979) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1980) LPFC_MBOXQ_t *pmboxq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1981) uint32_t req_len, alloc_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1982) struct lpfc_mbx_set_link_diag_loopback *link_diag_loopback;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1983) int mbxstatus = MBX_SUCCESS, rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1984)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1985) pmboxq = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1986) if (!pmboxq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1987) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1988) req_len = (sizeof(struct lpfc_mbx_set_link_diag_loopback) -
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1989) sizeof(struct lpfc_sli4_cfg_mhdr));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1990) alloc_len = lpfc_sli4_config(phba, pmboxq, LPFC_MBOX_SUBSYSTEM_FCOE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1991) LPFC_MBOX_OPCODE_FCOE_LINK_DIAG_LOOPBACK,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1992) req_len, LPFC_SLI4_MBX_EMBED);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1993) if (alloc_len != req_len) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1994) mempool_free(pmboxq, phba->mbox_mem_pool);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1995) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1996) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1997) link_diag_loopback = &pmboxq->u.mqe.un.link_diag_loopback;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1998) bf_set(lpfc_mbx_set_diag_state_link_num,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1999) &link_diag_loopback->u.req, link_no);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2000)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2001) if (phba->sli4_hba.conf_trunk & (1 << link_no)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2002) bf_set(lpfc_mbx_set_diag_state_link_type,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2003) &link_diag_loopback->u.req, LPFC_LNK_FC_TRUNKED);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2004) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2005) bf_set(lpfc_mbx_set_diag_state_link_type,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2006) &link_diag_loopback->u.req,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2007) phba->sli4_hba.lnk_info.lnk_tp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2008) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2009)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2010) bf_set(lpfc_mbx_set_diag_lpbk_type, &link_diag_loopback->u.req,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2011) mode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2012)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2013) mbxstatus = lpfc_sli_issue_mbox_wait(phba, pmboxq, LPFC_MBOX_TMO);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2014) if ((mbxstatus != MBX_SUCCESS) || (pmboxq->u.mb.mbxStatus)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2015) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2016) "3127 Failed setup loopback mode mailbox "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2017) "command, rc:x%x, status:x%x\n", mbxstatus,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2018) pmboxq->u.mb.mbxStatus);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2019) rc = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2020) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2021) if (pmboxq && (mbxstatus != MBX_TIMEOUT))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2022) mempool_free(pmboxq, phba->mbox_mem_pool);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2023) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2024) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2025)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2026) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2027) * lpfc_sli4_diag_fcport_reg_setup - setup port registrations for diagnostic
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2028) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2029) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2030) * This function set up SLI4 FC port registrations for diagnostic run, which
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2031) * includes all the rpis, vfi, and also vpi.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2032) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2033) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2034) lpfc_sli4_diag_fcport_reg_setup(struct lpfc_hba *phba)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2035) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2036) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2037)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2038) if (phba->pport->fc_flag & FC_VFI_REGISTERED) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2039) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2040) "3136 Port still had vfi registered: "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2041) "mydid:x%x, fcfi:%d, vfi:%d, vpi:%d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2042) phba->pport->fc_myDID, phba->fcf.fcfi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2043) phba->sli4_hba.vfi_ids[phba->pport->vfi],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2044) phba->vpi_ids[phba->pport->vpi]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2045) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2046) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2047) rc = lpfc_issue_reg_vfi(phba->pport);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2048) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2049) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2050)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2051) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2052) * lpfc_sli4_bsg_diag_loopback_mode - process an sli4 bsg vendor command
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2053) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2054) * @job: LPFC_BSG_VENDOR_DIAG_MODE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2055) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2056) * This function is responsible for placing an sli4 port into diagnostic
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2057) * loopback mode in order to perform a diagnostic loopback test.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2058) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2059) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2060) lpfc_sli4_bsg_diag_loopback_mode(struct lpfc_hba *phba, struct bsg_job *job)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2061) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2062) struct fc_bsg_request *bsg_request = job->request;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2063) struct fc_bsg_reply *bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2064) struct diag_mode_set *loopback_mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2065) uint32_t link_flags, timeout, link_no;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2066) int i, rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2067)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2068) /* no data to return just the return code */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2069) bsg_reply->reply_payload_rcv_len = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2070)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2071) if (job->request_len < sizeof(struct fc_bsg_request) +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2072) sizeof(struct diag_mode_set)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2073) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2074) "3011 Received DIAG MODE request size:%d "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2075) "below the minimum size:%d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2076) job->request_len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2077) (int)(sizeof(struct fc_bsg_request) +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2078) sizeof(struct diag_mode_set)));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2079) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2080) goto job_done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2081) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2082)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2083) loopback_mode = (struct diag_mode_set *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2084) bsg_request->rqst_data.h_vendor.vendor_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2085) link_flags = loopback_mode->type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2086) timeout = loopback_mode->timeout * 100;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2087)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2088) if (loopback_mode->physical_link == -1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2089) link_no = phba->sli4_hba.lnk_info.lnk_no;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2090) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2091) link_no = loopback_mode->physical_link;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2092)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2093) if (link_flags == DISABLE_LOOP_BACK) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2094) rc = lpfc_sli4_bsg_set_loopback_mode(phba,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2095) LPFC_DIAG_LOOPBACK_TYPE_DISABLE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2096) link_no);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2097) if (!rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2098) /* Unset the need disable bit */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2099) phba->sli4_hba.conf_trunk &= ~((1 << link_no) << 4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2100) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2101) goto job_done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2102) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2103) /* Check if we need to disable the loopback state */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2104) if (phba->sli4_hba.conf_trunk & ((1 << link_no) << 4)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2105) rc = -EPERM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2106) goto job_done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2107) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2108) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2109)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2110) rc = lpfc_bsg_diag_mode_enter(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2111) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2112) goto job_done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2113)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2114) /* indicate we are in loobpack diagnostic mode */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2115) spin_lock_irq(&phba->hbalock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2116) phba->link_flag |= LS_LOOPBACK_MODE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2117) spin_unlock_irq(&phba->hbalock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2118)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2119) /* reset port to start frome scratch */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2120) rc = lpfc_selective_reset(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2121) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2122) goto job_done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2123)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2124) /* bring the link to diagnostic mode */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2125) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2126) "3129 Bring link to diagnostic state.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2127)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2128) rc = lpfc_sli4_bsg_set_link_diag_state(phba, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2129) if (rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2130) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2131) "3130 Failed to bring link to diagnostic "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2132) "state, rc:x%x\n", rc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2133) goto loopback_mode_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2134) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2135)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2136) /* wait for link down before proceeding */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2137) i = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2138) while (phba->link_state != LPFC_LINK_DOWN) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2139) if (i++ > timeout) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2140) rc = -ETIMEDOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2141) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2142) "3131 Timeout waiting for link to "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2143) "diagnostic mode, timeout:%d ms\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2144) timeout * 10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2145) goto loopback_mode_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2146) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2147) msleep(10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2148) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2149)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2150) /* set up loopback mode */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2151) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2152) "3132 Set up loopback mode:x%x\n", link_flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2153)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2154) switch (link_flags) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2155) case INTERNAL_LOOP_BACK:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2156) if (phba->sli4_hba.conf_trunk & (1 << link_no)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2157) rc = lpfc_sli4_bsg_set_loopback_mode(phba,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2158) LPFC_DIAG_LOOPBACK_TYPE_INTERNAL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2159) link_no);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2160) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2161) /* Trunk is configured, but link is not in this trunk */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2162) if (phba->sli4_hba.conf_trunk) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2163) rc = -ELNRNG;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2164) goto loopback_mode_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2165) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2166)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2167) rc = lpfc_sli4_bsg_set_loopback_mode(phba,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2168) LPFC_DIAG_LOOPBACK_TYPE_INTERNAL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2169) link_no);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2170) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2171)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2172) if (!rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2173) /* Set the need disable bit */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2174) phba->sli4_hba.conf_trunk |= (1 << link_no) << 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2175) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2176)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2177) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2178) case EXTERNAL_LOOP_BACK:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2179) if (phba->sli4_hba.conf_trunk & (1 << link_no)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2180) rc = lpfc_sli4_bsg_set_loopback_mode(phba,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2181) LPFC_DIAG_LOOPBACK_TYPE_EXTERNAL_TRUNKED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2182) link_no);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2183) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2184) /* Trunk is configured, but link is not in this trunk */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2185) if (phba->sli4_hba.conf_trunk) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2186) rc = -ELNRNG;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2187) goto loopback_mode_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2188) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2189)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2190) rc = lpfc_sli4_bsg_set_loopback_mode(phba,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2191) LPFC_DIAG_LOOPBACK_TYPE_SERDES,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2192) link_no);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2193) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2194)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2195) if (!rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2196) /* Set the need disable bit */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2197) phba->sli4_hba.conf_trunk |= (1 << link_no) << 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2198) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2199)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2200) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2201) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2202) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2203) lpfc_printf_log(phba, KERN_ERR, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2204) "3141 Loopback mode:x%x not supported\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2205) link_flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2206) goto loopback_mode_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2207) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2208)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2209) if (!rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2210) /* wait for the link attention interrupt */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2211) msleep(100);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2212) i = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2213) while (phba->link_state < LPFC_LINK_UP) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2214) if (i++ > timeout) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2215) rc = -ETIMEDOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2216) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2217) "3137 Timeout waiting for link up "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2218) "in loopback mode, timeout:%d ms\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2219) timeout * 10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2220) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2221) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2222) msleep(10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2223) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2224) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2225)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2226) /* port resource registration setup for loopback diagnostic */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2227) if (!rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2228) /* set up a none zero myDID for loopback test */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2229) phba->pport->fc_myDID = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2230) rc = lpfc_sli4_diag_fcport_reg_setup(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2231) } else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2232) goto loopback_mode_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2233)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2234) if (!rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2235) /* wait for the port ready */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2236) msleep(100);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2237) i = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2238) while (phba->link_state != LPFC_HBA_READY) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2239) if (i++ > timeout) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2240) rc = -ETIMEDOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2241) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2242) "3133 Timeout waiting for port "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2243) "loopback mode ready, timeout:%d ms\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2244) timeout * 10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2245) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2246) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2247) msleep(10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2248) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2249) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2250)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2251) loopback_mode_exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2252) /* clear loopback diagnostic mode */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2253) if (rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2254) spin_lock_irq(&phba->hbalock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2255) phba->link_flag &= ~LS_LOOPBACK_MODE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2256) spin_unlock_irq(&phba->hbalock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2257) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2258) lpfc_bsg_diag_mode_exit(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2259)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2260) job_done:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2261) /* make error code available to userspace */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2262) bsg_reply->result = rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2263) /* complete the job back to userspace if no error */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2264) if (rc == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2265) bsg_job_done(job, bsg_reply->result,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2266) bsg_reply->reply_payload_rcv_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2267) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2268) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2269)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2270) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2271) * lpfc_bsg_diag_loopback_mode - bsg vendor command for diag loopback mode
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2272) * @job: LPFC_BSG_VENDOR_DIAG_MODE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2273) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2274) * This function is responsible for responding to check and dispatch bsg diag
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2275) * command from the user to proper driver action routines.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2276) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2277) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2278) lpfc_bsg_diag_loopback_mode(struct bsg_job *job)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2279) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2280) struct Scsi_Host *shost;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2281) struct lpfc_vport *vport;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2282) struct lpfc_hba *phba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2283) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2284)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2285) shost = fc_bsg_to_shost(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2286) if (!shost)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2287) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2288) vport = shost_priv(shost);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2289) if (!vport)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2290) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2291) phba = vport->phba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2292) if (!phba)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2293) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2294)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2295) if (phba->sli_rev < LPFC_SLI_REV4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2296) rc = lpfc_sli3_bsg_diag_loopback_mode(phba, job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2297) else if (bf_get(lpfc_sli_intf_if_type, &phba->sli4_hba.sli_intf) >=
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2298) LPFC_SLI_INTF_IF_TYPE_2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2299) rc = lpfc_sli4_bsg_diag_loopback_mode(phba, job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2300) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2301) rc = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2302)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2303) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2304) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2305)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2306) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2307) * lpfc_sli4_bsg_diag_mode_end - sli4 bsg vendor command for ending diag mode
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2308) * @job: LPFC_BSG_VENDOR_DIAG_MODE_END
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2309) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2310) * This function is responsible for responding to check and dispatch bsg diag
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2311) * command from the user to proper driver action routines.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2312) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2313) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2314) lpfc_sli4_bsg_diag_mode_end(struct bsg_job *job)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2315) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2316) struct fc_bsg_request *bsg_request = job->request;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2317) struct fc_bsg_reply *bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2318) struct Scsi_Host *shost;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2319) struct lpfc_vport *vport;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2320) struct lpfc_hba *phba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2321) struct diag_mode_set *loopback_mode_end_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2322) uint32_t timeout;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2323) int rc, i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2324)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2325) shost = fc_bsg_to_shost(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2326) if (!shost)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2327) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2328) vport = shost_priv(shost);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2329) if (!vport)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2330) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2331) phba = vport->phba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2332) if (!phba)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2333) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2334)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2335) if (phba->sli_rev < LPFC_SLI_REV4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2336) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2337) if (bf_get(lpfc_sli_intf_if_type, &phba->sli4_hba.sli_intf) <
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2338) LPFC_SLI_INTF_IF_TYPE_2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2339) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2340)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2341) /* clear loopback diagnostic mode */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2342) spin_lock_irq(&phba->hbalock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2343) phba->link_flag &= ~LS_LOOPBACK_MODE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2344) spin_unlock_irq(&phba->hbalock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2345) loopback_mode_end_cmd = (struct diag_mode_set *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2346) bsg_request->rqst_data.h_vendor.vendor_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2347) timeout = loopback_mode_end_cmd->timeout * 100;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2348)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2349) rc = lpfc_sli4_bsg_set_link_diag_state(phba, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2350) if (rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2351) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2352) "3139 Failed to bring link to diagnostic "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2353) "state, rc:x%x\n", rc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2354) goto loopback_mode_end_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2355) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2356)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2357) /* wait for link down before proceeding */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2358) i = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2359) while (phba->link_state != LPFC_LINK_DOWN) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2360) if (i++ > timeout) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2361) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2362) "3140 Timeout waiting for link to "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2363) "diagnostic mode_end, timeout:%d ms\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2364) timeout * 10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2365) /* there is nothing much we can do here */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2366) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2367) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2368) msleep(10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2369) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2370)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2371) /* reset port resource registrations */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2372) rc = lpfc_selective_reset(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2373) phba->pport->fc_myDID = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2374)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2375) loopback_mode_end_exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2376) /* make return code available to userspace */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2377) bsg_reply->result = rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2378) /* complete the job back to userspace if no error */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2379) if (rc == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2380) bsg_job_done(job, bsg_reply->result,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2381) bsg_reply->reply_payload_rcv_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2382) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2383) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2384)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2385) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2386) * lpfc_sli4_bsg_link_diag_test - sli4 bsg vendor command for diag link test
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2387) * @job: LPFC_BSG_VENDOR_DIAG_LINK_TEST
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2388) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2389) * This function is to perform SLI4 diag link test request from the user
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2390) * applicaiton.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2391) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2392) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2393) lpfc_sli4_bsg_link_diag_test(struct bsg_job *job)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2394) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2395) struct fc_bsg_request *bsg_request = job->request;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2396) struct fc_bsg_reply *bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2397) struct Scsi_Host *shost;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2398) struct lpfc_vport *vport;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2399) struct lpfc_hba *phba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2400) LPFC_MBOXQ_t *pmboxq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2401) struct sli4_link_diag *link_diag_test_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2402) uint32_t req_len, alloc_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2403) struct lpfc_mbx_run_link_diag_test *run_link_diag_test;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2404) union lpfc_sli4_cfg_shdr *shdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2405) uint32_t shdr_status, shdr_add_status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2406) struct diag_status *diag_status_reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2407) int mbxstatus, rc = -ENODEV, rc1 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2408)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2409) shost = fc_bsg_to_shost(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2410) if (!shost)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2411) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2412)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2413) vport = shost_priv(shost);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2414) if (!vport)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2415) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2416)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2417) phba = vport->phba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2418) if (!phba)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2419) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2420)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2421)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2422) if (phba->sli_rev < LPFC_SLI_REV4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2423) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2424)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2425) if (bf_get(lpfc_sli_intf_if_type, &phba->sli4_hba.sli_intf) <
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2426) LPFC_SLI_INTF_IF_TYPE_2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2427) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2428)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2429) if (job->request_len < sizeof(struct fc_bsg_request) +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2430) sizeof(struct sli4_link_diag)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2431) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2432) "3013 Received LINK DIAG TEST request "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2433) " size:%d below the minimum size:%d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2434) job->request_len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2435) (int)(sizeof(struct fc_bsg_request) +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2436) sizeof(struct sli4_link_diag)));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2437) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2438) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2439) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2440)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2441) rc = lpfc_bsg_diag_mode_enter(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2442) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2443) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2444)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2445) link_diag_test_cmd = (struct sli4_link_diag *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2446) bsg_request->rqst_data.h_vendor.vendor_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2447)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2448) rc = lpfc_sli4_bsg_set_link_diag_state(phba, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2449)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2450) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2451) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2452)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2453) pmboxq = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2454) if (!pmboxq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2455) goto link_diag_test_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2456)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2457) req_len = (sizeof(struct lpfc_mbx_set_link_diag_state) -
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2458) sizeof(struct lpfc_sli4_cfg_mhdr));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2459) alloc_len = lpfc_sli4_config(phba, pmboxq, LPFC_MBOX_SUBSYSTEM_FCOE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2460) LPFC_MBOX_OPCODE_FCOE_LINK_DIAG_STATE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2461) req_len, LPFC_SLI4_MBX_EMBED);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2462) if (alloc_len != req_len) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2463) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2464) goto link_diag_test_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2465) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2466)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2467) run_link_diag_test = &pmboxq->u.mqe.un.link_diag_test;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2468) bf_set(lpfc_mbx_run_diag_test_link_num, &run_link_diag_test->u.req,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2469) phba->sli4_hba.lnk_info.lnk_no);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2470) bf_set(lpfc_mbx_run_diag_test_link_type, &run_link_diag_test->u.req,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2471) phba->sli4_hba.lnk_info.lnk_tp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2472) bf_set(lpfc_mbx_run_diag_test_test_id, &run_link_diag_test->u.req,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2473) link_diag_test_cmd->test_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2474) bf_set(lpfc_mbx_run_diag_test_loops, &run_link_diag_test->u.req,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2475) link_diag_test_cmd->loops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2476) bf_set(lpfc_mbx_run_diag_test_test_ver, &run_link_diag_test->u.req,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2477) link_diag_test_cmd->test_version);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2478) bf_set(lpfc_mbx_run_diag_test_err_act, &run_link_diag_test->u.req,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2479) link_diag_test_cmd->error_action);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2480)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2481) mbxstatus = lpfc_sli_issue_mbox(phba, pmboxq, MBX_POLL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2482)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2483) shdr = (union lpfc_sli4_cfg_shdr *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2484) &pmboxq->u.mqe.un.sli4_config.header.cfg_shdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2485) shdr_status = bf_get(lpfc_mbox_hdr_status, &shdr->response);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2486) shdr_add_status = bf_get(lpfc_mbox_hdr_add_status, &shdr->response);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2487) if (shdr_status || shdr_add_status || mbxstatus) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2488) lpfc_printf_log(phba, KERN_ERR, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2489) "3010 Run link diag test mailbox failed with "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2490) "mbx_status x%x status x%x, add_status x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2491) mbxstatus, shdr_status, shdr_add_status);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2492) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2493)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2494) diag_status_reply = (struct diag_status *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2495) bsg_reply->reply_data.vendor_reply.vendor_rsp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2496)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2497) if (job->reply_len < sizeof(*bsg_reply) + sizeof(*diag_status_reply)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2498) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2499) "3012 Received Run link diag test reply "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2500) "below minimum size (%d): reply_len:%d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2501) (int)(sizeof(*bsg_reply) +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2502) sizeof(*diag_status_reply)),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2503) job->reply_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2504) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2505) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2506) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2507)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2508) diag_status_reply->mbox_status = mbxstatus;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2509) diag_status_reply->shdr_status = shdr_status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2510) diag_status_reply->shdr_add_status = shdr_add_status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2511)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2512) link_diag_test_exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2513) rc1 = lpfc_sli4_bsg_set_link_diag_state(phba, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2514)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2515) if (pmboxq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2516) mempool_free(pmboxq, phba->mbox_mem_pool);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2517)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2518) lpfc_bsg_diag_mode_exit(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2519)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2520) job_error:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2521) /* make error code available to userspace */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2522) if (rc1 && !rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2523) rc = rc1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2524) bsg_reply->result = rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2525) /* complete the job back to userspace if no error */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2526) if (rc == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2527) bsg_job_done(job, bsg_reply->result,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2528) bsg_reply->reply_payload_rcv_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2529) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2530) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2531)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2532) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2533) * lpfcdiag_loop_self_reg - obtains a remote port login id
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2534) * @phba: Pointer to HBA context object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2535) * @rpi: Pointer to a remote port login id
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2536) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2537) * This function obtains a remote port login id so the diag loopback test
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2538) * can send and receive its own unsolicited CT command.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2539) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2540) static int lpfcdiag_loop_self_reg(struct lpfc_hba *phba, uint16_t *rpi)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2541) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2542) LPFC_MBOXQ_t *mbox;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2543) struct lpfc_dmabuf *dmabuff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2544) int status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2545)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2546) mbox = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2547) if (!mbox)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2548) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2549)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2550) if (phba->sli_rev < LPFC_SLI_REV4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2551) status = lpfc_reg_rpi(phba, 0, phba->pport->fc_myDID,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2552) (uint8_t *)&phba->pport->fc_sparam,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2553) mbox, *rpi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2554) else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2555) *rpi = lpfc_sli4_alloc_rpi(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2556) if (*rpi == LPFC_RPI_ALLOC_ERROR) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2557) mempool_free(mbox, phba->mbox_mem_pool);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2558) return -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2559) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2560) status = lpfc_reg_rpi(phba, phba->pport->vpi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2561) phba->pport->fc_myDID,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2562) (uint8_t *)&phba->pport->fc_sparam,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2563) mbox, *rpi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2564) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2565)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2566) if (status) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2567) mempool_free(mbox, phba->mbox_mem_pool);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2568) if (phba->sli_rev == LPFC_SLI_REV4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2569) lpfc_sli4_free_rpi(phba, *rpi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2570) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2571) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2572)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2573) dmabuff = (struct lpfc_dmabuf *)mbox->ctx_buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2574) mbox->ctx_buf = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2575) mbox->ctx_ndlp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2576) status = lpfc_sli_issue_mbox_wait(phba, mbox, LPFC_MBOX_TMO);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2577)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2578) if ((status != MBX_SUCCESS) || (mbox->u.mb.mbxStatus)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2579) lpfc_mbuf_free(phba, dmabuff->virt, dmabuff->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2580) kfree(dmabuff);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2581) if (status != MBX_TIMEOUT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2582) mempool_free(mbox, phba->mbox_mem_pool);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2583) if (phba->sli_rev == LPFC_SLI_REV4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2584) lpfc_sli4_free_rpi(phba, *rpi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2585) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2586) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2587)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2588) if (phba->sli_rev < LPFC_SLI_REV4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2589) *rpi = mbox->u.mb.un.varWords[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2590)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2591) lpfc_mbuf_free(phba, dmabuff->virt, dmabuff->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2592) kfree(dmabuff);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2593) mempool_free(mbox, phba->mbox_mem_pool);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2594) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2595) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2596)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2597) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2598) * lpfcdiag_loop_self_unreg - unregs from the rpi
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2599) * @phba: Pointer to HBA context object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2600) * @rpi: Remote port login id
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2601) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2602) * This function unregisters the rpi obtained in lpfcdiag_loop_self_reg
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2603) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2604) static int lpfcdiag_loop_self_unreg(struct lpfc_hba *phba, uint16_t rpi)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2605) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2606) LPFC_MBOXQ_t *mbox;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2607) int status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2608)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2609) /* Allocate mboxq structure */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2610) mbox = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2611) if (mbox == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2612) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2613)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2614) if (phba->sli_rev < LPFC_SLI_REV4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2615) lpfc_unreg_login(phba, 0, rpi, mbox);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2616) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2617) lpfc_unreg_login(phba, phba->pport->vpi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2618) phba->sli4_hba.rpi_ids[rpi], mbox);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2619)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2620) status = lpfc_sli_issue_mbox_wait(phba, mbox, LPFC_MBOX_TMO);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2621)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2622) if ((status != MBX_SUCCESS) || (mbox->u.mb.mbxStatus)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2623) if (status != MBX_TIMEOUT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2624) mempool_free(mbox, phba->mbox_mem_pool);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2625) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2626) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2627) mempool_free(mbox, phba->mbox_mem_pool);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2628) if (phba->sli_rev == LPFC_SLI_REV4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2629) lpfc_sli4_free_rpi(phba, rpi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2630) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2631) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2632)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2633) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2634) * lpfcdiag_loop_get_xri - obtains the transmit and receive ids
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2635) * @phba: Pointer to HBA context object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2636) * @rpi: Remote port login id
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2637) * @txxri: Pointer to transmit exchange id
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2638) * @rxxri: Pointer to response exchabge id
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2639) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2640) * This function obtains the transmit and receive ids required to send
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2641) * an unsolicited ct command with a payload. A special lpfc FsType and CmdRsp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2642) * flags are used to the unsolicted response handler is able to process
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2643) * the ct command sent on the same port.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2644) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2645) static int lpfcdiag_loop_get_xri(struct lpfc_hba *phba, uint16_t rpi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2646) uint16_t *txxri, uint16_t * rxxri)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2647) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2648) struct lpfc_bsg_event *evt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2649) struct lpfc_iocbq *cmdiocbq, *rspiocbq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2650) IOCB_t *cmd, *rsp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2651) struct lpfc_dmabuf *dmabuf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2652) struct ulp_bde64 *bpl = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2653) struct lpfc_sli_ct_request *ctreq = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2654) int ret_val = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2655) int time_left;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2656) int iocb_stat = IOCB_SUCCESS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2657) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2658)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2659) *txxri = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2660) *rxxri = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2661) evt = lpfc_bsg_event_new(FC_REG_CT_EVENT, current->pid,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2662) SLI_CT_ELX_LOOPBACK);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2663) if (!evt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2664) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2665)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2666) spin_lock_irqsave(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2667) list_add(&evt->node, &phba->ct_ev_waiters);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2668) lpfc_bsg_event_ref(evt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2669) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2670)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2671) cmdiocbq = lpfc_sli_get_iocbq(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2672) rspiocbq = lpfc_sli_get_iocbq(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2673)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2674) dmabuf = kmalloc(sizeof(struct lpfc_dmabuf), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2675) if (dmabuf) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2676) dmabuf->virt = lpfc_mbuf_alloc(phba, 0, &dmabuf->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2677) if (dmabuf->virt) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2678) INIT_LIST_HEAD(&dmabuf->list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2679) bpl = (struct ulp_bde64 *) dmabuf->virt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2680) memset(bpl, 0, sizeof(*bpl));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2681) ctreq = (struct lpfc_sli_ct_request *)(bpl + 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2682) bpl->addrHigh =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2683) le32_to_cpu(putPaddrHigh(dmabuf->phys +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2684) sizeof(*bpl)));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2685) bpl->addrLow =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2686) le32_to_cpu(putPaddrLow(dmabuf->phys +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2687) sizeof(*bpl)));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2688) bpl->tus.f.bdeFlags = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2689) bpl->tus.f.bdeSize = ELX_LOOPBACK_HEADER_SZ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2690) bpl->tus.w = le32_to_cpu(bpl->tus.w);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2691) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2692) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2693)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2694) if (cmdiocbq == NULL || rspiocbq == NULL ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2695) dmabuf == NULL || bpl == NULL || ctreq == NULL ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2696) dmabuf->virt == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2697) ret_val = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2698) goto err_get_xri_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2699) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2700)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2701) cmd = &cmdiocbq->iocb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2702) rsp = &rspiocbq->iocb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2703)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2704) memset(ctreq, 0, ELX_LOOPBACK_HEADER_SZ);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2705)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2706) ctreq->RevisionId.bits.Revision = SLI_CT_REVISION;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2707) ctreq->RevisionId.bits.InId = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2708) ctreq->FsType = SLI_CT_ELX_LOOPBACK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2709) ctreq->FsSubType = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2710) ctreq->CommandResponse.bits.CmdRsp = ELX_LOOPBACK_XRI_SETUP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2711) ctreq->CommandResponse.bits.Size = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2712)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2713)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2714) cmd->un.xseq64.bdl.addrHigh = putPaddrHigh(dmabuf->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2715) cmd->un.xseq64.bdl.addrLow = putPaddrLow(dmabuf->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2716) cmd->un.xseq64.bdl.bdeFlags = BUFF_TYPE_BLP_64;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2717) cmd->un.xseq64.bdl.bdeSize = sizeof(*bpl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2718)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2719) cmd->un.xseq64.w5.hcsw.Fctl = LA;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2720) cmd->un.xseq64.w5.hcsw.Dfctl = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2721) cmd->un.xseq64.w5.hcsw.Rctl = FC_RCTL_DD_UNSOL_CTL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2722) cmd->un.xseq64.w5.hcsw.Type = FC_TYPE_CT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2723)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2724) cmd->ulpCommand = CMD_XMIT_SEQUENCE64_CR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2725) cmd->ulpBdeCount = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2726) cmd->ulpLe = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2727) cmd->ulpClass = CLASS3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2728) cmd->ulpContext = rpi;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2729)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2730) cmdiocbq->iocb_flag |= LPFC_IO_LIBDFC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2731) cmdiocbq->vport = phba->pport;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2732) cmdiocbq->iocb_cmpl = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2733)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2734) iocb_stat = lpfc_sli_issue_iocb_wait(phba, LPFC_ELS_RING, cmdiocbq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2735) rspiocbq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2736) (phba->fc_ratov * 2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2737) + LPFC_DRVR_TIMEOUT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2738) if ((iocb_stat != IOCB_SUCCESS) || (rsp->ulpStatus != IOSTAT_SUCCESS)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2739) ret_val = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2740) goto err_get_xri_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2741) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2742) *txxri = rsp->ulpContext;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2743)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2744) evt->waiting = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2745) evt->wait_time_stamp = jiffies;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2746) time_left = wait_event_interruptible_timeout(
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2747) evt->wq, !list_empty(&evt->events_to_see),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2748) msecs_to_jiffies(1000 *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2749) ((phba->fc_ratov * 2) + LPFC_DRVR_TIMEOUT)));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2750) if (list_empty(&evt->events_to_see))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2751) ret_val = (time_left) ? -EINTR : -ETIMEDOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2752) else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2753) spin_lock_irqsave(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2754) list_move(evt->events_to_see.prev, &evt->events_to_get);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2755) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2756) *rxxri = (list_entry(evt->events_to_get.prev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2757) typeof(struct event_data),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2758) node))->immed_dat;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2759) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2760) evt->waiting = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2761)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2762) err_get_xri_exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2763) spin_lock_irqsave(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2764) lpfc_bsg_event_unref(evt); /* release ref */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2765) lpfc_bsg_event_unref(evt); /* delete */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2766) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2767)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2768) if (dmabuf) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2769) if (dmabuf->virt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2770) lpfc_mbuf_free(phba, dmabuf->virt, dmabuf->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2771) kfree(dmabuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2772) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2773)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2774) if (cmdiocbq && (iocb_stat != IOCB_TIMEDOUT))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2775) lpfc_sli_release_iocbq(phba, cmdiocbq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2776) if (rspiocbq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2777) lpfc_sli_release_iocbq(phba, rspiocbq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2778) return ret_val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2779) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2780)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2781) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2782) * lpfc_bsg_dma_page_alloc - allocate a bsg mbox page sized dma buffers
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2783) * @phba: Pointer to HBA context object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2784) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2785) * This function allocates BSG_MBOX_SIZE (4KB) page size dma buffer and
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2786) * returns the pointer to the buffer.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2787) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2788) static struct lpfc_dmabuf *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2789) lpfc_bsg_dma_page_alloc(struct lpfc_hba *phba)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2790) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2791) struct lpfc_dmabuf *dmabuf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2792) struct pci_dev *pcidev = phba->pcidev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2793)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2794) /* allocate dma buffer struct */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2795) dmabuf = kmalloc(sizeof(struct lpfc_dmabuf), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2796) if (!dmabuf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2797) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2798)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2799) INIT_LIST_HEAD(&dmabuf->list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2800)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2801) /* now, allocate dma buffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2802) dmabuf->virt = dma_alloc_coherent(&pcidev->dev, BSG_MBOX_SIZE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2803) &(dmabuf->phys), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2804)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2805) if (!dmabuf->virt) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2806) kfree(dmabuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2807) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2808) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2809)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2810) return dmabuf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2811) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2812)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2813) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2814) * lpfc_bsg_dma_page_free - free a bsg mbox page sized dma buffer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2815) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2816) * @dmabuf: Pointer to the bsg mbox page sized dma buffer descriptor.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2817) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2818) * This routine just simply frees a dma buffer and its associated buffer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2819) * descriptor referred by @dmabuf.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2820) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2821) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2822) lpfc_bsg_dma_page_free(struct lpfc_hba *phba, struct lpfc_dmabuf *dmabuf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2823) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2824) struct pci_dev *pcidev = phba->pcidev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2825)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2826) if (!dmabuf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2827) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2828)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2829) if (dmabuf->virt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2830) dma_free_coherent(&pcidev->dev, BSG_MBOX_SIZE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2831) dmabuf->virt, dmabuf->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2832) kfree(dmabuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2833) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2834) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2835)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2836) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2837) * lpfc_bsg_dma_page_list_free - free a list of bsg mbox page sized dma buffers
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2838) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2839) * @dmabuf_list: Pointer to a list of bsg mbox page sized dma buffer descs.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2840) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2841) * This routine just simply frees all dma buffers and their associated buffer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2842) * descriptors referred by @dmabuf_list.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2843) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2844) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2845) lpfc_bsg_dma_page_list_free(struct lpfc_hba *phba,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2846) struct list_head *dmabuf_list)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2847) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2848) struct lpfc_dmabuf *dmabuf, *next_dmabuf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2849)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2850) if (list_empty(dmabuf_list))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2851) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2852)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2853) list_for_each_entry_safe(dmabuf, next_dmabuf, dmabuf_list, list) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2854) list_del_init(&dmabuf->list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2855) lpfc_bsg_dma_page_free(phba, dmabuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2856) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2857) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2858) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2859)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2860) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2861) * diag_cmd_data_alloc - fills in a bde struct with dma buffers
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2862) * @phba: Pointer to HBA context object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2863) * @bpl: Pointer to 64 bit bde structure
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2864) * @size: Number of bytes to process
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2865) * @nocopydata: Flag to copy user data into the allocated buffer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2866) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2867) * This function allocates page size buffers and populates an lpfc_dmabufext.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2868) * If allowed the user data pointed to with indataptr is copied into the kernel
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2869) * memory. The chained list of page size buffers is returned.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2870) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2871) static struct lpfc_dmabufext *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2872) diag_cmd_data_alloc(struct lpfc_hba *phba,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2873) struct ulp_bde64 *bpl, uint32_t size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2874) int nocopydata)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2875) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2876) struct lpfc_dmabufext *mlist = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2877) struct lpfc_dmabufext *dmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2878) int cnt, offset = 0, i = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2879) struct pci_dev *pcidev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2880)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2881) pcidev = phba->pcidev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2882)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2883) while (size) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2884) /* We get chunks of 4K */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2885) if (size > BUF_SZ_4K)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2886) cnt = BUF_SZ_4K;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2887) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2888) cnt = size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2889)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2890) /* allocate struct lpfc_dmabufext buffer header */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2891) dmp = kmalloc(sizeof(struct lpfc_dmabufext), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2892) if (!dmp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2893) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2894)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2895) INIT_LIST_HEAD(&dmp->dma.list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2896)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2897) /* Queue it to a linked list */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2898) if (mlist)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2899) list_add_tail(&dmp->dma.list, &mlist->dma.list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2900) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2901) mlist = dmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2902)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2903) /* allocate buffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2904) dmp->dma.virt = dma_alloc_coherent(&pcidev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2905) cnt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2906) &(dmp->dma.phys),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2907) GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2908)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2909) if (!dmp->dma.virt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2910) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2911)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2912) dmp->size = cnt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2913)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2914) if (nocopydata) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2915) bpl->tus.f.bdeFlags = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2916) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2917) memset((uint8_t *)dmp->dma.virt, 0, cnt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2918) bpl->tus.f.bdeFlags = BUFF_TYPE_BDE_64I;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2919) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2920)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2921) /* build buffer ptr list for IOCB */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2922) bpl->addrLow = le32_to_cpu(putPaddrLow(dmp->dma.phys));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2923) bpl->addrHigh = le32_to_cpu(putPaddrHigh(dmp->dma.phys));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2924) bpl->tus.f.bdeSize = (ushort) cnt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2925) bpl->tus.w = le32_to_cpu(bpl->tus.w);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2926) bpl++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2927)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2928) i++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2929) offset += cnt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2930) size -= cnt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2931) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2932)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2933) if (mlist) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2934) mlist->flag = i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2935) return mlist;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2936) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2937) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2938) diag_cmd_data_free(phba, mlist);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2939) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2940) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2941)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2942) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2943) * lpfcdiag_loop_post_rxbufs - post the receive buffers for an unsol CT cmd
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2944) * @phba: Pointer to HBA context object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2945) * @rxxri: Receive exchange id
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2946) * @len: Number of data bytes
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2947) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2948) * This function allocates and posts a data buffer of sufficient size to receive
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2949) * an unsolicted CT command.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2950) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2951) static int lpfcdiag_loop_post_rxbufs(struct lpfc_hba *phba, uint16_t rxxri,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2952) size_t len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2953) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2954) struct lpfc_sli_ring *pring;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2955) struct lpfc_iocbq *cmdiocbq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2956) IOCB_t *cmd = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2957) struct list_head head, *curr, *next;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2958) struct lpfc_dmabuf *rxbmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2959) struct lpfc_dmabuf *dmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2960) struct lpfc_dmabuf *mp[2] = {NULL, NULL};
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2961) struct ulp_bde64 *rxbpl = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2962) uint32_t num_bde;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2963) struct lpfc_dmabufext *rxbuffer = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2964) int ret_val = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2965) int iocb_stat;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2966) int i = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2967)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2968) pring = lpfc_phba_elsring(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2969)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2970) cmdiocbq = lpfc_sli_get_iocbq(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2971) rxbmp = kmalloc(sizeof(struct lpfc_dmabuf), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2972) if (rxbmp != NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2973) rxbmp->virt = lpfc_mbuf_alloc(phba, 0, &rxbmp->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2974) if (rxbmp->virt) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2975) INIT_LIST_HEAD(&rxbmp->list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2976) rxbpl = (struct ulp_bde64 *) rxbmp->virt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2977) rxbuffer = diag_cmd_data_alloc(phba, rxbpl, len, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2978) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2979) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2980)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2981) if (!cmdiocbq || !rxbmp || !rxbpl || !rxbuffer || !pring) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2982) ret_val = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2983) goto err_post_rxbufs_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2984) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2985)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2986) /* Queue buffers for the receive exchange */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2987) num_bde = (uint32_t)rxbuffer->flag;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2988) dmp = &rxbuffer->dma;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2989)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2990) cmd = &cmdiocbq->iocb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2991) i = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2992)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2993) INIT_LIST_HEAD(&head);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2994) list_add_tail(&head, &dmp->list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2995) list_for_each_safe(curr, next, &head) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2996) mp[i] = list_entry(curr, struct lpfc_dmabuf, list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2997) list_del(curr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2998)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2999) if (phba->sli3_options & LPFC_SLI3_HBQ_ENABLED) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3000) mp[i]->buffer_tag = lpfc_sli_get_buffer_tag(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3001) cmd->un.quexri64cx.buff.bde.addrHigh =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3002) putPaddrHigh(mp[i]->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3003) cmd->un.quexri64cx.buff.bde.addrLow =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3004) putPaddrLow(mp[i]->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3005) cmd->un.quexri64cx.buff.bde.tus.f.bdeSize =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3006) ((struct lpfc_dmabufext *)mp[i])->size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3007) cmd->un.quexri64cx.buff.buffer_tag = mp[i]->buffer_tag;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3008) cmd->ulpCommand = CMD_QUE_XRI64_CX;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3009) cmd->ulpPU = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3010) cmd->ulpLe = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3011) cmd->ulpBdeCount = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3012) cmd->unsli3.que_xri64cx_ext_words.ebde_count = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3013)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3014) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3015) cmd->un.cont64[i].addrHigh = putPaddrHigh(mp[i]->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3016) cmd->un.cont64[i].addrLow = putPaddrLow(mp[i]->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3017) cmd->un.cont64[i].tus.f.bdeSize =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3018) ((struct lpfc_dmabufext *)mp[i])->size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3019) cmd->ulpBdeCount = ++i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3020)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3021) if ((--num_bde > 0) && (i < 2))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3022) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3023)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3024) cmd->ulpCommand = CMD_QUE_XRI_BUF64_CX;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3025) cmd->ulpLe = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3026) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3027)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3028) cmd->ulpClass = CLASS3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3029) cmd->ulpContext = rxxri;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3030)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3031) iocb_stat = lpfc_sli_issue_iocb(phba, LPFC_ELS_RING, cmdiocbq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3032) 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3033) if (iocb_stat == IOCB_ERROR) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3034) diag_cmd_data_free(phba,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3035) (struct lpfc_dmabufext *)mp[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3036) if (mp[1])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3037) diag_cmd_data_free(phba,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3038) (struct lpfc_dmabufext *)mp[1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3039) dmp = list_entry(next, struct lpfc_dmabuf, list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3040) ret_val = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3041) goto err_post_rxbufs_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3042) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3043)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3044) lpfc_sli_ringpostbuf_put(phba, pring, mp[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3045) if (mp[1]) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3046) lpfc_sli_ringpostbuf_put(phba, pring, mp[1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3047) mp[1] = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3048) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3049)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3050) /* The iocb was freed by lpfc_sli_issue_iocb */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3051) cmdiocbq = lpfc_sli_get_iocbq(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3052) if (!cmdiocbq) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3053) dmp = list_entry(next, struct lpfc_dmabuf, list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3054) ret_val = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3055) goto err_post_rxbufs_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3056) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3057)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3058) cmd = &cmdiocbq->iocb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3059) i = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3060) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3061) list_del(&head);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3062)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3063) err_post_rxbufs_exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3064)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3065) if (rxbmp) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3066) if (rxbmp->virt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3067) lpfc_mbuf_free(phba, rxbmp->virt, rxbmp->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3068) kfree(rxbmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3069) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3070)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3071) if (cmdiocbq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3072) lpfc_sli_release_iocbq(phba, cmdiocbq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3073) return ret_val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3074) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3075)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3076) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3077) * lpfc_bsg_diag_loopback_run - run loopback on a port by issue ct cmd to itself
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3078) * @job: LPFC_BSG_VENDOR_DIAG_TEST fc_bsg_job
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3079) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3080) * This function receives a user data buffer to be transmitted and received on
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3081) * the same port, the link must be up and in loopback mode prior
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3082) * to being called.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3083) * 1. A kernel buffer is allocated to copy the user data into.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3084) * 2. The port registers with "itself".
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3085) * 3. The transmit and receive exchange ids are obtained.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3086) * 4. The receive exchange id is posted.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3087) * 5. A new els loopback event is created.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3088) * 6. The command and response iocbs are allocated.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3089) * 7. The cmd iocb FsType is set to elx loopback and the CmdRsp to looppback.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3090) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3091) * This function is meant to be called n times while the port is in loopback
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3092) * so it is the apps responsibility to issue a reset to take the port out
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3093) * of loopback mode.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3094) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3095) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3096) lpfc_bsg_diag_loopback_run(struct bsg_job *job)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3097) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3098) struct lpfc_vport *vport = shost_priv(fc_bsg_to_shost(job));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3099) struct fc_bsg_reply *bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3100) struct lpfc_hba *phba = vport->phba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3101) struct lpfc_bsg_event *evt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3102) struct event_data *evdat;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3103) struct lpfc_sli *psli = &phba->sli;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3104) uint32_t size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3105) uint32_t full_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3106) size_t segment_len = 0, segment_offset = 0, current_offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3107) uint16_t rpi = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3108) struct lpfc_iocbq *cmdiocbq, *rspiocbq = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3109) IOCB_t *cmd, *rsp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3110) struct lpfc_sli_ct_request *ctreq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3111) struct lpfc_dmabuf *txbmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3112) struct ulp_bde64 *txbpl = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3113) struct lpfc_dmabufext *txbuffer = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3114) struct list_head head;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3115) struct lpfc_dmabuf *curr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3116) uint16_t txxri = 0, rxxri;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3117) uint32_t num_bde;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3118) uint8_t *ptr = NULL, *rx_databuf = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3119) int rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3120) int time_left;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3121) int iocb_stat = IOCB_SUCCESS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3122) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3123) void *dataout = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3124) uint32_t total_mem;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3125)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3126) /* in case no data is returned return just the return code */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3127) bsg_reply->reply_payload_rcv_len = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3128)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3129) if (job->request_len <
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3130) sizeof(struct fc_bsg_request) + sizeof(struct diag_mode_test)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3131) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3132) "2739 Received DIAG TEST request below minimum "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3133) "size\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3134) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3135) goto loopback_test_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3136) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3137)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3138) if (job->request_payload.payload_len !=
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3139) job->reply_payload.payload_len) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3140) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3141) goto loopback_test_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3142) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3143)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3144) if ((phba->link_state == LPFC_HBA_ERROR) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3145) (psli->sli_flag & LPFC_BLOCK_MGMT_IO) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3146) (!(psli->sli_flag & LPFC_SLI_ACTIVE))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3147) rc = -EACCES;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3148) goto loopback_test_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3149) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3150)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3151) if (!lpfc_is_link_up(phba) || !(phba->link_flag & LS_LOOPBACK_MODE)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3152) rc = -EACCES;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3153) goto loopback_test_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3154) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3155)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3156) size = job->request_payload.payload_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3157) full_size = size + ELX_LOOPBACK_HEADER_SZ; /* plus the header */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3158)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3159) if ((size == 0) || (size > 80 * BUF_SZ_4K)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3160) rc = -ERANGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3161) goto loopback_test_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3162) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3163)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3164) if (full_size >= BUF_SZ_4K) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3165) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3166) * Allocate memory for ioctl data. If buffer is bigger than 64k,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3167) * then we allocate 64k and re-use that buffer over and over to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3168) * xfer the whole block. This is because Linux kernel has a
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3169) * problem allocating more than 120k of kernel space memory. Saw
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3170) * problem with GET_FCPTARGETMAPPING...
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3171) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3172) if (size <= (64 * 1024))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3173) total_mem = full_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3174) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3175) total_mem = 64 * 1024;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3176) } else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3177) /* Allocate memory for ioctl data */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3178) total_mem = BUF_SZ_4K;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3179)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3180) dataout = kmalloc(total_mem, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3181) if (dataout == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3182) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3183) goto loopback_test_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3184) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3185)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3186) ptr = dataout;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3187) ptr += ELX_LOOPBACK_HEADER_SZ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3188) sg_copy_to_buffer(job->request_payload.sg_list,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3189) job->request_payload.sg_cnt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3190) ptr, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3191) rc = lpfcdiag_loop_self_reg(phba, &rpi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3192) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3193) goto loopback_test_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3194)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3195) if (phba->sli_rev < LPFC_SLI_REV4) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3196) rc = lpfcdiag_loop_get_xri(phba, rpi, &txxri, &rxxri);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3197) if (rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3198) lpfcdiag_loop_self_unreg(phba, rpi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3199) goto loopback_test_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3200) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3201)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3202) rc = lpfcdiag_loop_post_rxbufs(phba, rxxri, full_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3203) if (rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3204) lpfcdiag_loop_self_unreg(phba, rpi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3205) goto loopback_test_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3206) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3207) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3208) evt = lpfc_bsg_event_new(FC_REG_CT_EVENT, current->pid,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3209) SLI_CT_ELX_LOOPBACK);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3210) if (!evt) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3211) lpfcdiag_loop_self_unreg(phba, rpi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3212) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3213) goto loopback_test_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3214) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3215)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3216) spin_lock_irqsave(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3217) list_add(&evt->node, &phba->ct_ev_waiters);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3218) lpfc_bsg_event_ref(evt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3219) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3220)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3221) cmdiocbq = lpfc_sli_get_iocbq(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3222) if (phba->sli_rev < LPFC_SLI_REV4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3223) rspiocbq = lpfc_sli_get_iocbq(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3224) txbmp = kmalloc(sizeof(struct lpfc_dmabuf), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3225)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3226) if (txbmp) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3227) txbmp->virt = lpfc_mbuf_alloc(phba, 0, &txbmp->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3228) if (txbmp->virt) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3229) INIT_LIST_HEAD(&txbmp->list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3230) txbpl = (struct ulp_bde64 *) txbmp->virt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3231) txbuffer = diag_cmd_data_alloc(phba,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3232) txbpl, full_size, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3233) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3234) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3235)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3236) if (!cmdiocbq || !txbmp || !txbpl || !txbuffer || !txbmp->virt) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3237) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3238) goto err_loopback_test_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3239) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3240) if ((phba->sli_rev < LPFC_SLI_REV4) && !rspiocbq) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3241) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3242) goto err_loopback_test_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3243) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3244)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3245) cmd = &cmdiocbq->iocb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3246) if (phba->sli_rev < LPFC_SLI_REV4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3247) rsp = &rspiocbq->iocb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3248)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3249) INIT_LIST_HEAD(&head);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3250) list_add_tail(&head, &txbuffer->dma.list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3251) list_for_each_entry(curr, &head, list) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3252) segment_len = ((struct lpfc_dmabufext *)curr)->size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3253) if (current_offset == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3254) ctreq = curr->virt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3255) memset(ctreq, 0, ELX_LOOPBACK_HEADER_SZ);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3256) ctreq->RevisionId.bits.Revision = SLI_CT_REVISION;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3257) ctreq->RevisionId.bits.InId = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3258) ctreq->FsType = SLI_CT_ELX_LOOPBACK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3259) ctreq->FsSubType = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3260) ctreq->CommandResponse.bits.CmdRsp = ELX_LOOPBACK_DATA;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3261) ctreq->CommandResponse.bits.Size = size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3262) segment_offset = ELX_LOOPBACK_HEADER_SZ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3263) } else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3264) segment_offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3265)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3266) BUG_ON(segment_offset >= segment_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3267) memcpy(curr->virt + segment_offset,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3268) ptr + current_offset,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3269) segment_len - segment_offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3270)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3271) current_offset += segment_len - segment_offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3272) BUG_ON(current_offset > size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3273) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3274) list_del(&head);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3275)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3276) /* Build the XMIT_SEQUENCE iocb */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3277) num_bde = (uint32_t)txbuffer->flag;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3278)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3279) cmd->un.xseq64.bdl.addrHigh = putPaddrHigh(txbmp->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3280) cmd->un.xseq64.bdl.addrLow = putPaddrLow(txbmp->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3281) cmd->un.xseq64.bdl.bdeFlags = BUFF_TYPE_BLP_64;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3282) cmd->un.xseq64.bdl.bdeSize = (num_bde * sizeof(struct ulp_bde64));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3283)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3284) cmd->un.xseq64.w5.hcsw.Fctl = (LS | LA);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3285) cmd->un.xseq64.w5.hcsw.Dfctl = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3286) cmd->un.xseq64.w5.hcsw.Rctl = FC_RCTL_DD_UNSOL_CTL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3287) cmd->un.xseq64.w5.hcsw.Type = FC_TYPE_CT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3288)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3289) cmd->ulpCommand = CMD_XMIT_SEQUENCE64_CX;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3290) cmd->ulpBdeCount = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3291) cmd->ulpLe = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3292) cmd->ulpClass = CLASS3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3293)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3294) if (phba->sli_rev < LPFC_SLI_REV4) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3295) cmd->ulpContext = txxri;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3296) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3297) cmd->un.xseq64.bdl.ulpIoTag32 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3298) cmd->un.ulpWord[3] = phba->sli4_hba.rpi_ids[rpi];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3299) cmdiocbq->context3 = txbmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3300) cmdiocbq->sli4_xritag = NO_XRI;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3301) cmd->unsli3.rcvsli3.ox_id = 0xffff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3302) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3303) cmdiocbq->iocb_flag |= LPFC_IO_LIBDFC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3304) cmdiocbq->iocb_flag |= LPFC_IO_LOOPBACK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3305) cmdiocbq->vport = phba->pport;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3306) cmdiocbq->iocb_cmpl = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3307) iocb_stat = lpfc_sli_issue_iocb_wait(phba, LPFC_ELS_RING, cmdiocbq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3308) rspiocbq, (phba->fc_ratov * 2) +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3309) LPFC_DRVR_TIMEOUT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3310)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3311) if ((iocb_stat != IOCB_SUCCESS) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3312) ((phba->sli_rev < LPFC_SLI_REV4) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3313) (rsp->ulpStatus != IOSTAT_SUCCESS))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3314) lpfc_printf_log(phba, KERN_ERR, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3315) "3126 Failed loopback test issue iocb: "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3316) "iocb_stat:x%x\n", iocb_stat);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3317) rc = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3318) goto err_loopback_test_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3319) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3320)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3321) evt->waiting = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3322) time_left = wait_event_interruptible_timeout(
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3323) evt->wq, !list_empty(&evt->events_to_see),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3324) msecs_to_jiffies(1000 *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3325) ((phba->fc_ratov * 2) + LPFC_DRVR_TIMEOUT)));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3326) evt->waiting = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3327) if (list_empty(&evt->events_to_see)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3328) rc = (time_left) ? -EINTR : -ETIMEDOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3329) lpfc_printf_log(phba, KERN_ERR, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3330) "3125 Not receiving unsolicited event, "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3331) "rc:x%x\n", rc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3332) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3333) spin_lock_irqsave(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3334) list_move(evt->events_to_see.prev, &evt->events_to_get);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3335) evdat = list_entry(evt->events_to_get.prev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3336) typeof(*evdat), node);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3337) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3338) rx_databuf = evdat->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3339) if (evdat->len != full_size) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3340) lpfc_printf_log(phba, KERN_ERR, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3341) "1603 Loopback test did not receive expected "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3342) "data length. actual length 0x%x expected "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3343) "length 0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3344) evdat->len, full_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3345) rc = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3346) } else if (rx_databuf == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3347) rc = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3348) else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3349) rc = IOCB_SUCCESS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3350) /* skip over elx loopback header */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3351) rx_databuf += ELX_LOOPBACK_HEADER_SZ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3352) bsg_reply->reply_payload_rcv_len =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3353) sg_copy_from_buffer(job->reply_payload.sg_list,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3354) job->reply_payload.sg_cnt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3355) rx_databuf, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3356) bsg_reply->reply_payload_rcv_len = size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3357) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3358) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3359)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3360) err_loopback_test_exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3361) lpfcdiag_loop_self_unreg(phba, rpi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3362)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3363) spin_lock_irqsave(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3364) lpfc_bsg_event_unref(evt); /* release ref */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3365) lpfc_bsg_event_unref(evt); /* delete */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3366) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3367)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3368) if ((cmdiocbq != NULL) && (iocb_stat != IOCB_TIMEDOUT))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3369) lpfc_sli_release_iocbq(phba, cmdiocbq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3370)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3371) if (rspiocbq != NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3372) lpfc_sli_release_iocbq(phba, rspiocbq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3373)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3374) if (txbmp != NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3375) if (txbpl != NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3376) if (txbuffer != NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3377) diag_cmd_data_free(phba, txbuffer);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3378) lpfc_mbuf_free(phba, txbmp->virt, txbmp->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3379) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3380) kfree(txbmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3381) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3382)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3383) loopback_test_exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3384) kfree(dataout);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3385) /* make error code available to userspace */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3386) bsg_reply->result = rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3387) job->dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3388) /* complete the job back to userspace if no error */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3389) if (rc == IOCB_SUCCESS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3390) bsg_job_done(job, bsg_reply->result,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3391) bsg_reply->reply_payload_rcv_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3392) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3393) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3394)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3395) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3396) * lpfc_bsg_get_dfc_rev - process a GET_DFC_REV bsg vendor command
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3397) * @job: GET_DFC_REV fc_bsg_job
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3398) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3399) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3400) lpfc_bsg_get_dfc_rev(struct bsg_job *job)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3401) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3402) struct lpfc_vport *vport = shost_priv(fc_bsg_to_shost(job));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3403) struct fc_bsg_reply *bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3404) struct lpfc_hba *phba = vport->phba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3405) struct get_mgmt_rev_reply *event_reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3406) int rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3407)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3408) if (job->request_len <
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3409) sizeof(struct fc_bsg_request) + sizeof(struct get_mgmt_rev)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3410) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3411) "2740 Received GET_DFC_REV request below "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3412) "minimum size\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3413) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3414) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3415) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3416)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3417) event_reply = (struct get_mgmt_rev_reply *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3418) bsg_reply->reply_data.vendor_reply.vendor_rsp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3419)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3420) if (job->reply_len < sizeof(*bsg_reply) + sizeof(*event_reply)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3421) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3422) "2741 Received GET_DFC_REV reply below "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3423) "minimum size\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3424) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3425) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3426) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3427)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3428) event_reply->info.a_Major = MANAGEMENT_MAJOR_REV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3429) event_reply->info.a_Minor = MANAGEMENT_MINOR_REV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3430) job_error:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3431) bsg_reply->result = rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3432) if (rc == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3433) bsg_job_done(job, bsg_reply->result,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3434) bsg_reply->reply_payload_rcv_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3435) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3436) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3437)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3438) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3439) * lpfc_bsg_issue_mbox_cmpl - lpfc_bsg_issue_mbox mbox completion handler
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3440) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3441) * @pmboxq: Pointer to mailbox command.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3442) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3443) * This is completion handler function for mailbox commands issued from
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3444) * lpfc_bsg_issue_mbox function. This function is called by the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3445) * mailbox event handler function with no lock held. This function
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3446) * will wake up thread waiting on the wait queue pointed by context1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3447) * of the mailbox.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3448) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3449) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3450) lpfc_bsg_issue_mbox_cmpl(struct lpfc_hba *phba, LPFC_MBOXQ_t *pmboxq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3451) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3452) struct bsg_job_data *dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3453) struct fc_bsg_reply *bsg_reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3454) struct bsg_job *job;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3455) uint32_t size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3456) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3457) uint8_t *pmb, *pmb_buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3458)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3459) dd_data = pmboxq->ctx_ndlp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3460)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3461) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3462) * The outgoing buffer is readily referred from the dma buffer,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3463) * just need to get header part from mailboxq structure.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3464) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3465) pmb = (uint8_t *)&pmboxq->u.mb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3466) pmb_buf = (uint8_t *)dd_data->context_un.mbox.mb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3467) memcpy(pmb_buf, pmb, sizeof(MAILBOX_t));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3468)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3469) /* Determine if job has been aborted */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3470)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3471) spin_lock_irqsave(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3472) job = dd_data->set_job;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3473) if (job) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3474) /* Prevent timeout handling from trying to abort job */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3475) job->dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3476) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3477) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3478)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3479) /* Copy the mailbox data to the job if it is still active */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3480)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3481) if (job) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3482) bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3483) size = job->reply_payload.payload_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3484) bsg_reply->reply_payload_rcv_len =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3485) sg_copy_from_buffer(job->reply_payload.sg_list,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3486) job->reply_payload.sg_cnt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3487) pmb_buf, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3488) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3489)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3490) dd_data->set_job = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3491) mempool_free(dd_data->context_un.mbox.pmboxq, phba->mbox_mem_pool);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3492) lpfc_bsg_dma_page_free(phba, dd_data->context_un.mbox.dmabuffers);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3493) kfree(dd_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3494)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3495) /* Complete the job if the job is still active */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3496)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3497) if (job) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3498) bsg_reply->result = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3499) bsg_job_done(job, bsg_reply->result,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3500) bsg_reply->reply_payload_rcv_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3501) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3502) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3503) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3504)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3505) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3506) * lpfc_bsg_check_cmd_access - test for a supported mailbox command
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3507) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3508) * @mb: Pointer to a mailbox object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3509) * @vport: Pointer to a vport object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3510) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3511) * Some commands require the port to be offline, some may not be called from
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3512) * the application.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3513) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3514) static int lpfc_bsg_check_cmd_access(struct lpfc_hba *phba,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3515) MAILBOX_t *mb, struct lpfc_vport *vport)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3516) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3517) /* return negative error values for bsg job */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3518) switch (mb->mbxCommand) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3519) /* Offline only */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3520) case MBX_INIT_LINK:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3521) case MBX_DOWN_LINK:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3522) case MBX_CONFIG_LINK:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3523) case MBX_CONFIG_RING:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3524) case MBX_RESET_RING:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3525) case MBX_UNREG_LOGIN:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3526) case MBX_CLEAR_LA:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3527) case MBX_DUMP_CONTEXT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3528) case MBX_RUN_DIAGS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3529) case MBX_RESTART:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3530) case MBX_SET_MASK:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3531) if (!(vport->fc_flag & FC_OFFLINE_MODE)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3532) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3533) "2743 Command 0x%x is illegal in on-line "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3534) "state\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3535) mb->mbxCommand);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3536) return -EPERM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3537) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3538) case MBX_WRITE_NV:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3539) case MBX_WRITE_VPARMS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3540) case MBX_LOAD_SM:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3541) case MBX_READ_NV:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3542) case MBX_READ_CONFIG:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3543) case MBX_READ_RCONFIG:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3544) case MBX_READ_STATUS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3545) case MBX_READ_XRI:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3546) case MBX_READ_REV:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3547) case MBX_READ_LNK_STAT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3548) case MBX_DUMP_MEMORY:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3549) case MBX_DOWN_LOAD:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3550) case MBX_UPDATE_CFG:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3551) case MBX_KILL_BOARD:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3552) case MBX_READ_TOPOLOGY:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3553) case MBX_LOAD_AREA:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3554) case MBX_LOAD_EXP_ROM:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3555) case MBX_BEACON:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3556) case MBX_DEL_LD_ENTRY:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3557) case MBX_SET_DEBUG:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3558) case MBX_WRITE_WWN:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3559) case MBX_SLI4_CONFIG:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3560) case MBX_READ_EVENT_LOG:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3561) case MBX_READ_EVENT_LOG_STATUS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3562) case MBX_WRITE_EVENT_LOG:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3563) case MBX_PORT_CAPABILITIES:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3564) case MBX_PORT_IOV_CONTROL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3565) case MBX_RUN_BIU_DIAG64:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3566) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3567) case MBX_SET_VARIABLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3568) lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3569) "1226 mbox: set_variable 0x%x, 0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3570) mb->un.varWords[0],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3571) mb->un.varWords[1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3572) if ((mb->un.varWords[0] == SETVAR_MLOMNT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3573) && (mb->un.varWords[1] == 1)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3574) phba->wait_4_mlo_maint_flg = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3575) } else if (mb->un.varWords[0] == SETVAR_MLORST) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3576) spin_lock_irq(&phba->hbalock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3577) phba->link_flag &= ~LS_LOOPBACK_MODE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3578) spin_unlock_irq(&phba->hbalock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3579) phba->fc_topology = LPFC_TOPOLOGY_PT_PT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3580) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3581) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3582) case MBX_READ_SPARM64:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3583) case MBX_REG_LOGIN:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3584) case MBX_REG_LOGIN64:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3585) case MBX_CONFIG_PORT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3586) case MBX_RUN_BIU_DIAG:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3587) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3588) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3589) "2742 Unknown Command 0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3590) mb->mbxCommand);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3591) return -EPERM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3592) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3593)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3594) return 0; /* ok */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3595) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3596)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3597) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3598) * lpfc_bsg_mbox_ext_cleanup - clean up context of multi-buffer mbox session
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3599) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3600) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3601) * This is routine clean up and reset BSG handling of multi-buffer mbox
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3602) * command session.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3603) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3604) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3605) lpfc_bsg_mbox_ext_session_reset(struct lpfc_hba *phba)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3606) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3607) if (phba->mbox_ext_buf_ctx.state == LPFC_BSG_MBOX_IDLE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3608) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3609)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3610) /* free all memory, including dma buffers */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3611) lpfc_bsg_dma_page_list_free(phba,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3612) &phba->mbox_ext_buf_ctx.ext_dmabuf_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3613) lpfc_bsg_dma_page_free(phba, phba->mbox_ext_buf_ctx.mbx_dmabuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3614) /* multi-buffer write mailbox command pass-through complete */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3615) memset((char *)&phba->mbox_ext_buf_ctx, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3616) sizeof(struct lpfc_mbox_ext_buf_ctx));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3617) INIT_LIST_HEAD(&phba->mbox_ext_buf_ctx.ext_dmabuf_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3618)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3619) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3620) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3621)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3622) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3623) * lpfc_bsg_issue_mbox_ext_handle_job - job handler for multi-buffer mbox cmpl
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3624) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3625) * @pmboxq: Pointer to mailbox command.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3626) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3627) * This is routine handles BSG job for mailbox commands completions with
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3628) * multiple external buffers.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3629) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3630) static struct bsg_job *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3631) lpfc_bsg_issue_mbox_ext_handle_job(struct lpfc_hba *phba, LPFC_MBOXQ_t *pmboxq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3632) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3633) struct bsg_job_data *dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3634) struct bsg_job *job;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3635) struct fc_bsg_reply *bsg_reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3636) uint8_t *pmb, *pmb_buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3637) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3638) uint32_t size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3639) int rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3640) struct lpfc_dmabuf *dmabuf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3641) struct lpfc_sli_config_mbox *sli_cfg_mbx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3642) uint8_t *pmbx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3643)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3644) dd_data = pmboxq->ctx_buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3645)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3646) /* Determine if job has been aborted */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3647) spin_lock_irqsave(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3648) job = dd_data->set_job;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3649) if (job) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3650) bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3651) /* Prevent timeout handling from trying to abort job */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3652) job->dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3653) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3654) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3655)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3656) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3657) * The outgoing buffer is readily referred from the dma buffer,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3658) * just need to get header part from mailboxq structure.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3659) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3660)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3661) pmb = (uint8_t *)&pmboxq->u.mb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3662) pmb_buf = (uint8_t *)dd_data->context_un.mbox.mb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3663) /* Copy the byte swapped response mailbox back to the user */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3664) memcpy(pmb_buf, pmb, sizeof(MAILBOX_t));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3665) /* if there is any non-embedded extended data copy that too */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3666) dmabuf = phba->mbox_ext_buf_ctx.mbx_dmabuf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3667) sli_cfg_mbx = (struct lpfc_sli_config_mbox *)dmabuf->virt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3668) if (!bsg_bf_get(lpfc_mbox_hdr_emb,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3669) &sli_cfg_mbx->un.sli_config_emb0_subsys.sli_config_hdr)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3670) pmbx = (uint8_t *)dmabuf->virt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3671) /* byte swap the extended data following the mailbox command */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3672) lpfc_sli_pcimem_bcopy(&pmbx[sizeof(MAILBOX_t)],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3673) &pmbx[sizeof(MAILBOX_t)],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3674) sli_cfg_mbx->un.sli_config_emb0_subsys.mse[0].buf_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3675) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3676)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3677) /* Complete the job if the job is still active */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3678)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3679) if (job) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3680) size = job->reply_payload.payload_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3681) bsg_reply->reply_payload_rcv_len =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3682) sg_copy_from_buffer(job->reply_payload.sg_list,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3683) job->reply_payload.sg_cnt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3684) pmb_buf, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3685)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3686) /* result for successful */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3687) bsg_reply->result = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3688)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3689) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3690) "2937 SLI_CONFIG ext-buffer mailbox command "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3691) "(x%x/x%x) complete bsg job done, bsize:%d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3692) phba->mbox_ext_buf_ctx.nembType,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3693) phba->mbox_ext_buf_ctx.mboxType, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3694) lpfc_idiag_mbxacc_dump_bsg_mbox(phba,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3695) phba->mbox_ext_buf_ctx.nembType,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3696) phba->mbox_ext_buf_ctx.mboxType,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3697) dma_ebuf, sta_pos_addr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3698) phba->mbox_ext_buf_ctx.mbx_dmabuf, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3699) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3700) lpfc_printf_log(phba, KERN_ERR, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3701) "2938 SLI_CONFIG ext-buffer mailbox "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3702) "command (x%x/x%x) failure, rc:x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3703) phba->mbox_ext_buf_ctx.nembType,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3704) phba->mbox_ext_buf_ctx.mboxType, rc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3705) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3706)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3707)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3708) /* state change */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3709) phba->mbox_ext_buf_ctx.state = LPFC_BSG_MBOX_DONE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3710) kfree(dd_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3711) return job;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3712) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3713)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3714) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3715) * lpfc_bsg_issue_read_mbox_ext_cmpl - compl handler for multi-buffer read mbox
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3716) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3717) * @pmboxq: Pointer to mailbox command.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3718) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3719) * This is completion handler function for mailbox read commands with multiple
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3720) * external buffers.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3721) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3722) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3723) lpfc_bsg_issue_read_mbox_ext_cmpl(struct lpfc_hba *phba, LPFC_MBOXQ_t *pmboxq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3724) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3725) struct bsg_job *job;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3726) struct fc_bsg_reply *bsg_reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3727)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3728) job = lpfc_bsg_issue_mbox_ext_handle_job(phba, pmboxq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3729)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3730) /* handle the BSG job with mailbox command */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3731) if (!job)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3732) pmboxq->u.mb.mbxStatus = MBXERR_ERROR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3733)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3734) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3735) "2939 SLI_CONFIG ext-buffer rd mailbox command "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3736) "complete, ctxState:x%x, mbxStatus:x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3737) phba->mbox_ext_buf_ctx.state, pmboxq->u.mb.mbxStatus);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3738)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3739) if (pmboxq->u.mb.mbxStatus || phba->mbox_ext_buf_ctx.numBuf == 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3740) lpfc_bsg_mbox_ext_session_reset(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3741)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3742) /* free base driver mailbox structure memory */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3743) mempool_free(pmboxq, phba->mbox_mem_pool);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3744)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3745) /* if the job is still active, call job done */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3746) if (job) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3747) bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3748) bsg_job_done(job, bsg_reply->result,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3749) bsg_reply->reply_payload_rcv_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3750) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3751) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3752) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3753)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3754) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3755) * lpfc_bsg_issue_write_mbox_ext_cmpl - cmpl handler for multi-buffer write mbox
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3756) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3757) * @pmboxq: Pointer to mailbox command.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3758) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3759) * This is completion handler function for mailbox write commands with multiple
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3760) * external buffers.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3761) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3762) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3763) lpfc_bsg_issue_write_mbox_ext_cmpl(struct lpfc_hba *phba, LPFC_MBOXQ_t *pmboxq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3764) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3765) struct bsg_job *job;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3766) struct fc_bsg_reply *bsg_reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3767)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3768) job = lpfc_bsg_issue_mbox_ext_handle_job(phba, pmboxq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3769)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3770) /* handle the BSG job with the mailbox command */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3771) if (!job)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3772) pmboxq->u.mb.mbxStatus = MBXERR_ERROR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3773)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3774) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3775) "2940 SLI_CONFIG ext-buffer wr mailbox command "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3776) "complete, ctxState:x%x, mbxStatus:x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3777) phba->mbox_ext_buf_ctx.state, pmboxq->u.mb.mbxStatus);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3778)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3779) /* free all memory, including dma buffers */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3780) mempool_free(pmboxq, phba->mbox_mem_pool);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3781) lpfc_bsg_mbox_ext_session_reset(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3782)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3783) /* if the job is still active, call job done */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3784) if (job) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3785) bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3786) bsg_job_done(job, bsg_reply->result,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3787) bsg_reply->reply_payload_rcv_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3788) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3789)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3790) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3791) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3792)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3793) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3794) lpfc_bsg_sli_cfg_dma_desc_setup(struct lpfc_hba *phba, enum nemb_type nemb_tp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3795) uint32_t index, struct lpfc_dmabuf *mbx_dmabuf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3796) struct lpfc_dmabuf *ext_dmabuf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3797) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3798) struct lpfc_sli_config_mbox *sli_cfg_mbx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3799)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3800) /* pointer to the start of mailbox command */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3801) sli_cfg_mbx = (struct lpfc_sli_config_mbox *)mbx_dmabuf->virt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3802)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3803) if (nemb_tp == nemb_mse) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3804) if (index == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3805) sli_cfg_mbx->un.sli_config_emb0_subsys.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3806) mse[index].pa_hi =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3807) putPaddrHigh(mbx_dmabuf->phys +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3808) sizeof(MAILBOX_t));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3809) sli_cfg_mbx->un.sli_config_emb0_subsys.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3810) mse[index].pa_lo =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3811) putPaddrLow(mbx_dmabuf->phys +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3812) sizeof(MAILBOX_t));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3813) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3814) "2943 SLI_CONFIG(mse)[%d], "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3815) "bufLen:%d, addrHi:x%x, addrLo:x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3816) index,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3817) sli_cfg_mbx->un.sli_config_emb0_subsys.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3818) mse[index].buf_len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3819) sli_cfg_mbx->un.sli_config_emb0_subsys.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3820) mse[index].pa_hi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3821) sli_cfg_mbx->un.sli_config_emb0_subsys.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3822) mse[index].pa_lo);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3823) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3824) sli_cfg_mbx->un.sli_config_emb0_subsys.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3825) mse[index].pa_hi =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3826) putPaddrHigh(ext_dmabuf->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3827) sli_cfg_mbx->un.sli_config_emb0_subsys.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3828) mse[index].pa_lo =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3829) putPaddrLow(ext_dmabuf->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3830) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3831) "2944 SLI_CONFIG(mse)[%d], "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3832) "bufLen:%d, addrHi:x%x, addrLo:x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3833) index,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3834) sli_cfg_mbx->un.sli_config_emb0_subsys.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3835) mse[index].buf_len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3836) sli_cfg_mbx->un.sli_config_emb0_subsys.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3837) mse[index].pa_hi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3838) sli_cfg_mbx->un.sli_config_emb0_subsys.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3839) mse[index].pa_lo);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3840) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3841) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3842) if (index == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3843) sli_cfg_mbx->un.sli_config_emb1_subsys.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3844) hbd[index].pa_hi =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3845) putPaddrHigh(mbx_dmabuf->phys +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3846) sizeof(MAILBOX_t));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3847) sli_cfg_mbx->un.sli_config_emb1_subsys.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3848) hbd[index].pa_lo =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3849) putPaddrLow(mbx_dmabuf->phys +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3850) sizeof(MAILBOX_t));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3851) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3852) "3007 SLI_CONFIG(hbd)[%d], "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3853) "bufLen:%d, addrHi:x%x, addrLo:x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3854) index,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3855) bsg_bf_get(lpfc_mbox_sli_config_ecmn_hbd_len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3856) &sli_cfg_mbx->un.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3857) sli_config_emb1_subsys.hbd[index]),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3858) sli_cfg_mbx->un.sli_config_emb1_subsys.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3859) hbd[index].pa_hi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3860) sli_cfg_mbx->un.sli_config_emb1_subsys.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3861) hbd[index].pa_lo);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3862)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3863) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3864) sli_cfg_mbx->un.sli_config_emb1_subsys.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3865) hbd[index].pa_hi =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3866) putPaddrHigh(ext_dmabuf->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3867) sli_cfg_mbx->un.sli_config_emb1_subsys.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3868) hbd[index].pa_lo =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3869) putPaddrLow(ext_dmabuf->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3870) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3871) "3008 SLI_CONFIG(hbd)[%d], "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3872) "bufLen:%d, addrHi:x%x, addrLo:x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3873) index,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3874) bsg_bf_get(lpfc_mbox_sli_config_ecmn_hbd_len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3875) &sli_cfg_mbx->un.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3876) sli_config_emb1_subsys.hbd[index]),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3877) sli_cfg_mbx->un.sli_config_emb1_subsys.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3878) hbd[index].pa_hi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3879) sli_cfg_mbx->un.sli_config_emb1_subsys.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3880) hbd[index].pa_lo);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3881) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3882) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3883) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3884) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3885)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3886) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3887) * lpfc_bsg_sli_cfg_mse_read_cmd_ext - sli_config non-embedded mailbox cmd read
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3888) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3889) * @mb: Pointer to a BSG mailbox object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3890) * @nemb_tp: Enumerate of non-embedded mailbox command type.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3891) * @dmabuff: Pointer to a DMA buffer descriptor.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3892) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3893) * This routine performs SLI_CONFIG (0x9B) read mailbox command operation with
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3894) * non-embedded external bufffers.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3895) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3896) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3897) lpfc_bsg_sli_cfg_read_cmd_ext(struct lpfc_hba *phba, struct bsg_job *job,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3898) enum nemb_type nemb_tp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3899) struct lpfc_dmabuf *dmabuf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3900) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3901) struct fc_bsg_request *bsg_request = job->request;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3902) struct lpfc_sli_config_mbox *sli_cfg_mbx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3903) struct dfc_mbox_req *mbox_req;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3904) struct lpfc_dmabuf *curr_dmabuf, *next_dmabuf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3905) uint32_t ext_buf_cnt, ext_buf_index;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3906) struct lpfc_dmabuf *ext_dmabuf = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3907) struct bsg_job_data *dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3908) LPFC_MBOXQ_t *pmboxq = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3909) MAILBOX_t *pmb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3910) uint8_t *pmbx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3911) int rc, i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3912)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3913) mbox_req =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3914) (struct dfc_mbox_req *)bsg_request->rqst_data.h_vendor.vendor_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3915)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3916) /* pointer to the start of mailbox command */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3917) sli_cfg_mbx = (struct lpfc_sli_config_mbox *)dmabuf->virt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3918)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3919) if (nemb_tp == nemb_mse) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3920) ext_buf_cnt = bsg_bf_get(lpfc_mbox_hdr_mse_cnt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3921) &sli_cfg_mbx->un.sli_config_emb0_subsys.sli_config_hdr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3922) if (ext_buf_cnt > LPFC_MBX_SLI_CONFIG_MAX_MSE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3923) lpfc_printf_log(phba, KERN_ERR, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3924) "2945 Handled SLI_CONFIG(mse) rd, "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3925) "ext_buf_cnt(%d) out of range(%d)\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3926) ext_buf_cnt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3927) LPFC_MBX_SLI_CONFIG_MAX_MSE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3928) rc = -ERANGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3929) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3930) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3931) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3932) "2941 Handled SLI_CONFIG(mse) rd, "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3933) "ext_buf_cnt:%d\n", ext_buf_cnt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3934) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3935) /* sanity check on interface type for support */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3936) if (bf_get(lpfc_sli_intf_if_type, &phba->sli4_hba.sli_intf) <
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3937) LPFC_SLI_INTF_IF_TYPE_2) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3938) rc = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3939) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3940) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3941) /* nemb_tp == nemb_hbd */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3942) ext_buf_cnt = sli_cfg_mbx->un.sli_config_emb1_subsys.hbd_count;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3943) if (ext_buf_cnt > LPFC_MBX_SLI_CONFIG_MAX_HBD) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3944) lpfc_printf_log(phba, KERN_ERR, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3945) "2946 Handled SLI_CONFIG(hbd) rd, "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3946) "ext_buf_cnt(%d) out of range(%d)\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3947) ext_buf_cnt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3948) LPFC_MBX_SLI_CONFIG_MAX_HBD);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3949) rc = -ERANGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3950) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3951) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3952) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3953) "2942 Handled SLI_CONFIG(hbd) rd, "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3954) "ext_buf_cnt:%d\n", ext_buf_cnt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3955) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3956)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3957) /* before dma descriptor setup */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3958) lpfc_idiag_mbxacc_dump_bsg_mbox(phba, nemb_tp, mbox_rd, dma_mbox,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3959) sta_pre_addr, dmabuf, ext_buf_cnt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3960)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3961) /* reject non-embedded mailbox command with none external buffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3962) if (ext_buf_cnt == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3963) rc = -EPERM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3964) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3965) } else if (ext_buf_cnt > 1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3966) /* additional external read buffers */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3967) for (i = 1; i < ext_buf_cnt; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3968) ext_dmabuf = lpfc_bsg_dma_page_alloc(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3969) if (!ext_dmabuf) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3970) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3971) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3972) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3973) list_add_tail(&ext_dmabuf->list,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3974) &phba->mbox_ext_buf_ctx.ext_dmabuf_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3975) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3976) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3977)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3978) /* bsg tracking structure */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3979) dd_data = kmalloc(sizeof(struct bsg_job_data), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3980) if (!dd_data) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3981) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3982) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3983) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3984)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3985) /* mailbox command structure for base driver */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3986) pmboxq = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3987) if (!pmboxq) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3988) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3989) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3990) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3991) memset(pmboxq, 0, sizeof(LPFC_MBOXQ_t));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3992)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3993) /* for the first external buffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3994) lpfc_bsg_sli_cfg_dma_desc_setup(phba, nemb_tp, 0, dmabuf, dmabuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3995)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3996) /* for the rest of external buffer descriptors if any */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3997) if (ext_buf_cnt > 1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3998) ext_buf_index = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3999) list_for_each_entry_safe(curr_dmabuf, next_dmabuf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4000) &phba->mbox_ext_buf_ctx.ext_dmabuf_list, list) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4001) lpfc_bsg_sli_cfg_dma_desc_setup(phba, nemb_tp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4002) ext_buf_index, dmabuf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4003) curr_dmabuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4004) ext_buf_index++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4005) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4006) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4007)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4008) /* after dma descriptor setup */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4009) lpfc_idiag_mbxacc_dump_bsg_mbox(phba, nemb_tp, mbox_rd, dma_mbox,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4010) sta_pos_addr, dmabuf, ext_buf_cnt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4011)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4012) /* construct base driver mbox command */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4013) pmb = &pmboxq->u.mb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4014) pmbx = (uint8_t *)dmabuf->virt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4015) memcpy(pmb, pmbx, sizeof(*pmb));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4016) pmb->mbxOwner = OWN_HOST;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4017) pmboxq->vport = phba->pport;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4018)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4019) /* multi-buffer handling context */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4020) phba->mbox_ext_buf_ctx.nembType = nemb_tp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4021) phba->mbox_ext_buf_ctx.mboxType = mbox_rd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4022) phba->mbox_ext_buf_ctx.numBuf = ext_buf_cnt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4023) phba->mbox_ext_buf_ctx.mbxTag = mbox_req->extMboxTag;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4024) phba->mbox_ext_buf_ctx.seqNum = mbox_req->extSeqNum;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4025) phba->mbox_ext_buf_ctx.mbx_dmabuf = dmabuf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4026)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4027) /* callback for multi-buffer read mailbox command */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4028) pmboxq->mbox_cmpl = lpfc_bsg_issue_read_mbox_ext_cmpl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4029)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4030) /* context fields to callback function */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4031) pmboxq->ctx_buf = dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4032) dd_data->type = TYPE_MBOX;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4033) dd_data->set_job = job;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4034) dd_data->context_un.mbox.pmboxq = pmboxq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4035) dd_data->context_un.mbox.mb = (MAILBOX_t *)pmbx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4036) job->dd_data = dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4037)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4038) /* state change */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4039) phba->mbox_ext_buf_ctx.state = LPFC_BSG_MBOX_PORT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4040)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4041) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4042) * Non-embedded mailbox subcommand data gets byte swapped here because
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4043) * the lower level driver code only does the first 64 mailbox words.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4044) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4045) if ((!bsg_bf_get(lpfc_mbox_hdr_emb,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4046) &sli_cfg_mbx->un.sli_config_emb0_subsys.sli_config_hdr)) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4047) (nemb_tp == nemb_mse))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4048) lpfc_sli_pcimem_bcopy(&pmbx[sizeof(MAILBOX_t)],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4049) &pmbx[sizeof(MAILBOX_t)],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4050) sli_cfg_mbx->un.sli_config_emb0_subsys.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4051) mse[0].buf_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4052)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4053) rc = lpfc_sli_issue_mbox(phba, pmboxq, MBX_NOWAIT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4054) if ((rc == MBX_SUCCESS) || (rc == MBX_BUSY)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4055) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4056) "2947 Issued SLI_CONFIG ext-buffer "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4057) "mailbox command, rc:x%x\n", rc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4058) return SLI_CONFIG_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4059) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4060) lpfc_printf_log(phba, KERN_ERR, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4061) "2948 Failed to issue SLI_CONFIG ext-buffer "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4062) "mailbox command, rc:x%x\n", rc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4063) rc = -EPIPE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4064)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4065) job_error:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4066) if (pmboxq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4067) mempool_free(pmboxq, phba->mbox_mem_pool);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4068) lpfc_bsg_dma_page_list_free(phba,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4069) &phba->mbox_ext_buf_ctx.ext_dmabuf_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4070) kfree(dd_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4071) phba->mbox_ext_buf_ctx.state = LPFC_BSG_MBOX_IDLE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4072) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4073) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4074)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4075) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4076) * lpfc_bsg_sli_cfg_write_cmd_ext - sli_config non-embedded mailbox cmd write
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4077) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4078) * @mb: Pointer to a BSG mailbox object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4079) * @dmabuff: Pointer to a DMA buffer descriptor.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4080) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4081) * This routine performs SLI_CONFIG (0x9B) write mailbox command operation with
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4082) * non-embedded external bufffers.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4083) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4084) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4085) lpfc_bsg_sli_cfg_write_cmd_ext(struct lpfc_hba *phba, struct bsg_job *job,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4086) enum nemb_type nemb_tp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4087) struct lpfc_dmabuf *dmabuf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4088) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4089) struct fc_bsg_request *bsg_request = job->request;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4090) struct fc_bsg_reply *bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4091) struct dfc_mbox_req *mbox_req;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4092) struct lpfc_sli_config_mbox *sli_cfg_mbx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4093) uint32_t ext_buf_cnt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4094) struct bsg_job_data *dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4095) LPFC_MBOXQ_t *pmboxq = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4096) MAILBOX_t *pmb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4097) uint8_t *mbx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4098) int rc = SLI_CONFIG_NOT_HANDLED, i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4099)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4100) mbox_req =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4101) (struct dfc_mbox_req *)bsg_request->rqst_data.h_vendor.vendor_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4102)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4103) /* pointer to the start of mailbox command */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4104) sli_cfg_mbx = (struct lpfc_sli_config_mbox *)dmabuf->virt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4105)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4106) if (nemb_tp == nemb_mse) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4107) ext_buf_cnt = bsg_bf_get(lpfc_mbox_hdr_mse_cnt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4108) &sli_cfg_mbx->un.sli_config_emb0_subsys.sli_config_hdr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4109) if (ext_buf_cnt > LPFC_MBX_SLI_CONFIG_MAX_MSE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4110) lpfc_printf_log(phba, KERN_ERR, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4111) "2953 Failed SLI_CONFIG(mse) wr, "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4112) "ext_buf_cnt(%d) out of range(%d)\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4113) ext_buf_cnt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4114) LPFC_MBX_SLI_CONFIG_MAX_MSE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4115) return -ERANGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4116) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4117) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4118) "2949 Handled SLI_CONFIG(mse) wr, "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4119) "ext_buf_cnt:%d\n", ext_buf_cnt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4120) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4121) /* sanity check on interface type for support */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4122) if (bf_get(lpfc_sli_intf_if_type, &phba->sli4_hba.sli_intf) <
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4123) LPFC_SLI_INTF_IF_TYPE_2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4124) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4125) /* nemb_tp == nemb_hbd */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4126) ext_buf_cnt = sli_cfg_mbx->un.sli_config_emb1_subsys.hbd_count;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4127) if (ext_buf_cnt > LPFC_MBX_SLI_CONFIG_MAX_HBD) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4128) lpfc_printf_log(phba, KERN_ERR, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4129) "2954 Failed SLI_CONFIG(hbd) wr, "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4130) "ext_buf_cnt(%d) out of range(%d)\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4131) ext_buf_cnt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4132) LPFC_MBX_SLI_CONFIG_MAX_HBD);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4133) return -ERANGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4134) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4135) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4136) "2950 Handled SLI_CONFIG(hbd) wr, "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4137) "ext_buf_cnt:%d\n", ext_buf_cnt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4138) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4139)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4140) /* before dma buffer descriptor setup */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4141) lpfc_idiag_mbxacc_dump_bsg_mbox(phba, nemb_tp, mbox_wr, dma_mbox,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4142) sta_pre_addr, dmabuf, ext_buf_cnt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4143)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4144) if (ext_buf_cnt == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4145) return -EPERM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4146)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4147) /* for the first external buffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4148) lpfc_bsg_sli_cfg_dma_desc_setup(phba, nemb_tp, 0, dmabuf, dmabuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4149)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4150) /* after dma descriptor setup */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4151) lpfc_idiag_mbxacc_dump_bsg_mbox(phba, nemb_tp, mbox_wr, dma_mbox,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4152) sta_pos_addr, dmabuf, ext_buf_cnt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4153)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4154) /* log for looking forward */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4155) for (i = 1; i < ext_buf_cnt; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4156) if (nemb_tp == nemb_mse)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4157) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4158) "2951 SLI_CONFIG(mse), buf[%d]-length:%d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4159) i, sli_cfg_mbx->un.sli_config_emb0_subsys.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4160) mse[i].buf_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4161) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4162) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4163) "2952 SLI_CONFIG(hbd), buf[%d]-length:%d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4164) i, bsg_bf_get(lpfc_mbox_sli_config_ecmn_hbd_len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4165) &sli_cfg_mbx->un.sli_config_emb1_subsys.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4166) hbd[i]));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4167) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4168)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4169) /* multi-buffer handling context */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4170) phba->mbox_ext_buf_ctx.nembType = nemb_tp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4171) phba->mbox_ext_buf_ctx.mboxType = mbox_wr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4172) phba->mbox_ext_buf_ctx.numBuf = ext_buf_cnt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4173) phba->mbox_ext_buf_ctx.mbxTag = mbox_req->extMboxTag;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4174) phba->mbox_ext_buf_ctx.seqNum = mbox_req->extSeqNum;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4175) phba->mbox_ext_buf_ctx.mbx_dmabuf = dmabuf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4176)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4177) if (ext_buf_cnt == 1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4178) /* bsg tracking structure */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4179) dd_data = kmalloc(sizeof(struct bsg_job_data), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4180) if (!dd_data) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4181) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4182) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4183) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4184)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4185) /* mailbox command structure for base driver */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4186) pmboxq = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4187) if (!pmboxq) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4188) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4189) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4190) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4191) memset(pmboxq, 0, sizeof(LPFC_MBOXQ_t));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4192) pmb = &pmboxq->u.mb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4193) mbx = (uint8_t *)dmabuf->virt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4194) memcpy(pmb, mbx, sizeof(*pmb));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4195) pmb->mbxOwner = OWN_HOST;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4196) pmboxq->vport = phba->pport;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4197)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4198) /* callback for multi-buffer read mailbox command */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4199) pmboxq->mbox_cmpl = lpfc_bsg_issue_write_mbox_ext_cmpl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4200)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4201) /* context fields to callback function */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4202) pmboxq->ctx_buf = dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4203) dd_data->type = TYPE_MBOX;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4204) dd_data->set_job = job;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4205) dd_data->context_un.mbox.pmboxq = pmboxq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4206) dd_data->context_un.mbox.mb = (MAILBOX_t *)mbx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4207) job->dd_data = dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4208)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4209) /* state change */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4210)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4211) phba->mbox_ext_buf_ctx.state = LPFC_BSG_MBOX_PORT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4212) rc = lpfc_sli_issue_mbox(phba, pmboxq, MBX_NOWAIT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4213) if ((rc == MBX_SUCCESS) || (rc == MBX_BUSY)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4214) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4215) "2955 Issued SLI_CONFIG ext-buffer "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4216) "mailbox command, rc:x%x\n", rc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4217) return SLI_CONFIG_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4218) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4219) lpfc_printf_log(phba, KERN_ERR, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4220) "2956 Failed to issue SLI_CONFIG ext-buffer "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4221) "mailbox command, rc:x%x\n", rc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4222) rc = -EPIPE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4223) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4224) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4225)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4226) /* wait for additoinal external buffers */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4227)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4228) bsg_reply->result = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4229) bsg_job_done(job, bsg_reply->result,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4230) bsg_reply->reply_payload_rcv_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4231) return SLI_CONFIG_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4232)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4233) job_error:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4234) if (pmboxq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4235) mempool_free(pmboxq, phba->mbox_mem_pool);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4236) kfree(dd_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4237)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4238) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4239) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4240)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4241) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4242) * lpfc_bsg_handle_sli_cfg_mbox - handle sli-cfg mailbox cmd with ext buffer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4243) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4244) * @mb: Pointer to a BSG mailbox object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4245) * @dmabuff: Pointer to a DMA buffer descriptor.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4246) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4247) * This routine handles SLI_CONFIG (0x9B) mailbox command with non-embedded
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4248) * external bufffers, including both 0x9B with non-embedded MSEs and 0x9B
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4249) * with embedded sussystem 0x1 and opcodes with external HBDs.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4250) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4251) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4252) lpfc_bsg_handle_sli_cfg_mbox(struct lpfc_hba *phba, struct bsg_job *job,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4253) struct lpfc_dmabuf *dmabuf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4254) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4255) struct lpfc_sli_config_mbox *sli_cfg_mbx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4256) uint32_t subsys;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4257) uint32_t opcode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4258) int rc = SLI_CONFIG_NOT_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4259)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4260) /* state change on new multi-buffer pass-through mailbox command */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4261) phba->mbox_ext_buf_ctx.state = LPFC_BSG_MBOX_HOST;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4262)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4263) sli_cfg_mbx = (struct lpfc_sli_config_mbox *)dmabuf->virt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4264)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4265) if (!bsg_bf_get(lpfc_mbox_hdr_emb,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4266) &sli_cfg_mbx->un.sli_config_emb0_subsys.sli_config_hdr)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4267) subsys = bsg_bf_get(lpfc_emb0_subcmnd_subsys,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4268) &sli_cfg_mbx->un.sli_config_emb0_subsys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4269) opcode = bsg_bf_get(lpfc_emb0_subcmnd_opcode,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4270) &sli_cfg_mbx->un.sli_config_emb0_subsys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4271) if (subsys == SLI_CONFIG_SUBSYS_FCOE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4272) switch (opcode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4273) case FCOE_OPCODE_READ_FCF:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4274) case FCOE_OPCODE_GET_DPORT_RESULTS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4275) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4276) "2957 Handled SLI_CONFIG "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4277) "subsys_fcoe, opcode:x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4278) opcode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4279) rc = lpfc_bsg_sli_cfg_read_cmd_ext(phba, job,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4280) nemb_mse, dmabuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4281) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4282) case FCOE_OPCODE_ADD_FCF:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4283) case FCOE_OPCODE_SET_DPORT_MODE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4284) case LPFC_MBOX_OPCODE_FCOE_LINK_DIAG_STATE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4285) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4286) "2958 Handled SLI_CONFIG "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4287) "subsys_fcoe, opcode:x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4288) opcode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4289) rc = lpfc_bsg_sli_cfg_write_cmd_ext(phba, job,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4290) nemb_mse, dmabuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4291) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4292) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4293) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4294) "2959 Reject SLI_CONFIG "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4295) "subsys_fcoe, opcode:x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4296) opcode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4297) rc = -EPERM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4298) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4299) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4300) } else if (subsys == SLI_CONFIG_SUBSYS_COMN) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4301) switch (opcode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4302) case COMN_OPCODE_GET_CNTL_ADDL_ATTRIBUTES:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4303) case COMN_OPCODE_GET_CNTL_ATTRIBUTES:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4304) case COMN_OPCODE_GET_PROFILE_CONFIG:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4305) case COMN_OPCODE_SET_FEATURES:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4306) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4307) "3106 Handled SLI_CONFIG "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4308) "subsys_comn, opcode:x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4309) opcode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4310) rc = lpfc_bsg_sli_cfg_read_cmd_ext(phba, job,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4311) nemb_mse, dmabuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4312) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4313) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4314) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4315) "3107 Reject SLI_CONFIG "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4316) "subsys_comn, opcode:x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4317) opcode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4318) rc = -EPERM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4319) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4320) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4321) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4322) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4323) "2977 Reject SLI_CONFIG "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4324) "subsys:x%d, opcode:x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4325) subsys, opcode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4326) rc = -EPERM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4327) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4328) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4329) subsys = bsg_bf_get(lpfc_emb1_subcmnd_subsys,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4330) &sli_cfg_mbx->un.sli_config_emb1_subsys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4331) opcode = bsg_bf_get(lpfc_emb1_subcmnd_opcode,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4332) &sli_cfg_mbx->un.sli_config_emb1_subsys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4333) if (subsys == SLI_CONFIG_SUBSYS_COMN) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4334) switch (opcode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4335) case COMN_OPCODE_READ_OBJECT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4336) case COMN_OPCODE_READ_OBJECT_LIST:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4337) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4338) "2960 Handled SLI_CONFIG "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4339) "subsys_comn, opcode:x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4340) opcode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4341) rc = lpfc_bsg_sli_cfg_read_cmd_ext(phba, job,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4342) nemb_hbd, dmabuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4343) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4344) case COMN_OPCODE_WRITE_OBJECT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4345) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4346) "2961 Handled SLI_CONFIG "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4347) "subsys_comn, opcode:x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4348) opcode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4349) rc = lpfc_bsg_sli_cfg_write_cmd_ext(phba, job,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4350) nemb_hbd, dmabuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4351) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4352) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4353) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4354) "2962 Not handled SLI_CONFIG "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4355) "subsys_comn, opcode:x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4356) opcode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4357) rc = SLI_CONFIG_NOT_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4358) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4359) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4360) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4361) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4362) "2978 Not handled SLI_CONFIG "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4363) "subsys:x%d, opcode:x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4364) subsys, opcode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4365) rc = SLI_CONFIG_NOT_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4366) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4367) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4368)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4369) /* state reset on not handled new multi-buffer mailbox command */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4370) if (rc != SLI_CONFIG_HANDLED)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4371) phba->mbox_ext_buf_ctx.state = LPFC_BSG_MBOX_IDLE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4372)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4373) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4374) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4375)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4376) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4377) * lpfc_bsg_mbox_ext_abort_req - request to abort mbox command with ext buffers
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4378) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4379) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4380) * This routine is for requesting to abort a pass-through mailbox command with
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4381) * multiple external buffers due to error condition.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4382) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4383) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4384) lpfc_bsg_mbox_ext_abort(struct lpfc_hba *phba)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4385) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4386) if (phba->mbox_ext_buf_ctx.state == LPFC_BSG_MBOX_PORT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4387) phba->mbox_ext_buf_ctx.state = LPFC_BSG_MBOX_ABTS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4388) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4389) lpfc_bsg_mbox_ext_session_reset(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4390) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4391) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4392)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4393) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4394) * lpfc_bsg_read_ebuf_get - get the next mailbox read external buffer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4395) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4396) * @dmabuf: Pointer to a DMA buffer descriptor.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4397) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4398) * This routine extracts the next mailbox read external buffer back to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4399) * user space through BSG.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4400) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4401) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4402) lpfc_bsg_read_ebuf_get(struct lpfc_hba *phba, struct bsg_job *job)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4403) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4404) struct fc_bsg_reply *bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4405) struct lpfc_sli_config_mbox *sli_cfg_mbx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4406) struct lpfc_dmabuf *dmabuf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4407) uint8_t *pbuf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4408) uint32_t size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4409) uint32_t index;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4410)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4411) index = phba->mbox_ext_buf_ctx.seqNum;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4412) phba->mbox_ext_buf_ctx.seqNum++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4413)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4414) sli_cfg_mbx = (struct lpfc_sli_config_mbox *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4415) phba->mbox_ext_buf_ctx.mbx_dmabuf->virt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4416)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4417) if (phba->mbox_ext_buf_ctx.nembType == nemb_mse) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4418) size = bsg_bf_get(lpfc_mbox_sli_config_mse_len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4419) &sli_cfg_mbx->un.sli_config_emb0_subsys.mse[index]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4420) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4421) "2963 SLI_CONFIG (mse) ext-buffer rd get "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4422) "buffer[%d], size:%d\n", index, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4423) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4424) size = bsg_bf_get(lpfc_mbox_sli_config_ecmn_hbd_len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4425) &sli_cfg_mbx->un.sli_config_emb1_subsys.hbd[index]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4426) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4427) "2964 SLI_CONFIG (hbd) ext-buffer rd get "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4428) "buffer[%d], size:%d\n", index, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4429) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4430) if (list_empty(&phba->mbox_ext_buf_ctx.ext_dmabuf_list))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4431) return -EPIPE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4432) dmabuf = list_first_entry(&phba->mbox_ext_buf_ctx.ext_dmabuf_list,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4433) struct lpfc_dmabuf, list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4434) list_del_init(&dmabuf->list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4435)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4436) /* after dma buffer descriptor setup */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4437) lpfc_idiag_mbxacc_dump_bsg_mbox(phba, phba->mbox_ext_buf_ctx.nembType,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4438) mbox_rd, dma_ebuf, sta_pos_addr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4439) dmabuf, index);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4440)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4441) pbuf = (uint8_t *)dmabuf->virt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4442) bsg_reply->reply_payload_rcv_len =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4443) sg_copy_from_buffer(job->reply_payload.sg_list,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4444) job->reply_payload.sg_cnt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4445) pbuf, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4446)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4447) lpfc_bsg_dma_page_free(phba, dmabuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4448)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4449) if (phba->mbox_ext_buf_ctx.seqNum == phba->mbox_ext_buf_ctx.numBuf) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4450) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4451) "2965 SLI_CONFIG (hbd) ext-buffer rd mbox "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4452) "command session done\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4453) lpfc_bsg_mbox_ext_session_reset(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4454) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4455)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4456) bsg_reply->result = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4457) bsg_job_done(job, bsg_reply->result,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4458) bsg_reply->reply_payload_rcv_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4459)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4460) return SLI_CONFIG_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4461) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4462)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4463) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4464) * lpfc_bsg_write_ebuf_set - set the next mailbox write external buffer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4465) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4466) * @dmabuf: Pointer to a DMA buffer descriptor.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4467) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4468) * This routine sets up the next mailbox read external buffer obtained
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4469) * from user space through BSG.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4470) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4471) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4472) lpfc_bsg_write_ebuf_set(struct lpfc_hba *phba, struct bsg_job *job,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4473) struct lpfc_dmabuf *dmabuf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4474) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4475) struct fc_bsg_reply *bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4476) struct bsg_job_data *dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4477) LPFC_MBOXQ_t *pmboxq = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4478) MAILBOX_t *pmb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4479) enum nemb_type nemb_tp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4480) uint8_t *pbuf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4481) uint32_t size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4482) uint32_t index;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4483) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4484)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4485) index = phba->mbox_ext_buf_ctx.seqNum;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4486) phba->mbox_ext_buf_ctx.seqNum++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4487) nemb_tp = phba->mbox_ext_buf_ctx.nembType;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4488)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4489) pbuf = (uint8_t *)dmabuf->virt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4490) size = job->request_payload.payload_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4491) sg_copy_to_buffer(job->request_payload.sg_list,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4492) job->request_payload.sg_cnt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4493) pbuf, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4494)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4495) if (phba->mbox_ext_buf_ctx.nembType == nemb_mse) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4496) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4497) "2966 SLI_CONFIG (mse) ext-buffer wr set "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4498) "buffer[%d], size:%d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4499) phba->mbox_ext_buf_ctx.seqNum, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4500)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4501) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4502) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4503) "2967 SLI_CONFIG (hbd) ext-buffer wr set "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4504) "buffer[%d], size:%d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4505) phba->mbox_ext_buf_ctx.seqNum, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4506)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4507) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4508)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4509) /* set up external buffer descriptor and add to external buffer list */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4510) lpfc_bsg_sli_cfg_dma_desc_setup(phba, nemb_tp, index,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4511) phba->mbox_ext_buf_ctx.mbx_dmabuf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4512) dmabuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4513) list_add_tail(&dmabuf->list, &phba->mbox_ext_buf_ctx.ext_dmabuf_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4514)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4515) /* after write dma buffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4516) lpfc_idiag_mbxacc_dump_bsg_mbox(phba, phba->mbox_ext_buf_ctx.nembType,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4517) mbox_wr, dma_ebuf, sta_pos_addr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4518) dmabuf, index);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4519)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4520) if (phba->mbox_ext_buf_ctx.seqNum == phba->mbox_ext_buf_ctx.numBuf) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4521) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4522) "2968 SLI_CONFIG ext-buffer wr all %d "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4523) "ebuffers received\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4524) phba->mbox_ext_buf_ctx.numBuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4525)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4526) dd_data = kmalloc(sizeof(struct bsg_job_data), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4527) if (!dd_data) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4528) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4529) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4530) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4531)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4532) /* mailbox command structure for base driver */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4533) pmboxq = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4534) if (!pmboxq) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4535) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4536) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4537) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4538) memset(pmboxq, 0, sizeof(LPFC_MBOXQ_t));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4539) pbuf = (uint8_t *)phba->mbox_ext_buf_ctx.mbx_dmabuf->virt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4540) pmb = &pmboxq->u.mb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4541) memcpy(pmb, pbuf, sizeof(*pmb));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4542) pmb->mbxOwner = OWN_HOST;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4543) pmboxq->vport = phba->pport;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4544)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4545) /* callback for multi-buffer write mailbox command */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4546) pmboxq->mbox_cmpl = lpfc_bsg_issue_write_mbox_ext_cmpl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4547)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4548) /* context fields to callback function */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4549) pmboxq->ctx_buf = dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4550) dd_data->type = TYPE_MBOX;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4551) dd_data->set_job = job;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4552) dd_data->context_un.mbox.pmboxq = pmboxq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4553) dd_data->context_un.mbox.mb = (MAILBOX_t *)pbuf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4554) job->dd_data = dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4555)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4556) /* state change */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4557) phba->mbox_ext_buf_ctx.state = LPFC_BSG_MBOX_PORT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4558)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4559) rc = lpfc_sli_issue_mbox(phba, pmboxq, MBX_NOWAIT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4560) if ((rc == MBX_SUCCESS) || (rc == MBX_BUSY)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4561) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4562) "2969 Issued SLI_CONFIG ext-buffer "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4563) "mailbox command, rc:x%x\n", rc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4564) return SLI_CONFIG_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4565) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4566) lpfc_printf_log(phba, KERN_ERR, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4567) "2970 Failed to issue SLI_CONFIG ext-buffer "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4568) "mailbox command, rc:x%x\n", rc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4569) rc = -EPIPE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4570) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4571) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4572)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4573) /* wait for additoinal external buffers */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4574) bsg_reply->result = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4575) bsg_job_done(job, bsg_reply->result,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4576) bsg_reply->reply_payload_rcv_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4577) return SLI_CONFIG_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4578)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4579) job_error:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4580) if (pmboxq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4581) mempool_free(pmboxq, phba->mbox_mem_pool);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4582) lpfc_bsg_dma_page_free(phba, dmabuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4583) kfree(dd_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4584)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4585) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4586) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4587)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4588) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4589) * lpfc_bsg_handle_sli_cfg_ebuf - handle ext buffer with sli-cfg mailbox cmd
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4590) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4591) * @mb: Pointer to a BSG mailbox object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4592) * @dmabuff: Pointer to a DMA buffer descriptor.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4593) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4594) * This routine handles the external buffer with SLI_CONFIG (0x9B) mailbox
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4595) * command with multiple non-embedded external buffers.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4596) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4597) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4598) lpfc_bsg_handle_sli_cfg_ebuf(struct lpfc_hba *phba, struct bsg_job *job,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4599) struct lpfc_dmabuf *dmabuf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4600) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4601) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4602)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4603) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4604) "2971 SLI_CONFIG buffer (type:x%x)\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4605) phba->mbox_ext_buf_ctx.mboxType);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4606)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4607) if (phba->mbox_ext_buf_ctx.mboxType == mbox_rd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4608) if (phba->mbox_ext_buf_ctx.state != LPFC_BSG_MBOX_DONE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4609) lpfc_printf_log(phba, KERN_ERR, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4610) "2972 SLI_CONFIG rd buffer state "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4611) "mismatch:x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4612) phba->mbox_ext_buf_ctx.state);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4613) lpfc_bsg_mbox_ext_abort(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4614) return -EPIPE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4615) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4616) rc = lpfc_bsg_read_ebuf_get(phba, job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4617) if (rc == SLI_CONFIG_HANDLED)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4618) lpfc_bsg_dma_page_free(phba, dmabuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4619) } else { /* phba->mbox_ext_buf_ctx.mboxType == mbox_wr */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4620) if (phba->mbox_ext_buf_ctx.state != LPFC_BSG_MBOX_HOST) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4621) lpfc_printf_log(phba, KERN_ERR, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4622) "2973 SLI_CONFIG wr buffer state "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4623) "mismatch:x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4624) phba->mbox_ext_buf_ctx.state);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4625) lpfc_bsg_mbox_ext_abort(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4626) return -EPIPE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4627) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4628) rc = lpfc_bsg_write_ebuf_set(phba, job, dmabuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4629) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4630) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4631) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4632)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4633) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4634) * lpfc_bsg_handle_sli_cfg_ext - handle sli-cfg mailbox with external buffer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4635) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4636) * @mb: Pointer to a BSG mailbox object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4637) * @dmabuff: Pointer to a DMA buffer descriptor.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4638) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4639) * This routine checkes and handles non-embedded multi-buffer SLI_CONFIG
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4640) * (0x9B) mailbox commands and external buffers.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4641) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4642) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4643) lpfc_bsg_handle_sli_cfg_ext(struct lpfc_hba *phba, struct bsg_job *job,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4644) struct lpfc_dmabuf *dmabuf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4645) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4646) struct fc_bsg_request *bsg_request = job->request;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4647) struct dfc_mbox_req *mbox_req;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4648) int rc = SLI_CONFIG_NOT_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4649)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4650) mbox_req =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4651) (struct dfc_mbox_req *)bsg_request->rqst_data.h_vendor.vendor_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4652)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4653) /* mbox command with/without single external buffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4654) if (mbox_req->extMboxTag == 0 && mbox_req->extSeqNum == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4655) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4656)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4657) /* mbox command and first external buffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4658) if (phba->mbox_ext_buf_ctx.state == LPFC_BSG_MBOX_IDLE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4659) if (mbox_req->extSeqNum == 1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4660) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4661) "2974 SLI_CONFIG mailbox: tag:%d, "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4662) "seq:%d\n", mbox_req->extMboxTag,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4663) mbox_req->extSeqNum);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4664) rc = lpfc_bsg_handle_sli_cfg_mbox(phba, job, dmabuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4665) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4666) } else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4667) goto sli_cfg_ext_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4668) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4669)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4670) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4671) * handle additional external buffers
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4672) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4673)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4674) /* check broken pipe conditions */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4675) if (mbox_req->extMboxTag != phba->mbox_ext_buf_ctx.mbxTag)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4676) goto sli_cfg_ext_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4677) if (mbox_req->extSeqNum > phba->mbox_ext_buf_ctx.numBuf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4678) goto sli_cfg_ext_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4679) if (mbox_req->extSeqNum != phba->mbox_ext_buf_ctx.seqNum + 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4680) goto sli_cfg_ext_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4681)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4682) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4683) "2975 SLI_CONFIG mailbox external buffer: "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4684) "extSta:x%x, tag:%d, seq:%d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4685) phba->mbox_ext_buf_ctx.state, mbox_req->extMboxTag,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4686) mbox_req->extSeqNum);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4687) rc = lpfc_bsg_handle_sli_cfg_ebuf(phba, job, dmabuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4688) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4689)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4690) sli_cfg_ext_error:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4691) /* all other cases, broken pipe */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4692) lpfc_printf_log(phba, KERN_ERR, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4693) "2976 SLI_CONFIG mailbox broken pipe: "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4694) "ctxSta:x%x, ctxNumBuf:%d "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4695) "ctxTag:%d, ctxSeq:%d, tag:%d, seq:%d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4696) phba->mbox_ext_buf_ctx.state,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4697) phba->mbox_ext_buf_ctx.numBuf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4698) phba->mbox_ext_buf_ctx.mbxTag,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4699) phba->mbox_ext_buf_ctx.seqNum,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4700) mbox_req->extMboxTag, mbox_req->extSeqNum);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4701)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4702) lpfc_bsg_mbox_ext_session_reset(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4703)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4704) return -EPIPE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4705) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4706)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4707) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4708) * lpfc_bsg_issue_mbox - issues a mailbox command on behalf of an app
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4709) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4710) * @mb: Pointer to a mailbox object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4711) * @vport: Pointer to a vport object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4712) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4713) * Allocate a tracking object, mailbox command memory, get a mailbox
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4714) * from the mailbox pool, copy the caller mailbox command.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4715) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4716) * If offline and the sli is active we need to poll for the command (port is
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4717) * being reset) and com-plete the job, otherwise issue the mailbox command and
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4718) * let our completion handler finish the command.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4719) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4720) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4721) lpfc_bsg_issue_mbox(struct lpfc_hba *phba, struct bsg_job *job,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4722) struct lpfc_vport *vport)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4723) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4724) struct fc_bsg_request *bsg_request = job->request;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4725) struct fc_bsg_reply *bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4726) LPFC_MBOXQ_t *pmboxq = NULL; /* internal mailbox queue */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4727) MAILBOX_t *pmb; /* shortcut to the pmboxq mailbox */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4728) /* a 4k buffer to hold the mb and extended data from/to the bsg */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4729) uint8_t *pmbx = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4730) struct bsg_job_data *dd_data = NULL; /* bsg data tracking structure */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4731) struct lpfc_dmabuf *dmabuf = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4732) struct dfc_mbox_req *mbox_req;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4733) struct READ_EVENT_LOG_VAR *rdEventLog;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4734) uint32_t transmit_length, receive_length, mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4735) struct lpfc_mbx_sli4_config *sli4_config;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4736) struct lpfc_mbx_nembed_cmd *nembed_sge;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4737) struct ulp_bde64 *bde;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4738) uint8_t *ext = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4739) int rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4740) uint8_t *from;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4741) uint32_t size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4742)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4743) /* in case no data is transferred */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4744) bsg_reply->reply_payload_rcv_len = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4745)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4746) /* sanity check to protect driver */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4747) if (job->reply_payload.payload_len > BSG_MBOX_SIZE ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4748) job->request_payload.payload_len > BSG_MBOX_SIZE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4749) rc = -ERANGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4750) goto job_done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4751) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4752)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4753) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4754) * Don't allow mailbox commands to be sent when blocked or when in
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4755) * the middle of discovery
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4756) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4757) if (phba->sli.sli_flag & LPFC_BLOCK_MGMT_IO) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4758) rc = -EAGAIN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4759) goto job_done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4760) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4761)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4762) mbox_req =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4763) (struct dfc_mbox_req *)bsg_request->rqst_data.h_vendor.vendor_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4764)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4765) /* check if requested extended data lengths are valid */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4766) if ((mbox_req->inExtWLen > BSG_MBOX_SIZE/sizeof(uint32_t)) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4767) (mbox_req->outExtWLen > BSG_MBOX_SIZE/sizeof(uint32_t))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4768) rc = -ERANGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4769) goto job_done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4770) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4771)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4772) dmabuf = lpfc_bsg_dma_page_alloc(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4773) if (!dmabuf || !dmabuf->virt) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4774) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4775) goto job_done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4776) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4777)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4778) /* Get the mailbox command or external buffer from BSG */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4779) pmbx = (uint8_t *)dmabuf->virt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4780) size = job->request_payload.payload_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4781) sg_copy_to_buffer(job->request_payload.sg_list,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4782) job->request_payload.sg_cnt, pmbx, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4783)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4784) /* Handle possible SLI_CONFIG with non-embedded payloads */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4785) if (phba->sli_rev == LPFC_SLI_REV4) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4786) rc = lpfc_bsg_handle_sli_cfg_ext(phba, job, dmabuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4787) if (rc == SLI_CONFIG_HANDLED)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4788) goto job_cont;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4789) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4790) goto job_done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4791) /* SLI_CONFIG_NOT_HANDLED for other mailbox commands */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4792) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4793)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4794) rc = lpfc_bsg_check_cmd_access(phba, (MAILBOX_t *)pmbx, vport);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4795) if (rc != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4796) goto job_done; /* must be negative */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4797)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4798) /* allocate our bsg tracking structure */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4799) dd_data = kmalloc(sizeof(struct bsg_job_data), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4800) if (!dd_data) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4801) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4802) "2727 Failed allocation of dd_data\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4803) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4804) goto job_done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4805) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4806)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4807) pmboxq = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4808) if (!pmboxq) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4809) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4810) goto job_done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4811) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4812) memset(pmboxq, 0, sizeof(LPFC_MBOXQ_t));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4813)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4814) pmb = &pmboxq->u.mb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4815) memcpy(pmb, pmbx, sizeof(*pmb));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4816) pmb->mbxOwner = OWN_HOST;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4817) pmboxq->vport = vport;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4818)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4819) /* If HBA encountered an error attention, allow only DUMP
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4820) * or RESTART mailbox commands until the HBA is restarted.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4821) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4822) if (phba->pport->stopped &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4823) pmb->mbxCommand != MBX_DUMP_MEMORY &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4824) pmb->mbxCommand != MBX_RESTART &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4825) pmb->mbxCommand != MBX_WRITE_VPARMS &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4826) pmb->mbxCommand != MBX_WRITE_WWN)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4827) lpfc_printf_log(phba, KERN_WARNING, LOG_MBOX,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4828) "2797 mbox: Issued mailbox cmd "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4829) "0x%x while in stopped state.\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4830) pmb->mbxCommand);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4831)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4832) /* extended mailbox commands will need an extended buffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4833) if (mbox_req->inExtWLen || mbox_req->outExtWLen) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4834) from = pmbx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4835) ext = from + sizeof(MAILBOX_t);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4836) pmboxq->ctx_buf = ext;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4837) pmboxq->in_ext_byte_len =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4838) mbox_req->inExtWLen * sizeof(uint32_t);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4839) pmboxq->out_ext_byte_len =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4840) mbox_req->outExtWLen * sizeof(uint32_t);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4841) pmboxq->mbox_offset_word = mbox_req->mbOffset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4842) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4843)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4844) /* biu diag will need a kernel buffer to transfer the data
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4845) * allocate our own buffer and setup the mailbox command to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4846) * use ours
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4847) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4848) if (pmb->mbxCommand == MBX_RUN_BIU_DIAG64) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4849) transmit_length = pmb->un.varWords[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4850) receive_length = pmb->un.varWords[4];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4851) /* transmit length cannot be greater than receive length or
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4852) * mailbox extension size
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4853) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4854) if ((transmit_length > receive_length) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4855) (transmit_length > BSG_MBOX_SIZE - sizeof(MAILBOX_t))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4856) rc = -ERANGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4857) goto job_done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4858) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4859) pmb->un.varBIUdiag.un.s2.xmit_bde64.addrHigh =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4860) putPaddrHigh(dmabuf->phys + sizeof(MAILBOX_t));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4861) pmb->un.varBIUdiag.un.s2.xmit_bde64.addrLow =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4862) putPaddrLow(dmabuf->phys + sizeof(MAILBOX_t));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4863)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4864) pmb->un.varBIUdiag.un.s2.rcv_bde64.addrHigh =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4865) putPaddrHigh(dmabuf->phys + sizeof(MAILBOX_t)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4866) + pmb->un.varBIUdiag.un.s2.xmit_bde64.tus.f.bdeSize);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4867) pmb->un.varBIUdiag.un.s2.rcv_bde64.addrLow =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4868) putPaddrLow(dmabuf->phys + sizeof(MAILBOX_t)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4869) + pmb->un.varBIUdiag.un.s2.xmit_bde64.tus.f.bdeSize);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4870) } else if (pmb->mbxCommand == MBX_READ_EVENT_LOG) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4871) rdEventLog = &pmb->un.varRdEventLog;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4872) receive_length = rdEventLog->rcv_bde64.tus.f.bdeSize;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4873) mode = bf_get(lpfc_event_log, rdEventLog);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4874)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4875) /* receive length cannot be greater than mailbox
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4876) * extension size
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4877) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4878) if (receive_length > BSG_MBOX_SIZE - sizeof(MAILBOX_t)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4879) rc = -ERANGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4880) goto job_done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4881) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4882)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4883) /* mode zero uses a bde like biu diags command */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4884) if (mode == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4885) pmb->un.varWords[3] = putPaddrLow(dmabuf->phys
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4886) + sizeof(MAILBOX_t));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4887) pmb->un.varWords[4] = putPaddrHigh(dmabuf->phys
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4888) + sizeof(MAILBOX_t));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4889) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4890) } else if (phba->sli_rev == LPFC_SLI_REV4) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4891) /* Let type 4 (well known data) through because the data is
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4892) * returned in varwords[4-8]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4893) * otherwise check the recieve length and fetch the buffer addr
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4894) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4895) if ((pmb->mbxCommand == MBX_DUMP_MEMORY) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4896) (pmb->un.varDmp.type != DMP_WELL_KNOWN)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4897) /* rebuild the command for sli4 using our own buffers
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4898) * like we do for biu diags
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4899) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4900) receive_length = pmb->un.varWords[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4901) /* receive length cannot be greater than mailbox
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4902) * extension size
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4903) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4904) if (receive_length == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4905) rc = -ERANGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4906) goto job_done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4907) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4908) pmb->un.varWords[3] = putPaddrLow(dmabuf->phys
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4909) + sizeof(MAILBOX_t));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4910) pmb->un.varWords[4] = putPaddrHigh(dmabuf->phys
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4911) + sizeof(MAILBOX_t));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4912) } else if ((pmb->mbxCommand == MBX_UPDATE_CFG) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4913) pmb->un.varUpdateCfg.co) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4914) bde = (struct ulp_bde64 *)&pmb->un.varWords[4];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4915)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4916) /* bde size cannot be greater than mailbox ext size */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4917) if (bde->tus.f.bdeSize >
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4918) BSG_MBOX_SIZE - sizeof(MAILBOX_t)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4919) rc = -ERANGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4920) goto job_done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4921) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4922) bde->addrHigh = putPaddrHigh(dmabuf->phys
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4923) + sizeof(MAILBOX_t));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4924) bde->addrLow = putPaddrLow(dmabuf->phys
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4925) + sizeof(MAILBOX_t));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4926) } else if (pmb->mbxCommand == MBX_SLI4_CONFIG) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4927) /* Handling non-embedded SLI_CONFIG mailbox command */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4928) sli4_config = &pmboxq->u.mqe.un.sli4_config;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4929) if (!bf_get(lpfc_mbox_hdr_emb,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4930) &sli4_config->header.cfg_mhdr)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4931) /* rebuild the command for sli4 using our
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4932) * own buffers like we do for biu diags
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4933) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4934) nembed_sge = (struct lpfc_mbx_nembed_cmd *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4935) &pmb->un.varWords[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4936) receive_length = nembed_sge->sge[0].length;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4937)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4938) /* receive length cannot be greater than
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4939) * mailbox extension size
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4940) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4941) if ((receive_length == 0) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4942) (receive_length >
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4943) BSG_MBOX_SIZE - sizeof(MAILBOX_t))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4944) rc = -ERANGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4945) goto job_done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4946) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4947)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4948) nembed_sge->sge[0].pa_hi =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4949) putPaddrHigh(dmabuf->phys
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4950) + sizeof(MAILBOX_t));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4951) nembed_sge->sge[0].pa_lo =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4952) putPaddrLow(dmabuf->phys
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4953) + sizeof(MAILBOX_t));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4954) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4955) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4956) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4957)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4958) dd_data->context_un.mbox.dmabuffers = dmabuf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4959)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4960) /* setup wake call as IOCB callback */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4961) pmboxq->mbox_cmpl = lpfc_bsg_issue_mbox_cmpl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4962)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4963) /* setup context field to pass wait_queue pointer to wake function */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4964) pmboxq->ctx_ndlp = dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4965) dd_data->type = TYPE_MBOX;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4966) dd_data->set_job = job;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4967) dd_data->context_un.mbox.pmboxq = pmboxq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4968) dd_data->context_un.mbox.mb = (MAILBOX_t *)pmbx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4969) dd_data->context_un.mbox.ext = ext;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4970) dd_data->context_un.mbox.mbOffset = mbox_req->mbOffset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4971) dd_data->context_un.mbox.inExtWLen = mbox_req->inExtWLen;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4972) dd_data->context_un.mbox.outExtWLen = mbox_req->outExtWLen;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4973) job->dd_data = dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4974)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4975) if ((vport->fc_flag & FC_OFFLINE_MODE) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4976) (!(phba->sli.sli_flag & LPFC_SLI_ACTIVE))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4977) rc = lpfc_sli_issue_mbox(phba, pmboxq, MBX_POLL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4978) if (rc != MBX_SUCCESS) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4979) rc = (rc == MBX_TIMEOUT) ? -ETIME : -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4980) goto job_done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4981) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4982)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4983) /* job finished, copy the data */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4984) memcpy(pmbx, pmb, sizeof(*pmb));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4985) bsg_reply->reply_payload_rcv_len =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4986) sg_copy_from_buffer(job->reply_payload.sg_list,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4987) job->reply_payload.sg_cnt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4988) pmbx, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4989) /* not waiting mbox already done */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4990) rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4991) goto job_done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4992) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4993)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4994) rc = lpfc_sli_issue_mbox(phba, pmboxq, MBX_NOWAIT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4995) if ((rc == MBX_SUCCESS) || (rc == MBX_BUSY))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4996) return 1; /* job started */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4997)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4998) job_done:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4999) /* common exit for error or job completed inline */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5000) if (pmboxq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5001) mempool_free(pmboxq, phba->mbox_mem_pool);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5002) lpfc_bsg_dma_page_free(phba, dmabuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5003) kfree(dd_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5004)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5005) job_cont:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5006) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5007) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5008)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5009) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5010) * lpfc_bsg_mbox_cmd - process an fc bsg LPFC_BSG_VENDOR_MBOX command
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5011) * @job: MBOX fc_bsg_job for LPFC_BSG_VENDOR_MBOX.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5012) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5013) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5014) lpfc_bsg_mbox_cmd(struct bsg_job *job)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5015) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5016) struct lpfc_vport *vport = shost_priv(fc_bsg_to_shost(job));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5017) struct fc_bsg_request *bsg_request = job->request;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5018) struct fc_bsg_reply *bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5019) struct lpfc_hba *phba = vport->phba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5020) struct dfc_mbox_req *mbox_req;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5021) int rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5022)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5023) /* mix-and-match backward compatibility */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5024) bsg_reply->reply_payload_rcv_len = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5025) if (job->request_len <
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5026) sizeof(struct fc_bsg_request) + sizeof(struct dfc_mbox_req)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5027) lpfc_printf_log(phba, KERN_INFO, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5028) "2737 Mix-and-match backward compatibility "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5029) "between MBOX_REQ old size:%d and "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5030) "new request size:%d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5031) (int)(job->request_len -
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5032) sizeof(struct fc_bsg_request)),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5033) (int)sizeof(struct dfc_mbox_req));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5034) mbox_req = (struct dfc_mbox_req *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5035) bsg_request->rqst_data.h_vendor.vendor_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5036) mbox_req->extMboxTag = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5037) mbox_req->extSeqNum = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5038) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5039)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5040) rc = lpfc_bsg_issue_mbox(phba, job, vport);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5041)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5042) if (rc == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5043) /* job done */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5044) bsg_reply->result = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5045) job->dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5046) bsg_job_done(job, bsg_reply->result,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5047) bsg_reply->reply_payload_rcv_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5048) } else if (rc == 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5049) /* job submitted, will complete later*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5050) rc = 0; /* return zero, no error */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5051) else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5052) /* some error occurred */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5053) bsg_reply->result = rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5054) job->dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5055) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5056)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5057) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5058) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5059)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5060) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5061) * lpfc_bsg_menlo_cmd_cmp - lpfc_menlo_cmd completion handler
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5062) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5063) * @cmdiocbq: Pointer to command iocb.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5064) * @rspiocbq: Pointer to response iocb.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5065) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5066) * This function is the completion handler for iocbs issued using
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5067) * lpfc_menlo_cmd function. This function is called by the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5068) * ring event handler function without any lock held. This function
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5069) * can be called from both worker thread context and interrupt
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5070) * context. This function also can be called from another thread which
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5071) * cleans up the SLI layer objects.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5072) * This function copies the contents of the response iocb to the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5073) * response iocb memory object provided by the caller of
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5074) * lpfc_sli_issue_iocb_wait and then wakes up the thread which
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5075) * sleeps for the iocb completion.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5076) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5077) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5078) lpfc_bsg_menlo_cmd_cmp(struct lpfc_hba *phba,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5079) struct lpfc_iocbq *cmdiocbq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5080) struct lpfc_iocbq *rspiocbq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5081) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5082) struct bsg_job_data *dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5083) struct bsg_job *job;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5084) struct fc_bsg_reply *bsg_reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5085) IOCB_t *rsp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5086) struct lpfc_dmabuf *bmp, *cmp, *rmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5087) struct lpfc_bsg_menlo *menlo;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5088) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5089) struct menlo_response *menlo_resp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5090) unsigned int rsp_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5091) int rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5092)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5093) dd_data = cmdiocbq->context1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5094) cmp = cmdiocbq->context2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5095) bmp = cmdiocbq->context3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5096) menlo = &dd_data->context_un.menlo;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5097) rmp = menlo->rmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5098) rsp = &rspiocbq->iocb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5099)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5100) /* Determine if job has been aborted */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5101) spin_lock_irqsave(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5102) job = dd_data->set_job;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5103) if (job) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5104) bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5105) /* Prevent timeout handling from trying to abort job */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5106) job->dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5107) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5108) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5109)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5110) /* Copy the job data or set the failing status for the job */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5111)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5112) if (job) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5113) /* always return the xri, this would be used in the case
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5114) * of a menlo download to allow the data to be sent as a
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5115) * continuation of the exchange.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5116) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5117)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5118) menlo_resp = (struct menlo_response *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5119) bsg_reply->reply_data.vendor_reply.vendor_rsp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5120) menlo_resp->xri = rsp->ulpContext;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5121) if (rsp->ulpStatus) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5122) if (rsp->ulpStatus == IOSTAT_LOCAL_REJECT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5123) switch (rsp->un.ulpWord[4] & IOERR_PARAM_MASK) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5124) case IOERR_SEQUENCE_TIMEOUT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5125) rc = -ETIMEDOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5126) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5127) case IOERR_INVALID_RPI:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5128) rc = -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5129) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5130) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5131) rc = -EACCES;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5132) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5133) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5134) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5135) rc = -EACCES;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5136) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5137) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5138) rsp_size = rsp->un.genreq64.bdl.bdeSize;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5139) bsg_reply->reply_payload_rcv_len =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5140) lpfc_bsg_copy_data(rmp, &job->reply_payload,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5141) rsp_size, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5142) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5143)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5144) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5145)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5146) lpfc_sli_release_iocbq(phba, cmdiocbq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5147) lpfc_free_bsg_buffers(phba, cmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5148) lpfc_free_bsg_buffers(phba, rmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5149) lpfc_mbuf_free(phba, bmp->virt, bmp->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5150) kfree(bmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5151) kfree(dd_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5152)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5153) /* Complete the job if active */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5154)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5155) if (job) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5156) bsg_reply->result = rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5157) bsg_job_done(job, bsg_reply->result,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5158) bsg_reply->reply_payload_rcv_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5159) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5160)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5161) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5162) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5163)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5164) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5165) * lpfc_menlo_cmd - send an ioctl for menlo hardware
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5166) * @job: fc_bsg_job to handle
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5167) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5168) * This function issues a gen request 64 CR ioctl for all menlo cmd requests,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5169) * all the command completions will return the xri for the command.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5170) * For menlo data requests a gen request 64 CX is used to continue the exchange
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5171) * supplied in the menlo request header xri field.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5172) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5173) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5174) lpfc_menlo_cmd(struct bsg_job *job)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5175) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5176) struct lpfc_vport *vport = shost_priv(fc_bsg_to_shost(job));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5177) struct fc_bsg_request *bsg_request = job->request;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5178) struct fc_bsg_reply *bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5179) struct lpfc_hba *phba = vport->phba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5180) struct lpfc_iocbq *cmdiocbq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5181) IOCB_t *cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5182) int rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5183) struct menlo_command *menlo_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5184) struct lpfc_dmabuf *bmp = NULL, *cmp = NULL, *rmp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5185) int request_nseg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5186) int reply_nseg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5187) struct bsg_job_data *dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5188) struct ulp_bde64 *bpl = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5189)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5190) /* in case no data is returned return just the return code */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5191) bsg_reply->reply_payload_rcv_len = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5192)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5193) if (job->request_len <
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5194) sizeof(struct fc_bsg_request) +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5195) sizeof(struct menlo_command)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5196) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5197) "2784 Received MENLO_CMD request below "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5198) "minimum size\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5199) rc = -ERANGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5200) goto no_dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5201) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5202)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5203) if (job->reply_len < sizeof(*bsg_reply) +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5204) sizeof(struct menlo_response)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5205) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5206) "2785 Received MENLO_CMD reply below "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5207) "minimum size\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5208) rc = -ERANGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5209) goto no_dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5210) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5211)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5212) if (!(phba->menlo_flag & HBA_MENLO_SUPPORT)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5213) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5214) "2786 Adapter does not support menlo "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5215) "commands\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5216) rc = -EPERM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5217) goto no_dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5218) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5219)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5220) menlo_cmd = (struct menlo_command *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5221) bsg_request->rqst_data.h_vendor.vendor_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5222)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5223) /* allocate our bsg tracking structure */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5224) dd_data = kmalloc(sizeof(struct bsg_job_data), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5225) if (!dd_data) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5226) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5227) "2787 Failed allocation of dd_data\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5228) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5229) goto no_dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5230) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5231)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5232) bmp = kmalloc(sizeof(struct lpfc_dmabuf), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5233) if (!bmp) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5234) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5235) goto free_dd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5236) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5237)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5238) bmp->virt = lpfc_mbuf_alloc(phba, 0, &bmp->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5239) if (!bmp->virt) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5240) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5241) goto free_bmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5242) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5243)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5244) INIT_LIST_HEAD(&bmp->list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5245)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5246) bpl = (struct ulp_bde64 *)bmp->virt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5247) request_nseg = LPFC_BPL_SIZE/sizeof(struct ulp_bde64);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5248) cmp = lpfc_alloc_bsg_buffers(phba, job->request_payload.payload_len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5249) 1, bpl, &request_nseg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5250) if (!cmp) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5251) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5252) goto free_bmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5253) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5254) lpfc_bsg_copy_data(cmp, &job->request_payload,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5255) job->request_payload.payload_len, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5256)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5257) bpl += request_nseg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5258) reply_nseg = LPFC_BPL_SIZE/sizeof(struct ulp_bde64) - request_nseg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5259) rmp = lpfc_alloc_bsg_buffers(phba, job->reply_payload.payload_len, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5260) bpl, &reply_nseg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5261) if (!rmp) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5262) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5263) goto free_cmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5264) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5265)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5266) cmdiocbq = lpfc_sli_get_iocbq(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5267) if (!cmdiocbq) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5268) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5269) goto free_rmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5270) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5271)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5272) cmd = &cmdiocbq->iocb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5273) cmd->un.genreq64.bdl.ulpIoTag32 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5274) cmd->un.genreq64.bdl.addrHigh = putPaddrHigh(bmp->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5275) cmd->un.genreq64.bdl.addrLow = putPaddrLow(bmp->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5276) cmd->un.genreq64.bdl.bdeFlags = BUFF_TYPE_BLP_64;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5277) cmd->un.genreq64.bdl.bdeSize =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5278) (request_nseg + reply_nseg) * sizeof(struct ulp_bde64);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5279) cmd->un.genreq64.w5.hcsw.Fctl = (SI | LA);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5280) cmd->un.genreq64.w5.hcsw.Dfctl = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5281) cmd->un.genreq64.w5.hcsw.Rctl = FC_RCTL_DD_UNSOL_CMD;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5282) cmd->un.genreq64.w5.hcsw.Type = MENLO_TRANSPORT_TYPE; /* 0xfe */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5283) cmd->ulpBdeCount = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5284) cmd->ulpClass = CLASS3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5285) cmd->ulpOwner = OWN_CHIP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5286) cmd->ulpLe = 1; /* Limited Edition */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5287) cmdiocbq->iocb_flag |= LPFC_IO_LIBDFC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5288) cmdiocbq->vport = phba->pport;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5289) /* We want the firmware to timeout before we do */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5290) cmd->ulpTimeout = MENLO_TIMEOUT - 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5291) cmdiocbq->iocb_cmpl = lpfc_bsg_menlo_cmd_cmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5292) cmdiocbq->context1 = dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5293) cmdiocbq->context2 = cmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5294) cmdiocbq->context3 = bmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5295) if (menlo_cmd->cmd == LPFC_BSG_VENDOR_MENLO_CMD) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5296) cmd->ulpCommand = CMD_GEN_REQUEST64_CR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5297) cmd->ulpPU = MENLO_PU; /* 3 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5298) cmd->un.ulpWord[4] = MENLO_DID; /* 0x0000FC0E */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5299) cmd->ulpContext = MENLO_CONTEXT; /* 0 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5300) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5301) cmd->ulpCommand = CMD_GEN_REQUEST64_CX;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5302) cmd->ulpPU = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5303) cmd->un.ulpWord[4] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5304) cmd->ulpContext = menlo_cmd->xri;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5305) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5306)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5307) dd_data->type = TYPE_MENLO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5308) dd_data->set_job = job;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5309) dd_data->context_un.menlo.cmdiocbq = cmdiocbq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5310) dd_data->context_un.menlo.rmp = rmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5311) job->dd_data = dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5312)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5313) rc = lpfc_sli_issue_iocb(phba, LPFC_ELS_RING, cmdiocbq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5314) MENLO_TIMEOUT - 5);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5315) if (rc == IOCB_SUCCESS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5316) return 0; /* done for now */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5317)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5318) lpfc_sli_release_iocbq(phba, cmdiocbq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5319)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5320) free_rmp:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5321) lpfc_free_bsg_buffers(phba, rmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5322) free_cmp:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5323) lpfc_free_bsg_buffers(phba, cmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5324) free_bmp:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5325) if (bmp->virt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5326) lpfc_mbuf_free(phba, bmp->virt, bmp->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5327) kfree(bmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5328) free_dd:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5329) kfree(dd_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5330) no_dd_data:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5331) /* make error code available to userspace */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5332) bsg_reply->result = rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5333) job->dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5334) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5335) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5336)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5337) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5338) lpfc_forced_link_speed(struct bsg_job *job)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5339) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5340) struct Scsi_Host *shost = fc_bsg_to_shost(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5341) struct lpfc_vport *vport = shost_priv(shost);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5342) struct lpfc_hba *phba = vport->phba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5343) struct fc_bsg_reply *bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5344) struct forced_link_speed_support_reply *forced_reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5345) int rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5346)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5347) if (job->request_len <
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5348) sizeof(struct fc_bsg_request) +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5349) sizeof(struct get_forced_link_speed_support)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5350) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5351) "0048 Received FORCED_LINK_SPEED request "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5352) "below minimum size\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5353) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5354) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5355) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5356)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5357) forced_reply = (struct forced_link_speed_support_reply *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5358) bsg_reply->reply_data.vendor_reply.vendor_rsp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5359)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5360) if (job->reply_len < sizeof(*bsg_reply) + sizeof(*forced_reply)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5361) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5362) "0049 Received FORCED_LINK_SPEED reply below "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5363) "minimum size\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5364) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5365) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5366) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5367)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5368) forced_reply->supported = (phba->hba_flag & HBA_FORCED_LINK_SPEED)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5369) ? LPFC_FORCED_LINK_SPEED_SUPPORTED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5370) : LPFC_FORCED_LINK_SPEED_NOT_SUPPORTED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5371) job_error:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5372) bsg_reply->result = rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5373) if (rc == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5374) bsg_job_done(job, bsg_reply->result,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5375) bsg_reply->reply_payload_rcv_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5376) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5377) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5378)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5379) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5380) * lpfc_check_fwlog_support: Check FW log support on the adapter
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5381) * @phba: Pointer to HBA context object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5382) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5383) * Check if FW Logging support by the adapter
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5384) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5385) int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5386) lpfc_check_fwlog_support(struct lpfc_hba *phba)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5387) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5388) struct lpfc_ras_fwlog *ras_fwlog = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5389)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5390) ras_fwlog = &phba->ras_fwlog;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5391)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5392) if (ras_fwlog->ras_hwsupport == false)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5393) return -EACCES;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5394) else if (ras_fwlog->ras_enabled == false)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5395) return -EPERM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5396) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5397) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5398) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5399)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5400) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5401) * lpfc_bsg_get_ras_config: Get RAS configuration settings
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5402) * @job: fc_bsg_job to handle
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5403) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5404) * Get RAS configuration values set.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5405) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5406) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5407) lpfc_bsg_get_ras_config(struct bsg_job *job)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5408) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5409) struct Scsi_Host *shost = fc_bsg_to_shost(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5410) struct lpfc_vport *vport = shost_priv(shost);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5411) struct fc_bsg_reply *bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5412) struct lpfc_hba *phba = vport->phba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5413) struct lpfc_bsg_get_ras_config_reply *ras_reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5414) struct lpfc_ras_fwlog *ras_fwlog = &phba->ras_fwlog;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5415) int rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5416)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5417) if (job->request_len <
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5418) sizeof(struct fc_bsg_request) +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5419) sizeof(struct lpfc_bsg_ras_req)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5420) lpfc_printf_log(phba, KERN_ERR, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5421) "6192 FW_LOG request received "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5422) "below minimum size\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5423) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5424) goto ras_job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5425) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5426)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5427) /* Check FW log status */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5428) rc = lpfc_check_fwlog_support(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5429) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5430) goto ras_job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5431)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5432) ras_reply = (struct lpfc_bsg_get_ras_config_reply *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5433) bsg_reply->reply_data.vendor_reply.vendor_rsp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5434)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5435) /* Current logging state */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5436) spin_lock_irq(&phba->hbalock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5437) if (ras_fwlog->state == ACTIVE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5438) ras_reply->state = LPFC_RASLOG_STATE_RUNNING;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5439) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5440) ras_reply->state = LPFC_RASLOG_STATE_STOPPED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5441) spin_unlock_irq(&phba->hbalock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5442)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5443) ras_reply->log_level = phba->ras_fwlog.fw_loglevel;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5444) ras_reply->log_buff_sz = phba->cfg_ras_fwlog_buffsize;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5445)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5446) ras_job_error:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5447) /* make error code available to userspace */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5448) bsg_reply->result = rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5449)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5450) /* complete the job back to userspace */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5451) if (!rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5452) bsg_job_done(job, bsg_reply->result,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5453) bsg_reply->reply_payload_rcv_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5454) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5455) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5456)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5457) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5458) * lpfc_bsg_set_ras_config: Set FW logging parameters
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5459) * @job: fc_bsg_job to handle
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5460) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5461) * Set log-level parameters for FW-logging in host memory
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5462) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5463) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5464) lpfc_bsg_set_ras_config(struct bsg_job *job)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5465) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5466) struct Scsi_Host *shost = fc_bsg_to_shost(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5467) struct lpfc_vport *vport = shost_priv(shost);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5468) struct lpfc_hba *phba = vport->phba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5469) struct lpfc_bsg_set_ras_config_req *ras_req;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5470) struct fc_bsg_request *bsg_request = job->request;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5471) struct lpfc_ras_fwlog *ras_fwlog = &phba->ras_fwlog;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5472) struct fc_bsg_reply *bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5473) uint8_t action = 0, log_level = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5474) int rc = 0, action_status = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5475)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5476) if (job->request_len <
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5477) sizeof(struct fc_bsg_request) +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5478) sizeof(struct lpfc_bsg_set_ras_config_req)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5479) lpfc_printf_log(phba, KERN_ERR, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5480) "6182 Received RAS_LOG request "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5481) "below minimum size\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5482) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5483) goto ras_job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5484) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5485)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5486) /* Check FW log status */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5487) rc = lpfc_check_fwlog_support(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5488) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5489) goto ras_job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5490)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5491) ras_req = (struct lpfc_bsg_set_ras_config_req *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5492) bsg_request->rqst_data.h_vendor.vendor_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5493) action = ras_req->action;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5494) log_level = ras_req->log_level;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5495)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5496) if (action == LPFC_RASACTION_STOP_LOGGING) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5497) /* Check if already disabled */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5498) spin_lock_irq(&phba->hbalock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5499) if (ras_fwlog->state != ACTIVE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5500) spin_unlock_irq(&phba->hbalock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5501) rc = -ESRCH;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5502) goto ras_job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5503) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5504) spin_unlock_irq(&phba->hbalock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5505)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5506) /* Disable logging */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5507) lpfc_ras_stop_fwlog(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5508) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5509) /*action = LPFC_RASACTION_START_LOGGING*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5510)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5511) /* Even though FW-logging is active re-initialize
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5512) * FW-logging with new log-level. Return status
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5513) * "Logging already Running" to caller.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5514) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5515) spin_lock_irq(&phba->hbalock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5516) if (ras_fwlog->state != INACTIVE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5517) action_status = -EINPROGRESS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5518) spin_unlock_irq(&phba->hbalock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5519)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5520) /* Enable logging */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5521) rc = lpfc_sli4_ras_fwlog_init(phba, log_level,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5522) LPFC_RAS_ENABLE_LOGGING);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5523) if (rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5524) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5525) goto ras_job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5526) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5527)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5528) /* Check if FW-logging is re-initialized */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5529) if (action_status == -EINPROGRESS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5530) rc = action_status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5531) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5532) ras_job_error:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5533) /* make error code available to userspace */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5534) bsg_reply->result = rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5535)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5536) /* complete the job back to userspace */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5537) if (!rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5538) bsg_job_done(job, bsg_reply->result,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5539) bsg_reply->reply_payload_rcv_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5540)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5541) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5542) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5543)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5544) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5545) * lpfc_bsg_get_ras_lwpd: Get log write position data
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5546) * @job: fc_bsg_job to handle
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5547) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5548) * Get Offset/Wrap count of the log message written
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5549) * in host memory
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5550) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5551) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5552) lpfc_bsg_get_ras_lwpd(struct bsg_job *job)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5553) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5554) struct Scsi_Host *shost = fc_bsg_to_shost(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5555) struct lpfc_vport *vport = shost_priv(shost);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5556) struct lpfc_bsg_get_ras_lwpd *ras_reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5557) struct lpfc_hba *phba = vport->phba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5558) struct lpfc_ras_fwlog *ras_fwlog = &phba->ras_fwlog;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5559) struct fc_bsg_reply *bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5560) u32 *lwpd_ptr = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5561) int rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5562)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5563) rc = lpfc_check_fwlog_support(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5564) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5565) goto ras_job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5566)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5567) if (job->request_len <
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5568) sizeof(struct fc_bsg_request) +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5569) sizeof(struct lpfc_bsg_ras_req)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5570) lpfc_printf_log(phba, KERN_ERR, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5571) "6183 Received RAS_LOG request "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5572) "below minimum size\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5573) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5574) goto ras_job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5575) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5576)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5577) ras_reply = (struct lpfc_bsg_get_ras_lwpd *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5578) bsg_reply->reply_data.vendor_reply.vendor_rsp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5579)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5580) if (!ras_fwlog->lwpd.virt) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5581) lpfc_printf_log(phba, KERN_ERR, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5582) "6193 Restart FW Logging\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5583) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5584) goto ras_job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5585) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5586)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5587) /* Get lwpd offset */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5588) lwpd_ptr = (uint32_t *)(ras_fwlog->lwpd.virt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5589) ras_reply->offset = be32_to_cpu(*lwpd_ptr & 0xffffffff);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5590)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5591) /* Get wrap count */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5592) ras_reply->wrap_count = be32_to_cpu(*(++lwpd_ptr) & 0xffffffff);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5593)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5594) ras_job_error:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5595) /* make error code available to userspace */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5596) bsg_reply->result = rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5597)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5598) /* complete the job back to userspace */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5599) if (!rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5600) bsg_job_done(job, bsg_reply->result,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5601) bsg_reply->reply_payload_rcv_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5602)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5603) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5604) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5605)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5606) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5607) * lpfc_bsg_get_ras_fwlog: Read FW log
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5608) * @job: fc_bsg_job to handle
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5609) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5610) * Copy the FW log into the passed buffer.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5611) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5612) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5613) lpfc_bsg_get_ras_fwlog(struct bsg_job *job)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5614) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5615) struct Scsi_Host *shost = fc_bsg_to_shost(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5616) struct lpfc_vport *vport = shost_priv(shost);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5617) struct lpfc_hba *phba = vport->phba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5618) struct fc_bsg_request *bsg_request = job->request;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5619) struct fc_bsg_reply *bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5620) struct lpfc_bsg_get_fwlog_req *ras_req;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5621) u32 rd_offset, rd_index, offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5622) void *src, *fwlog_buff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5623) struct lpfc_ras_fwlog *ras_fwlog = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5624) struct lpfc_dmabuf *dmabuf, *next;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5625) int rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5626)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5627) ras_fwlog = &phba->ras_fwlog;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5628)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5629) rc = lpfc_check_fwlog_support(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5630) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5631) goto ras_job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5632)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5633) /* Logging to be stopped before reading */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5634) spin_lock_irq(&phba->hbalock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5635) if (ras_fwlog->state == ACTIVE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5636) spin_unlock_irq(&phba->hbalock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5637) rc = -EINPROGRESS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5638) goto ras_job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5639) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5640) spin_unlock_irq(&phba->hbalock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5641)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5642) if (job->request_len <
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5643) sizeof(struct fc_bsg_request) +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5644) sizeof(struct lpfc_bsg_get_fwlog_req)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5645) lpfc_printf_log(phba, KERN_ERR, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5646) "6184 Received RAS_LOG request "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5647) "below minimum size\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5648) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5649) goto ras_job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5650) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5651)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5652) ras_req = (struct lpfc_bsg_get_fwlog_req *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5653) bsg_request->rqst_data.h_vendor.vendor_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5654) rd_offset = ras_req->read_offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5655)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5656) /* Allocate memory to read fw log*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5657) fwlog_buff = vmalloc(ras_req->read_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5658) if (!fwlog_buff) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5659) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5660) goto ras_job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5661) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5662)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5663) rd_index = (rd_offset / LPFC_RAS_MAX_ENTRY_SIZE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5664) offset = (rd_offset % LPFC_RAS_MAX_ENTRY_SIZE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5665)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5666) list_for_each_entry_safe(dmabuf, next,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5667) &ras_fwlog->fwlog_buff_list, list) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5668)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5669) if (dmabuf->buffer_tag < rd_index)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5670) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5671)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5672) src = dmabuf->virt + offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5673) memcpy(fwlog_buff, src, ras_req->read_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5674) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5675) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5676)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5677) bsg_reply->reply_payload_rcv_len =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5678) sg_copy_from_buffer(job->reply_payload.sg_list,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5679) job->reply_payload.sg_cnt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5680) fwlog_buff, ras_req->read_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5681)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5682) vfree(fwlog_buff);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5683)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5684) ras_job_error:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5685) bsg_reply->result = rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5686) if (!rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5687) bsg_job_done(job, bsg_reply->result,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5688) bsg_reply->reply_payload_rcv_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5689)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5690) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5691) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5692)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5693) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5694) lpfc_get_trunk_info(struct bsg_job *job)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5695) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5696) struct lpfc_vport *vport = shost_priv(fc_bsg_to_shost(job));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5697) struct lpfc_hba *phba = vport->phba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5698) struct fc_bsg_reply *bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5699) struct lpfc_trunk_info *event_reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5700) int rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5701)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5702) if (job->request_len <
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5703) sizeof(struct fc_bsg_request) + sizeof(struct get_trunk_info_req)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5704) lpfc_printf_log(phba, KERN_ERR, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5705) "2744 Received GET TRUNK _INFO request below "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5706) "minimum size\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5707) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5708) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5709) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5710)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5711) event_reply = (struct lpfc_trunk_info *)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5712) bsg_reply->reply_data.vendor_reply.vendor_rsp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5713)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5714) if (job->reply_len < sizeof(*bsg_reply) + sizeof(*event_reply)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5715) lpfc_printf_log(phba, KERN_WARNING, LOG_LIBDFC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5716) "2728 Received GET TRUNK _INFO reply below "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5717) "minimum size\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5718) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5719) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5720) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5721) if (event_reply == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5722) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5723) goto job_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5724) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5725)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5726) bsg_bf_set(lpfc_trunk_info_link_status, event_reply,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5727) (phba->link_state >= LPFC_LINK_UP) ? 1 : 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5728)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5729) bsg_bf_set(lpfc_trunk_info_trunk_active0, event_reply,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5730) (phba->trunk_link.link0.state == LPFC_LINK_UP) ? 1 : 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5731)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5732) bsg_bf_set(lpfc_trunk_info_trunk_active1, event_reply,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5733) (phba->trunk_link.link1.state == LPFC_LINK_UP) ? 1 : 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5734)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5735) bsg_bf_set(lpfc_trunk_info_trunk_active2, event_reply,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5736) (phba->trunk_link.link2.state == LPFC_LINK_UP) ? 1 : 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5737)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5738) bsg_bf_set(lpfc_trunk_info_trunk_active3, event_reply,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5739) (phba->trunk_link.link3.state == LPFC_LINK_UP) ? 1 : 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5740)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5741) bsg_bf_set(lpfc_trunk_info_trunk_config0, event_reply,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5742) bf_get(lpfc_conf_trunk_port0, &phba->sli4_hba));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5743)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5744) bsg_bf_set(lpfc_trunk_info_trunk_config1, event_reply,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5745) bf_get(lpfc_conf_trunk_port1, &phba->sli4_hba));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5746)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5747) bsg_bf_set(lpfc_trunk_info_trunk_config2, event_reply,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5748) bf_get(lpfc_conf_trunk_port2, &phba->sli4_hba));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5749)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5750) bsg_bf_set(lpfc_trunk_info_trunk_config3, event_reply,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5751) bf_get(lpfc_conf_trunk_port3, &phba->sli4_hba));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5752)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5753) event_reply->port_speed = phba->sli4_hba.link_state.speed / 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5754) event_reply->logical_speed =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5755) phba->sli4_hba.link_state.logical_speed / 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5756) job_error:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5757) bsg_reply->result = rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5758) if (!rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5759) bsg_job_done(job, bsg_reply->result,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5760) bsg_reply->reply_payload_rcv_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5761) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5762)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5763) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5764)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5765) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5766) * lpfc_bsg_hst_vendor - process a vendor-specific fc_bsg_job
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5767) * @job: fc_bsg_job to handle
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5768) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5769) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5770) lpfc_bsg_hst_vendor(struct bsg_job *job)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5771) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5772) struct fc_bsg_request *bsg_request = job->request;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5773) struct fc_bsg_reply *bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5774) int command = bsg_request->rqst_data.h_vendor.vendor_cmd[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5775) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5776)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5777) switch (command) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5778) case LPFC_BSG_VENDOR_SET_CT_EVENT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5779) rc = lpfc_bsg_hba_set_event(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5780) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5781) case LPFC_BSG_VENDOR_GET_CT_EVENT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5782) rc = lpfc_bsg_hba_get_event(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5783) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5784) case LPFC_BSG_VENDOR_SEND_MGMT_RESP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5785) rc = lpfc_bsg_send_mgmt_rsp(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5786) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5787) case LPFC_BSG_VENDOR_DIAG_MODE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5788) rc = lpfc_bsg_diag_loopback_mode(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5789) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5790) case LPFC_BSG_VENDOR_DIAG_MODE_END:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5791) rc = lpfc_sli4_bsg_diag_mode_end(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5792) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5793) case LPFC_BSG_VENDOR_DIAG_RUN_LOOPBACK:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5794) rc = lpfc_bsg_diag_loopback_run(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5795) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5796) case LPFC_BSG_VENDOR_LINK_DIAG_TEST:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5797) rc = lpfc_sli4_bsg_link_diag_test(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5798) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5799) case LPFC_BSG_VENDOR_GET_MGMT_REV:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5800) rc = lpfc_bsg_get_dfc_rev(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5801) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5802) case LPFC_BSG_VENDOR_MBOX:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5803) rc = lpfc_bsg_mbox_cmd(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5804) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5805) case LPFC_BSG_VENDOR_MENLO_CMD:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5806) case LPFC_BSG_VENDOR_MENLO_DATA:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5807) rc = lpfc_menlo_cmd(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5808) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5809) case LPFC_BSG_VENDOR_FORCED_LINK_SPEED:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5810) rc = lpfc_forced_link_speed(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5811) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5812) case LPFC_BSG_VENDOR_RAS_GET_LWPD:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5813) rc = lpfc_bsg_get_ras_lwpd(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5814) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5815) case LPFC_BSG_VENDOR_RAS_GET_FWLOG:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5816) rc = lpfc_bsg_get_ras_fwlog(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5817) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5818) case LPFC_BSG_VENDOR_RAS_GET_CONFIG:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5819) rc = lpfc_bsg_get_ras_config(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5820) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5821) case LPFC_BSG_VENDOR_RAS_SET_CONFIG:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5822) rc = lpfc_bsg_set_ras_config(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5823) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5824) case LPFC_BSG_VENDOR_GET_TRUNK_INFO:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5825) rc = lpfc_get_trunk_info(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5826) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5827) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5828) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5829) bsg_reply->reply_payload_rcv_len = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5830) /* make error code available to userspace */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5831) bsg_reply->result = rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5832) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5833) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5834)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5835) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5836) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5837)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5838) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5839) * lpfc_bsg_request - handle a bsg request from the FC transport
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5840) * @job: bsg_job to handle
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5841) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5842) int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5843) lpfc_bsg_request(struct bsg_job *job)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5844) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5845) struct fc_bsg_request *bsg_request = job->request;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5846) struct fc_bsg_reply *bsg_reply = job->reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5847) uint32_t msgcode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5848) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5849)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5850) msgcode = bsg_request->msgcode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5851) switch (msgcode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5852) case FC_BSG_HST_VENDOR:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5853) rc = lpfc_bsg_hst_vendor(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5854) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5855) case FC_BSG_RPT_ELS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5856) rc = lpfc_bsg_rport_els(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5857) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5858) case FC_BSG_RPT_CT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5859) rc = lpfc_bsg_send_mgmt_cmd(job);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5860) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5861) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5862) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5863) bsg_reply->reply_payload_rcv_len = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5864) /* make error code available to userspace */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5865) bsg_reply->result = rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5866) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5867) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5868)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5869) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5870) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5871)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5872) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5873) * lpfc_bsg_timeout - handle timeout of a bsg request from the FC transport
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5874) * @job: bsg_job that has timed out
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5875) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5876) * This function just aborts the job's IOCB. The aborted IOCB will return to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5877) * the waiting function which will handle passing the error back to userspace
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5878) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5879) int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5880) lpfc_bsg_timeout(struct bsg_job *job)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5881) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5882) struct lpfc_vport *vport = shost_priv(fc_bsg_to_shost(job));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5883) struct lpfc_hba *phba = vport->phba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5884) struct lpfc_iocbq *cmdiocb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5885) struct lpfc_sli_ring *pring;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5886) struct bsg_job_data *dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5887) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5888) int rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5889) LIST_HEAD(completions);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5890) struct lpfc_iocbq *check_iocb, *next_iocb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5891)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5892) pring = lpfc_phba_elsring(phba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5893) if (unlikely(!pring))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5894) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5895)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5896) /* if job's driver data is NULL, the command completed or is in the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5897) * the process of completing. In this case, return status to request
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5898) * so the timeout is retried. This avoids double completion issues
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5899) * and the request will be pulled off the timer queue when the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5900) * command's completion handler executes. Otherwise, prevent the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5901) * command's completion handler from executing the job done callback
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5902) * and continue processing to abort the outstanding the command.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5903) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5904)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5905) spin_lock_irqsave(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5906) dd_data = (struct bsg_job_data *)job->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5907) if (dd_data) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5908) dd_data->set_job = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5909) job->dd_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5910) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5911) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5912) return -EAGAIN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5913) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5914)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5915) switch (dd_data->type) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5916) case TYPE_IOCB:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5917) /* Check to see if IOCB was issued to the port or not. If not,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5918) * remove it from the txq queue and call cancel iocbs.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5919) * Otherwise, call abort iotag
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5920) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5921) cmdiocb = dd_data->context_un.iocb.cmdiocbq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5922) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5923)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5924) spin_lock_irqsave(&phba->hbalock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5925) /* make sure the I/O abort window is still open */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5926) if (!(cmdiocb->iocb_flag & LPFC_IO_CMD_OUTSTANDING)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5927) spin_unlock_irqrestore(&phba->hbalock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5928) return -EAGAIN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5929) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5930) list_for_each_entry_safe(check_iocb, next_iocb, &pring->txq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5931) list) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5932) if (check_iocb == cmdiocb) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5933) list_move_tail(&check_iocb->list, &completions);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5934) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5935) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5936) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5937) if (list_empty(&completions))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5938) lpfc_sli_issue_abort_iotag(phba, pring, cmdiocb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5939) spin_unlock_irqrestore(&phba->hbalock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5940) if (!list_empty(&completions)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5941) lpfc_sli_cancel_iocbs(phba, &completions,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5942) IOSTAT_LOCAL_REJECT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5943) IOERR_SLI_ABORTED);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5944) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5945) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5946)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5947) case TYPE_EVT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5948) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5949) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5950)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5951) case TYPE_MBOX:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5952) /* Update the ext buf ctx state if needed */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5953)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5954) if (phba->mbox_ext_buf_ctx.state == LPFC_BSG_MBOX_PORT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5955) phba->mbox_ext_buf_ctx.state = LPFC_BSG_MBOX_ABTS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5956) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5957) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5958) case TYPE_MENLO:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5959) /* Check to see if IOCB was issued to the port or not. If not,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5960) * remove it from the txq queue and call cancel iocbs.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5961) * Otherwise, call abort iotag.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5962) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5963) cmdiocb = dd_data->context_un.menlo.cmdiocbq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5964) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5965)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5966) spin_lock_irqsave(&phba->hbalock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5967) list_for_each_entry_safe(check_iocb, next_iocb, &pring->txq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5968) list) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5969) if (check_iocb == cmdiocb) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5970) list_move_tail(&check_iocb->list, &completions);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5971) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5972) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5973) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5974) if (list_empty(&completions))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5975) lpfc_sli_issue_abort_iotag(phba, pring, cmdiocb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5976) spin_unlock_irqrestore(&phba->hbalock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5977) if (!list_empty(&completions)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5978) lpfc_sli_cancel_iocbs(phba, &completions,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5979) IOSTAT_LOCAL_REJECT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5980) IOERR_SLI_ABORTED);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5981) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5982) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5983) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5984) spin_unlock_irqrestore(&phba->ct_ev_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5985) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5986) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5987)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5988) /* scsi transport fc fc_bsg_job_timeout expects a zero return code,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5989) * otherwise an error message will be displayed on the console
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5990) * so always return success (zero)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5991) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5992) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5993) }
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags