149ab747fSPaolo Bonzini /* 249ab747fSPaolo Bonzini * QEMU MegaRAID SAS 8708EM2 Host Bus Adapter emulation 349ab747fSPaolo Bonzini * Based on the linux driver code at drivers/scsi/megaraid 449ab747fSPaolo Bonzini * 549ab747fSPaolo Bonzini * Copyright (c) 2009-2012 Hannes Reinecke, SUSE Labs 649ab747fSPaolo Bonzini * 749ab747fSPaolo Bonzini * This library is free software; you can redistribute it and/or 849ab747fSPaolo Bonzini * modify it under the terms of the GNU Lesser General Public 949ab747fSPaolo Bonzini * License as published by the Free Software Foundation; either 1049ab747fSPaolo Bonzini * version 2 of the License, or (at your option) any later version. 1149ab747fSPaolo Bonzini * 1249ab747fSPaolo Bonzini * This library is distributed in the hope that it will be useful, 1349ab747fSPaolo Bonzini * but WITHOUT ANY WARRANTY; without even the implied warranty of 1449ab747fSPaolo Bonzini * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 1549ab747fSPaolo Bonzini * Lesser General Public License for more details. 1649ab747fSPaolo Bonzini * 1749ab747fSPaolo Bonzini * You should have received a copy of the GNU Lesser General Public 1849ab747fSPaolo Bonzini * License along with this library; if not, see <http://www.gnu.org/licenses/>. 1949ab747fSPaolo Bonzini */ 2049ab747fSPaolo Bonzini 2149ab747fSPaolo Bonzini #include "hw/hw.h" 2249ab747fSPaolo Bonzini #include "hw/pci/pci.h" 2349ab747fSPaolo Bonzini #include "sysemu/dma.h" 244be74634SMarkus Armbruster #include "sysemu/block-backend.h" 254522b69cSHannes Reinecke #include "hw/pci/msi.h" 2649ab747fSPaolo Bonzini #include "hw/pci/msix.h" 2749ab747fSPaolo Bonzini #include "qemu/iov.h" 2849ab747fSPaolo Bonzini #include "hw/scsi/scsi.h" 2949ab747fSPaolo Bonzini #include "block/scsi.h" 3049ab747fSPaolo Bonzini #include "trace.h" 3149ab747fSPaolo Bonzini 3247b43a1fSPaolo Bonzini #include "mfi.h" 3349ab747fSPaolo Bonzini 34e23d0498SHannes Reinecke #define MEGASAS_VERSION_GEN1 "1.70" 35e23d0498SHannes Reinecke #define MEGASAS_VERSION_GEN2 "1.80" 3649ab747fSPaolo Bonzini #define MEGASAS_MAX_FRAMES 2048 /* Firmware limit at 65535 */ 3749ab747fSPaolo Bonzini #define MEGASAS_DEFAULT_FRAMES 1000 /* Windows requires this */ 38e23d0498SHannes Reinecke #define MEGASAS_GEN2_DEFAULT_FRAMES 1008 /* Windows requires this */ 3949ab747fSPaolo Bonzini #define MEGASAS_MAX_SGE 128 /* Firmware limit */ 4049ab747fSPaolo Bonzini #define MEGASAS_DEFAULT_SGE 80 4149ab747fSPaolo Bonzini #define MEGASAS_MAX_SECTORS 0xFFFF /* No real limit */ 4249ab747fSPaolo Bonzini #define MEGASAS_MAX_ARRAYS 128 4349ab747fSPaolo Bonzini 4449ab747fSPaolo Bonzini #define MEGASAS_HBA_SERIAL "QEMU123456" 4549ab747fSPaolo Bonzini #define NAA_LOCALLY_ASSIGNED_ID 0x3ULL 4649ab747fSPaolo Bonzini #define IEEE_COMPANY_LOCALLY_ASSIGNED 0x525400 4749ab747fSPaolo Bonzini 4849ab747fSPaolo Bonzini #define MEGASAS_FLAG_USE_JBOD 0 4949ab747fSPaolo Bonzini #define MEGASAS_MASK_USE_JBOD (1 << MEGASAS_FLAG_USE_JBOD) 504522b69cSHannes Reinecke #define MEGASAS_FLAG_USE_MSI 1 514522b69cSHannes Reinecke #define MEGASAS_MASK_USE_MSI (1 << MEGASAS_FLAG_USE_MSI) 524522b69cSHannes Reinecke #define MEGASAS_FLAG_USE_MSIX 2 5349ab747fSPaolo Bonzini #define MEGASAS_MASK_USE_MSIX (1 << MEGASAS_FLAG_USE_MSIX) 544522b69cSHannes Reinecke #define MEGASAS_FLAG_USE_QUEUE64 3 5549ab747fSPaolo Bonzini #define MEGASAS_MASK_USE_QUEUE64 (1 << MEGASAS_FLAG_USE_QUEUE64) 5649ab747fSPaolo Bonzini 5749ab747fSPaolo Bonzini static const char *mfi_frame_desc[] = { 5849ab747fSPaolo Bonzini "MFI init", "LD Read", "LD Write", "LD SCSI", "PD SCSI", 5949ab747fSPaolo Bonzini "MFI Doorbell", "MFI Abort", "MFI SMP", "MFI Stop"}; 6049ab747fSPaolo Bonzini 6149ab747fSPaolo Bonzini typedef struct MegasasCmd { 6249ab747fSPaolo Bonzini uint32_t index; 6349ab747fSPaolo Bonzini uint16_t flags; 6449ab747fSPaolo Bonzini uint16_t count; 6549ab747fSPaolo Bonzini uint64_t context; 6649ab747fSPaolo Bonzini 6749ab747fSPaolo Bonzini hwaddr pa; 6849ab747fSPaolo Bonzini hwaddr pa_size; 6949ab747fSPaolo Bonzini union mfi_frame *frame; 7049ab747fSPaolo Bonzini SCSIRequest *req; 7149ab747fSPaolo Bonzini QEMUSGList qsg; 7249ab747fSPaolo Bonzini void *iov_buf; 7349ab747fSPaolo Bonzini size_t iov_size; 7449ab747fSPaolo Bonzini size_t iov_offset; 7549ab747fSPaolo Bonzini struct MegasasState *state; 7649ab747fSPaolo Bonzini } MegasasCmd; 7749ab747fSPaolo Bonzini 7849ab747fSPaolo Bonzini typedef struct MegasasState { 7952190c1eSAndreas Färber /*< private >*/ 8052190c1eSAndreas Färber PCIDevice parent_obj; 8152190c1eSAndreas Färber /*< public >*/ 8252190c1eSAndreas Färber 8349ab747fSPaolo Bonzini MemoryRegion mmio_io; 8449ab747fSPaolo Bonzini MemoryRegion port_io; 8549ab747fSPaolo Bonzini MemoryRegion queue_io; 8649ab747fSPaolo Bonzini uint32_t frame_hi; 8749ab747fSPaolo Bonzini 8849ab747fSPaolo Bonzini int fw_state; 8949ab747fSPaolo Bonzini uint32_t fw_sge; 9049ab747fSPaolo Bonzini uint32_t fw_cmds; 9149ab747fSPaolo Bonzini uint32_t flags; 9249ab747fSPaolo Bonzini int fw_luns; 9349ab747fSPaolo Bonzini int intr_mask; 9449ab747fSPaolo Bonzini int doorbell; 9549ab747fSPaolo Bonzini int busy; 96e23d0498SHannes Reinecke int diag; 97e23d0498SHannes Reinecke int adp_reset; 9849ab747fSPaolo Bonzini 9949ab747fSPaolo Bonzini MegasasCmd *event_cmd; 10049ab747fSPaolo Bonzini int event_locale; 10149ab747fSPaolo Bonzini int event_class; 10249ab747fSPaolo Bonzini int event_count; 10349ab747fSPaolo Bonzini int shutdown_event; 10449ab747fSPaolo Bonzini int boot_event; 10549ab747fSPaolo Bonzini 10649ab747fSPaolo Bonzini uint64_t sas_addr; 10749ab747fSPaolo Bonzini char *hba_serial; 10849ab747fSPaolo Bonzini 10949ab747fSPaolo Bonzini uint64_t reply_queue_pa; 11049ab747fSPaolo Bonzini void *reply_queue; 11149ab747fSPaolo Bonzini int reply_queue_len; 11249ab747fSPaolo Bonzini int reply_queue_head; 11349ab747fSPaolo Bonzini int reply_queue_tail; 11449ab747fSPaolo Bonzini uint64_t consumer_pa; 11549ab747fSPaolo Bonzini uint64_t producer_pa; 11649ab747fSPaolo Bonzini 11749ab747fSPaolo Bonzini MegasasCmd frames[MEGASAS_MAX_FRAMES]; 1186df5718bSHannes Reinecke DECLARE_BITMAP(frame_map, MEGASAS_MAX_FRAMES); 11949ab747fSPaolo Bonzini SCSIBus bus; 12049ab747fSPaolo Bonzini } MegasasState; 12149ab747fSPaolo Bonzini 122e23d0498SHannes Reinecke typedef struct MegasasBaseClass { 123e23d0498SHannes Reinecke PCIDeviceClass parent_class; 124e23d0498SHannes Reinecke const char *product_name; 125e23d0498SHannes Reinecke const char *product_version; 126e23d0498SHannes Reinecke int mmio_bar; 127e23d0498SHannes Reinecke int ioport_bar; 128e23d0498SHannes Reinecke int osts; 129e23d0498SHannes Reinecke } MegasasBaseClass; 130e23d0498SHannes Reinecke 131e23d0498SHannes Reinecke #define TYPE_MEGASAS_BASE "megasas-base" 132e23d0498SHannes Reinecke #define TYPE_MEGASAS_GEN1 "megasas" 133e23d0498SHannes Reinecke #define TYPE_MEGASAS_GEN2 "megasas-gen2" 134c79e16aeSPeter Crosthwaite 135c79e16aeSPeter Crosthwaite #define MEGASAS(obj) \ 136e23d0498SHannes Reinecke OBJECT_CHECK(MegasasState, (obj), TYPE_MEGASAS_BASE) 137e23d0498SHannes Reinecke 138e23d0498SHannes Reinecke #define MEGASAS_DEVICE_CLASS(oc) \ 139e23d0498SHannes Reinecke OBJECT_CLASS_CHECK(MegasasBaseClass, (oc), TYPE_MEGASAS_BASE) 140e23d0498SHannes Reinecke #define MEGASAS_DEVICE_GET_CLASS(oc) \ 141e23d0498SHannes Reinecke OBJECT_GET_CLASS(MegasasBaseClass, (oc), TYPE_MEGASAS_BASE) 142c79e16aeSPeter Crosthwaite 14349ab747fSPaolo Bonzini #define MEGASAS_INTR_DISABLED_MASK 0xFFFFFFFF 14449ab747fSPaolo Bonzini 14549ab747fSPaolo Bonzini static bool megasas_intr_enabled(MegasasState *s) 14649ab747fSPaolo Bonzini { 14749ab747fSPaolo Bonzini if ((s->intr_mask & MEGASAS_INTR_DISABLED_MASK) != 14849ab747fSPaolo Bonzini MEGASAS_INTR_DISABLED_MASK) { 14949ab747fSPaolo Bonzini return true; 15049ab747fSPaolo Bonzini } 15149ab747fSPaolo Bonzini return false; 15249ab747fSPaolo Bonzini } 15349ab747fSPaolo Bonzini 15449ab747fSPaolo Bonzini static bool megasas_use_queue64(MegasasState *s) 15549ab747fSPaolo Bonzini { 15649ab747fSPaolo Bonzini return s->flags & MEGASAS_MASK_USE_QUEUE64; 15749ab747fSPaolo Bonzini } 15849ab747fSPaolo Bonzini 1594522b69cSHannes Reinecke static bool megasas_use_msi(MegasasState *s) 1604522b69cSHannes Reinecke { 1614522b69cSHannes Reinecke return s->flags & MEGASAS_MASK_USE_MSI; 1624522b69cSHannes Reinecke } 1634522b69cSHannes Reinecke 16449ab747fSPaolo Bonzini static bool megasas_use_msix(MegasasState *s) 16549ab747fSPaolo Bonzini { 16649ab747fSPaolo Bonzini return s->flags & MEGASAS_MASK_USE_MSIX; 16749ab747fSPaolo Bonzini } 16849ab747fSPaolo Bonzini 16949ab747fSPaolo Bonzini static bool megasas_is_jbod(MegasasState *s) 17049ab747fSPaolo Bonzini { 17149ab747fSPaolo Bonzini return s->flags & MEGASAS_MASK_USE_JBOD; 17249ab747fSPaolo Bonzini } 17349ab747fSPaolo Bonzini 17416578c6fSPaolo Bonzini static void megasas_frame_set_cmd_status(MegasasState *s, 17516578c6fSPaolo Bonzini unsigned long frame, uint8_t v) 17649ab747fSPaolo Bonzini { 17716578c6fSPaolo Bonzini PCIDevice *pci = &s->parent_obj; 17816578c6fSPaolo Bonzini stb_pci_dma(pci, frame + offsetof(struct mfi_frame_header, cmd_status), v); 17949ab747fSPaolo Bonzini } 18049ab747fSPaolo Bonzini 18116578c6fSPaolo Bonzini static void megasas_frame_set_scsi_status(MegasasState *s, 18216578c6fSPaolo Bonzini unsigned long frame, uint8_t v) 18349ab747fSPaolo Bonzini { 18416578c6fSPaolo Bonzini PCIDevice *pci = &s->parent_obj; 18516578c6fSPaolo Bonzini stb_pci_dma(pci, frame + offsetof(struct mfi_frame_header, scsi_status), v); 18649ab747fSPaolo Bonzini } 18749ab747fSPaolo Bonzini 18849ab747fSPaolo Bonzini /* 18949ab747fSPaolo Bonzini * Context is considered opaque, but the HBA firmware is running 19049ab747fSPaolo Bonzini * in little endian mode. So convert it to little endian, too. 19149ab747fSPaolo Bonzini */ 19216578c6fSPaolo Bonzini static uint64_t megasas_frame_get_context(MegasasState *s, 19316578c6fSPaolo Bonzini unsigned long frame) 19449ab747fSPaolo Bonzini { 19516578c6fSPaolo Bonzini PCIDevice *pci = &s->parent_obj; 19616578c6fSPaolo Bonzini return ldq_le_pci_dma(pci, frame + offsetof(struct mfi_frame_header, context)); 19749ab747fSPaolo Bonzini } 19849ab747fSPaolo Bonzini 19949ab747fSPaolo Bonzini static bool megasas_frame_is_ieee_sgl(MegasasCmd *cmd) 20049ab747fSPaolo Bonzini { 20149ab747fSPaolo Bonzini return cmd->flags & MFI_FRAME_IEEE_SGL; 20249ab747fSPaolo Bonzini } 20349ab747fSPaolo Bonzini 20449ab747fSPaolo Bonzini static bool megasas_frame_is_sgl64(MegasasCmd *cmd) 20549ab747fSPaolo Bonzini { 20649ab747fSPaolo Bonzini return cmd->flags & MFI_FRAME_SGL64; 20749ab747fSPaolo Bonzini } 20849ab747fSPaolo Bonzini 20949ab747fSPaolo Bonzini static bool megasas_frame_is_sense64(MegasasCmd *cmd) 21049ab747fSPaolo Bonzini { 21149ab747fSPaolo Bonzini return cmd->flags & MFI_FRAME_SENSE64; 21249ab747fSPaolo Bonzini } 21349ab747fSPaolo Bonzini 21449ab747fSPaolo Bonzini static uint64_t megasas_sgl_get_addr(MegasasCmd *cmd, 21549ab747fSPaolo Bonzini union mfi_sgl *sgl) 21649ab747fSPaolo Bonzini { 21749ab747fSPaolo Bonzini uint64_t addr; 21849ab747fSPaolo Bonzini 21949ab747fSPaolo Bonzini if (megasas_frame_is_ieee_sgl(cmd)) { 22049ab747fSPaolo Bonzini addr = le64_to_cpu(sgl->sg_skinny->addr); 22149ab747fSPaolo Bonzini } else if (megasas_frame_is_sgl64(cmd)) { 22249ab747fSPaolo Bonzini addr = le64_to_cpu(sgl->sg64->addr); 22349ab747fSPaolo Bonzini } else { 22449ab747fSPaolo Bonzini addr = le32_to_cpu(sgl->sg32->addr); 22549ab747fSPaolo Bonzini } 22649ab747fSPaolo Bonzini return addr; 22749ab747fSPaolo Bonzini } 22849ab747fSPaolo Bonzini 22949ab747fSPaolo Bonzini static uint32_t megasas_sgl_get_len(MegasasCmd *cmd, 23049ab747fSPaolo Bonzini union mfi_sgl *sgl) 23149ab747fSPaolo Bonzini { 23249ab747fSPaolo Bonzini uint32_t len; 23349ab747fSPaolo Bonzini 23449ab747fSPaolo Bonzini if (megasas_frame_is_ieee_sgl(cmd)) { 23549ab747fSPaolo Bonzini len = le32_to_cpu(sgl->sg_skinny->len); 23649ab747fSPaolo Bonzini } else if (megasas_frame_is_sgl64(cmd)) { 23749ab747fSPaolo Bonzini len = le32_to_cpu(sgl->sg64->len); 23849ab747fSPaolo Bonzini } else { 23949ab747fSPaolo Bonzini len = le32_to_cpu(sgl->sg32->len); 24049ab747fSPaolo Bonzini } 24149ab747fSPaolo Bonzini return len; 24249ab747fSPaolo Bonzini } 24349ab747fSPaolo Bonzini 24449ab747fSPaolo Bonzini static union mfi_sgl *megasas_sgl_next(MegasasCmd *cmd, 24549ab747fSPaolo Bonzini union mfi_sgl *sgl) 24649ab747fSPaolo Bonzini { 24749ab747fSPaolo Bonzini uint8_t *next = (uint8_t *)sgl; 24849ab747fSPaolo Bonzini 24949ab747fSPaolo Bonzini if (megasas_frame_is_ieee_sgl(cmd)) { 25049ab747fSPaolo Bonzini next += sizeof(struct mfi_sg_skinny); 25149ab747fSPaolo Bonzini } else if (megasas_frame_is_sgl64(cmd)) { 25249ab747fSPaolo Bonzini next += sizeof(struct mfi_sg64); 25349ab747fSPaolo Bonzini } else { 25449ab747fSPaolo Bonzini next += sizeof(struct mfi_sg32); 25549ab747fSPaolo Bonzini } 25649ab747fSPaolo Bonzini 25749ab747fSPaolo Bonzini if (next >= (uint8_t *)cmd->frame + cmd->pa_size) { 25849ab747fSPaolo Bonzini return NULL; 25949ab747fSPaolo Bonzini } 26049ab747fSPaolo Bonzini return (union mfi_sgl *)next; 26149ab747fSPaolo Bonzini } 26249ab747fSPaolo Bonzini 26349ab747fSPaolo Bonzini static void megasas_soft_reset(MegasasState *s); 26449ab747fSPaolo Bonzini 26549ab747fSPaolo Bonzini static int megasas_map_sgl(MegasasState *s, MegasasCmd *cmd, union mfi_sgl *sgl) 26649ab747fSPaolo Bonzini { 26749ab747fSPaolo Bonzini int i; 26849ab747fSPaolo Bonzini int iov_count = 0; 26949ab747fSPaolo Bonzini size_t iov_size = 0; 27049ab747fSPaolo Bonzini 27149ab747fSPaolo Bonzini cmd->flags = le16_to_cpu(cmd->frame->header.flags); 27249ab747fSPaolo Bonzini iov_count = cmd->frame->header.sge_count; 27349ab747fSPaolo Bonzini if (iov_count > MEGASAS_MAX_SGE) { 27449ab747fSPaolo Bonzini trace_megasas_iovec_sgl_overflow(cmd->index, iov_count, 27549ab747fSPaolo Bonzini MEGASAS_MAX_SGE); 27649ab747fSPaolo Bonzini return iov_count; 27749ab747fSPaolo Bonzini } 27852190c1eSAndreas Färber pci_dma_sglist_init(&cmd->qsg, PCI_DEVICE(s), iov_count); 27949ab747fSPaolo Bonzini for (i = 0; i < iov_count; i++) { 28049ab747fSPaolo Bonzini dma_addr_t iov_pa, iov_size_p; 28149ab747fSPaolo Bonzini 28249ab747fSPaolo Bonzini if (!sgl) { 28349ab747fSPaolo Bonzini trace_megasas_iovec_sgl_underflow(cmd->index, i); 28449ab747fSPaolo Bonzini goto unmap; 28549ab747fSPaolo Bonzini } 28649ab747fSPaolo Bonzini iov_pa = megasas_sgl_get_addr(cmd, sgl); 28749ab747fSPaolo Bonzini iov_size_p = megasas_sgl_get_len(cmd, sgl); 28849ab747fSPaolo Bonzini if (!iov_pa || !iov_size_p) { 28949ab747fSPaolo Bonzini trace_megasas_iovec_sgl_invalid(cmd->index, i, 29049ab747fSPaolo Bonzini iov_pa, iov_size_p); 29149ab747fSPaolo Bonzini goto unmap; 29249ab747fSPaolo Bonzini } 29349ab747fSPaolo Bonzini qemu_sglist_add(&cmd->qsg, iov_pa, iov_size_p); 29449ab747fSPaolo Bonzini sgl = megasas_sgl_next(cmd, sgl); 29549ab747fSPaolo Bonzini iov_size += (size_t)iov_size_p; 29649ab747fSPaolo Bonzini } 29749ab747fSPaolo Bonzini if (cmd->iov_size > iov_size) { 29849ab747fSPaolo Bonzini trace_megasas_iovec_overflow(cmd->index, iov_size, cmd->iov_size); 29949ab747fSPaolo Bonzini } else if (cmd->iov_size < iov_size) { 30049ab747fSPaolo Bonzini trace_megasas_iovec_underflow(cmd->iov_size, iov_size, cmd->iov_size); 30149ab747fSPaolo Bonzini } 30249ab747fSPaolo Bonzini cmd->iov_offset = 0; 30349ab747fSPaolo Bonzini return 0; 30449ab747fSPaolo Bonzini unmap: 30549ab747fSPaolo Bonzini qemu_sglist_destroy(&cmd->qsg); 30649ab747fSPaolo Bonzini return iov_count - i; 30749ab747fSPaolo Bonzini } 30849ab747fSPaolo Bonzini 30949ab747fSPaolo Bonzini static void megasas_unmap_sgl(MegasasCmd *cmd) 31049ab747fSPaolo Bonzini { 31149ab747fSPaolo Bonzini qemu_sglist_destroy(&cmd->qsg); 31249ab747fSPaolo Bonzini cmd->iov_offset = 0; 31349ab747fSPaolo Bonzini } 31449ab747fSPaolo Bonzini 31549ab747fSPaolo Bonzini /* 31649ab747fSPaolo Bonzini * passthrough sense and io sense are at the same offset 31749ab747fSPaolo Bonzini */ 31849ab747fSPaolo Bonzini static int megasas_build_sense(MegasasCmd *cmd, uint8_t *sense_ptr, 31949ab747fSPaolo Bonzini uint8_t sense_len) 32049ab747fSPaolo Bonzini { 3211016b239SPaolo Bonzini PCIDevice *pcid = PCI_DEVICE(cmd->state); 32249ab747fSPaolo Bonzini uint32_t pa_hi = 0, pa_lo; 32349ab747fSPaolo Bonzini hwaddr pa; 32449ab747fSPaolo Bonzini 32549ab747fSPaolo Bonzini if (sense_len > cmd->frame->header.sense_len) { 32649ab747fSPaolo Bonzini sense_len = cmd->frame->header.sense_len; 32749ab747fSPaolo Bonzini } 32849ab747fSPaolo Bonzini if (sense_len) { 32949ab747fSPaolo Bonzini pa_lo = le32_to_cpu(cmd->frame->pass.sense_addr_lo); 33049ab747fSPaolo Bonzini if (megasas_frame_is_sense64(cmd)) { 33149ab747fSPaolo Bonzini pa_hi = le32_to_cpu(cmd->frame->pass.sense_addr_hi); 33249ab747fSPaolo Bonzini } 33349ab747fSPaolo Bonzini pa = ((uint64_t) pa_hi << 32) | pa_lo; 3341016b239SPaolo Bonzini pci_dma_write(pcid, pa, sense_ptr, sense_len); 33549ab747fSPaolo Bonzini cmd->frame->header.sense_len = sense_len; 33649ab747fSPaolo Bonzini } 33749ab747fSPaolo Bonzini return sense_len; 33849ab747fSPaolo Bonzini } 33949ab747fSPaolo Bonzini 34049ab747fSPaolo Bonzini static void megasas_write_sense(MegasasCmd *cmd, SCSISense sense) 34149ab747fSPaolo Bonzini { 34249ab747fSPaolo Bonzini uint8_t sense_buf[SCSI_SENSE_BUF_SIZE]; 34349ab747fSPaolo Bonzini uint8_t sense_len = 18; 34449ab747fSPaolo Bonzini 34549ab747fSPaolo Bonzini memset(sense_buf, 0, sense_len); 34649ab747fSPaolo Bonzini sense_buf[0] = 0xf0; 34749ab747fSPaolo Bonzini sense_buf[2] = sense.key; 34849ab747fSPaolo Bonzini sense_buf[7] = 10; 34949ab747fSPaolo Bonzini sense_buf[12] = sense.asc; 35049ab747fSPaolo Bonzini sense_buf[13] = sense.ascq; 35149ab747fSPaolo Bonzini megasas_build_sense(cmd, sense_buf, sense_len); 35249ab747fSPaolo Bonzini } 35349ab747fSPaolo Bonzini 35449ab747fSPaolo Bonzini static void megasas_copy_sense(MegasasCmd *cmd) 35549ab747fSPaolo Bonzini { 35649ab747fSPaolo Bonzini uint8_t sense_buf[SCSI_SENSE_BUF_SIZE]; 35749ab747fSPaolo Bonzini uint8_t sense_len; 35849ab747fSPaolo Bonzini 35949ab747fSPaolo Bonzini sense_len = scsi_req_get_sense(cmd->req, sense_buf, 36049ab747fSPaolo Bonzini SCSI_SENSE_BUF_SIZE); 36149ab747fSPaolo Bonzini megasas_build_sense(cmd, sense_buf, sense_len); 36249ab747fSPaolo Bonzini } 36349ab747fSPaolo Bonzini 36449ab747fSPaolo Bonzini /* 36549ab747fSPaolo Bonzini * Format an INQUIRY CDB 36649ab747fSPaolo Bonzini */ 36749ab747fSPaolo Bonzini static int megasas_setup_inquiry(uint8_t *cdb, int pg, int len) 36849ab747fSPaolo Bonzini { 36949ab747fSPaolo Bonzini memset(cdb, 0, 6); 37049ab747fSPaolo Bonzini cdb[0] = INQUIRY; 37149ab747fSPaolo Bonzini if (pg > 0) { 37249ab747fSPaolo Bonzini cdb[1] = 0x1; 37349ab747fSPaolo Bonzini cdb[2] = pg; 37449ab747fSPaolo Bonzini } 37549ab747fSPaolo Bonzini cdb[3] = (len >> 8) & 0xff; 37649ab747fSPaolo Bonzini cdb[4] = (len & 0xff); 37749ab747fSPaolo Bonzini return len; 37849ab747fSPaolo Bonzini } 37949ab747fSPaolo Bonzini 38049ab747fSPaolo Bonzini /* 38149ab747fSPaolo Bonzini * Encode lba and len into a READ_16/WRITE_16 CDB 38249ab747fSPaolo Bonzini */ 38349ab747fSPaolo Bonzini static void megasas_encode_lba(uint8_t *cdb, uint64_t lba, 38449ab747fSPaolo Bonzini uint32_t len, bool is_write) 38549ab747fSPaolo Bonzini { 38649ab747fSPaolo Bonzini memset(cdb, 0x0, 16); 38749ab747fSPaolo Bonzini if (is_write) { 38849ab747fSPaolo Bonzini cdb[0] = WRITE_16; 38949ab747fSPaolo Bonzini } else { 39049ab747fSPaolo Bonzini cdb[0] = READ_16; 39149ab747fSPaolo Bonzini } 39249ab747fSPaolo Bonzini cdb[2] = (lba >> 56) & 0xff; 39349ab747fSPaolo Bonzini cdb[3] = (lba >> 48) & 0xff; 39449ab747fSPaolo Bonzini cdb[4] = (lba >> 40) & 0xff; 39549ab747fSPaolo Bonzini cdb[5] = (lba >> 32) & 0xff; 39649ab747fSPaolo Bonzini cdb[6] = (lba >> 24) & 0xff; 39749ab747fSPaolo Bonzini cdb[7] = (lba >> 16) & 0xff; 39849ab747fSPaolo Bonzini cdb[8] = (lba >> 8) & 0xff; 39949ab747fSPaolo Bonzini cdb[9] = (lba) & 0xff; 40049ab747fSPaolo Bonzini cdb[10] = (len >> 24) & 0xff; 40149ab747fSPaolo Bonzini cdb[11] = (len >> 16) & 0xff; 40249ab747fSPaolo Bonzini cdb[12] = (len >> 8) & 0xff; 40349ab747fSPaolo Bonzini cdb[13] = (len) & 0xff; 40449ab747fSPaolo Bonzini } 40549ab747fSPaolo Bonzini 40649ab747fSPaolo Bonzini /* 40749ab747fSPaolo Bonzini * Utility functions 40849ab747fSPaolo Bonzini */ 40949ab747fSPaolo Bonzini static uint64_t megasas_fw_time(void) 41049ab747fSPaolo Bonzini { 41149ab747fSPaolo Bonzini struct tm curtime; 41249ab747fSPaolo Bonzini uint64_t bcd_time; 41349ab747fSPaolo Bonzini 41449ab747fSPaolo Bonzini qemu_get_timedate(&curtime, 0); 41549ab747fSPaolo Bonzini bcd_time = ((uint64_t)curtime.tm_sec & 0xff) << 48 | 41649ab747fSPaolo Bonzini ((uint64_t)curtime.tm_min & 0xff) << 40 | 41749ab747fSPaolo Bonzini ((uint64_t)curtime.tm_hour & 0xff) << 32 | 41849ab747fSPaolo Bonzini ((uint64_t)curtime.tm_mday & 0xff) << 24 | 41949ab747fSPaolo Bonzini ((uint64_t)curtime.tm_mon & 0xff) << 16 | 42049ab747fSPaolo Bonzini ((uint64_t)(curtime.tm_year + 1900) & 0xffff); 42149ab747fSPaolo Bonzini 42249ab747fSPaolo Bonzini return bcd_time; 42349ab747fSPaolo Bonzini } 42449ab747fSPaolo Bonzini 42549ab747fSPaolo Bonzini /* 42649ab747fSPaolo Bonzini * Default disk sata address 42749ab747fSPaolo Bonzini * 0x1221 is the magic number as 42849ab747fSPaolo Bonzini * present in real hardware, 42949ab747fSPaolo Bonzini * so use it here, too. 43049ab747fSPaolo Bonzini */ 43149ab747fSPaolo Bonzini static uint64_t megasas_get_sata_addr(uint16_t id) 43249ab747fSPaolo Bonzini { 43349ab747fSPaolo Bonzini uint64_t addr = (0x1221ULL << 48); 43449ab747fSPaolo Bonzini return addr & (id << 24); 43549ab747fSPaolo Bonzini } 43649ab747fSPaolo Bonzini 43749ab747fSPaolo Bonzini /* 43849ab747fSPaolo Bonzini * Frame handling 43949ab747fSPaolo Bonzini */ 44049ab747fSPaolo Bonzini static int megasas_next_index(MegasasState *s, int index, int limit) 44149ab747fSPaolo Bonzini { 44249ab747fSPaolo Bonzini index++; 44349ab747fSPaolo Bonzini if (index == limit) { 44449ab747fSPaolo Bonzini index = 0; 44549ab747fSPaolo Bonzini } 44649ab747fSPaolo Bonzini return index; 44749ab747fSPaolo Bonzini } 44849ab747fSPaolo Bonzini 44949ab747fSPaolo Bonzini static MegasasCmd *megasas_lookup_frame(MegasasState *s, 45049ab747fSPaolo Bonzini hwaddr frame) 45149ab747fSPaolo Bonzini { 45249ab747fSPaolo Bonzini MegasasCmd *cmd = NULL; 45349ab747fSPaolo Bonzini int num = 0, index; 45449ab747fSPaolo Bonzini 45549ab747fSPaolo Bonzini index = s->reply_queue_head; 45649ab747fSPaolo Bonzini 45749ab747fSPaolo Bonzini while (num < s->fw_cmds) { 45849ab747fSPaolo Bonzini if (s->frames[index].pa && s->frames[index].pa == frame) { 45949ab747fSPaolo Bonzini cmd = &s->frames[index]; 46049ab747fSPaolo Bonzini break; 46149ab747fSPaolo Bonzini } 46249ab747fSPaolo Bonzini index = megasas_next_index(s, index, s->fw_cmds); 46349ab747fSPaolo Bonzini num++; 46449ab747fSPaolo Bonzini } 46549ab747fSPaolo Bonzini 46649ab747fSPaolo Bonzini return cmd; 46749ab747fSPaolo Bonzini } 46849ab747fSPaolo Bonzini 4696df5718bSHannes Reinecke static void megasas_unmap_frame(MegasasState *s, MegasasCmd *cmd) 47049ab747fSPaolo Bonzini { 4716df5718bSHannes Reinecke PCIDevice *p = PCI_DEVICE(s); 47249ab747fSPaolo Bonzini 4736df5718bSHannes Reinecke pci_dma_unmap(p, cmd->frame, cmd->pa_size, 0, 0); 4746df5718bSHannes Reinecke cmd->frame = NULL; 4756df5718bSHannes Reinecke cmd->pa = 0; 4766df5718bSHannes Reinecke clear_bit(cmd->index, s->frame_map); 47749ab747fSPaolo Bonzini } 47849ab747fSPaolo Bonzini 4796df5718bSHannes Reinecke /* 4806df5718bSHannes Reinecke * This absolutely needs to be locked if 4816df5718bSHannes Reinecke * qemu ever goes multithreaded. 4826df5718bSHannes Reinecke */ 48349ab747fSPaolo Bonzini static MegasasCmd *megasas_enqueue_frame(MegasasState *s, 48449ab747fSPaolo Bonzini hwaddr frame, uint64_t context, int count) 48549ab747fSPaolo Bonzini { 4861016b239SPaolo Bonzini PCIDevice *pcid = PCI_DEVICE(s); 48749ab747fSPaolo Bonzini MegasasCmd *cmd = NULL; 48849ab747fSPaolo Bonzini int frame_size = MFI_FRAME_SIZE * 16; 48949ab747fSPaolo Bonzini hwaddr frame_size_p = frame_size; 4906df5718bSHannes Reinecke unsigned long index; 49149ab747fSPaolo Bonzini 4926df5718bSHannes Reinecke index = 0; 4936df5718bSHannes Reinecke while (index < s->fw_cmds) { 4946df5718bSHannes Reinecke index = find_next_zero_bit(s->frame_map, s->fw_cmds, index); 4956df5718bSHannes Reinecke if (!s->frames[index].pa) 4966df5718bSHannes Reinecke break; 4976df5718bSHannes Reinecke /* Busy frame found */ 4986df5718bSHannes Reinecke trace_megasas_qf_mapped(index); 4996df5718bSHannes Reinecke } 5006df5718bSHannes Reinecke if (index >= s->fw_cmds) { 50149ab747fSPaolo Bonzini /* All frames busy */ 5026df5718bSHannes Reinecke trace_megasas_qf_busy(frame); 50349ab747fSPaolo Bonzini return NULL; 50449ab747fSPaolo Bonzini } 5056df5718bSHannes Reinecke cmd = &s->frames[index]; 5066df5718bSHannes Reinecke set_bit(index, s->frame_map); 5076df5718bSHannes Reinecke trace_megasas_qf_new(index, frame); 5086df5718bSHannes Reinecke 50949ab747fSPaolo Bonzini cmd->pa = frame; 51049ab747fSPaolo Bonzini /* Map all possible frames */ 5111016b239SPaolo Bonzini cmd->frame = pci_dma_map(pcid, frame, &frame_size_p, 0); 51249ab747fSPaolo Bonzini if (frame_size_p != frame_size) { 51349ab747fSPaolo Bonzini trace_megasas_qf_map_failed(cmd->index, (unsigned long)frame); 51449ab747fSPaolo Bonzini if (cmd->frame) { 5156df5718bSHannes Reinecke megasas_unmap_frame(s, cmd); 51649ab747fSPaolo Bonzini } 51749ab747fSPaolo Bonzini s->event_count++; 51849ab747fSPaolo Bonzini return NULL; 51949ab747fSPaolo Bonzini } 52049ab747fSPaolo Bonzini cmd->pa_size = frame_size_p; 52149ab747fSPaolo Bonzini cmd->context = context; 52249ab747fSPaolo Bonzini if (!megasas_use_queue64(s)) { 52349ab747fSPaolo Bonzini cmd->context &= (uint64_t)0xFFFFFFFF; 52449ab747fSPaolo Bonzini } 52549ab747fSPaolo Bonzini cmd->count = count; 52649ab747fSPaolo Bonzini s->busy++; 52749ab747fSPaolo Bonzini 528aaf2a859SHannes Reinecke if (s->consumer_pa) { 52916578c6fSPaolo Bonzini s->reply_queue_tail = ldl_le_pci_dma(pcid, s->consumer_pa); 530aaf2a859SHannes Reinecke } 53149ab747fSPaolo Bonzini trace_megasas_qf_enqueue(cmd->index, cmd->count, cmd->context, 532aaf2a859SHannes Reinecke s->reply_queue_head, s->reply_queue_tail, s->busy); 53349ab747fSPaolo Bonzini 53449ab747fSPaolo Bonzini return cmd; 53549ab747fSPaolo Bonzini } 53649ab747fSPaolo Bonzini 53749ab747fSPaolo Bonzini static void megasas_complete_frame(MegasasState *s, uint64_t context) 53849ab747fSPaolo Bonzini { 53952190c1eSAndreas Färber PCIDevice *pci_dev = PCI_DEVICE(s); 54049ab747fSPaolo Bonzini int tail, queue_offset; 54149ab747fSPaolo Bonzini 54249ab747fSPaolo Bonzini /* Decrement busy count */ 54349ab747fSPaolo Bonzini s->busy--; 54449ab747fSPaolo Bonzini if (s->reply_queue_pa) { 54549ab747fSPaolo Bonzini /* 54649ab747fSPaolo Bonzini * Put command on the reply queue. 54749ab747fSPaolo Bonzini * Context is opaque, but emulation is running in 54849ab747fSPaolo Bonzini * little endian. So convert it. 54949ab747fSPaolo Bonzini */ 55049ab747fSPaolo Bonzini if (megasas_use_queue64(s)) { 5517957ee71SHannes Reinecke queue_offset = s->reply_queue_head * sizeof(uint64_t); 55216578c6fSPaolo Bonzini stq_le_pci_dma(pci_dev, s->reply_queue_pa + queue_offset, context); 55349ab747fSPaolo Bonzini } else { 5547957ee71SHannes Reinecke queue_offset = s->reply_queue_head * sizeof(uint32_t); 55516578c6fSPaolo Bonzini stl_le_pci_dma(pci_dev, s->reply_queue_pa + queue_offset, context); 55649ab747fSPaolo Bonzini } 55716578c6fSPaolo Bonzini s->reply_queue_tail = ldl_le_pci_dma(pci_dev, s->consumer_pa); 558aaf2a859SHannes Reinecke trace_megasas_qf_complete(context, s->reply_queue_head, 5597957ee71SHannes Reinecke s->reply_queue_tail, s->busy); 56049ab747fSPaolo Bonzini } 56149ab747fSPaolo Bonzini 56249ab747fSPaolo Bonzini if (megasas_intr_enabled(s)) { 5637957ee71SHannes Reinecke /* Update reply queue pointer */ 56416578c6fSPaolo Bonzini s->reply_queue_tail = ldl_le_pci_dma(pci_dev, s->consumer_pa); 5657957ee71SHannes Reinecke tail = s->reply_queue_head; 5667957ee71SHannes Reinecke s->reply_queue_head = megasas_next_index(s, tail, s->fw_cmds); 5677957ee71SHannes Reinecke trace_megasas_qf_update(s->reply_queue_head, s->reply_queue_tail, 5687957ee71SHannes Reinecke s->busy); 56916578c6fSPaolo Bonzini stl_le_pci_dma(pci_dev, s->producer_pa, s->reply_queue_head); 57049ab747fSPaolo Bonzini /* Notify HBA */ 57152190c1eSAndreas Färber if (msix_enabled(pci_dev)) { 57249ab747fSPaolo Bonzini trace_megasas_msix_raise(0); 57352190c1eSAndreas Färber msix_notify(pci_dev, 0); 5744522b69cSHannes Reinecke } else if (msi_enabled(pci_dev)) { 5754522b69cSHannes Reinecke trace_megasas_msi_raise(0); 5764522b69cSHannes Reinecke msi_notify(pci_dev, 0); 57749ab747fSPaolo Bonzini } else { 5787957ee71SHannes Reinecke s->doorbell++; 5797957ee71SHannes Reinecke if (s->doorbell == 1) { 58049ab747fSPaolo Bonzini trace_megasas_irq_raise(); 5819e64f8a3SMarcel Apfelbaum pci_irq_assert(pci_dev); 58249ab747fSPaolo Bonzini } 58349ab747fSPaolo Bonzini } 58449ab747fSPaolo Bonzini } else { 58549ab747fSPaolo Bonzini trace_megasas_qf_complete_noirq(context); 58649ab747fSPaolo Bonzini } 58749ab747fSPaolo Bonzini } 58849ab747fSPaolo Bonzini 58949ab747fSPaolo Bonzini static void megasas_reset_frames(MegasasState *s) 59049ab747fSPaolo Bonzini { 59149ab747fSPaolo Bonzini int i; 59249ab747fSPaolo Bonzini MegasasCmd *cmd; 59349ab747fSPaolo Bonzini 59449ab747fSPaolo Bonzini for (i = 0; i < s->fw_cmds; i++) { 59549ab747fSPaolo Bonzini cmd = &s->frames[i]; 59649ab747fSPaolo Bonzini if (cmd->pa) { 5976df5718bSHannes Reinecke megasas_unmap_frame(s, cmd); 59849ab747fSPaolo Bonzini } 59949ab747fSPaolo Bonzini } 6006df5718bSHannes Reinecke bitmap_zero(s->frame_map, MEGASAS_MAX_FRAMES); 60149ab747fSPaolo Bonzini } 60249ab747fSPaolo Bonzini 60349ab747fSPaolo Bonzini static void megasas_abort_command(MegasasCmd *cmd) 60449ab747fSPaolo Bonzini { 60549ab747fSPaolo Bonzini if (cmd->req) { 60649ab747fSPaolo Bonzini scsi_req_cancel(cmd->req); 60749ab747fSPaolo Bonzini cmd->req = NULL; 60849ab747fSPaolo Bonzini } 60949ab747fSPaolo Bonzini } 61049ab747fSPaolo Bonzini 61149ab747fSPaolo Bonzini static int megasas_init_firmware(MegasasState *s, MegasasCmd *cmd) 61249ab747fSPaolo Bonzini { 6131016b239SPaolo Bonzini PCIDevice *pcid = PCI_DEVICE(s); 61449ab747fSPaolo Bonzini uint32_t pa_hi, pa_lo; 61596f8f23aSHannes Reinecke hwaddr iq_pa, initq_size = sizeof(struct mfi_init_qinfo); 61696f8f23aSHannes Reinecke struct mfi_init_qinfo *initq = NULL; 61749ab747fSPaolo Bonzini uint32_t flags; 61849ab747fSPaolo Bonzini int ret = MFI_STAT_OK; 61949ab747fSPaolo Bonzini 62096f8f23aSHannes Reinecke if (s->reply_queue_pa) { 62196f8f23aSHannes Reinecke trace_megasas_initq_mapped(s->reply_queue_pa); 62296f8f23aSHannes Reinecke goto out; 62396f8f23aSHannes Reinecke } 62449ab747fSPaolo Bonzini pa_lo = le32_to_cpu(cmd->frame->init.qinfo_new_addr_lo); 62549ab747fSPaolo Bonzini pa_hi = le32_to_cpu(cmd->frame->init.qinfo_new_addr_hi); 62649ab747fSPaolo Bonzini iq_pa = (((uint64_t) pa_hi << 32) | pa_lo); 62749ab747fSPaolo Bonzini trace_megasas_init_firmware((uint64_t)iq_pa); 6281016b239SPaolo Bonzini initq = pci_dma_map(pcid, iq_pa, &initq_size, 0); 62949ab747fSPaolo Bonzini if (!initq || initq_size != sizeof(*initq)) { 63049ab747fSPaolo Bonzini trace_megasas_initq_map_failed(cmd->index); 63149ab747fSPaolo Bonzini s->event_count++; 63249ab747fSPaolo Bonzini ret = MFI_STAT_MEMORY_NOT_AVAILABLE; 63349ab747fSPaolo Bonzini goto out; 63449ab747fSPaolo Bonzini } 63549ab747fSPaolo Bonzini s->reply_queue_len = le32_to_cpu(initq->rq_entries) & 0xFFFF; 63649ab747fSPaolo Bonzini if (s->reply_queue_len > s->fw_cmds) { 63749ab747fSPaolo Bonzini trace_megasas_initq_mismatch(s->reply_queue_len, s->fw_cmds); 63849ab747fSPaolo Bonzini s->event_count++; 63949ab747fSPaolo Bonzini ret = MFI_STAT_INVALID_PARAMETER; 64049ab747fSPaolo Bonzini goto out; 64149ab747fSPaolo Bonzini } 64249ab747fSPaolo Bonzini pa_lo = le32_to_cpu(initq->rq_addr_lo); 64349ab747fSPaolo Bonzini pa_hi = le32_to_cpu(initq->rq_addr_hi); 64449ab747fSPaolo Bonzini s->reply_queue_pa = ((uint64_t) pa_hi << 32) | pa_lo; 64549ab747fSPaolo Bonzini pa_lo = le32_to_cpu(initq->ci_addr_lo); 64649ab747fSPaolo Bonzini pa_hi = le32_to_cpu(initq->ci_addr_hi); 64749ab747fSPaolo Bonzini s->consumer_pa = ((uint64_t) pa_hi << 32) | pa_lo; 64849ab747fSPaolo Bonzini pa_lo = le32_to_cpu(initq->pi_addr_lo); 64949ab747fSPaolo Bonzini pa_hi = le32_to_cpu(initq->pi_addr_hi); 65049ab747fSPaolo Bonzini s->producer_pa = ((uint64_t) pa_hi << 32) | pa_lo; 65116578c6fSPaolo Bonzini s->reply_queue_head = ldl_le_pci_dma(pcid, s->producer_pa); 65216578c6fSPaolo Bonzini s->reply_queue_tail = ldl_le_pci_dma(pcid, s->consumer_pa); 65349ab747fSPaolo Bonzini flags = le32_to_cpu(initq->flags); 65449ab747fSPaolo Bonzini if (flags & MFI_QUEUE_FLAG_CONTEXT64) { 65549ab747fSPaolo Bonzini s->flags |= MEGASAS_MASK_USE_QUEUE64; 65649ab747fSPaolo Bonzini } 65749ab747fSPaolo Bonzini trace_megasas_init_queue((unsigned long)s->reply_queue_pa, 65849ab747fSPaolo Bonzini s->reply_queue_len, s->reply_queue_head, 65949ab747fSPaolo Bonzini s->reply_queue_tail, flags); 66049ab747fSPaolo Bonzini megasas_reset_frames(s); 66149ab747fSPaolo Bonzini s->fw_state = MFI_FWSTATE_OPERATIONAL; 66249ab747fSPaolo Bonzini out: 66349ab747fSPaolo Bonzini if (initq) { 6641016b239SPaolo Bonzini pci_dma_unmap(pcid, initq, initq_size, 0, 0); 66549ab747fSPaolo Bonzini } 66649ab747fSPaolo Bonzini return ret; 66749ab747fSPaolo Bonzini } 66849ab747fSPaolo Bonzini 66949ab747fSPaolo Bonzini static int megasas_map_dcmd(MegasasState *s, MegasasCmd *cmd) 67049ab747fSPaolo Bonzini { 67149ab747fSPaolo Bonzini dma_addr_t iov_pa, iov_size; 67249ab747fSPaolo Bonzini 67349ab747fSPaolo Bonzini cmd->flags = le16_to_cpu(cmd->frame->header.flags); 67449ab747fSPaolo Bonzini if (!cmd->frame->header.sge_count) { 67549ab747fSPaolo Bonzini trace_megasas_dcmd_zero_sge(cmd->index); 67649ab747fSPaolo Bonzini cmd->iov_size = 0; 67749ab747fSPaolo Bonzini return 0; 67849ab747fSPaolo Bonzini } else if (cmd->frame->header.sge_count > 1) { 67949ab747fSPaolo Bonzini trace_megasas_dcmd_invalid_sge(cmd->index, 68049ab747fSPaolo Bonzini cmd->frame->header.sge_count); 68149ab747fSPaolo Bonzini cmd->iov_size = 0; 68249ab747fSPaolo Bonzini return -1; 68349ab747fSPaolo Bonzini } 68449ab747fSPaolo Bonzini iov_pa = megasas_sgl_get_addr(cmd, &cmd->frame->dcmd.sgl); 68549ab747fSPaolo Bonzini iov_size = megasas_sgl_get_len(cmd, &cmd->frame->dcmd.sgl); 68652190c1eSAndreas Färber pci_dma_sglist_init(&cmd->qsg, PCI_DEVICE(s), 1); 68749ab747fSPaolo Bonzini qemu_sglist_add(&cmd->qsg, iov_pa, iov_size); 68849ab747fSPaolo Bonzini cmd->iov_size = iov_size; 68949ab747fSPaolo Bonzini return cmd->iov_size; 69049ab747fSPaolo Bonzini } 69149ab747fSPaolo Bonzini 69249ab747fSPaolo Bonzini static void megasas_finish_dcmd(MegasasCmd *cmd, uint32_t iov_size) 69349ab747fSPaolo Bonzini { 69449ab747fSPaolo Bonzini trace_megasas_finish_dcmd(cmd->index, iov_size); 69549ab747fSPaolo Bonzini 69649ab747fSPaolo Bonzini if (cmd->frame->header.sge_count) { 69749ab747fSPaolo Bonzini qemu_sglist_destroy(&cmd->qsg); 69849ab747fSPaolo Bonzini } 69949ab747fSPaolo Bonzini if (iov_size > cmd->iov_size) { 70049ab747fSPaolo Bonzini if (megasas_frame_is_ieee_sgl(cmd)) { 70149ab747fSPaolo Bonzini cmd->frame->dcmd.sgl.sg_skinny->len = cpu_to_le32(iov_size); 70249ab747fSPaolo Bonzini } else if (megasas_frame_is_sgl64(cmd)) { 70349ab747fSPaolo Bonzini cmd->frame->dcmd.sgl.sg64->len = cpu_to_le32(iov_size); 70449ab747fSPaolo Bonzini } else { 70549ab747fSPaolo Bonzini cmd->frame->dcmd.sgl.sg32->len = cpu_to_le32(iov_size); 70649ab747fSPaolo Bonzini } 70749ab747fSPaolo Bonzini } 70849ab747fSPaolo Bonzini cmd->iov_size = 0; 70949ab747fSPaolo Bonzini } 71049ab747fSPaolo Bonzini 71149ab747fSPaolo Bonzini static int megasas_ctrl_get_info(MegasasState *s, MegasasCmd *cmd) 71249ab747fSPaolo Bonzini { 71352190c1eSAndreas Färber PCIDevice *pci_dev = PCI_DEVICE(s); 714e23d0498SHannes Reinecke PCIDeviceClass *pci_class = PCI_DEVICE_GET_CLASS(pci_dev); 715e23d0498SHannes Reinecke MegasasBaseClass *base_class = MEGASAS_DEVICE_GET_CLASS(s); 71649ab747fSPaolo Bonzini struct mfi_ctrl_info info; 71749ab747fSPaolo Bonzini size_t dcmd_size = sizeof(info); 71849ab747fSPaolo Bonzini BusChild *kid; 7193f2cd4ddSHannes Reinecke int num_pd_disks = 0; 72049ab747fSPaolo Bonzini 72149ab747fSPaolo Bonzini memset(&info, 0x0, cmd->iov_size); 72249ab747fSPaolo Bonzini if (cmd->iov_size < dcmd_size) { 72349ab747fSPaolo Bonzini trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size, 72449ab747fSPaolo Bonzini dcmd_size); 72549ab747fSPaolo Bonzini return MFI_STAT_INVALID_PARAMETER; 72649ab747fSPaolo Bonzini } 72749ab747fSPaolo Bonzini 728e23d0498SHannes Reinecke info.pci.vendor = cpu_to_le16(pci_class->vendor_id); 729e23d0498SHannes Reinecke info.pci.device = cpu_to_le16(pci_class->device_id); 730e23d0498SHannes Reinecke info.pci.subvendor = cpu_to_le16(pci_class->subsystem_vendor_id); 731e23d0498SHannes Reinecke info.pci.subdevice = cpu_to_le16(pci_class->subsystem_id); 73249ab747fSPaolo Bonzini 73349ab747fSPaolo Bonzini /* 73449ab747fSPaolo Bonzini * For some reason the firmware supports 73549ab747fSPaolo Bonzini * only up to 8 device ports. 73649ab747fSPaolo Bonzini * Despite supporting a far larger number 73749ab747fSPaolo Bonzini * of devices for the physical devices. 73849ab747fSPaolo Bonzini * So just display the first 8 devices 73949ab747fSPaolo Bonzini * in the device port list, independent 74049ab747fSPaolo Bonzini * of how many logical devices are actually 74149ab747fSPaolo Bonzini * present. 74249ab747fSPaolo Bonzini */ 74349ab747fSPaolo Bonzini info.host.type = MFI_INFO_HOST_PCIE; 74449ab747fSPaolo Bonzini info.device.type = MFI_INFO_DEV_SAS3G; 74549ab747fSPaolo Bonzini info.device.port_count = 8; 74649ab747fSPaolo Bonzini QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) { 74749ab747fSPaolo Bonzini SCSIDevice *sdev = DO_UPCAST(SCSIDevice, qdev, kid->child); 7483f2cd4ddSHannes Reinecke uint16_t pd_id; 74949ab747fSPaolo Bonzini 7503f2cd4ddSHannes Reinecke if (num_pd_disks < 8) { 7513f2cd4ddSHannes Reinecke pd_id = ((sdev->id & 0xFF) << 8) | (sdev->lun & 0xFF); 7523f2cd4ddSHannes Reinecke info.device.port_addr[num_pd_disks] = 7533f2cd4ddSHannes Reinecke cpu_to_le64(megasas_get_sata_addr(pd_id)); 75449ab747fSPaolo Bonzini } 7553f2cd4ddSHannes Reinecke num_pd_disks++; 75649ab747fSPaolo Bonzini } 75749ab747fSPaolo Bonzini 758e23d0498SHannes Reinecke memcpy(info.product_name, base_class->product_name, 24); 75949ab747fSPaolo Bonzini snprintf(info.serial_number, 32, "%s", s->hba_serial); 76049ab747fSPaolo Bonzini snprintf(info.package_version, 0x60, "%s-QEMU", QEMU_VERSION); 76149ab747fSPaolo Bonzini memcpy(info.image_component[0].name, "APP", 3); 762e23d0498SHannes Reinecke snprintf(info.image_component[0].version, 10, "%s-QEMU", 763e23d0498SHannes Reinecke base_class->product_version); 7645a7733b0SOlaf Hering memcpy(info.image_component[0].build_date, "Apr 1 2014", 11); 7655a7733b0SOlaf Hering memcpy(info.image_component[0].build_time, "12:34:56", 8); 76649ab747fSPaolo Bonzini info.image_component_count = 1; 76752190c1eSAndreas Färber if (pci_dev->has_rom) { 76849ab747fSPaolo Bonzini uint8_t biosver[32]; 76949ab747fSPaolo Bonzini uint8_t *ptr; 77049ab747fSPaolo Bonzini 77152190c1eSAndreas Färber ptr = memory_region_get_ram_ptr(&pci_dev->rom); 77249ab747fSPaolo Bonzini memcpy(biosver, ptr + 0x41, 31); 77349ab747fSPaolo Bonzini memcpy(info.image_component[1].name, "BIOS", 4); 77449ab747fSPaolo Bonzini memcpy(info.image_component[1].version, biosver, 77549ab747fSPaolo Bonzini strlen((const char *)biosver)); 77649ab747fSPaolo Bonzini info.image_component_count++; 77749ab747fSPaolo Bonzini } 77849ab747fSPaolo Bonzini info.current_fw_time = cpu_to_le32(megasas_fw_time()); 77949ab747fSPaolo Bonzini info.max_arms = 32; 78049ab747fSPaolo Bonzini info.max_spans = 8; 78149ab747fSPaolo Bonzini info.max_arrays = MEGASAS_MAX_ARRAYS; 7823f2cd4ddSHannes Reinecke info.max_lds = MFI_MAX_LD; 78349ab747fSPaolo Bonzini info.max_cmds = cpu_to_le16(s->fw_cmds); 78449ab747fSPaolo Bonzini info.max_sg_elements = cpu_to_le16(s->fw_sge); 78549ab747fSPaolo Bonzini info.max_request_size = cpu_to_le32(MEGASAS_MAX_SECTORS); 7863f2cd4ddSHannes Reinecke if (!megasas_is_jbod(s)) 7873f2cd4ddSHannes Reinecke info.lds_present = cpu_to_le16(num_pd_disks); 7883f2cd4ddSHannes Reinecke info.pd_present = cpu_to_le16(num_pd_disks); 7893f2cd4ddSHannes Reinecke info.pd_disks_present = cpu_to_le16(num_pd_disks); 79049ab747fSPaolo Bonzini info.hw_present = cpu_to_le32(MFI_INFO_HW_NVRAM | 79149ab747fSPaolo Bonzini MFI_INFO_HW_MEM | 79249ab747fSPaolo Bonzini MFI_INFO_HW_FLASH); 79349ab747fSPaolo Bonzini info.memory_size = cpu_to_le16(512); 79449ab747fSPaolo Bonzini info.nvram_size = cpu_to_le16(32); 79549ab747fSPaolo Bonzini info.flash_size = cpu_to_le16(16); 79649ab747fSPaolo Bonzini info.raid_levels = cpu_to_le32(MFI_INFO_RAID_0); 79749ab747fSPaolo Bonzini info.adapter_ops = cpu_to_le32(MFI_INFO_AOPS_RBLD_RATE | 79849ab747fSPaolo Bonzini MFI_INFO_AOPS_SELF_DIAGNOSTIC | 79949ab747fSPaolo Bonzini MFI_INFO_AOPS_MIXED_ARRAY); 80049ab747fSPaolo Bonzini info.ld_ops = cpu_to_le32(MFI_INFO_LDOPS_DISK_CACHE_POLICY | 80149ab747fSPaolo Bonzini MFI_INFO_LDOPS_ACCESS_POLICY | 80249ab747fSPaolo Bonzini MFI_INFO_LDOPS_IO_POLICY | 80349ab747fSPaolo Bonzini MFI_INFO_LDOPS_WRITE_POLICY | 80449ab747fSPaolo Bonzini MFI_INFO_LDOPS_READ_POLICY); 80549ab747fSPaolo Bonzini info.max_strips_per_io = cpu_to_le16(s->fw_sge); 80649ab747fSPaolo Bonzini info.stripe_sz_ops.min = 3; 807*786a4ea8SStefan Hajnoczi info.stripe_sz_ops.max = ctz32(MEGASAS_MAX_SECTORS + 1); 80849ab747fSPaolo Bonzini info.properties.pred_fail_poll_interval = cpu_to_le16(300); 80949ab747fSPaolo Bonzini info.properties.intr_throttle_cnt = cpu_to_le16(16); 81049ab747fSPaolo Bonzini info.properties.intr_throttle_timeout = cpu_to_le16(50); 81149ab747fSPaolo Bonzini info.properties.rebuild_rate = 30; 81249ab747fSPaolo Bonzini info.properties.patrol_read_rate = 30; 81349ab747fSPaolo Bonzini info.properties.bgi_rate = 30; 81449ab747fSPaolo Bonzini info.properties.cc_rate = 30; 81549ab747fSPaolo Bonzini info.properties.recon_rate = 30; 81649ab747fSPaolo Bonzini info.properties.cache_flush_interval = 4; 81749ab747fSPaolo Bonzini info.properties.spinup_drv_cnt = 2; 81849ab747fSPaolo Bonzini info.properties.spinup_delay = 6; 81949ab747fSPaolo Bonzini info.properties.ecc_bucket_size = 15; 82049ab747fSPaolo Bonzini info.properties.ecc_bucket_leak_rate = cpu_to_le16(1440); 82149ab747fSPaolo Bonzini info.properties.expose_encl_devices = 1; 82249ab747fSPaolo Bonzini info.properties.OnOffProperties = cpu_to_le32(MFI_CTRL_PROP_EnableJBOD); 82349ab747fSPaolo Bonzini info.pd_ops = cpu_to_le32(MFI_INFO_PDOPS_FORCE_ONLINE | 82449ab747fSPaolo Bonzini MFI_INFO_PDOPS_FORCE_OFFLINE); 82549ab747fSPaolo Bonzini info.pd_mix_support = cpu_to_le32(MFI_INFO_PDMIX_SAS | 82649ab747fSPaolo Bonzini MFI_INFO_PDMIX_SATA | 82749ab747fSPaolo Bonzini MFI_INFO_PDMIX_LD); 82849ab747fSPaolo Bonzini 82949ab747fSPaolo Bonzini cmd->iov_size -= dma_buf_read((uint8_t *)&info, dcmd_size, &cmd->qsg); 83049ab747fSPaolo Bonzini return MFI_STAT_OK; 83149ab747fSPaolo Bonzini } 83249ab747fSPaolo Bonzini 83349ab747fSPaolo Bonzini static int megasas_mfc_get_defaults(MegasasState *s, MegasasCmd *cmd) 83449ab747fSPaolo Bonzini { 83549ab747fSPaolo Bonzini struct mfi_defaults info; 83649ab747fSPaolo Bonzini size_t dcmd_size = sizeof(struct mfi_defaults); 83749ab747fSPaolo Bonzini 83849ab747fSPaolo Bonzini memset(&info, 0x0, dcmd_size); 83949ab747fSPaolo Bonzini if (cmd->iov_size < dcmd_size) { 84049ab747fSPaolo Bonzini trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size, 84149ab747fSPaolo Bonzini dcmd_size); 84249ab747fSPaolo Bonzini return MFI_STAT_INVALID_PARAMETER; 84349ab747fSPaolo Bonzini } 84449ab747fSPaolo Bonzini 84549ab747fSPaolo Bonzini info.sas_addr = cpu_to_le64(s->sas_addr); 84649ab747fSPaolo Bonzini info.stripe_size = 3; 84749ab747fSPaolo Bonzini info.flush_time = 4; 84849ab747fSPaolo Bonzini info.background_rate = 30; 84949ab747fSPaolo Bonzini info.allow_mix_in_enclosure = 1; 85049ab747fSPaolo Bonzini info.allow_mix_in_ld = 1; 85149ab747fSPaolo Bonzini info.direct_pd_mapping = 1; 85249ab747fSPaolo Bonzini /* Enable for BIOS support */ 85349ab747fSPaolo Bonzini info.bios_enumerate_lds = 1; 85449ab747fSPaolo Bonzini info.disable_ctrl_r = 1; 85549ab747fSPaolo Bonzini info.expose_enclosure_devices = 1; 85649ab747fSPaolo Bonzini info.disable_preboot_cli = 1; 85749ab747fSPaolo Bonzini info.cluster_disable = 1; 85849ab747fSPaolo Bonzini 85949ab747fSPaolo Bonzini cmd->iov_size -= dma_buf_read((uint8_t *)&info, dcmd_size, &cmd->qsg); 86049ab747fSPaolo Bonzini return MFI_STAT_OK; 86149ab747fSPaolo Bonzini } 86249ab747fSPaolo Bonzini 86349ab747fSPaolo Bonzini static int megasas_dcmd_get_bios_info(MegasasState *s, MegasasCmd *cmd) 86449ab747fSPaolo Bonzini { 86549ab747fSPaolo Bonzini struct mfi_bios_data info; 86649ab747fSPaolo Bonzini size_t dcmd_size = sizeof(info); 86749ab747fSPaolo Bonzini 86849ab747fSPaolo Bonzini memset(&info, 0x0, dcmd_size); 86949ab747fSPaolo Bonzini if (cmd->iov_size < dcmd_size) { 87049ab747fSPaolo Bonzini trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size, 87149ab747fSPaolo Bonzini dcmd_size); 87249ab747fSPaolo Bonzini return MFI_STAT_INVALID_PARAMETER; 87349ab747fSPaolo Bonzini } 87449ab747fSPaolo Bonzini info.continue_on_error = 1; 87549ab747fSPaolo Bonzini info.verbose = 1; 87649ab747fSPaolo Bonzini if (megasas_is_jbod(s)) { 87749ab747fSPaolo Bonzini info.expose_all_drives = 1; 87849ab747fSPaolo Bonzini } 87949ab747fSPaolo Bonzini 88049ab747fSPaolo Bonzini cmd->iov_size -= dma_buf_read((uint8_t *)&info, dcmd_size, &cmd->qsg); 88149ab747fSPaolo Bonzini return MFI_STAT_OK; 88249ab747fSPaolo Bonzini } 88349ab747fSPaolo Bonzini 88449ab747fSPaolo Bonzini static int megasas_dcmd_get_fw_time(MegasasState *s, MegasasCmd *cmd) 88549ab747fSPaolo Bonzini { 88649ab747fSPaolo Bonzini uint64_t fw_time; 88749ab747fSPaolo Bonzini size_t dcmd_size = sizeof(fw_time); 88849ab747fSPaolo Bonzini 88949ab747fSPaolo Bonzini fw_time = cpu_to_le64(megasas_fw_time()); 89049ab747fSPaolo Bonzini 89149ab747fSPaolo Bonzini cmd->iov_size -= dma_buf_read((uint8_t *)&fw_time, dcmd_size, &cmd->qsg); 89249ab747fSPaolo Bonzini return MFI_STAT_OK; 89349ab747fSPaolo Bonzini } 89449ab747fSPaolo Bonzini 89549ab747fSPaolo Bonzini static int megasas_dcmd_set_fw_time(MegasasState *s, MegasasCmd *cmd) 89649ab747fSPaolo Bonzini { 89749ab747fSPaolo Bonzini uint64_t fw_time; 89849ab747fSPaolo Bonzini 89949ab747fSPaolo Bonzini /* This is a dummy; setting of firmware time is not allowed */ 90049ab747fSPaolo Bonzini memcpy(&fw_time, cmd->frame->dcmd.mbox, sizeof(fw_time)); 90149ab747fSPaolo Bonzini 90249ab747fSPaolo Bonzini trace_megasas_dcmd_set_fw_time(cmd->index, fw_time); 90349ab747fSPaolo Bonzini fw_time = cpu_to_le64(megasas_fw_time()); 90449ab747fSPaolo Bonzini return MFI_STAT_OK; 90549ab747fSPaolo Bonzini } 90649ab747fSPaolo Bonzini 90749ab747fSPaolo Bonzini static int megasas_event_info(MegasasState *s, MegasasCmd *cmd) 90849ab747fSPaolo Bonzini { 90949ab747fSPaolo Bonzini struct mfi_evt_log_state info; 91049ab747fSPaolo Bonzini size_t dcmd_size = sizeof(info); 91149ab747fSPaolo Bonzini 91249ab747fSPaolo Bonzini memset(&info, 0, dcmd_size); 91349ab747fSPaolo Bonzini 91449ab747fSPaolo Bonzini info.newest_seq_num = cpu_to_le32(s->event_count); 91549ab747fSPaolo Bonzini info.shutdown_seq_num = cpu_to_le32(s->shutdown_event); 91649ab747fSPaolo Bonzini info.boot_seq_num = cpu_to_le32(s->boot_event); 91749ab747fSPaolo Bonzini 91849ab747fSPaolo Bonzini cmd->iov_size -= dma_buf_read((uint8_t *)&info, dcmd_size, &cmd->qsg); 91949ab747fSPaolo Bonzini return MFI_STAT_OK; 92049ab747fSPaolo Bonzini } 92149ab747fSPaolo Bonzini 92249ab747fSPaolo Bonzini static int megasas_event_wait(MegasasState *s, MegasasCmd *cmd) 92349ab747fSPaolo Bonzini { 92449ab747fSPaolo Bonzini union mfi_evt event; 92549ab747fSPaolo Bonzini 92649ab747fSPaolo Bonzini if (cmd->iov_size < sizeof(struct mfi_evt_detail)) { 92749ab747fSPaolo Bonzini trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size, 92849ab747fSPaolo Bonzini sizeof(struct mfi_evt_detail)); 92949ab747fSPaolo Bonzini return MFI_STAT_INVALID_PARAMETER; 93049ab747fSPaolo Bonzini } 93149ab747fSPaolo Bonzini s->event_count = cpu_to_le32(cmd->frame->dcmd.mbox[0]); 93249ab747fSPaolo Bonzini event.word = cpu_to_le32(cmd->frame->dcmd.mbox[4]); 93349ab747fSPaolo Bonzini s->event_locale = event.members.locale; 93449ab747fSPaolo Bonzini s->event_class = event.members.class; 93549ab747fSPaolo Bonzini s->event_cmd = cmd; 93649ab747fSPaolo Bonzini /* Decrease busy count; event frame doesn't count here */ 93749ab747fSPaolo Bonzini s->busy--; 93849ab747fSPaolo Bonzini cmd->iov_size = sizeof(struct mfi_evt_detail); 93949ab747fSPaolo Bonzini return MFI_STAT_INVALID_STATUS; 94049ab747fSPaolo Bonzini } 94149ab747fSPaolo Bonzini 94249ab747fSPaolo Bonzini static int megasas_dcmd_pd_get_list(MegasasState *s, MegasasCmd *cmd) 94349ab747fSPaolo Bonzini { 94449ab747fSPaolo Bonzini struct mfi_pd_list info; 94549ab747fSPaolo Bonzini size_t dcmd_size = sizeof(info); 94649ab747fSPaolo Bonzini BusChild *kid; 94749ab747fSPaolo Bonzini uint32_t offset, dcmd_limit, num_pd_disks = 0, max_pd_disks; 94849ab747fSPaolo Bonzini 94949ab747fSPaolo Bonzini memset(&info, 0, dcmd_size); 95049ab747fSPaolo Bonzini offset = 8; 95149ab747fSPaolo Bonzini dcmd_limit = offset + sizeof(struct mfi_pd_address); 95249ab747fSPaolo Bonzini if (cmd->iov_size < dcmd_limit) { 95349ab747fSPaolo Bonzini trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size, 95449ab747fSPaolo Bonzini dcmd_limit); 95549ab747fSPaolo Bonzini return MFI_STAT_INVALID_PARAMETER; 95649ab747fSPaolo Bonzini } 95749ab747fSPaolo Bonzini 95849ab747fSPaolo Bonzini max_pd_disks = (cmd->iov_size - offset) / sizeof(struct mfi_pd_address); 9593f2cd4ddSHannes Reinecke if (max_pd_disks > MFI_MAX_SYS_PDS) { 9603f2cd4ddSHannes Reinecke max_pd_disks = MFI_MAX_SYS_PDS; 96149ab747fSPaolo Bonzini } 96249ab747fSPaolo Bonzini QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) { 96349ab747fSPaolo Bonzini SCSIDevice *sdev = DO_UPCAST(SCSIDevice, qdev, kid->child); 9643f2cd4ddSHannes Reinecke uint16_t pd_id; 96549ab747fSPaolo Bonzini 9663f2cd4ddSHannes Reinecke if (num_pd_disks >= max_pd_disks) 9673f2cd4ddSHannes Reinecke break; 9683f2cd4ddSHannes Reinecke 9693f2cd4ddSHannes Reinecke pd_id = ((sdev->id & 0xFF) << 8) | (sdev->lun & 0xFF); 9703f2cd4ddSHannes Reinecke info.addr[num_pd_disks].device_id = cpu_to_le16(pd_id); 97149ab747fSPaolo Bonzini info.addr[num_pd_disks].encl_device_id = 0xFFFF; 97249ab747fSPaolo Bonzini info.addr[num_pd_disks].encl_index = 0; 9733f2cd4ddSHannes Reinecke info.addr[num_pd_disks].slot_number = sdev->id & 0xFF; 97449ab747fSPaolo Bonzini info.addr[num_pd_disks].scsi_dev_type = sdev->type; 97549ab747fSPaolo Bonzini info.addr[num_pd_disks].connect_port_bitmap = 0x1; 97649ab747fSPaolo Bonzini info.addr[num_pd_disks].sas_addr[0] = 9773f2cd4ddSHannes Reinecke cpu_to_le64(megasas_get_sata_addr(pd_id)); 97849ab747fSPaolo Bonzini num_pd_disks++; 97949ab747fSPaolo Bonzini offset += sizeof(struct mfi_pd_address); 98049ab747fSPaolo Bonzini } 98149ab747fSPaolo Bonzini trace_megasas_dcmd_pd_get_list(cmd->index, num_pd_disks, 98249ab747fSPaolo Bonzini max_pd_disks, offset); 98349ab747fSPaolo Bonzini 98449ab747fSPaolo Bonzini info.size = cpu_to_le32(offset); 98549ab747fSPaolo Bonzini info.count = cpu_to_le32(num_pd_disks); 98649ab747fSPaolo Bonzini 98749ab747fSPaolo Bonzini cmd->iov_size -= dma_buf_read((uint8_t *)&info, offset, &cmd->qsg); 98849ab747fSPaolo Bonzini return MFI_STAT_OK; 98949ab747fSPaolo Bonzini } 99049ab747fSPaolo Bonzini 99149ab747fSPaolo Bonzini static int megasas_dcmd_pd_list_query(MegasasState *s, MegasasCmd *cmd) 99249ab747fSPaolo Bonzini { 99349ab747fSPaolo Bonzini uint16_t flags; 99449ab747fSPaolo Bonzini 99549ab747fSPaolo Bonzini /* mbox0 contains flags */ 99649ab747fSPaolo Bonzini flags = le16_to_cpu(cmd->frame->dcmd.mbox[0]); 99749ab747fSPaolo Bonzini trace_megasas_dcmd_pd_list_query(cmd->index, flags); 99849ab747fSPaolo Bonzini if (flags == MR_PD_QUERY_TYPE_ALL || 99949ab747fSPaolo Bonzini megasas_is_jbod(s)) { 100049ab747fSPaolo Bonzini return megasas_dcmd_pd_get_list(s, cmd); 100149ab747fSPaolo Bonzini } 100249ab747fSPaolo Bonzini 100349ab747fSPaolo Bonzini return MFI_STAT_OK; 100449ab747fSPaolo Bonzini } 100549ab747fSPaolo Bonzini 100649ab747fSPaolo Bonzini static int megasas_pd_get_info_submit(SCSIDevice *sdev, int lun, 100749ab747fSPaolo Bonzini MegasasCmd *cmd) 100849ab747fSPaolo Bonzini { 100949ab747fSPaolo Bonzini struct mfi_pd_info *info = cmd->iov_buf; 101049ab747fSPaolo Bonzini size_t dcmd_size = sizeof(struct mfi_pd_info); 101149ab747fSPaolo Bonzini uint64_t pd_size; 10123f2cd4ddSHannes Reinecke uint16_t pd_id = ((sdev->id & 0xFF) << 8) | (lun & 0xFF); 101349ab747fSPaolo Bonzini uint8_t cmdbuf[6]; 101449ab747fSPaolo Bonzini SCSIRequest *req; 101549ab747fSPaolo Bonzini size_t len, resid; 101649ab747fSPaolo Bonzini 101749ab747fSPaolo Bonzini if (!cmd->iov_buf) { 10180bd0adbeSMarkus Armbruster cmd->iov_buf = g_malloc0(dcmd_size); 101949ab747fSPaolo Bonzini info = cmd->iov_buf; 102049ab747fSPaolo Bonzini info->inquiry_data[0] = 0x7f; /* Force PQual 0x3, PType 0x1f */ 102149ab747fSPaolo Bonzini info->vpd_page83[0] = 0x7f; 102249ab747fSPaolo Bonzini megasas_setup_inquiry(cmdbuf, 0, sizeof(info->inquiry_data)); 102349ab747fSPaolo Bonzini req = scsi_req_new(sdev, cmd->index, lun, cmdbuf, cmd); 102449ab747fSPaolo Bonzini if (!req) { 102549ab747fSPaolo Bonzini trace_megasas_dcmd_req_alloc_failed(cmd->index, 102649ab747fSPaolo Bonzini "PD get info std inquiry"); 102749ab747fSPaolo Bonzini g_free(cmd->iov_buf); 102849ab747fSPaolo Bonzini cmd->iov_buf = NULL; 102949ab747fSPaolo Bonzini return MFI_STAT_FLASH_ALLOC_FAIL; 103049ab747fSPaolo Bonzini } 103149ab747fSPaolo Bonzini trace_megasas_dcmd_internal_submit(cmd->index, 103249ab747fSPaolo Bonzini "PD get info std inquiry", lun); 103349ab747fSPaolo Bonzini len = scsi_req_enqueue(req); 103449ab747fSPaolo Bonzini if (len > 0) { 103549ab747fSPaolo Bonzini cmd->iov_size = len; 103649ab747fSPaolo Bonzini scsi_req_continue(req); 103749ab747fSPaolo Bonzini } 103849ab747fSPaolo Bonzini return MFI_STAT_INVALID_STATUS; 103949ab747fSPaolo Bonzini } else if (info->inquiry_data[0] != 0x7f && info->vpd_page83[0] == 0x7f) { 104049ab747fSPaolo Bonzini megasas_setup_inquiry(cmdbuf, 0x83, sizeof(info->vpd_page83)); 104149ab747fSPaolo Bonzini req = scsi_req_new(sdev, cmd->index, lun, cmdbuf, cmd); 104249ab747fSPaolo Bonzini if (!req) { 104349ab747fSPaolo Bonzini trace_megasas_dcmd_req_alloc_failed(cmd->index, 104449ab747fSPaolo Bonzini "PD get info vpd inquiry"); 104549ab747fSPaolo Bonzini return MFI_STAT_FLASH_ALLOC_FAIL; 104649ab747fSPaolo Bonzini } 104749ab747fSPaolo Bonzini trace_megasas_dcmd_internal_submit(cmd->index, 104849ab747fSPaolo Bonzini "PD get info vpd inquiry", lun); 104949ab747fSPaolo Bonzini len = scsi_req_enqueue(req); 105049ab747fSPaolo Bonzini if (len > 0) { 105149ab747fSPaolo Bonzini cmd->iov_size = len; 105249ab747fSPaolo Bonzini scsi_req_continue(req); 105349ab747fSPaolo Bonzini } 105449ab747fSPaolo Bonzini return MFI_STAT_INVALID_STATUS; 105549ab747fSPaolo Bonzini } 105649ab747fSPaolo Bonzini /* Finished, set FW state */ 105749ab747fSPaolo Bonzini if ((info->inquiry_data[0] >> 5) == 0) { 105849ab747fSPaolo Bonzini if (megasas_is_jbod(cmd->state)) { 105949ab747fSPaolo Bonzini info->fw_state = cpu_to_le16(MFI_PD_STATE_SYSTEM); 106049ab747fSPaolo Bonzini } else { 106149ab747fSPaolo Bonzini info->fw_state = cpu_to_le16(MFI_PD_STATE_ONLINE); 106249ab747fSPaolo Bonzini } 106349ab747fSPaolo Bonzini } else { 106449ab747fSPaolo Bonzini info->fw_state = cpu_to_le16(MFI_PD_STATE_OFFLINE); 106549ab747fSPaolo Bonzini } 106649ab747fSPaolo Bonzini 10673f2cd4ddSHannes Reinecke info->ref.v.device_id = cpu_to_le16(pd_id); 106849ab747fSPaolo Bonzini info->state.ddf.pd_type = cpu_to_le16(MFI_PD_DDF_TYPE_IN_VD| 106949ab747fSPaolo Bonzini MFI_PD_DDF_TYPE_INTF_SAS); 10704be74634SMarkus Armbruster blk_get_geometry(sdev->conf.blk, &pd_size); 107149ab747fSPaolo Bonzini info->raw_size = cpu_to_le64(pd_size); 107249ab747fSPaolo Bonzini info->non_coerced_size = cpu_to_le64(pd_size); 107349ab747fSPaolo Bonzini info->coerced_size = cpu_to_le64(pd_size); 107449ab747fSPaolo Bonzini info->encl_device_id = 0xFFFF; 107549ab747fSPaolo Bonzini info->slot_number = (sdev->id & 0xFF); 107649ab747fSPaolo Bonzini info->path_info.count = 1; 107749ab747fSPaolo Bonzini info->path_info.sas_addr[0] = 10783f2cd4ddSHannes Reinecke cpu_to_le64(megasas_get_sata_addr(pd_id)); 107949ab747fSPaolo Bonzini info->connected_port_bitmap = 0x1; 108049ab747fSPaolo Bonzini info->device_speed = 1; 108149ab747fSPaolo Bonzini info->link_speed = 1; 108249ab747fSPaolo Bonzini resid = dma_buf_read(cmd->iov_buf, dcmd_size, &cmd->qsg); 108349ab747fSPaolo Bonzini g_free(cmd->iov_buf); 108449ab747fSPaolo Bonzini cmd->iov_size = dcmd_size - resid; 108549ab747fSPaolo Bonzini cmd->iov_buf = NULL; 108649ab747fSPaolo Bonzini return MFI_STAT_OK; 108749ab747fSPaolo Bonzini } 108849ab747fSPaolo Bonzini 108949ab747fSPaolo Bonzini static int megasas_dcmd_pd_get_info(MegasasState *s, MegasasCmd *cmd) 109049ab747fSPaolo Bonzini { 109149ab747fSPaolo Bonzini size_t dcmd_size = sizeof(struct mfi_pd_info); 109249ab747fSPaolo Bonzini uint16_t pd_id; 10933f2cd4ddSHannes Reinecke uint8_t target_id, lun_id; 109449ab747fSPaolo Bonzini SCSIDevice *sdev = NULL; 109549ab747fSPaolo Bonzini int retval = MFI_STAT_DEVICE_NOT_FOUND; 109649ab747fSPaolo Bonzini 109749ab747fSPaolo Bonzini if (cmd->iov_size < dcmd_size) { 109849ab747fSPaolo Bonzini return MFI_STAT_INVALID_PARAMETER; 109949ab747fSPaolo Bonzini } 110049ab747fSPaolo Bonzini 110149ab747fSPaolo Bonzini /* mbox0 has the ID */ 110249ab747fSPaolo Bonzini pd_id = le16_to_cpu(cmd->frame->dcmd.mbox[0]); 11033f2cd4ddSHannes Reinecke target_id = (pd_id >> 8) & 0xFF; 11043f2cd4ddSHannes Reinecke lun_id = pd_id & 0xFF; 11053f2cd4ddSHannes Reinecke sdev = scsi_device_find(&s->bus, 0, target_id, lun_id); 110649ab747fSPaolo Bonzini trace_megasas_dcmd_pd_get_info(cmd->index, pd_id); 110749ab747fSPaolo Bonzini 110849ab747fSPaolo Bonzini if (sdev) { 110949ab747fSPaolo Bonzini /* Submit inquiry */ 111049ab747fSPaolo Bonzini retval = megasas_pd_get_info_submit(sdev, pd_id, cmd); 111149ab747fSPaolo Bonzini } 111249ab747fSPaolo Bonzini 111349ab747fSPaolo Bonzini return retval; 111449ab747fSPaolo Bonzini } 111549ab747fSPaolo Bonzini 111649ab747fSPaolo Bonzini static int megasas_dcmd_ld_get_list(MegasasState *s, MegasasCmd *cmd) 111749ab747fSPaolo Bonzini { 111849ab747fSPaolo Bonzini struct mfi_ld_list info; 111949ab747fSPaolo Bonzini size_t dcmd_size = sizeof(info), resid; 11203f2cd4ddSHannes Reinecke uint32_t num_ld_disks = 0, max_ld_disks; 112149ab747fSPaolo Bonzini uint64_t ld_size; 112249ab747fSPaolo Bonzini BusChild *kid; 112349ab747fSPaolo Bonzini 112449ab747fSPaolo Bonzini memset(&info, 0, dcmd_size); 1125e74a4315SHannes Reinecke if (cmd->iov_size > dcmd_size) { 112649ab747fSPaolo Bonzini trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size, 112749ab747fSPaolo Bonzini dcmd_size); 112849ab747fSPaolo Bonzini return MFI_STAT_INVALID_PARAMETER; 112949ab747fSPaolo Bonzini } 113049ab747fSPaolo Bonzini 11313f2cd4ddSHannes Reinecke max_ld_disks = (cmd->iov_size - 8) / 16; 113249ab747fSPaolo Bonzini if (megasas_is_jbod(s)) { 113349ab747fSPaolo Bonzini max_ld_disks = 0; 113449ab747fSPaolo Bonzini } 11353f2cd4ddSHannes Reinecke if (max_ld_disks > MFI_MAX_LD) { 11363f2cd4ddSHannes Reinecke max_ld_disks = MFI_MAX_LD; 11373f2cd4ddSHannes Reinecke } 113849ab747fSPaolo Bonzini QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) { 113949ab747fSPaolo Bonzini SCSIDevice *sdev = DO_UPCAST(SCSIDevice, qdev, kid->child); 114049ab747fSPaolo Bonzini 114149ab747fSPaolo Bonzini if (num_ld_disks >= max_ld_disks) { 114249ab747fSPaolo Bonzini break; 114349ab747fSPaolo Bonzini } 114449ab747fSPaolo Bonzini /* Logical device size is in blocks */ 11454be74634SMarkus Armbruster blk_get_geometry(sdev->conf.blk, &ld_size); 114649ab747fSPaolo Bonzini info.ld_list[num_ld_disks].ld.v.target_id = sdev->id; 114749ab747fSPaolo Bonzini info.ld_list[num_ld_disks].state = MFI_LD_STATE_OPTIMAL; 114849ab747fSPaolo Bonzini info.ld_list[num_ld_disks].size = cpu_to_le64(ld_size); 114949ab747fSPaolo Bonzini num_ld_disks++; 115049ab747fSPaolo Bonzini } 115149ab747fSPaolo Bonzini info.ld_count = cpu_to_le32(num_ld_disks); 115249ab747fSPaolo Bonzini trace_megasas_dcmd_ld_get_list(cmd->index, num_ld_disks, max_ld_disks); 115349ab747fSPaolo Bonzini 115449ab747fSPaolo Bonzini resid = dma_buf_read((uint8_t *)&info, dcmd_size, &cmd->qsg); 115549ab747fSPaolo Bonzini cmd->iov_size = dcmd_size - resid; 115649ab747fSPaolo Bonzini return MFI_STAT_OK; 115749ab747fSPaolo Bonzini } 115849ab747fSPaolo Bonzini 115934bb4d02SHannes Reinecke static int megasas_dcmd_ld_list_query(MegasasState *s, MegasasCmd *cmd) 116034bb4d02SHannes Reinecke { 116134bb4d02SHannes Reinecke uint16_t flags; 1162d97ae368SHannes Reinecke struct mfi_ld_targetid_list info; 1163d97ae368SHannes Reinecke size_t dcmd_size = sizeof(info), resid; 1164d97ae368SHannes Reinecke uint32_t num_ld_disks = 0, max_ld_disks = s->fw_luns; 1165d97ae368SHannes Reinecke BusChild *kid; 116634bb4d02SHannes Reinecke 116734bb4d02SHannes Reinecke /* mbox0 contains flags */ 116834bb4d02SHannes Reinecke flags = le16_to_cpu(cmd->frame->dcmd.mbox[0]); 116934bb4d02SHannes Reinecke trace_megasas_dcmd_ld_list_query(cmd->index, flags); 1170d97ae368SHannes Reinecke if (flags != MR_LD_QUERY_TYPE_ALL && 1171d97ae368SHannes Reinecke flags != MR_LD_QUERY_TYPE_EXPOSED_TO_HOST) { 1172d97ae368SHannes Reinecke max_ld_disks = 0; 117334bb4d02SHannes Reinecke } 117434bb4d02SHannes Reinecke 1175d97ae368SHannes Reinecke memset(&info, 0, dcmd_size); 1176d97ae368SHannes Reinecke if (cmd->iov_size < 12) { 1177d97ae368SHannes Reinecke trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size, 1178d97ae368SHannes Reinecke dcmd_size); 1179d97ae368SHannes Reinecke return MFI_STAT_INVALID_PARAMETER; 1180d97ae368SHannes Reinecke } 1181d97ae368SHannes Reinecke dcmd_size = sizeof(uint32_t) * 2 + 3; 11823f2cd4ddSHannes Reinecke max_ld_disks = cmd->iov_size - dcmd_size; 1183d97ae368SHannes Reinecke if (megasas_is_jbod(s)) { 1184d97ae368SHannes Reinecke max_ld_disks = 0; 1185d97ae368SHannes Reinecke } 11863f2cd4ddSHannes Reinecke if (max_ld_disks > MFI_MAX_LD) { 11873f2cd4ddSHannes Reinecke max_ld_disks = MFI_MAX_LD; 11883f2cd4ddSHannes Reinecke } 1189d97ae368SHannes Reinecke QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) { 1190d97ae368SHannes Reinecke SCSIDevice *sdev = DO_UPCAST(SCSIDevice, qdev, kid->child); 1191d97ae368SHannes Reinecke 1192d97ae368SHannes Reinecke if (num_ld_disks >= max_ld_disks) { 1193d97ae368SHannes Reinecke break; 1194d97ae368SHannes Reinecke } 1195d97ae368SHannes Reinecke info.targetid[num_ld_disks] = sdev->lun; 1196d97ae368SHannes Reinecke num_ld_disks++; 1197d97ae368SHannes Reinecke dcmd_size++; 1198d97ae368SHannes Reinecke } 1199d97ae368SHannes Reinecke info.ld_count = cpu_to_le32(num_ld_disks); 1200d97ae368SHannes Reinecke info.size = dcmd_size; 1201d97ae368SHannes Reinecke trace_megasas_dcmd_ld_get_list(cmd->index, num_ld_disks, max_ld_disks); 1202d97ae368SHannes Reinecke 1203d97ae368SHannes Reinecke resid = dma_buf_read((uint8_t *)&info, dcmd_size, &cmd->qsg); 1204d97ae368SHannes Reinecke cmd->iov_size = dcmd_size - resid; 120534bb4d02SHannes Reinecke return MFI_STAT_OK; 120634bb4d02SHannes Reinecke } 120734bb4d02SHannes Reinecke 120849ab747fSPaolo Bonzini static int megasas_ld_get_info_submit(SCSIDevice *sdev, int lun, 120949ab747fSPaolo Bonzini MegasasCmd *cmd) 121049ab747fSPaolo Bonzini { 121149ab747fSPaolo Bonzini struct mfi_ld_info *info = cmd->iov_buf; 121249ab747fSPaolo Bonzini size_t dcmd_size = sizeof(struct mfi_ld_info); 121349ab747fSPaolo Bonzini uint8_t cdb[6]; 121449ab747fSPaolo Bonzini SCSIRequest *req; 121549ab747fSPaolo Bonzini ssize_t len, resid; 12163f2cd4ddSHannes Reinecke uint16_t sdev_id = ((sdev->id & 0xFF) << 8) | (lun & 0xFF); 121749ab747fSPaolo Bonzini uint64_t ld_size; 121849ab747fSPaolo Bonzini 121949ab747fSPaolo Bonzini if (!cmd->iov_buf) { 12200bd0adbeSMarkus Armbruster cmd->iov_buf = g_malloc0(dcmd_size); 122149ab747fSPaolo Bonzini info = cmd->iov_buf; 122249ab747fSPaolo Bonzini megasas_setup_inquiry(cdb, 0x83, sizeof(info->vpd_page83)); 122349ab747fSPaolo Bonzini req = scsi_req_new(sdev, cmd->index, lun, cdb, cmd); 122449ab747fSPaolo Bonzini if (!req) { 122549ab747fSPaolo Bonzini trace_megasas_dcmd_req_alloc_failed(cmd->index, 122649ab747fSPaolo Bonzini "LD get info vpd inquiry"); 122749ab747fSPaolo Bonzini g_free(cmd->iov_buf); 122849ab747fSPaolo Bonzini cmd->iov_buf = NULL; 122949ab747fSPaolo Bonzini return MFI_STAT_FLASH_ALLOC_FAIL; 123049ab747fSPaolo Bonzini } 123149ab747fSPaolo Bonzini trace_megasas_dcmd_internal_submit(cmd->index, 123249ab747fSPaolo Bonzini "LD get info vpd inquiry", lun); 123349ab747fSPaolo Bonzini len = scsi_req_enqueue(req); 123449ab747fSPaolo Bonzini if (len > 0) { 123549ab747fSPaolo Bonzini cmd->iov_size = len; 123649ab747fSPaolo Bonzini scsi_req_continue(req); 123749ab747fSPaolo Bonzini } 123849ab747fSPaolo Bonzini return MFI_STAT_INVALID_STATUS; 123949ab747fSPaolo Bonzini } 124049ab747fSPaolo Bonzini 124149ab747fSPaolo Bonzini info->ld_config.params.state = MFI_LD_STATE_OPTIMAL; 124249ab747fSPaolo Bonzini info->ld_config.properties.ld.v.target_id = lun; 124349ab747fSPaolo Bonzini info->ld_config.params.stripe_size = 3; 124449ab747fSPaolo Bonzini info->ld_config.params.num_drives = 1; 124549ab747fSPaolo Bonzini info->ld_config.params.is_consistent = 1; 124649ab747fSPaolo Bonzini /* Logical device size is in blocks */ 12474be74634SMarkus Armbruster blk_get_geometry(sdev->conf.blk, &ld_size); 124849ab747fSPaolo Bonzini info->size = cpu_to_le64(ld_size); 124949ab747fSPaolo Bonzini memset(info->ld_config.span, 0, sizeof(info->ld_config.span)); 125049ab747fSPaolo Bonzini info->ld_config.span[0].start_block = 0; 125149ab747fSPaolo Bonzini info->ld_config.span[0].num_blocks = info->size; 125249ab747fSPaolo Bonzini info->ld_config.span[0].array_ref = cpu_to_le16(sdev_id); 125349ab747fSPaolo Bonzini 125449ab747fSPaolo Bonzini resid = dma_buf_read(cmd->iov_buf, dcmd_size, &cmd->qsg); 125549ab747fSPaolo Bonzini g_free(cmd->iov_buf); 125649ab747fSPaolo Bonzini cmd->iov_size = dcmd_size - resid; 125749ab747fSPaolo Bonzini cmd->iov_buf = NULL; 125849ab747fSPaolo Bonzini return MFI_STAT_OK; 125949ab747fSPaolo Bonzini } 126049ab747fSPaolo Bonzini 126149ab747fSPaolo Bonzini static int megasas_dcmd_ld_get_info(MegasasState *s, MegasasCmd *cmd) 126249ab747fSPaolo Bonzini { 126349ab747fSPaolo Bonzini struct mfi_ld_info info; 126449ab747fSPaolo Bonzini size_t dcmd_size = sizeof(info); 126549ab747fSPaolo Bonzini uint16_t ld_id; 126649ab747fSPaolo Bonzini uint32_t max_ld_disks = s->fw_luns; 126749ab747fSPaolo Bonzini SCSIDevice *sdev = NULL; 126849ab747fSPaolo Bonzini int retval = MFI_STAT_DEVICE_NOT_FOUND; 126949ab747fSPaolo Bonzini 127049ab747fSPaolo Bonzini if (cmd->iov_size < dcmd_size) { 127149ab747fSPaolo Bonzini return MFI_STAT_INVALID_PARAMETER; 127249ab747fSPaolo Bonzini } 127349ab747fSPaolo Bonzini 127449ab747fSPaolo Bonzini /* mbox0 has the ID */ 127549ab747fSPaolo Bonzini ld_id = le16_to_cpu(cmd->frame->dcmd.mbox[0]); 127649ab747fSPaolo Bonzini trace_megasas_dcmd_ld_get_info(cmd->index, ld_id); 127749ab747fSPaolo Bonzini 127849ab747fSPaolo Bonzini if (megasas_is_jbod(s)) { 127949ab747fSPaolo Bonzini return MFI_STAT_DEVICE_NOT_FOUND; 128049ab747fSPaolo Bonzini } 128149ab747fSPaolo Bonzini 128249ab747fSPaolo Bonzini if (ld_id < max_ld_disks) { 128349ab747fSPaolo Bonzini sdev = scsi_device_find(&s->bus, 0, ld_id, 0); 128449ab747fSPaolo Bonzini } 128549ab747fSPaolo Bonzini 128649ab747fSPaolo Bonzini if (sdev) { 128749ab747fSPaolo Bonzini retval = megasas_ld_get_info_submit(sdev, ld_id, cmd); 128849ab747fSPaolo Bonzini } 128949ab747fSPaolo Bonzini 129049ab747fSPaolo Bonzini return retval; 129149ab747fSPaolo Bonzini } 129249ab747fSPaolo Bonzini 129349ab747fSPaolo Bonzini static int megasas_dcmd_cfg_read(MegasasState *s, MegasasCmd *cmd) 129449ab747fSPaolo Bonzini { 129549ab747fSPaolo Bonzini uint8_t data[4096]; 129649ab747fSPaolo Bonzini struct mfi_config_data *info; 129749ab747fSPaolo Bonzini int num_pd_disks = 0, array_offset, ld_offset; 129849ab747fSPaolo Bonzini BusChild *kid; 129949ab747fSPaolo Bonzini 130049ab747fSPaolo Bonzini if (cmd->iov_size > 4096) { 130149ab747fSPaolo Bonzini return MFI_STAT_INVALID_PARAMETER; 130249ab747fSPaolo Bonzini } 130349ab747fSPaolo Bonzini 130449ab747fSPaolo Bonzini QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) { 130549ab747fSPaolo Bonzini num_pd_disks++; 130649ab747fSPaolo Bonzini } 130749ab747fSPaolo Bonzini info = (struct mfi_config_data *)&data; 130849ab747fSPaolo Bonzini /* 130949ab747fSPaolo Bonzini * Array mapping: 131049ab747fSPaolo Bonzini * - One array per SCSI device 131149ab747fSPaolo Bonzini * - One logical drive per SCSI device 131249ab747fSPaolo Bonzini * spanning the entire device 131349ab747fSPaolo Bonzini */ 131449ab747fSPaolo Bonzini info->array_count = num_pd_disks; 131549ab747fSPaolo Bonzini info->array_size = sizeof(struct mfi_array) * num_pd_disks; 131649ab747fSPaolo Bonzini info->log_drv_count = num_pd_disks; 131749ab747fSPaolo Bonzini info->log_drv_size = sizeof(struct mfi_ld_config) * num_pd_disks; 131849ab747fSPaolo Bonzini info->spares_count = 0; 131949ab747fSPaolo Bonzini info->spares_size = sizeof(struct mfi_spare); 132049ab747fSPaolo Bonzini info->size = sizeof(struct mfi_config_data) + info->array_size + 132149ab747fSPaolo Bonzini info->log_drv_size; 132249ab747fSPaolo Bonzini if (info->size > 4096) { 132349ab747fSPaolo Bonzini return MFI_STAT_INVALID_PARAMETER; 132449ab747fSPaolo Bonzini } 132549ab747fSPaolo Bonzini 132649ab747fSPaolo Bonzini array_offset = sizeof(struct mfi_config_data); 132749ab747fSPaolo Bonzini ld_offset = array_offset + sizeof(struct mfi_array) * num_pd_disks; 132849ab747fSPaolo Bonzini 132949ab747fSPaolo Bonzini QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) { 133049ab747fSPaolo Bonzini SCSIDevice *sdev = DO_UPCAST(SCSIDevice, qdev, kid->child); 13313f2cd4ddSHannes Reinecke uint16_t sdev_id = ((sdev->id & 0xFF) << 8) | (sdev->lun & 0xFF); 133249ab747fSPaolo Bonzini struct mfi_array *array; 133349ab747fSPaolo Bonzini struct mfi_ld_config *ld; 133449ab747fSPaolo Bonzini uint64_t pd_size; 133549ab747fSPaolo Bonzini int i; 133649ab747fSPaolo Bonzini 133749ab747fSPaolo Bonzini array = (struct mfi_array *)(data + array_offset); 13384be74634SMarkus Armbruster blk_get_geometry(sdev->conf.blk, &pd_size); 133949ab747fSPaolo Bonzini array->size = cpu_to_le64(pd_size); 134049ab747fSPaolo Bonzini array->num_drives = 1; 134149ab747fSPaolo Bonzini array->array_ref = cpu_to_le16(sdev_id); 134249ab747fSPaolo Bonzini array->pd[0].ref.v.device_id = cpu_to_le16(sdev_id); 134349ab747fSPaolo Bonzini array->pd[0].ref.v.seq_num = 0; 134449ab747fSPaolo Bonzini array->pd[0].fw_state = MFI_PD_STATE_ONLINE; 134549ab747fSPaolo Bonzini array->pd[0].encl.pd = 0xFF; 134649ab747fSPaolo Bonzini array->pd[0].encl.slot = (sdev->id & 0xFF); 134749ab747fSPaolo Bonzini for (i = 1; i < MFI_MAX_ROW_SIZE; i++) { 134849ab747fSPaolo Bonzini array->pd[i].ref.v.device_id = 0xFFFF; 134949ab747fSPaolo Bonzini array->pd[i].ref.v.seq_num = 0; 135049ab747fSPaolo Bonzini array->pd[i].fw_state = MFI_PD_STATE_UNCONFIGURED_GOOD; 135149ab747fSPaolo Bonzini array->pd[i].encl.pd = 0xFF; 135249ab747fSPaolo Bonzini array->pd[i].encl.slot = 0xFF; 135349ab747fSPaolo Bonzini } 135449ab747fSPaolo Bonzini array_offset += sizeof(struct mfi_array); 135549ab747fSPaolo Bonzini ld = (struct mfi_ld_config *)(data + ld_offset); 135649ab747fSPaolo Bonzini memset(ld, 0, sizeof(struct mfi_ld_config)); 13573f2cd4ddSHannes Reinecke ld->properties.ld.v.target_id = sdev->id; 135849ab747fSPaolo Bonzini ld->properties.default_cache_policy = MR_LD_CACHE_READ_AHEAD | 135949ab747fSPaolo Bonzini MR_LD_CACHE_READ_ADAPTIVE; 136049ab747fSPaolo Bonzini ld->properties.current_cache_policy = MR_LD_CACHE_READ_AHEAD | 136149ab747fSPaolo Bonzini MR_LD_CACHE_READ_ADAPTIVE; 136249ab747fSPaolo Bonzini ld->params.state = MFI_LD_STATE_OPTIMAL; 136349ab747fSPaolo Bonzini ld->params.stripe_size = 3; 136449ab747fSPaolo Bonzini ld->params.num_drives = 1; 136549ab747fSPaolo Bonzini ld->params.span_depth = 1; 136649ab747fSPaolo Bonzini ld->params.is_consistent = 1; 136749ab747fSPaolo Bonzini ld->span[0].start_block = 0; 136849ab747fSPaolo Bonzini ld->span[0].num_blocks = cpu_to_le64(pd_size); 136949ab747fSPaolo Bonzini ld->span[0].array_ref = cpu_to_le16(sdev_id); 137049ab747fSPaolo Bonzini ld_offset += sizeof(struct mfi_ld_config); 137149ab747fSPaolo Bonzini } 137249ab747fSPaolo Bonzini 137349ab747fSPaolo Bonzini cmd->iov_size -= dma_buf_read((uint8_t *)data, info->size, &cmd->qsg); 137449ab747fSPaolo Bonzini return MFI_STAT_OK; 137549ab747fSPaolo Bonzini } 137649ab747fSPaolo Bonzini 137749ab747fSPaolo Bonzini static int megasas_dcmd_get_properties(MegasasState *s, MegasasCmd *cmd) 137849ab747fSPaolo Bonzini { 137949ab747fSPaolo Bonzini struct mfi_ctrl_props info; 138049ab747fSPaolo Bonzini size_t dcmd_size = sizeof(info); 138149ab747fSPaolo Bonzini 138249ab747fSPaolo Bonzini memset(&info, 0x0, dcmd_size); 138349ab747fSPaolo Bonzini if (cmd->iov_size < dcmd_size) { 138449ab747fSPaolo Bonzini trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size, 138549ab747fSPaolo Bonzini dcmd_size); 138649ab747fSPaolo Bonzini return MFI_STAT_INVALID_PARAMETER; 138749ab747fSPaolo Bonzini } 138849ab747fSPaolo Bonzini info.pred_fail_poll_interval = cpu_to_le16(300); 138949ab747fSPaolo Bonzini info.intr_throttle_cnt = cpu_to_le16(16); 139049ab747fSPaolo Bonzini info.intr_throttle_timeout = cpu_to_le16(50); 139149ab747fSPaolo Bonzini info.rebuild_rate = 30; 139249ab747fSPaolo Bonzini info.patrol_read_rate = 30; 139349ab747fSPaolo Bonzini info.bgi_rate = 30; 139449ab747fSPaolo Bonzini info.cc_rate = 30; 139549ab747fSPaolo Bonzini info.recon_rate = 30; 139649ab747fSPaolo Bonzini info.cache_flush_interval = 4; 139749ab747fSPaolo Bonzini info.spinup_drv_cnt = 2; 139849ab747fSPaolo Bonzini info.spinup_delay = 6; 139949ab747fSPaolo Bonzini info.ecc_bucket_size = 15; 140049ab747fSPaolo Bonzini info.ecc_bucket_leak_rate = cpu_to_le16(1440); 140149ab747fSPaolo Bonzini info.expose_encl_devices = 1; 140249ab747fSPaolo Bonzini 140349ab747fSPaolo Bonzini cmd->iov_size -= dma_buf_read((uint8_t *)&info, dcmd_size, &cmd->qsg); 140449ab747fSPaolo Bonzini return MFI_STAT_OK; 140549ab747fSPaolo Bonzini } 140649ab747fSPaolo Bonzini 140749ab747fSPaolo Bonzini static int megasas_cache_flush(MegasasState *s, MegasasCmd *cmd) 140849ab747fSPaolo Bonzini { 14094be74634SMarkus Armbruster blk_drain_all(); 141049ab747fSPaolo Bonzini return MFI_STAT_OK; 141149ab747fSPaolo Bonzini } 141249ab747fSPaolo Bonzini 141349ab747fSPaolo Bonzini static int megasas_ctrl_shutdown(MegasasState *s, MegasasCmd *cmd) 141449ab747fSPaolo Bonzini { 141549ab747fSPaolo Bonzini s->fw_state = MFI_FWSTATE_READY; 141649ab747fSPaolo Bonzini return MFI_STAT_OK; 141749ab747fSPaolo Bonzini } 141849ab747fSPaolo Bonzini 1419200b6966SHannes Reinecke /* Some implementations use CLUSTER RESET LD to simulate a device reset */ 142049ab747fSPaolo Bonzini static int megasas_cluster_reset_ld(MegasasState *s, MegasasCmd *cmd) 142149ab747fSPaolo Bonzini { 1422200b6966SHannes Reinecke uint16_t target_id; 1423200b6966SHannes Reinecke int i; 1424200b6966SHannes Reinecke 1425200b6966SHannes Reinecke /* mbox0 contains the device index */ 1426200b6966SHannes Reinecke target_id = le16_to_cpu(cmd->frame->dcmd.mbox[0]); 1427200b6966SHannes Reinecke trace_megasas_dcmd_reset_ld(cmd->index, target_id); 1428200b6966SHannes Reinecke for (i = 0; i < s->fw_cmds; i++) { 1429200b6966SHannes Reinecke MegasasCmd *tmp_cmd = &s->frames[i]; 1430200b6966SHannes Reinecke if (tmp_cmd->req && tmp_cmd->req->dev->id == target_id) { 1431200b6966SHannes Reinecke SCSIDevice *d = tmp_cmd->req->dev; 1432200b6966SHannes Reinecke qdev_reset_all(&d->qdev); 1433200b6966SHannes Reinecke } 1434200b6966SHannes Reinecke } 1435200b6966SHannes Reinecke return MFI_STAT_OK; 143649ab747fSPaolo Bonzini } 143749ab747fSPaolo Bonzini 143849ab747fSPaolo Bonzini static int megasas_dcmd_set_properties(MegasasState *s, MegasasCmd *cmd) 143949ab747fSPaolo Bonzini { 144049ab747fSPaolo Bonzini struct mfi_ctrl_props info; 144149ab747fSPaolo Bonzini size_t dcmd_size = sizeof(info); 144249ab747fSPaolo Bonzini 144349ab747fSPaolo Bonzini if (cmd->iov_size < dcmd_size) { 144449ab747fSPaolo Bonzini trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size, 144549ab747fSPaolo Bonzini dcmd_size); 144649ab747fSPaolo Bonzini return MFI_STAT_INVALID_PARAMETER; 144749ab747fSPaolo Bonzini } 144849ab747fSPaolo Bonzini dma_buf_write((uint8_t *)&info, cmd->iov_size, &cmd->qsg); 144949ab747fSPaolo Bonzini trace_megasas_dcmd_unsupported(cmd->index, cmd->iov_size); 145049ab747fSPaolo Bonzini return MFI_STAT_OK; 145149ab747fSPaolo Bonzini } 145249ab747fSPaolo Bonzini 145349ab747fSPaolo Bonzini static int megasas_dcmd_dummy(MegasasState *s, MegasasCmd *cmd) 145449ab747fSPaolo Bonzini { 145549ab747fSPaolo Bonzini trace_megasas_dcmd_dummy(cmd->index, cmd->iov_size); 145649ab747fSPaolo Bonzini return MFI_STAT_OK; 145749ab747fSPaolo Bonzini } 145849ab747fSPaolo Bonzini 145949ab747fSPaolo Bonzini static const struct dcmd_cmd_tbl_t { 146049ab747fSPaolo Bonzini int opcode; 146149ab747fSPaolo Bonzini const char *desc; 146249ab747fSPaolo Bonzini int (*func)(MegasasState *s, MegasasCmd *cmd); 146349ab747fSPaolo Bonzini } dcmd_cmd_tbl[] = { 146449ab747fSPaolo Bonzini { MFI_DCMD_CTRL_MFI_HOST_MEM_ALLOC, "CTRL_HOST_MEM_ALLOC", 146549ab747fSPaolo Bonzini megasas_dcmd_dummy }, 146649ab747fSPaolo Bonzini { MFI_DCMD_CTRL_GET_INFO, "CTRL_GET_INFO", 146749ab747fSPaolo Bonzini megasas_ctrl_get_info }, 146849ab747fSPaolo Bonzini { MFI_DCMD_CTRL_GET_PROPERTIES, "CTRL_GET_PROPERTIES", 146949ab747fSPaolo Bonzini megasas_dcmd_get_properties }, 147049ab747fSPaolo Bonzini { MFI_DCMD_CTRL_SET_PROPERTIES, "CTRL_SET_PROPERTIES", 147149ab747fSPaolo Bonzini megasas_dcmd_set_properties }, 147249ab747fSPaolo Bonzini { MFI_DCMD_CTRL_ALARM_GET, "CTRL_ALARM_GET", 147349ab747fSPaolo Bonzini megasas_dcmd_dummy }, 147449ab747fSPaolo Bonzini { MFI_DCMD_CTRL_ALARM_ENABLE, "CTRL_ALARM_ENABLE", 147549ab747fSPaolo Bonzini megasas_dcmd_dummy }, 147649ab747fSPaolo Bonzini { MFI_DCMD_CTRL_ALARM_DISABLE, "CTRL_ALARM_DISABLE", 147749ab747fSPaolo Bonzini megasas_dcmd_dummy }, 147849ab747fSPaolo Bonzini { MFI_DCMD_CTRL_ALARM_SILENCE, "CTRL_ALARM_SILENCE", 147949ab747fSPaolo Bonzini megasas_dcmd_dummy }, 148049ab747fSPaolo Bonzini { MFI_DCMD_CTRL_ALARM_TEST, "CTRL_ALARM_TEST", 148149ab747fSPaolo Bonzini megasas_dcmd_dummy }, 148249ab747fSPaolo Bonzini { MFI_DCMD_CTRL_EVENT_GETINFO, "CTRL_EVENT_GETINFO", 148349ab747fSPaolo Bonzini megasas_event_info }, 148449ab747fSPaolo Bonzini { MFI_DCMD_CTRL_EVENT_GET, "CTRL_EVENT_GET", 148549ab747fSPaolo Bonzini megasas_dcmd_dummy }, 148649ab747fSPaolo Bonzini { MFI_DCMD_CTRL_EVENT_WAIT, "CTRL_EVENT_WAIT", 148749ab747fSPaolo Bonzini megasas_event_wait }, 148849ab747fSPaolo Bonzini { MFI_DCMD_CTRL_SHUTDOWN, "CTRL_SHUTDOWN", 148949ab747fSPaolo Bonzini megasas_ctrl_shutdown }, 149049ab747fSPaolo Bonzini { MFI_DCMD_HIBERNATE_STANDBY, "CTRL_STANDBY", 149149ab747fSPaolo Bonzini megasas_dcmd_dummy }, 149249ab747fSPaolo Bonzini { MFI_DCMD_CTRL_GET_TIME, "CTRL_GET_TIME", 149349ab747fSPaolo Bonzini megasas_dcmd_get_fw_time }, 149449ab747fSPaolo Bonzini { MFI_DCMD_CTRL_SET_TIME, "CTRL_SET_TIME", 149549ab747fSPaolo Bonzini megasas_dcmd_set_fw_time }, 149649ab747fSPaolo Bonzini { MFI_DCMD_CTRL_BIOS_DATA_GET, "CTRL_BIOS_DATA_GET", 149749ab747fSPaolo Bonzini megasas_dcmd_get_bios_info }, 149849ab747fSPaolo Bonzini { MFI_DCMD_CTRL_FACTORY_DEFAULTS, "CTRL_FACTORY_DEFAULTS", 149949ab747fSPaolo Bonzini megasas_dcmd_dummy }, 150049ab747fSPaolo Bonzini { MFI_DCMD_CTRL_MFC_DEFAULTS_GET, "CTRL_MFC_DEFAULTS_GET", 150149ab747fSPaolo Bonzini megasas_mfc_get_defaults }, 150249ab747fSPaolo Bonzini { MFI_DCMD_CTRL_MFC_DEFAULTS_SET, "CTRL_MFC_DEFAULTS_SET", 150349ab747fSPaolo Bonzini megasas_dcmd_dummy }, 150449ab747fSPaolo Bonzini { MFI_DCMD_CTRL_CACHE_FLUSH, "CTRL_CACHE_FLUSH", 150549ab747fSPaolo Bonzini megasas_cache_flush }, 150649ab747fSPaolo Bonzini { MFI_DCMD_PD_GET_LIST, "PD_GET_LIST", 150749ab747fSPaolo Bonzini megasas_dcmd_pd_get_list }, 150849ab747fSPaolo Bonzini { MFI_DCMD_PD_LIST_QUERY, "PD_LIST_QUERY", 150949ab747fSPaolo Bonzini megasas_dcmd_pd_list_query }, 151049ab747fSPaolo Bonzini { MFI_DCMD_PD_GET_INFO, "PD_GET_INFO", 151149ab747fSPaolo Bonzini megasas_dcmd_pd_get_info }, 151249ab747fSPaolo Bonzini { MFI_DCMD_PD_STATE_SET, "PD_STATE_SET", 151349ab747fSPaolo Bonzini megasas_dcmd_dummy }, 151449ab747fSPaolo Bonzini { MFI_DCMD_PD_REBUILD, "PD_REBUILD", 151549ab747fSPaolo Bonzini megasas_dcmd_dummy }, 151649ab747fSPaolo Bonzini { MFI_DCMD_PD_BLINK, "PD_BLINK", 151749ab747fSPaolo Bonzini megasas_dcmd_dummy }, 151849ab747fSPaolo Bonzini { MFI_DCMD_PD_UNBLINK, "PD_UNBLINK", 151949ab747fSPaolo Bonzini megasas_dcmd_dummy }, 152049ab747fSPaolo Bonzini { MFI_DCMD_LD_GET_LIST, "LD_GET_LIST", 152149ab747fSPaolo Bonzini megasas_dcmd_ld_get_list}, 152234bb4d02SHannes Reinecke { MFI_DCMD_LD_LIST_QUERY, "LD_LIST_QUERY", 152334bb4d02SHannes Reinecke megasas_dcmd_ld_list_query }, 152449ab747fSPaolo Bonzini { MFI_DCMD_LD_GET_INFO, "LD_GET_INFO", 152549ab747fSPaolo Bonzini megasas_dcmd_ld_get_info }, 152649ab747fSPaolo Bonzini { MFI_DCMD_LD_GET_PROP, "LD_GET_PROP", 152749ab747fSPaolo Bonzini megasas_dcmd_dummy }, 152849ab747fSPaolo Bonzini { MFI_DCMD_LD_SET_PROP, "LD_SET_PROP", 152949ab747fSPaolo Bonzini megasas_dcmd_dummy }, 153049ab747fSPaolo Bonzini { MFI_DCMD_LD_DELETE, "LD_DELETE", 153149ab747fSPaolo Bonzini megasas_dcmd_dummy }, 153249ab747fSPaolo Bonzini { MFI_DCMD_CFG_READ, "CFG_READ", 153349ab747fSPaolo Bonzini megasas_dcmd_cfg_read }, 153449ab747fSPaolo Bonzini { MFI_DCMD_CFG_ADD, "CFG_ADD", 153549ab747fSPaolo Bonzini megasas_dcmd_dummy }, 153649ab747fSPaolo Bonzini { MFI_DCMD_CFG_CLEAR, "CFG_CLEAR", 153749ab747fSPaolo Bonzini megasas_dcmd_dummy }, 153849ab747fSPaolo Bonzini { MFI_DCMD_CFG_FOREIGN_READ, "CFG_FOREIGN_READ", 153949ab747fSPaolo Bonzini megasas_dcmd_dummy }, 154049ab747fSPaolo Bonzini { MFI_DCMD_CFG_FOREIGN_IMPORT, "CFG_FOREIGN_IMPORT", 154149ab747fSPaolo Bonzini megasas_dcmd_dummy }, 154249ab747fSPaolo Bonzini { MFI_DCMD_BBU_STATUS, "BBU_STATUS", 154349ab747fSPaolo Bonzini megasas_dcmd_dummy }, 154449ab747fSPaolo Bonzini { MFI_DCMD_BBU_CAPACITY_INFO, "BBU_CAPACITY_INFO", 154549ab747fSPaolo Bonzini megasas_dcmd_dummy }, 154649ab747fSPaolo Bonzini { MFI_DCMD_BBU_DESIGN_INFO, "BBU_DESIGN_INFO", 154749ab747fSPaolo Bonzini megasas_dcmd_dummy }, 154849ab747fSPaolo Bonzini { MFI_DCMD_BBU_PROP_GET, "BBU_PROP_GET", 154949ab747fSPaolo Bonzini megasas_dcmd_dummy }, 155049ab747fSPaolo Bonzini { MFI_DCMD_CLUSTER, "CLUSTER", 155149ab747fSPaolo Bonzini megasas_dcmd_dummy }, 155249ab747fSPaolo Bonzini { MFI_DCMD_CLUSTER_RESET_ALL, "CLUSTER_RESET_ALL", 155349ab747fSPaolo Bonzini megasas_dcmd_dummy }, 155449ab747fSPaolo Bonzini { MFI_DCMD_CLUSTER_RESET_LD, "CLUSTER_RESET_LD", 155549ab747fSPaolo Bonzini megasas_cluster_reset_ld }, 155649ab747fSPaolo Bonzini { -1, NULL, NULL } 155749ab747fSPaolo Bonzini }; 155849ab747fSPaolo Bonzini 155949ab747fSPaolo Bonzini static int megasas_handle_dcmd(MegasasState *s, MegasasCmd *cmd) 156049ab747fSPaolo Bonzini { 156149ab747fSPaolo Bonzini int opcode, len; 156249ab747fSPaolo Bonzini int retval = 0; 156349ab747fSPaolo Bonzini const struct dcmd_cmd_tbl_t *cmdptr = dcmd_cmd_tbl; 156449ab747fSPaolo Bonzini 156549ab747fSPaolo Bonzini opcode = le32_to_cpu(cmd->frame->dcmd.opcode); 156649ab747fSPaolo Bonzini trace_megasas_handle_dcmd(cmd->index, opcode); 156749ab747fSPaolo Bonzini len = megasas_map_dcmd(s, cmd); 156849ab747fSPaolo Bonzini if (len < 0) { 156949ab747fSPaolo Bonzini return MFI_STAT_MEMORY_NOT_AVAILABLE; 157049ab747fSPaolo Bonzini } 157149ab747fSPaolo Bonzini while (cmdptr->opcode != -1 && cmdptr->opcode != opcode) { 157249ab747fSPaolo Bonzini cmdptr++; 157349ab747fSPaolo Bonzini } 157449ab747fSPaolo Bonzini if (cmdptr->opcode == -1) { 157549ab747fSPaolo Bonzini trace_megasas_dcmd_unhandled(cmd->index, opcode, len); 157649ab747fSPaolo Bonzini retval = megasas_dcmd_dummy(s, cmd); 157749ab747fSPaolo Bonzini } else { 157849ab747fSPaolo Bonzini trace_megasas_dcmd_enter(cmd->index, cmdptr->desc, len); 157949ab747fSPaolo Bonzini retval = cmdptr->func(s, cmd); 158049ab747fSPaolo Bonzini } 158149ab747fSPaolo Bonzini if (retval != MFI_STAT_INVALID_STATUS) { 158249ab747fSPaolo Bonzini megasas_finish_dcmd(cmd, len); 158349ab747fSPaolo Bonzini } 158449ab747fSPaolo Bonzini return retval; 158549ab747fSPaolo Bonzini } 158649ab747fSPaolo Bonzini 158749ab747fSPaolo Bonzini static int megasas_finish_internal_dcmd(MegasasCmd *cmd, 158849ab747fSPaolo Bonzini SCSIRequest *req) 158949ab747fSPaolo Bonzini { 159049ab747fSPaolo Bonzini int opcode; 159149ab747fSPaolo Bonzini int retval = MFI_STAT_OK; 159249ab747fSPaolo Bonzini int lun = req->lun; 159349ab747fSPaolo Bonzini 159449ab747fSPaolo Bonzini opcode = le32_to_cpu(cmd->frame->dcmd.opcode); 159549ab747fSPaolo Bonzini scsi_req_unref(req); 159649ab747fSPaolo Bonzini trace_megasas_dcmd_internal_finish(cmd->index, opcode, lun); 159749ab747fSPaolo Bonzini switch (opcode) { 159849ab747fSPaolo Bonzini case MFI_DCMD_PD_GET_INFO: 159949ab747fSPaolo Bonzini retval = megasas_pd_get_info_submit(req->dev, lun, cmd); 160049ab747fSPaolo Bonzini break; 160149ab747fSPaolo Bonzini case MFI_DCMD_LD_GET_INFO: 160249ab747fSPaolo Bonzini retval = megasas_ld_get_info_submit(req->dev, lun, cmd); 160349ab747fSPaolo Bonzini break; 160449ab747fSPaolo Bonzini default: 160549ab747fSPaolo Bonzini trace_megasas_dcmd_internal_invalid(cmd->index, opcode); 160649ab747fSPaolo Bonzini retval = MFI_STAT_INVALID_DCMD; 160749ab747fSPaolo Bonzini break; 160849ab747fSPaolo Bonzini } 160949ab747fSPaolo Bonzini if (retval != MFI_STAT_INVALID_STATUS) { 161049ab747fSPaolo Bonzini megasas_finish_dcmd(cmd, cmd->iov_size); 161149ab747fSPaolo Bonzini } 161249ab747fSPaolo Bonzini return retval; 161349ab747fSPaolo Bonzini } 161449ab747fSPaolo Bonzini 161549ab747fSPaolo Bonzini static int megasas_enqueue_req(MegasasCmd *cmd, bool is_write) 161649ab747fSPaolo Bonzini { 161749ab747fSPaolo Bonzini int len; 161849ab747fSPaolo Bonzini 161949ab747fSPaolo Bonzini len = scsi_req_enqueue(cmd->req); 162049ab747fSPaolo Bonzini if (len < 0) { 162149ab747fSPaolo Bonzini len = -len; 162249ab747fSPaolo Bonzini } 162349ab747fSPaolo Bonzini if (len > 0) { 162449ab747fSPaolo Bonzini if (len > cmd->iov_size) { 162549ab747fSPaolo Bonzini if (is_write) { 162649ab747fSPaolo Bonzini trace_megasas_iov_write_overflow(cmd->index, len, 162749ab747fSPaolo Bonzini cmd->iov_size); 162849ab747fSPaolo Bonzini } else { 162949ab747fSPaolo Bonzini trace_megasas_iov_read_overflow(cmd->index, len, 163049ab747fSPaolo Bonzini cmd->iov_size); 163149ab747fSPaolo Bonzini } 163249ab747fSPaolo Bonzini } 163349ab747fSPaolo Bonzini if (len < cmd->iov_size) { 163449ab747fSPaolo Bonzini if (is_write) { 163549ab747fSPaolo Bonzini trace_megasas_iov_write_underflow(cmd->index, len, 163649ab747fSPaolo Bonzini cmd->iov_size); 163749ab747fSPaolo Bonzini } else { 163849ab747fSPaolo Bonzini trace_megasas_iov_read_underflow(cmd->index, len, 163949ab747fSPaolo Bonzini cmd->iov_size); 164049ab747fSPaolo Bonzini } 164149ab747fSPaolo Bonzini cmd->iov_size = len; 164249ab747fSPaolo Bonzini } 164349ab747fSPaolo Bonzini scsi_req_continue(cmd->req); 164449ab747fSPaolo Bonzini } 164549ab747fSPaolo Bonzini return len; 164649ab747fSPaolo Bonzini } 164749ab747fSPaolo Bonzini 164849ab747fSPaolo Bonzini static int megasas_handle_scsi(MegasasState *s, MegasasCmd *cmd, 164949ab747fSPaolo Bonzini bool is_logical) 165049ab747fSPaolo Bonzini { 165149ab747fSPaolo Bonzini uint8_t *cdb; 165249ab747fSPaolo Bonzini bool is_write; 165349ab747fSPaolo Bonzini struct SCSIDevice *sdev = NULL; 165449ab747fSPaolo Bonzini 165549ab747fSPaolo Bonzini cdb = cmd->frame->pass.cdb; 165649ab747fSPaolo Bonzini 16573f2cd4ddSHannes Reinecke if (is_logical) { 16583f2cd4ddSHannes Reinecke if (cmd->frame->header.target_id >= MFI_MAX_LD || 16593f2cd4ddSHannes Reinecke cmd->frame->header.lun_id != 0) { 16603f2cd4ddSHannes Reinecke trace_megasas_scsi_target_not_present( 16613f2cd4ddSHannes Reinecke mfi_frame_desc[cmd->frame->header.frame_cmd], is_logical, 16623f2cd4ddSHannes Reinecke cmd->frame->header.target_id, cmd->frame->header.lun_id); 16633f2cd4ddSHannes Reinecke return MFI_STAT_DEVICE_NOT_FOUND; 16643f2cd4ddSHannes Reinecke } 16653f2cd4ddSHannes Reinecke } 166649ab747fSPaolo Bonzini sdev = scsi_device_find(&s->bus, 0, cmd->frame->header.target_id, 166749ab747fSPaolo Bonzini cmd->frame->header.lun_id); 16683f2cd4ddSHannes Reinecke 166949ab747fSPaolo Bonzini cmd->iov_size = le32_to_cpu(cmd->frame->header.data_len); 167049ab747fSPaolo Bonzini trace_megasas_handle_scsi(mfi_frame_desc[cmd->frame->header.frame_cmd], 167149ab747fSPaolo Bonzini is_logical, cmd->frame->header.target_id, 167249ab747fSPaolo Bonzini cmd->frame->header.lun_id, sdev, cmd->iov_size); 167349ab747fSPaolo Bonzini 167449ab747fSPaolo Bonzini if (!sdev || (megasas_is_jbod(s) && is_logical)) { 167549ab747fSPaolo Bonzini trace_megasas_scsi_target_not_present( 167649ab747fSPaolo Bonzini mfi_frame_desc[cmd->frame->header.frame_cmd], is_logical, 167749ab747fSPaolo Bonzini cmd->frame->header.target_id, cmd->frame->header.lun_id); 167849ab747fSPaolo Bonzini return MFI_STAT_DEVICE_NOT_FOUND; 167949ab747fSPaolo Bonzini } 168049ab747fSPaolo Bonzini 168149ab747fSPaolo Bonzini if (cmd->frame->header.cdb_len > 16) { 168249ab747fSPaolo Bonzini trace_megasas_scsi_invalid_cdb_len( 168349ab747fSPaolo Bonzini mfi_frame_desc[cmd->frame->header.frame_cmd], is_logical, 168449ab747fSPaolo Bonzini cmd->frame->header.target_id, cmd->frame->header.lun_id, 168549ab747fSPaolo Bonzini cmd->frame->header.cdb_len); 168649ab747fSPaolo Bonzini megasas_write_sense(cmd, SENSE_CODE(INVALID_OPCODE)); 168749ab747fSPaolo Bonzini cmd->frame->header.scsi_status = CHECK_CONDITION; 168849ab747fSPaolo Bonzini s->event_count++; 168949ab747fSPaolo Bonzini return MFI_STAT_SCSI_DONE_WITH_ERROR; 169049ab747fSPaolo Bonzini } 169149ab747fSPaolo Bonzini 169249ab747fSPaolo Bonzini if (megasas_map_sgl(s, cmd, &cmd->frame->pass.sgl)) { 169349ab747fSPaolo Bonzini megasas_write_sense(cmd, SENSE_CODE(TARGET_FAILURE)); 169449ab747fSPaolo Bonzini cmd->frame->header.scsi_status = CHECK_CONDITION; 169549ab747fSPaolo Bonzini s->event_count++; 169649ab747fSPaolo Bonzini return MFI_STAT_SCSI_DONE_WITH_ERROR; 169749ab747fSPaolo Bonzini } 169849ab747fSPaolo Bonzini 169949ab747fSPaolo Bonzini cmd->req = scsi_req_new(sdev, cmd->index, 170049ab747fSPaolo Bonzini cmd->frame->header.lun_id, cdb, cmd); 170149ab747fSPaolo Bonzini if (!cmd->req) { 170249ab747fSPaolo Bonzini trace_megasas_scsi_req_alloc_failed( 170349ab747fSPaolo Bonzini mfi_frame_desc[cmd->frame->header.frame_cmd], 170449ab747fSPaolo Bonzini cmd->frame->header.target_id, cmd->frame->header.lun_id); 170549ab747fSPaolo Bonzini megasas_write_sense(cmd, SENSE_CODE(NO_SENSE)); 170649ab747fSPaolo Bonzini cmd->frame->header.scsi_status = BUSY; 170749ab747fSPaolo Bonzini s->event_count++; 170849ab747fSPaolo Bonzini return MFI_STAT_SCSI_DONE_WITH_ERROR; 170949ab747fSPaolo Bonzini } 171049ab747fSPaolo Bonzini 171149ab747fSPaolo Bonzini is_write = (cmd->req->cmd.mode == SCSI_XFER_TO_DEV); 1712aaf2a859SHannes Reinecke if (cmd->iov_size) { 171349ab747fSPaolo Bonzini if (is_write) { 1714aaf2a859SHannes Reinecke trace_megasas_scsi_write_start(cmd->index, cmd->iov_size); 171549ab747fSPaolo Bonzini } else { 1716aaf2a859SHannes Reinecke trace_megasas_scsi_read_start(cmd->index, cmd->iov_size); 171749ab747fSPaolo Bonzini } 171849ab747fSPaolo Bonzini } else { 171949ab747fSPaolo Bonzini trace_megasas_scsi_nodata(cmd->index); 172049ab747fSPaolo Bonzini } 1721aaf2a859SHannes Reinecke megasas_enqueue_req(cmd, is_write); 172249ab747fSPaolo Bonzini return MFI_STAT_INVALID_STATUS; 172349ab747fSPaolo Bonzini } 172449ab747fSPaolo Bonzini 172549ab747fSPaolo Bonzini static int megasas_handle_io(MegasasState *s, MegasasCmd *cmd) 172649ab747fSPaolo Bonzini { 172749ab747fSPaolo Bonzini uint32_t lba_count, lba_start_hi, lba_start_lo; 172849ab747fSPaolo Bonzini uint64_t lba_start; 172949ab747fSPaolo Bonzini bool is_write = (cmd->frame->header.frame_cmd == MFI_CMD_LD_WRITE); 173049ab747fSPaolo Bonzini uint8_t cdb[16]; 173149ab747fSPaolo Bonzini int len; 173249ab747fSPaolo Bonzini struct SCSIDevice *sdev = NULL; 173349ab747fSPaolo Bonzini 173449ab747fSPaolo Bonzini lba_count = le32_to_cpu(cmd->frame->io.header.data_len); 173549ab747fSPaolo Bonzini lba_start_lo = le32_to_cpu(cmd->frame->io.lba_lo); 173649ab747fSPaolo Bonzini lba_start_hi = le32_to_cpu(cmd->frame->io.lba_hi); 173749ab747fSPaolo Bonzini lba_start = ((uint64_t)lba_start_hi << 32) | lba_start_lo; 173849ab747fSPaolo Bonzini 17393f2cd4ddSHannes Reinecke if (cmd->frame->header.target_id < MFI_MAX_LD && 17403f2cd4ddSHannes Reinecke cmd->frame->header.lun_id == 0) { 174149ab747fSPaolo Bonzini sdev = scsi_device_find(&s->bus, 0, cmd->frame->header.target_id, 174249ab747fSPaolo Bonzini cmd->frame->header.lun_id); 174349ab747fSPaolo Bonzini } 174449ab747fSPaolo Bonzini 174549ab747fSPaolo Bonzini trace_megasas_handle_io(cmd->index, 174649ab747fSPaolo Bonzini mfi_frame_desc[cmd->frame->header.frame_cmd], 174749ab747fSPaolo Bonzini cmd->frame->header.target_id, 174849ab747fSPaolo Bonzini cmd->frame->header.lun_id, 174949ab747fSPaolo Bonzini (unsigned long)lba_start, (unsigned long)lba_count); 175049ab747fSPaolo Bonzini if (!sdev) { 175149ab747fSPaolo Bonzini trace_megasas_io_target_not_present(cmd->index, 175249ab747fSPaolo Bonzini mfi_frame_desc[cmd->frame->header.frame_cmd], 175349ab747fSPaolo Bonzini cmd->frame->header.target_id, cmd->frame->header.lun_id); 175449ab747fSPaolo Bonzini return MFI_STAT_DEVICE_NOT_FOUND; 175549ab747fSPaolo Bonzini } 175649ab747fSPaolo Bonzini 175749ab747fSPaolo Bonzini if (cmd->frame->header.cdb_len > 16) { 175849ab747fSPaolo Bonzini trace_megasas_scsi_invalid_cdb_len( 175949ab747fSPaolo Bonzini mfi_frame_desc[cmd->frame->header.frame_cmd], 1, 176049ab747fSPaolo Bonzini cmd->frame->header.target_id, cmd->frame->header.lun_id, 176149ab747fSPaolo Bonzini cmd->frame->header.cdb_len); 176249ab747fSPaolo Bonzini megasas_write_sense(cmd, SENSE_CODE(INVALID_OPCODE)); 176349ab747fSPaolo Bonzini cmd->frame->header.scsi_status = CHECK_CONDITION; 176449ab747fSPaolo Bonzini s->event_count++; 176549ab747fSPaolo Bonzini return MFI_STAT_SCSI_DONE_WITH_ERROR; 176649ab747fSPaolo Bonzini } 176749ab747fSPaolo Bonzini 176849ab747fSPaolo Bonzini cmd->iov_size = lba_count * sdev->blocksize; 176949ab747fSPaolo Bonzini if (megasas_map_sgl(s, cmd, &cmd->frame->io.sgl)) { 177049ab747fSPaolo Bonzini megasas_write_sense(cmd, SENSE_CODE(TARGET_FAILURE)); 177149ab747fSPaolo Bonzini cmd->frame->header.scsi_status = CHECK_CONDITION; 177249ab747fSPaolo Bonzini s->event_count++; 177349ab747fSPaolo Bonzini return MFI_STAT_SCSI_DONE_WITH_ERROR; 177449ab747fSPaolo Bonzini } 177549ab747fSPaolo Bonzini 177649ab747fSPaolo Bonzini megasas_encode_lba(cdb, lba_start, lba_count, is_write); 177749ab747fSPaolo Bonzini cmd->req = scsi_req_new(sdev, cmd->index, 177849ab747fSPaolo Bonzini cmd->frame->header.lun_id, cdb, cmd); 177949ab747fSPaolo Bonzini if (!cmd->req) { 178049ab747fSPaolo Bonzini trace_megasas_scsi_req_alloc_failed( 178149ab747fSPaolo Bonzini mfi_frame_desc[cmd->frame->header.frame_cmd], 178249ab747fSPaolo Bonzini cmd->frame->header.target_id, cmd->frame->header.lun_id); 178349ab747fSPaolo Bonzini megasas_write_sense(cmd, SENSE_CODE(NO_SENSE)); 178449ab747fSPaolo Bonzini cmd->frame->header.scsi_status = BUSY; 178549ab747fSPaolo Bonzini s->event_count++; 178649ab747fSPaolo Bonzini return MFI_STAT_SCSI_DONE_WITH_ERROR; 178749ab747fSPaolo Bonzini } 178849ab747fSPaolo Bonzini len = megasas_enqueue_req(cmd, is_write); 178949ab747fSPaolo Bonzini if (len > 0) { 179049ab747fSPaolo Bonzini if (is_write) { 179149ab747fSPaolo Bonzini trace_megasas_io_write_start(cmd->index, lba_start, lba_count, len); 179249ab747fSPaolo Bonzini } else { 179349ab747fSPaolo Bonzini trace_megasas_io_read_start(cmd->index, lba_start, lba_count, len); 179449ab747fSPaolo Bonzini } 179549ab747fSPaolo Bonzini } 179649ab747fSPaolo Bonzini return MFI_STAT_INVALID_STATUS; 179749ab747fSPaolo Bonzini } 179849ab747fSPaolo Bonzini 179949ab747fSPaolo Bonzini static int megasas_finish_internal_command(MegasasCmd *cmd, 180049ab747fSPaolo Bonzini SCSIRequest *req, size_t resid) 180149ab747fSPaolo Bonzini { 180249ab747fSPaolo Bonzini int retval = MFI_STAT_INVALID_CMD; 180349ab747fSPaolo Bonzini 180449ab747fSPaolo Bonzini if (cmd->frame->header.frame_cmd == MFI_CMD_DCMD) { 180549ab747fSPaolo Bonzini cmd->iov_size -= resid; 180649ab747fSPaolo Bonzini retval = megasas_finish_internal_dcmd(cmd, req); 180749ab747fSPaolo Bonzini } 180849ab747fSPaolo Bonzini return retval; 180949ab747fSPaolo Bonzini } 181049ab747fSPaolo Bonzini 181149ab747fSPaolo Bonzini static QEMUSGList *megasas_get_sg_list(SCSIRequest *req) 181249ab747fSPaolo Bonzini { 181349ab747fSPaolo Bonzini MegasasCmd *cmd = req->hba_private; 181449ab747fSPaolo Bonzini 181549ab747fSPaolo Bonzini if (cmd->frame->header.frame_cmd == MFI_CMD_DCMD) { 181649ab747fSPaolo Bonzini return NULL; 181749ab747fSPaolo Bonzini } else { 181849ab747fSPaolo Bonzini return &cmd->qsg; 181949ab747fSPaolo Bonzini } 182049ab747fSPaolo Bonzini } 182149ab747fSPaolo Bonzini 182249ab747fSPaolo Bonzini static void megasas_xfer_complete(SCSIRequest *req, uint32_t len) 182349ab747fSPaolo Bonzini { 182449ab747fSPaolo Bonzini MegasasCmd *cmd = req->hba_private; 182549ab747fSPaolo Bonzini uint8_t *buf; 182649ab747fSPaolo Bonzini uint32_t opcode; 182749ab747fSPaolo Bonzini 182849ab747fSPaolo Bonzini trace_megasas_io_complete(cmd->index, len); 182949ab747fSPaolo Bonzini 183049ab747fSPaolo Bonzini if (cmd->frame->header.frame_cmd != MFI_CMD_DCMD) { 183149ab747fSPaolo Bonzini scsi_req_continue(req); 183249ab747fSPaolo Bonzini return; 183349ab747fSPaolo Bonzini } 183449ab747fSPaolo Bonzini 183549ab747fSPaolo Bonzini buf = scsi_req_get_buf(req); 183649ab747fSPaolo Bonzini opcode = le32_to_cpu(cmd->frame->dcmd.opcode); 183749ab747fSPaolo Bonzini if (opcode == MFI_DCMD_PD_GET_INFO && cmd->iov_buf) { 183849ab747fSPaolo Bonzini struct mfi_pd_info *info = cmd->iov_buf; 183949ab747fSPaolo Bonzini 184049ab747fSPaolo Bonzini if (info->inquiry_data[0] == 0x7f) { 184149ab747fSPaolo Bonzini memset(info->inquiry_data, 0, sizeof(info->inquiry_data)); 184249ab747fSPaolo Bonzini memcpy(info->inquiry_data, buf, len); 184349ab747fSPaolo Bonzini } else if (info->vpd_page83[0] == 0x7f) { 184449ab747fSPaolo Bonzini memset(info->vpd_page83, 0, sizeof(info->vpd_page83)); 184549ab747fSPaolo Bonzini memcpy(info->vpd_page83, buf, len); 184649ab747fSPaolo Bonzini } 184749ab747fSPaolo Bonzini scsi_req_continue(req); 184849ab747fSPaolo Bonzini } else if (opcode == MFI_DCMD_LD_GET_INFO) { 184949ab747fSPaolo Bonzini struct mfi_ld_info *info = cmd->iov_buf; 185049ab747fSPaolo Bonzini 185149ab747fSPaolo Bonzini if (cmd->iov_buf) { 185249ab747fSPaolo Bonzini memcpy(info->vpd_page83, buf, sizeof(info->vpd_page83)); 185349ab747fSPaolo Bonzini scsi_req_continue(req); 185449ab747fSPaolo Bonzini } 185549ab747fSPaolo Bonzini } 185649ab747fSPaolo Bonzini } 185749ab747fSPaolo Bonzini 185849ab747fSPaolo Bonzini static void megasas_command_complete(SCSIRequest *req, uint32_t status, 185949ab747fSPaolo Bonzini size_t resid) 186049ab747fSPaolo Bonzini { 186149ab747fSPaolo Bonzini MegasasCmd *cmd = req->hba_private; 186249ab747fSPaolo Bonzini uint8_t cmd_status = MFI_STAT_OK; 186349ab747fSPaolo Bonzini 186449ab747fSPaolo Bonzini trace_megasas_command_complete(cmd->index, status, resid); 186549ab747fSPaolo Bonzini 186649ab747fSPaolo Bonzini if (cmd->req != req) { 186749ab747fSPaolo Bonzini /* 186849ab747fSPaolo Bonzini * Internal command complete 186949ab747fSPaolo Bonzini */ 187049ab747fSPaolo Bonzini cmd_status = megasas_finish_internal_command(cmd, req, resid); 187149ab747fSPaolo Bonzini if (cmd_status == MFI_STAT_INVALID_STATUS) { 187249ab747fSPaolo Bonzini return; 187349ab747fSPaolo Bonzini } 187449ab747fSPaolo Bonzini } else { 187549ab747fSPaolo Bonzini req->status = status; 187649ab747fSPaolo Bonzini trace_megasas_scsi_complete(cmd->index, req->status, 187749ab747fSPaolo Bonzini cmd->iov_size, req->cmd.xfer); 187849ab747fSPaolo Bonzini if (req->status != GOOD) { 187949ab747fSPaolo Bonzini cmd_status = MFI_STAT_SCSI_DONE_WITH_ERROR; 188049ab747fSPaolo Bonzini } 188149ab747fSPaolo Bonzini if (req->status == CHECK_CONDITION) { 188249ab747fSPaolo Bonzini megasas_copy_sense(cmd); 188349ab747fSPaolo Bonzini } 188449ab747fSPaolo Bonzini 188549ab747fSPaolo Bonzini megasas_unmap_sgl(cmd); 188649ab747fSPaolo Bonzini cmd->frame->header.scsi_status = req->status; 188749ab747fSPaolo Bonzini scsi_req_unref(cmd->req); 188849ab747fSPaolo Bonzini cmd->req = NULL; 188949ab747fSPaolo Bonzini } 189049ab747fSPaolo Bonzini cmd->frame->header.cmd_status = cmd_status; 18916df5718bSHannes Reinecke megasas_unmap_frame(cmd->state, cmd); 189249ab747fSPaolo Bonzini megasas_complete_frame(cmd->state, cmd->context); 189349ab747fSPaolo Bonzini } 189449ab747fSPaolo Bonzini 189549ab747fSPaolo Bonzini static void megasas_command_cancel(SCSIRequest *req) 189649ab747fSPaolo Bonzini { 189749ab747fSPaolo Bonzini MegasasCmd *cmd = req->hba_private; 189849ab747fSPaolo Bonzini 189949ab747fSPaolo Bonzini if (cmd) { 190049ab747fSPaolo Bonzini megasas_abort_command(cmd); 190149ab747fSPaolo Bonzini } else { 190249ab747fSPaolo Bonzini scsi_req_unref(req); 190349ab747fSPaolo Bonzini } 190449ab747fSPaolo Bonzini } 190549ab747fSPaolo Bonzini 190649ab747fSPaolo Bonzini static int megasas_handle_abort(MegasasState *s, MegasasCmd *cmd) 190749ab747fSPaolo Bonzini { 190849ab747fSPaolo Bonzini uint64_t abort_ctx = le64_to_cpu(cmd->frame->abort.abort_context); 190949ab747fSPaolo Bonzini hwaddr abort_addr, addr_hi, addr_lo; 191049ab747fSPaolo Bonzini MegasasCmd *abort_cmd; 191149ab747fSPaolo Bonzini 191249ab747fSPaolo Bonzini addr_hi = le32_to_cpu(cmd->frame->abort.abort_mfi_addr_hi); 191349ab747fSPaolo Bonzini addr_lo = le32_to_cpu(cmd->frame->abort.abort_mfi_addr_lo); 191449ab747fSPaolo Bonzini abort_addr = ((uint64_t)addr_hi << 32) | addr_lo; 191549ab747fSPaolo Bonzini 191649ab747fSPaolo Bonzini abort_cmd = megasas_lookup_frame(s, abort_addr); 191749ab747fSPaolo Bonzini if (!abort_cmd) { 191849ab747fSPaolo Bonzini trace_megasas_abort_no_cmd(cmd->index, abort_ctx); 191949ab747fSPaolo Bonzini s->event_count++; 192049ab747fSPaolo Bonzini return MFI_STAT_OK; 192149ab747fSPaolo Bonzini } 192249ab747fSPaolo Bonzini if (!megasas_use_queue64(s)) { 192349ab747fSPaolo Bonzini abort_ctx &= (uint64_t)0xFFFFFFFF; 192449ab747fSPaolo Bonzini } 192549ab747fSPaolo Bonzini if (abort_cmd->context != abort_ctx) { 192649ab747fSPaolo Bonzini trace_megasas_abort_invalid_context(cmd->index, abort_cmd->index, 192749ab747fSPaolo Bonzini abort_cmd->context); 192849ab747fSPaolo Bonzini s->event_count++; 192949ab747fSPaolo Bonzini return MFI_STAT_ABORT_NOT_POSSIBLE; 193049ab747fSPaolo Bonzini } 193149ab747fSPaolo Bonzini trace_megasas_abort_frame(cmd->index, abort_cmd->index); 193249ab747fSPaolo Bonzini megasas_abort_command(abort_cmd); 193349ab747fSPaolo Bonzini if (!s->event_cmd || abort_cmd != s->event_cmd) { 193449ab747fSPaolo Bonzini s->event_cmd = NULL; 193549ab747fSPaolo Bonzini } 193649ab747fSPaolo Bonzini s->event_count++; 193749ab747fSPaolo Bonzini return MFI_STAT_OK; 193849ab747fSPaolo Bonzini } 193949ab747fSPaolo Bonzini 194049ab747fSPaolo Bonzini static void megasas_handle_frame(MegasasState *s, uint64_t frame_addr, 194149ab747fSPaolo Bonzini uint32_t frame_count) 194249ab747fSPaolo Bonzini { 194349ab747fSPaolo Bonzini uint8_t frame_status = MFI_STAT_INVALID_CMD; 194449ab747fSPaolo Bonzini uint64_t frame_context; 194549ab747fSPaolo Bonzini MegasasCmd *cmd; 194649ab747fSPaolo Bonzini 194749ab747fSPaolo Bonzini /* 194849ab747fSPaolo Bonzini * Always read 64bit context, top bits will be 194949ab747fSPaolo Bonzini * masked out if required in megasas_enqueue_frame() 195049ab747fSPaolo Bonzini */ 195116578c6fSPaolo Bonzini frame_context = megasas_frame_get_context(s, frame_addr); 195249ab747fSPaolo Bonzini 195349ab747fSPaolo Bonzini cmd = megasas_enqueue_frame(s, frame_addr, frame_context, frame_count); 195449ab747fSPaolo Bonzini if (!cmd) { 195549ab747fSPaolo Bonzini /* reply queue full */ 195649ab747fSPaolo Bonzini trace_megasas_frame_busy(frame_addr); 195716578c6fSPaolo Bonzini megasas_frame_set_scsi_status(s, frame_addr, BUSY); 195816578c6fSPaolo Bonzini megasas_frame_set_cmd_status(s, frame_addr, MFI_STAT_SCSI_DONE_WITH_ERROR); 195949ab747fSPaolo Bonzini megasas_complete_frame(s, frame_context); 196049ab747fSPaolo Bonzini s->event_count++; 196149ab747fSPaolo Bonzini return; 196249ab747fSPaolo Bonzini } 196349ab747fSPaolo Bonzini switch (cmd->frame->header.frame_cmd) { 196449ab747fSPaolo Bonzini case MFI_CMD_INIT: 196549ab747fSPaolo Bonzini frame_status = megasas_init_firmware(s, cmd); 196649ab747fSPaolo Bonzini break; 196749ab747fSPaolo Bonzini case MFI_CMD_DCMD: 196849ab747fSPaolo Bonzini frame_status = megasas_handle_dcmd(s, cmd); 196949ab747fSPaolo Bonzini break; 197049ab747fSPaolo Bonzini case MFI_CMD_ABORT: 197149ab747fSPaolo Bonzini frame_status = megasas_handle_abort(s, cmd); 197249ab747fSPaolo Bonzini break; 197349ab747fSPaolo Bonzini case MFI_CMD_PD_SCSI_IO: 197449ab747fSPaolo Bonzini frame_status = megasas_handle_scsi(s, cmd, 0); 197549ab747fSPaolo Bonzini break; 197649ab747fSPaolo Bonzini case MFI_CMD_LD_SCSI_IO: 197749ab747fSPaolo Bonzini frame_status = megasas_handle_scsi(s, cmd, 1); 197849ab747fSPaolo Bonzini break; 197949ab747fSPaolo Bonzini case MFI_CMD_LD_READ: 198049ab747fSPaolo Bonzini case MFI_CMD_LD_WRITE: 198149ab747fSPaolo Bonzini frame_status = megasas_handle_io(s, cmd); 198249ab747fSPaolo Bonzini break; 198349ab747fSPaolo Bonzini default: 198449ab747fSPaolo Bonzini trace_megasas_unhandled_frame_cmd(cmd->index, 198549ab747fSPaolo Bonzini cmd->frame->header.frame_cmd); 198649ab747fSPaolo Bonzini s->event_count++; 198749ab747fSPaolo Bonzini break; 198849ab747fSPaolo Bonzini } 198949ab747fSPaolo Bonzini if (frame_status != MFI_STAT_INVALID_STATUS) { 199049ab747fSPaolo Bonzini if (cmd->frame) { 199149ab747fSPaolo Bonzini cmd->frame->header.cmd_status = frame_status; 199249ab747fSPaolo Bonzini } else { 199316578c6fSPaolo Bonzini megasas_frame_set_cmd_status(s, frame_addr, frame_status); 199449ab747fSPaolo Bonzini } 19956df5718bSHannes Reinecke megasas_unmap_frame(s, cmd); 199649ab747fSPaolo Bonzini megasas_complete_frame(s, cmd->context); 199749ab747fSPaolo Bonzini } 199849ab747fSPaolo Bonzini } 199949ab747fSPaolo Bonzini 200049ab747fSPaolo Bonzini static uint64_t megasas_mmio_read(void *opaque, hwaddr addr, 200149ab747fSPaolo Bonzini unsigned size) 200249ab747fSPaolo Bonzini { 200349ab747fSPaolo Bonzini MegasasState *s = opaque; 2004e23d0498SHannes Reinecke PCIDevice *pci_dev = PCI_DEVICE(s); 2005e23d0498SHannes Reinecke MegasasBaseClass *base_class = MEGASAS_DEVICE_GET_CLASS(s); 200649ab747fSPaolo Bonzini uint32_t retval = 0; 200749ab747fSPaolo Bonzini 200849ab747fSPaolo Bonzini switch (addr) { 200949ab747fSPaolo Bonzini case MFI_IDB: 201049ab747fSPaolo Bonzini retval = 0; 201177bb6b17SHannes Reinecke trace_megasas_mmio_readl("MFI_IDB", retval); 201249ab747fSPaolo Bonzini break; 201349ab747fSPaolo Bonzini case MFI_OMSG0: 201449ab747fSPaolo Bonzini case MFI_OSP0: 2015e23d0498SHannes Reinecke retval = (msix_present(pci_dev) ? MFI_FWSTATE_MSIX_SUPPORTED : 0) | 201649ab747fSPaolo Bonzini (s->fw_state & MFI_FWSTATE_MASK) | 201749ab747fSPaolo Bonzini ((s->fw_sge & 0xff) << 16) | 201849ab747fSPaolo Bonzini (s->fw_cmds & 0xFFFF); 201977bb6b17SHannes Reinecke trace_megasas_mmio_readl(addr == MFI_OMSG0 ? "MFI_OMSG0" : "MFI_OSP0", 202077bb6b17SHannes Reinecke retval); 202149ab747fSPaolo Bonzini break; 202249ab747fSPaolo Bonzini case MFI_OSTS: 202349ab747fSPaolo Bonzini if (megasas_intr_enabled(s) && s->doorbell) { 2024e23d0498SHannes Reinecke retval = base_class->osts; 202549ab747fSPaolo Bonzini } 202677bb6b17SHannes Reinecke trace_megasas_mmio_readl("MFI_OSTS", retval); 202749ab747fSPaolo Bonzini break; 202849ab747fSPaolo Bonzini case MFI_OMSK: 202949ab747fSPaolo Bonzini retval = s->intr_mask; 203077bb6b17SHannes Reinecke trace_megasas_mmio_readl("MFI_OMSK", retval); 203149ab747fSPaolo Bonzini break; 203249ab747fSPaolo Bonzini case MFI_ODCR0: 20337957ee71SHannes Reinecke retval = s->doorbell ? 1 : 0; 203477bb6b17SHannes Reinecke trace_megasas_mmio_readl("MFI_ODCR0", retval); 203549ab747fSPaolo Bonzini break; 2036e23d0498SHannes Reinecke case MFI_DIAG: 2037e23d0498SHannes Reinecke retval = s->diag; 203877bb6b17SHannes Reinecke trace_megasas_mmio_readl("MFI_DIAG", retval); 2039e23d0498SHannes Reinecke break; 2040e23d0498SHannes Reinecke case MFI_OSP1: 2041e23d0498SHannes Reinecke retval = 15; 204277bb6b17SHannes Reinecke trace_megasas_mmio_readl("MFI_OSP1", retval); 2043e23d0498SHannes Reinecke break; 204449ab747fSPaolo Bonzini default: 204549ab747fSPaolo Bonzini trace_megasas_mmio_invalid_readl(addr); 204649ab747fSPaolo Bonzini break; 204749ab747fSPaolo Bonzini } 204849ab747fSPaolo Bonzini return retval; 204949ab747fSPaolo Bonzini } 205049ab747fSPaolo Bonzini 2051e23d0498SHannes Reinecke static int adp_reset_seq[] = {0x00, 0x04, 0x0b, 0x02, 0x07, 0x0d}; 2052e23d0498SHannes Reinecke 205349ab747fSPaolo Bonzini static void megasas_mmio_write(void *opaque, hwaddr addr, 205449ab747fSPaolo Bonzini uint64_t val, unsigned size) 205549ab747fSPaolo Bonzini { 205649ab747fSPaolo Bonzini MegasasState *s = opaque; 205752190c1eSAndreas Färber PCIDevice *pci_dev = PCI_DEVICE(s); 205849ab747fSPaolo Bonzini uint64_t frame_addr; 205949ab747fSPaolo Bonzini uint32_t frame_count; 206049ab747fSPaolo Bonzini int i; 206149ab747fSPaolo Bonzini 206249ab747fSPaolo Bonzini switch (addr) { 206349ab747fSPaolo Bonzini case MFI_IDB: 206477bb6b17SHannes Reinecke trace_megasas_mmio_writel("MFI_IDB", val); 206549ab747fSPaolo Bonzini if (val & MFI_FWINIT_ABORT) { 206649ab747fSPaolo Bonzini /* Abort all pending cmds */ 206749ab747fSPaolo Bonzini for (i = 0; i < s->fw_cmds; i++) { 206849ab747fSPaolo Bonzini megasas_abort_command(&s->frames[i]); 206949ab747fSPaolo Bonzini } 207049ab747fSPaolo Bonzini } 207149ab747fSPaolo Bonzini if (val & MFI_FWINIT_READY) { 207249ab747fSPaolo Bonzini /* move to FW READY */ 207349ab747fSPaolo Bonzini megasas_soft_reset(s); 207449ab747fSPaolo Bonzini } 207549ab747fSPaolo Bonzini if (val & MFI_FWINIT_MFIMODE) { 207649ab747fSPaolo Bonzini /* discard MFIs */ 207749ab747fSPaolo Bonzini } 2078e23d0498SHannes Reinecke if (val & MFI_FWINIT_STOP_ADP) { 2079e23d0498SHannes Reinecke /* Terminal error, stop processing */ 2080e23d0498SHannes Reinecke s->fw_state = MFI_FWSTATE_FAULT; 2081e23d0498SHannes Reinecke } 208249ab747fSPaolo Bonzini break; 208349ab747fSPaolo Bonzini case MFI_OMSK: 208477bb6b17SHannes Reinecke trace_megasas_mmio_writel("MFI_OMSK", val); 208549ab747fSPaolo Bonzini s->intr_mask = val; 20864522b69cSHannes Reinecke if (!megasas_intr_enabled(s) && 20874522b69cSHannes Reinecke !msi_enabled(pci_dev) && 20884522b69cSHannes Reinecke !msix_enabled(pci_dev)) { 208949ab747fSPaolo Bonzini trace_megasas_irq_lower(); 20909e64f8a3SMarcel Apfelbaum pci_irq_deassert(pci_dev); 209149ab747fSPaolo Bonzini } 209249ab747fSPaolo Bonzini if (megasas_intr_enabled(s)) { 20934522b69cSHannes Reinecke if (msix_enabled(pci_dev)) { 20944522b69cSHannes Reinecke trace_megasas_msix_enabled(0); 20954522b69cSHannes Reinecke } else if (msi_enabled(pci_dev)) { 20964522b69cSHannes Reinecke trace_megasas_msi_enabled(0); 20974522b69cSHannes Reinecke } else { 209849ab747fSPaolo Bonzini trace_megasas_intr_enabled(); 20994522b69cSHannes Reinecke } 210049ab747fSPaolo Bonzini } else { 210149ab747fSPaolo Bonzini trace_megasas_intr_disabled(); 2102e23d0498SHannes Reinecke megasas_soft_reset(s); 210349ab747fSPaolo Bonzini } 210449ab747fSPaolo Bonzini break; 210549ab747fSPaolo Bonzini case MFI_ODCR0: 210677bb6b17SHannes Reinecke trace_megasas_mmio_writel("MFI_ODCR0", val); 210749ab747fSPaolo Bonzini s->doorbell = 0; 21087957ee71SHannes Reinecke if (megasas_intr_enabled(s)) { 21097957ee71SHannes Reinecke if (!msix_enabled(pci_dev) && !msi_enabled(pci_dev)) { 211049ab747fSPaolo Bonzini trace_megasas_irq_lower(); 21119e64f8a3SMarcel Apfelbaum pci_irq_deassert(pci_dev); 211249ab747fSPaolo Bonzini } 211349ab747fSPaolo Bonzini } 211449ab747fSPaolo Bonzini break; 211549ab747fSPaolo Bonzini case MFI_IQPH: 211677bb6b17SHannes Reinecke trace_megasas_mmio_writel("MFI_IQPH", val); 211749ab747fSPaolo Bonzini /* Received high 32 bits of a 64 bit MFI frame address */ 211849ab747fSPaolo Bonzini s->frame_hi = val; 211949ab747fSPaolo Bonzini break; 212049ab747fSPaolo Bonzini case MFI_IQPL: 212177bb6b17SHannes Reinecke trace_megasas_mmio_writel("MFI_IQPL", val); 212249ab747fSPaolo Bonzini /* Received low 32 bits of a 64 bit MFI frame address */ 2123e23d0498SHannes Reinecke /* Fallthrough */ 212449ab747fSPaolo Bonzini case MFI_IQP: 212577bb6b17SHannes Reinecke if (addr == MFI_IQP) { 212677bb6b17SHannes Reinecke trace_megasas_mmio_writel("MFI_IQP", val); 2127e23d0498SHannes Reinecke /* Received 64 bit MFI frame address */ 212877bb6b17SHannes Reinecke s->frame_hi = 0; 212977bb6b17SHannes Reinecke } 213049ab747fSPaolo Bonzini frame_addr = (val & ~0x1F); 213149ab747fSPaolo Bonzini /* Add possible 64 bit offset */ 213249ab747fSPaolo Bonzini frame_addr |= ((uint64_t)s->frame_hi << 32); 213349ab747fSPaolo Bonzini s->frame_hi = 0; 213449ab747fSPaolo Bonzini frame_count = (val >> 1) & 0xF; 213549ab747fSPaolo Bonzini megasas_handle_frame(s, frame_addr, frame_count); 213649ab747fSPaolo Bonzini break; 2137e23d0498SHannes Reinecke case MFI_SEQ: 213877bb6b17SHannes Reinecke trace_megasas_mmio_writel("MFI_SEQ", val); 2139e23d0498SHannes Reinecke /* Magic sequence to start ADP reset */ 2140e23d0498SHannes Reinecke if (adp_reset_seq[s->adp_reset] == val) { 2141e23d0498SHannes Reinecke s->adp_reset++; 2142e23d0498SHannes Reinecke } else { 2143e23d0498SHannes Reinecke s->adp_reset = 0; 2144e23d0498SHannes Reinecke s->diag = 0; 2145e23d0498SHannes Reinecke } 2146e23d0498SHannes Reinecke if (s->adp_reset == 6) { 2147e23d0498SHannes Reinecke s->diag = MFI_DIAG_WRITE_ENABLE; 2148e23d0498SHannes Reinecke } 2149e23d0498SHannes Reinecke break; 2150e23d0498SHannes Reinecke case MFI_DIAG: 215177bb6b17SHannes Reinecke trace_megasas_mmio_writel("MFI_DIAG", val); 2152e23d0498SHannes Reinecke /* ADP reset */ 2153e23d0498SHannes Reinecke if ((s->diag & MFI_DIAG_WRITE_ENABLE) && 2154e23d0498SHannes Reinecke (val & MFI_DIAG_RESET_ADP)) { 2155e23d0498SHannes Reinecke s->diag |= MFI_DIAG_RESET_ADP; 2156e23d0498SHannes Reinecke megasas_soft_reset(s); 2157e23d0498SHannes Reinecke s->adp_reset = 0; 2158e23d0498SHannes Reinecke s->diag = 0; 2159e23d0498SHannes Reinecke } 2160e23d0498SHannes Reinecke break; 216149ab747fSPaolo Bonzini default: 216249ab747fSPaolo Bonzini trace_megasas_mmio_invalid_writel(addr, val); 216349ab747fSPaolo Bonzini break; 216449ab747fSPaolo Bonzini } 216549ab747fSPaolo Bonzini } 216649ab747fSPaolo Bonzini 216749ab747fSPaolo Bonzini static const MemoryRegionOps megasas_mmio_ops = { 216849ab747fSPaolo Bonzini .read = megasas_mmio_read, 216949ab747fSPaolo Bonzini .write = megasas_mmio_write, 217049ab747fSPaolo Bonzini .endianness = DEVICE_LITTLE_ENDIAN, 217149ab747fSPaolo Bonzini .impl = { 217249ab747fSPaolo Bonzini .min_access_size = 8, 217349ab747fSPaolo Bonzini .max_access_size = 8, 217449ab747fSPaolo Bonzini } 217549ab747fSPaolo Bonzini }; 217649ab747fSPaolo Bonzini 217749ab747fSPaolo Bonzini static uint64_t megasas_port_read(void *opaque, hwaddr addr, 217849ab747fSPaolo Bonzini unsigned size) 217949ab747fSPaolo Bonzini { 218049ab747fSPaolo Bonzini return megasas_mmio_read(opaque, addr & 0xff, size); 218149ab747fSPaolo Bonzini } 218249ab747fSPaolo Bonzini 218349ab747fSPaolo Bonzini static void megasas_port_write(void *opaque, hwaddr addr, 218449ab747fSPaolo Bonzini uint64_t val, unsigned size) 218549ab747fSPaolo Bonzini { 218649ab747fSPaolo Bonzini megasas_mmio_write(opaque, addr & 0xff, val, size); 218749ab747fSPaolo Bonzini } 218849ab747fSPaolo Bonzini 218949ab747fSPaolo Bonzini static const MemoryRegionOps megasas_port_ops = { 219049ab747fSPaolo Bonzini .read = megasas_port_read, 219149ab747fSPaolo Bonzini .write = megasas_port_write, 219249ab747fSPaolo Bonzini .endianness = DEVICE_LITTLE_ENDIAN, 219349ab747fSPaolo Bonzini .impl = { 219449ab747fSPaolo Bonzini .min_access_size = 4, 219549ab747fSPaolo Bonzini .max_access_size = 4, 219649ab747fSPaolo Bonzini } 219749ab747fSPaolo Bonzini }; 219849ab747fSPaolo Bonzini 219949ab747fSPaolo Bonzini static uint64_t megasas_queue_read(void *opaque, hwaddr addr, 220049ab747fSPaolo Bonzini unsigned size) 220149ab747fSPaolo Bonzini { 220249ab747fSPaolo Bonzini return 0; 220349ab747fSPaolo Bonzini } 220449ab747fSPaolo Bonzini 220549ab747fSPaolo Bonzini static const MemoryRegionOps megasas_queue_ops = { 220649ab747fSPaolo Bonzini .read = megasas_queue_read, 220749ab747fSPaolo Bonzini .endianness = DEVICE_LITTLE_ENDIAN, 220849ab747fSPaolo Bonzini .impl = { 220949ab747fSPaolo Bonzini .min_access_size = 8, 221049ab747fSPaolo Bonzini .max_access_size = 8, 221149ab747fSPaolo Bonzini } 221249ab747fSPaolo Bonzini }; 221349ab747fSPaolo Bonzini 221449ab747fSPaolo Bonzini static void megasas_soft_reset(MegasasState *s) 221549ab747fSPaolo Bonzini { 221649ab747fSPaolo Bonzini int i; 221749ab747fSPaolo Bonzini MegasasCmd *cmd; 221849ab747fSPaolo Bonzini 22198d72db68SHannes Reinecke trace_megasas_reset(s->fw_state); 222049ab747fSPaolo Bonzini for (i = 0; i < s->fw_cmds; i++) { 222149ab747fSPaolo Bonzini cmd = &s->frames[i]; 222249ab747fSPaolo Bonzini megasas_abort_command(cmd); 222349ab747fSPaolo Bonzini } 22248d72db68SHannes Reinecke if (s->fw_state == MFI_FWSTATE_READY) { 22258d72db68SHannes Reinecke BusChild *kid; 22268d72db68SHannes Reinecke 22278d72db68SHannes Reinecke /* 22288d72db68SHannes Reinecke * The EFI firmware doesn't handle UA, 22298d72db68SHannes Reinecke * so we need to clear the Power On/Reset UA 22308d72db68SHannes Reinecke * after the initial reset. 22318d72db68SHannes Reinecke */ 22328d72db68SHannes Reinecke QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) { 22338d72db68SHannes Reinecke SCSIDevice *sdev = DO_UPCAST(SCSIDevice, qdev, kid->child); 22348d72db68SHannes Reinecke 22358d72db68SHannes Reinecke sdev->unit_attention = SENSE_CODE(NO_SENSE); 22368d72db68SHannes Reinecke scsi_device_unit_attention_reported(sdev); 22378d72db68SHannes Reinecke } 22388d72db68SHannes Reinecke } 223949ab747fSPaolo Bonzini megasas_reset_frames(s); 224049ab747fSPaolo Bonzini s->reply_queue_len = s->fw_cmds; 224149ab747fSPaolo Bonzini s->reply_queue_pa = 0; 224249ab747fSPaolo Bonzini s->consumer_pa = 0; 224349ab747fSPaolo Bonzini s->producer_pa = 0; 224449ab747fSPaolo Bonzini s->fw_state = MFI_FWSTATE_READY; 224549ab747fSPaolo Bonzini s->doorbell = 0; 224649ab747fSPaolo Bonzini s->intr_mask = MEGASAS_INTR_DISABLED_MASK; 224749ab747fSPaolo Bonzini s->frame_hi = 0; 224849ab747fSPaolo Bonzini s->flags &= ~MEGASAS_MASK_USE_QUEUE64; 224949ab747fSPaolo Bonzini s->event_count++; 225049ab747fSPaolo Bonzini s->boot_event = s->event_count; 225149ab747fSPaolo Bonzini } 225249ab747fSPaolo Bonzini 225349ab747fSPaolo Bonzini static void megasas_scsi_reset(DeviceState *dev) 225449ab747fSPaolo Bonzini { 2255c79e16aeSPeter Crosthwaite MegasasState *s = MEGASAS(dev); 225649ab747fSPaolo Bonzini 225749ab747fSPaolo Bonzini megasas_soft_reset(s); 225849ab747fSPaolo Bonzini } 225949ab747fSPaolo Bonzini 2260e23d0498SHannes Reinecke static const VMStateDescription vmstate_megasas_gen1 = { 226149ab747fSPaolo Bonzini .name = "megasas", 226249ab747fSPaolo Bonzini .version_id = 0, 226349ab747fSPaolo Bonzini .minimum_version_id = 0, 226449ab747fSPaolo Bonzini .fields = (VMStateField[]) { 226552190c1eSAndreas Färber VMSTATE_PCI_DEVICE(parent_obj, MegasasState), 226623335f62SHannes Reinecke VMSTATE_MSIX(parent_obj, MegasasState), 226749ab747fSPaolo Bonzini 226849ab747fSPaolo Bonzini VMSTATE_INT32(fw_state, MegasasState), 226949ab747fSPaolo Bonzini VMSTATE_INT32(intr_mask, MegasasState), 227049ab747fSPaolo Bonzini VMSTATE_INT32(doorbell, MegasasState), 227149ab747fSPaolo Bonzini VMSTATE_UINT64(reply_queue_pa, MegasasState), 227249ab747fSPaolo Bonzini VMSTATE_UINT64(consumer_pa, MegasasState), 227349ab747fSPaolo Bonzini VMSTATE_UINT64(producer_pa, MegasasState), 227449ab747fSPaolo Bonzini VMSTATE_END_OF_LIST() 227549ab747fSPaolo Bonzini } 227649ab747fSPaolo Bonzini }; 227749ab747fSPaolo Bonzini 2278e23d0498SHannes Reinecke static const VMStateDescription vmstate_megasas_gen2 = { 2279e23d0498SHannes Reinecke .name = "megasas-gen2", 2280e23d0498SHannes Reinecke .version_id = 0, 2281e23d0498SHannes Reinecke .minimum_version_id = 0, 2282e23d0498SHannes Reinecke .minimum_version_id_old = 0, 2283e23d0498SHannes Reinecke .fields = (VMStateField[]) { 2284e23d0498SHannes Reinecke VMSTATE_PCIE_DEVICE(parent_obj, MegasasState), 2285e23d0498SHannes Reinecke VMSTATE_MSIX(parent_obj, MegasasState), 2286e23d0498SHannes Reinecke 2287e23d0498SHannes Reinecke VMSTATE_INT32(fw_state, MegasasState), 2288e23d0498SHannes Reinecke VMSTATE_INT32(intr_mask, MegasasState), 2289e23d0498SHannes Reinecke VMSTATE_INT32(doorbell, MegasasState), 2290e23d0498SHannes Reinecke VMSTATE_UINT64(reply_queue_pa, MegasasState), 2291e23d0498SHannes Reinecke VMSTATE_UINT64(consumer_pa, MegasasState), 2292e23d0498SHannes Reinecke VMSTATE_UINT64(producer_pa, MegasasState), 2293e23d0498SHannes Reinecke VMSTATE_END_OF_LIST() 2294e23d0498SHannes Reinecke } 2295e23d0498SHannes Reinecke }; 2296e23d0498SHannes Reinecke 229749ab747fSPaolo Bonzini static void megasas_scsi_uninit(PCIDevice *d) 229849ab747fSPaolo Bonzini { 2299c79e16aeSPeter Crosthwaite MegasasState *s = MEGASAS(d); 230049ab747fSPaolo Bonzini 23014522b69cSHannes Reinecke if (megasas_use_msix(s)) { 230223335f62SHannes Reinecke msix_uninit(d, &s->mmio_io, &s->mmio_io); 23034522b69cSHannes Reinecke } 23044522b69cSHannes Reinecke if (megasas_use_msi(s)) { 23054522b69cSHannes Reinecke msi_uninit(d); 23064522b69cSHannes Reinecke } 230749ab747fSPaolo Bonzini } 230849ab747fSPaolo Bonzini 230949ab747fSPaolo Bonzini static const struct SCSIBusInfo megasas_scsi_info = { 231049ab747fSPaolo Bonzini .tcq = true, 231149ab747fSPaolo Bonzini .max_target = MFI_MAX_LD, 231249ab747fSPaolo Bonzini .max_lun = 255, 231349ab747fSPaolo Bonzini 231449ab747fSPaolo Bonzini .transfer_data = megasas_xfer_complete, 231549ab747fSPaolo Bonzini .get_sg_list = megasas_get_sg_list, 231649ab747fSPaolo Bonzini .complete = megasas_command_complete, 231749ab747fSPaolo Bonzini .cancel = megasas_command_cancel, 231849ab747fSPaolo Bonzini }; 231949ab747fSPaolo Bonzini 2320ae071cc8SMarkus Armbruster static void megasas_scsi_realize(PCIDevice *dev, Error **errp) 232149ab747fSPaolo Bonzini { 232222d6aa03SAndreas Färber DeviceState *d = DEVICE(dev); 2323c79e16aeSPeter Crosthwaite MegasasState *s = MEGASAS(dev); 2324e23d0498SHannes Reinecke MegasasBaseClass *b = MEGASAS_DEVICE_GET_CLASS(s); 232549ab747fSPaolo Bonzini uint8_t *pci_conf; 232649ab747fSPaolo Bonzini int i, bar_type; 232749ab747fSPaolo Bonzini 232852190c1eSAndreas Färber pci_conf = dev->config; 232949ab747fSPaolo Bonzini 233049ab747fSPaolo Bonzini /* PCI latency timer = 0 */ 233149ab747fSPaolo Bonzini pci_conf[PCI_LATENCY_TIMER] = 0; 233249ab747fSPaolo Bonzini /* Interrupt pin 1 */ 233349ab747fSPaolo Bonzini pci_conf[PCI_INTERRUPT_PIN] = 0x01; 233449ab747fSPaolo Bonzini 233529776739SPaolo Bonzini memory_region_init_io(&s->mmio_io, OBJECT(s), &megasas_mmio_ops, s, 233649ab747fSPaolo Bonzini "megasas-mmio", 0x4000); 233729776739SPaolo Bonzini memory_region_init_io(&s->port_io, OBJECT(s), &megasas_port_ops, s, 233849ab747fSPaolo Bonzini "megasas-io", 256); 233929776739SPaolo Bonzini memory_region_init_io(&s->queue_io, OBJECT(s), &megasas_queue_ops, s, 234049ab747fSPaolo Bonzini "megasas-queue", 0x40000); 234149ab747fSPaolo Bonzini 23424522b69cSHannes Reinecke if (megasas_use_msi(s) && 23434522b69cSHannes Reinecke msi_init(dev, 0x50, 1, true, false)) { 23444522b69cSHannes Reinecke s->flags &= ~MEGASAS_MASK_USE_MSI; 23454522b69cSHannes Reinecke } 234649ab747fSPaolo Bonzini if (megasas_use_msix(s) && 2347e23d0498SHannes Reinecke msix_init(dev, 15, &s->mmio_io, b->mmio_bar, 0x2000, 2348e23d0498SHannes Reinecke &s->mmio_io, b->mmio_bar, 0x3800, 0x68)) { 234949ab747fSPaolo Bonzini s->flags &= ~MEGASAS_MASK_USE_MSIX; 235049ab747fSPaolo Bonzini } 2351e23d0498SHannes Reinecke if (pci_is_express(dev)) { 2352e23d0498SHannes Reinecke pcie_endpoint_cap_init(dev, 0xa0); 2353e23d0498SHannes Reinecke } 235449ab747fSPaolo Bonzini 235549ab747fSPaolo Bonzini bar_type = PCI_BASE_ADDRESS_SPACE_MEMORY | PCI_BASE_ADDRESS_MEM_TYPE_64; 2356e23d0498SHannes Reinecke pci_register_bar(dev, b->ioport_bar, 2357e23d0498SHannes Reinecke PCI_BASE_ADDRESS_SPACE_IO, &s->port_io); 2358e23d0498SHannes Reinecke pci_register_bar(dev, b->mmio_bar, bar_type, &s->mmio_io); 235952190c1eSAndreas Färber pci_register_bar(dev, 3, bar_type, &s->queue_io); 236049ab747fSPaolo Bonzini 236149ab747fSPaolo Bonzini if (megasas_use_msix(s)) { 236252190c1eSAndreas Färber msix_vector_use(dev, 0); 236349ab747fSPaolo Bonzini } 236449ab747fSPaolo Bonzini 23658d72db68SHannes Reinecke s->fw_state = MFI_FWSTATE_READY; 236649ab747fSPaolo Bonzini if (!s->sas_addr) { 236749ab747fSPaolo Bonzini s->sas_addr = ((NAA_LOCALLY_ASSIGNED_ID << 24) | 236849ab747fSPaolo Bonzini IEEE_COMPANY_LOCALLY_ASSIGNED) << 36; 236949ab747fSPaolo Bonzini s->sas_addr |= (pci_bus_num(dev->bus) << 16); 237049ab747fSPaolo Bonzini s->sas_addr |= (PCI_SLOT(dev->devfn) << 8); 237149ab747fSPaolo Bonzini s->sas_addr |= PCI_FUNC(dev->devfn); 237249ab747fSPaolo Bonzini } 237349ab747fSPaolo Bonzini if (!s->hba_serial) { 237449ab747fSPaolo Bonzini s->hba_serial = g_strdup(MEGASAS_HBA_SERIAL); 237549ab747fSPaolo Bonzini } 237649ab747fSPaolo Bonzini if (s->fw_sge >= MEGASAS_MAX_SGE - MFI_PASS_FRAME_SIZE) { 237749ab747fSPaolo Bonzini s->fw_sge = MEGASAS_MAX_SGE - MFI_PASS_FRAME_SIZE; 237849ab747fSPaolo Bonzini } else if (s->fw_sge >= 128 - MFI_PASS_FRAME_SIZE) { 237949ab747fSPaolo Bonzini s->fw_sge = 128 - MFI_PASS_FRAME_SIZE; 238049ab747fSPaolo Bonzini } else { 238149ab747fSPaolo Bonzini s->fw_sge = 64 - MFI_PASS_FRAME_SIZE; 238249ab747fSPaolo Bonzini } 238349ab747fSPaolo Bonzini if (s->fw_cmds > MEGASAS_MAX_FRAMES) { 238449ab747fSPaolo Bonzini s->fw_cmds = MEGASAS_MAX_FRAMES; 238549ab747fSPaolo Bonzini } 238649ab747fSPaolo Bonzini trace_megasas_init(s->fw_sge, s->fw_cmds, 238749ab747fSPaolo Bonzini megasas_is_jbod(s) ? "jbod" : "raid"); 23883f2cd4ddSHannes Reinecke 23893f2cd4ddSHannes Reinecke if (megasas_is_jbod(s)) { 23903f2cd4ddSHannes Reinecke s->fw_luns = MFI_MAX_SYS_PDS; 23913f2cd4ddSHannes Reinecke } else { 23923f2cd4ddSHannes Reinecke s->fw_luns = MFI_MAX_LD; 23933f2cd4ddSHannes Reinecke } 239449ab747fSPaolo Bonzini s->producer_pa = 0; 239549ab747fSPaolo Bonzini s->consumer_pa = 0; 239649ab747fSPaolo Bonzini for (i = 0; i < s->fw_cmds; i++) { 239749ab747fSPaolo Bonzini s->frames[i].index = i; 239849ab747fSPaolo Bonzini s->frames[i].context = -1; 239949ab747fSPaolo Bonzini s->frames[i].pa = 0; 240049ab747fSPaolo Bonzini s->frames[i].state = s; 240149ab747fSPaolo Bonzini } 240249ab747fSPaolo Bonzini 2403b1187b51SAndreas Färber scsi_bus_new(&s->bus, sizeof(s->bus), DEVICE(dev), 2404b1187b51SAndreas Färber &megasas_scsi_info, NULL); 240522d6aa03SAndreas Färber if (!d->hotplugged) { 2406ae071cc8SMarkus Armbruster scsi_bus_legacy_handle_cmdline(&s->bus, errp); 2407caad4eb3SAndreas Färber } 240822d6aa03SAndreas Färber } 240949ab747fSPaolo Bonzini 24104522b69cSHannes Reinecke static void 24114522b69cSHannes Reinecke megasas_write_config(PCIDevice *pci, uint32_t addr, uint32_t val, int len) 24124522b69cSHannes Reinecke { 24134522b69cSHannes Reinecke pci_default_write_config(pci, addr, val, len); 24144522b69cSHannes Reinecke msi_write_config(pci, addr, val, len); 24154522b69cSHannes Reinecke } 24164522b69cSHannes Reinecke 2417e23d0498SHannes Reinecke static Property megasas_properties_gen1[] = { 241849ab747fSPaolo Bonzini DEFINE_PROP_UINT32("max_sge", MegasasState, fw_sge, 241949ab747fSPaolo Bonzini MEGASAS_DEFAULT_SGE), 242049ab747fSPaolo Bonzini DEFINE_PROP_UINT32("max_cmds", MegasasState, fw_cmds, 242149ab747fSPaolo Bonzini MEGASAS_DEFAULT_FRAMES), 242249ab747fSPaolo Bonzini DEFINE_PROP_STRING("hba_serial", MegasasState, hba_serial), 2423c7bcc85dSPaolo Bonzini DEFINE_PROP_UINT64("sas_address", MegasasState, sas_addr, 0), 24244522b69cSHannes Reinecke DEFINE_PROP_BIT("use_msi", MegasasState, flags, 24254522b69cSHannes Reinecke MEGASAS_FLAG_USE_MSI, false), 242649ab747fSPaolo Bonzini DEFINE_PROP_BIT("use_msix", MegasasState, flags, 242749ab747fSPaolo Bonzini MEGASAS_FLAG_USE_MSIX, false), 242849ab747fSPaolo Bonzini DEFINE_PROP_BIT("use_jbod", MegasasState, flags, 242949ab747fSPaolo Bonzini MEGASAS_FLAG_USE_JBOD, false), 243049ab747fSPaolo Bonzini DEFINE_PROP_END_OF_LIST(), 243149ab747fSPaolo Bonzini }; 243249ab747fSPaolo Bonzini 2433e23d0498SHannes Reinecke static Property megasas_properties_gen2[] = { 2434e23d0498SHannes Reinecke DEFINE_PROP_UINT32("max_sge", MegasasState, fw_sge, 2435e23d0498SHannes Reinecke MEGASAS_DEFAULT_SGE), 2436e23d0498SHannes Reinecke DEFINE_PROP_UINT32("max_cmds", MegasasState, fw_cmds, 2437e23d0498SHannes Reinecke MEGASAS_GEN2_DEFAULT_FRAMES), 2438e23d0498SHannes Reinecke DEFINE_PROP_STRING("hba_serial", MegasasState, hba_serial), 2439e23d0498SHannes Reinecke DEFINE_PROP_UINT64("sas_address", MegasasState, sas_addr, 0), 2440e23d0498SHannes Reinecke DEFINE_PROP_BIT("use_msi", MegasasState, flags, 2441e23d0498SHannes Reinecke MEGASAS_FLAG_USE_MSI, true), 2442e23d0498SHannes Reinecke DEFINE_PROP_BIT("use_msix", MegasasState, flags, 2443e23d0498SHannes Reinecke MEGASAS_FLAG_USE_MSIX, true), 2444e23d0498SHannes Reinecke DEFINE_PROP_BIT("use_jbod", MegasasState, flags, 2445e23d0498SHannes Reinecke MEGASAS_FLAG_USE_JBOD, false), 2446e23d0498SHannes Reinecke DEFINE_PROP_END_OF_LIST(), 2447e23d0498SHannes Reinecke }; 2448e23d0498SHannes Reinecke 2449e23d0498SHannes Reinecke typedef struct MegasasInfo { 2450e23d0498SHannes Reinecke const char *name; 2451e23d0498SHannes Reinecke const char *desc; 2452e23d0498SHannes Reinecke const char *product_name; 2453e23d0498SHannes Reinecke const char *product_version; 2454e23d0498SHannes Reinecke uint16_t device_id; 2455e23d0498SHannes Reinecke uint16_t subsystem_id; 2456e23d0498SHannes Reinecke int ioport_bar; 2457e23d0498SHannes Reinecke int mmio_bar; 2458e23d0498SHannes Reinecke bool is_express; 2459e23d0498SHannes Reinecke int osts; 2460e23d0498SHannes Reinecke const VMStateDescription *vmsd; 2461e23d0498SHannes Reinecke Property *props; 2462e23d0498SHannes Reinecke } MegasasInfo; 2463e23d0498SHannes Reinecke 2464e23d0498SHannes Reinecke static struct MegasasInfo megasas_devices[] = { 2465e23d0498SHannes Reinecke { 2466e23d0498SHannes Reinecke .name = TYPE_MEGASAS_GEN1, 2467e23d0498SHannes Reinecke .desc = "LSI MegaRAID SAS 1078", 2468e23d0498SHannes Reinecke .product_name = "LSI MegaRAID SAS 8708EM2", 2469e23d0498SHannes Reinecke .product_version = MEGASAS_VERSION_GEN1, 2470e23d0498SHannes Reinecke .device_id = PCI_DEVICE_ID_LSI_SAS1078, 2471e23d0498SHannes Reinecke .subsystem_id = 0x1013, 2472e23d0498SHannes Reinecke .ioport_bar = 2, 2473e23d0498SHannes Reinecke .mmio_bar = 0, 2474e23d0498SHannes Reinecke .osts = MFI_1078_RM | 1, 2475e23d0498SHannes Reinecke .is_express = false, 2476e23d0498SHannes Reinecke .vmsd = &vmstate_megasas_gen1, 2477e23d0498SHannes Reinecke .props = megasas_properties_gen1, 2478e23d0498SHannes Reinecke },{ 2479e23d0498SHannes Reinecke .name = TYPE_MEGASAS_GEN2, 2480e23d0498SHannes Reinecke .desc = "LSI MegaRAID SAS 2108", 2481e23d0498SHannes Reinecke .product_name = "LSI MegaRAID SAS 9260-8i", 2482e23d0498SHannes Reinecke .product_version = MEGASAS_VERSION_GEN2, 2483e23d0498SHannes Reinecke .device_id = PCI_DEVICE_ID_LSI_SAS0079, 2484e23d0498SHannes Reinecke .subsystem_id = 0x9261, 2485e23d0498SHannes Reinecke .ioport_bar = 0, 2486e23d0498SHannes Reinecke .mmio_bar = 1, 2487e23d0498SHannes Reinecke .osts = MFI_GEN2_RM, 2488e23d0498SHannes Reinecke .is_express = true, 2489e23d0498SHannes Reinecke .vmsd = &vmstate_megasas_gen2, 2490e23d0498SHannes Reinecke .props = megasas_properties_gen2, 2491e23d0498SHannes Reinecke } 2492e23d0498SHannes Reinecke }; 2493e23d0498SHannes Reinecke 249449ab747fSPaolo Bonzini static void megasas_class_init(ObjectClass *oc, void *data) 249549ab747fSPaolo Bonzini { 249649ab747fSPaolo Bonzini DeviceClass *dc = DEVICE_CLASS(oc); 249749ab747fSPaolo Bonzini PCIDeviceClass *pc = PCI_DEVICE_CLASS(oc); 2498e23d0498SHannes Reinecke MegasasBaseClass *e = MEGASAS_DEVICE_CLASS(oc); 2499e23d0498SHannes Reinecke const MegasasInfo *info = data; 250049ab747fSPaolo Bonzini 2501ae071cc8SMarkus Armbruster pc->realize = megasas_scsi_realize; 250249ab747fSPaolo Bonzini pc->exit = megasas_scsi_uninit; 250349ab747fSPaolo Bonzini pc->vendor_id = PCI_VENDOR_ID_LSI_LOGIC; 2504e23d0498SHannes Reinecke pc->device_id = info->device_id; 250549ab747fSPaolo Bonzini pc->subsystem_vendor_id = PCI_VENDOR_ID_LSI_LOGIC; 2506e23d0498SHannes Reinecke pc->subsystem_id = info->subsystem_id; 250749ab747fSPaolo Bonzini pc->class_id = PCI_CLASS_STORAGE_RAID; 2508e23d0498SHannes Reinecke pc->is_express = info->is_express; 2509e23d0498SHannes Reinecke e->mmio_bar = info->mmio_bar; 2510e23d0498SHannes Reinecke e->ioport_bar = info->ioport_bar; 2511e23d0498SHannes Reinecke e->osts = info->osts; 2512e23d0498SHannes Reinecke e->product_name = info->product_name; 2513e23d0498SHannes Reinecke e->product_version = info->product_version; 2514e23d0498SHannes Reinecke dc->props = info->props; 251549ab747fSPaolo Bonzini dc->reset = megasas_scsi_reset; 2516e23d0498SHannes Reinecke dc->vmsd = info->vmsd; 2517125ee0edSMarcel Apfelbaum set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 2518e23d0498SHannes Reinecke dc->desc = info->desc; 25194522b69cSHannes Reinecke pc->config_write = megasas_write_config; 252049ab747fSPaolo Bonzini } 252149ab747fSPaolo Bonzini 252249ab747fSPaolo Bonzini static const TypeInfo megasas_info = { 2523e23d0498SHannes Reinecke .name = TYPE_MEGASAS_BASE, 252449ab747fSPaolo Bonzini .parent = TYPE_PCI_DEVICE, 252549ab747fSPaolo Bonzini .instance_size = sizeof(MegasasState), 2526e23d0498SHannes Reinecke .class_size = sizeof(MegasasBaseClass), 2527e23d0498SHannes Reinecke .abstract = true, 252849ab747fSPaolo Bonzini }; 252949ab747fSPaolo Bonzini 253049ab747fSPaolo Bonzini static void megasas_register_types(void) 253149ab747fSPaolo Bonzini { 2532e23d0498SHannes Reinecke int i; 2533e23d0498SHannes Reinecke 253449ab747fSPaolo Bonzini type_register_static(&megasas_info); 2535e23d0498SHannes Reinecke for (i = 0; i < ARRAY_SIZE(megasas_devices); i++) { 2536e23d0498SHannes Reinecke const MegasasInfo *info = &megasas_devices[i]; 2537e23d0498SHannes Reinecke TypeInfo type_info = {}; 2538e23d0498SHannes Reinecke 2539e23d0498SHannes Reinecke type_info.name = info->name; 2540e23d0498SHannes Reinecke type_info.parent = TYPE_MEGASAS_BASE; 2541e23d0498SHannes Reinecke type_info.class_data = (void *)info; 2542e23d0498SHannes Reinecke type_info.class_init = megasas_class_init; 2543e23d0498SHannes Reinecke 2544e23d0498SHannes Reinecke type_register(&type_info); 2545e23d0498SHannes Reinecke } 254649ab747fSPaolo Bonzini } 254749ab747fSPaolo Bonzini 254849ab747fSPaolo Bonzini type_init(megasas_register_types) 2549