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 21a4ab4792SPeter Maydell #include "qemu/osdep.h" 22a8d25326SMarkus Armbruster #include "qemu-common.h" 2349ab747fSPaolo Bonzini #include "hw/pci/pci.h" 24a27bd6c7SMarkus Armbruster #include "hw/qdev-properties.h" 2549ab747fSPaolo Bonzini #include "sysemu/dma.h" 264be74634SMarkus Armbruster #include "sysemu/block-backend.h" 274522b69cSHannes Reinecke #include "hw/pci/msi.h" 2849ab747fSPaolo Bonzini #include "hw/pci/msix.h" 2949ab747fSPaolo Bonzini #include "qemu/iov.h" 300b8fa32fSMarkus Armbruster #include "qemu/module.h" 3149ab747fSPaolo Bonzini #include "hw/scsi/scsi.h" 3208e2c9f1SPaolo Bonzini #include "scsi/constants.h" 3349ab747fSPaolo Bonzini #include "trace.h" 341108b2f8SCao jin #include "qapi/error.h" 3547b43a1fSPaolo Bonzini #include "mfi.h" 36d6454270SMarkus Armbruster #include "migration/vmstate.h" 37db1015e9SEduardo Habkost #include "qom/object.h" 3849ab747fSPaolo Bonzini 39e23d0498SHannes Reinecke #define MEGASAS_VERSION_GEN1 "1.70" 40e23d0498SHannes Reinecke #define MEGASAS_VERSION_GEN2 "1.80" 4149ab747fSPaolo Bonzini #define MEGASAS_MAX_FRAMES 2048 /* Firmware limit at 65535 */ 4249ab747fSPaolo Bonzini #define MEGASAS_DEFAULT_FRAMES 1000 /* Windows requires this */ 43e23d0498SHannes Reinecke #define MEGASAS_GEN2_DEFAULT_FRAMES 1008 /* Windows requires this */ 4449ab747fSPaolo Bonzini #define MEGASAS_MAX_SGE 128 /* Firmware limit */ 4549ab747fSPaolo Bonzini #define MEGASAS_DEFAULT_SGE 80 4649ab747fSPaolo Bonzini #define MEGASAS_MAX_SECTORS 0xFFFF /* No real limit */ 4749ab747fSPaolo Bonzini #define MEGASAS_MAX_ARRAYS 128 4849ab747fSPaolo Bonzini 4949ab747fSPaolo Bonzini #define MEGASAS_HBA_SERIAL "QEMU123456" 5049ab747fSPaolo Bonzini #define NAA_LOCALLY_ASSIGNED_ID 0x3ULL 5149ab747fSPaolo Bonzini #define IEEE_COMPANY_LOCALLY_ASSIGNED 0x525400 5249ab747fSPaolo Bonzini 5349ab747fSPaolo Bonzini #define MEGASAS_FLAG_USE_JBOD 0 5449ab747fSPaolo Bonzini #define MEGASAS_MASK_USE_JBOD (1 << MEGASAS_FLAG_USE_JBOD) 55b4b4a57fSCao jin #define MEGASAS_FLAG_USE_QUEUE64 1 5649ab747fSPaolo Bonzini #define MEGASAS_MASK_USE_QUEUE64 (1 << MEGASAS_FLAG_USE_QUEUE64) 5749ab747fSPaolo Bonzini 5849ab747fSPaolo Bonzini typedef struct MegasasCmd { 5949ab747fSPaolo Bonzini uint32_t index; 6049ab747fSPaolo Bonzini uint16_t flags; 6149ab747fSPaolo Bonzini uint16_t count; 6249ab747fSPaolo Bonzini uint64_t context; 6349ab747fSPaolo Bonzini 6449ab747fSPaolo Bonzini hwaddr pa; 6549ab747fSPaolo Bonzini hwaddr pa_size; 665104fac8SPaolo Bonzini uint32_t dcmd_opcode; 6749ab747fSPaolo Bonzini union mfi_frame *frame; 6849ab747fSPaolo Bonzini SCSIRequest *req; 6949ab747fSPaolo Bonzini QEMUSGList qsg; 7049ab747fSPaolo Bonzini void *iov_buf; 7149ab747fSPaolo Bonzini size_t iov_size; 7249ab747fSPaolo Bonzini size_t iov_offset; 7349ab747fSPaolo Bonzini struct MegasasState *state; 7449ab747fSPaolo Bonzini } MegasasCmd; 7549ab747fSPaolo Bonzini 76db1015e9SEduardo Habkost struct MegasasState { 7752190c1eSAndreas Färber /*< private >*/ 7852190c1eSAndreas Färber PCIDevice parent_obj; 7952190c1eSAndreas Färber /*< public >*/ 8052190c1eSAndreas Färber 8149ab747fSPaolo Bonzini MemoryRegion mmio_io; 8249ab747fSPaolo Bonzini MemoryRegion port_io; 8349ab747fSPaolo Bonzini MemoryRegion queue_io; 8449ab747fSPaolo Bonzini uint32_t frame_hi; 8549ab747fSPaolo Bonzini 862b151297SPrasad J Pandit uint32_t fw_state; 8749ab747fSPaolo Bonzini uint32_t fw_sge; 8849ab747fSPaolo Bonzini uint32_t fw_cmds; 8949ab747fSPaolo Bonzini uint32_t flags; 902b151297SPrasad J Pandit uint32_t fw_luns; 912b151297SPrasad J Pandit uint32_t intr_mask; 922b151297SPrasad J Pandit uint32_t doorbell; 932b151297SPrasad J Pandit uint32_t busy; 942b151297SPrasad J Pandit uint32_t diag; 952b151297SPrasad J Pandit uint32_t adp_reset; 96b4b4a57fSCao jin OnOffAuto msi; 97b4b4a57fSCao jin OnOffAuto msix; 9849ab747fSPaolo Bonzini 9949ab747fSPaolo Bonzini MegasasCmd *event_cmd; 1002b151297SPrasad J Pandit uint16_t event_locale; 10149ab747fSPaolo Bonzini int event_class; 1022b151297SPrasad J Pandit uint32_t event_count; 1032b151297SPrasad J Pandit uint32_t shutdown_event; 1042b151297SPrasad J Pandit uint32_t 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; 1112b151297SPrasad J Pandit uint16_t reply_queue_len; 112f50ab86aSPrasad J Pandit uint16_t reply_queue_head; 1132b151297SPrasad J Pandit uint16_t 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; 120db1015e9SEduardo Habkost }; 121db1015e9SEduardo Habkost typedef struct MegasasState MegasasState; 12249ab747fSPaolo Bonzini 123db1015e9SEduardo Habkost struct MegasasBaseClass { 124e23d0498SHannes Reinecke PCIDeviceClass parent_class; 125e23d0498SHannes Reinecke const char *product_name; 126e23d0498SHannes Reinecke const char *product_version; 127e23d0498SHannes Reinecke int mmio_bar; 128e23d0498SHannes Reinecke int ioport_bar; 129e23d0498SHannes Reinecke int osts; 130db1015e9SEduardo Habkost }; 131db1015e9SEduardo Habkost typedef struct MegasasBaseClass MegasasBaseClass; 132e23d0498SHannes Reinecke 133e23d0498SHannes Reinecke #define TYPE_MEGASAS_BASE "megasas-base" 134e23d0498SHannes Reinecke #define TYPE_MEGASAS_GEN1 "megasas" 135e23d0498SHannes Reinecke #define TYPE_MEGASAS_GEN2 "megasas-gen2" 136c79e16aeSPeter Crosthwaite 137*8110fa1dSEduardo Habkost DECLARE_OBJ_CHECKERS(MegasasState, MegasasBaseClass, 138*8110fa1dSEduardo Habkost MEGASAS, TYPE_MEGASAS_BASE) 139e23d0498SHannes Reinecke 140c79e16aeSPeter Crosthwaite 14149ab747fSPaolo Bonzini #define MEGASAS_INTR_DISABLED_MASK 0xFFFFFFFF 14249ab747fSPaolo Bonzini 14349ab747fSPaolo Bonzini static bool megasas_intr_enabled(MegasasState *s) 14449ab747fSPaolo Bonzini { 14549ab747fSPaolo Bonzini if ((s->intr_mask & MEGASAS_INTR_DISABLED_MASK) != 14649ab747fSPaolo Bonzini MEGASAS_INTR_DISABLED_MASK) { 14749ab747fSPaolo Bonzini return true; 14849ab747fSPaolo Bonzini } 14949ab747fSPaolo Bonzini return false; 15049ab747fSPaolo Bonzini } 15149ab747fSPaolo Bonzini 15249ab747fSPaolo Bonzini static bool megasas_use_queue64(MegasasState *s) 15349ab747fSPaolo Bonzini { 15449ab747fSPaolo Bonzini return s->flags & MEGASAS_MASK_USE_QUEUE64; 15549ab747fSPaolo Bonzini } 15649ab747fSPaolo Bonzini 15749ab747fSPaolo Bonzini static bool megasas_use_msix(MegasasState *s) 15849ab747fSPaolo Bonzini { 159b4b4a57fSCao jin return s->msix != ON_OFF_AUTO_OFF; 16049ab747fSPaolo Bonzini } 16149ab747fSPaolo Bonzini 16249ab747fSPaolo Bonzini static bool megasas_is_jbod(MegasasState *s) 16349ab747fSPaolo Bonzini { 16449ab747fSPaolo Bonzini return s->flags & MEGASAS_MASK_USE_JBOD; 16549ab747fSPaolo Bonzini } 16649ab747fSPaolo Bonzini 16716578c6fSPaolo Bonzini static void megasas_frame_set_cmd_status(MegasasState *s, 16816578c6fSPaolo Bonzini unsigned long frame, uint8_t v) 16949ab747fSPaolo Bonzini { 17016578c6fSPaolo Bonzini PCIDevice *pci = &s->parent_obj; 17116578c6fSPaolo Bonzini stb_pci_dma(pci, frame + offsetof(struct mfi_frame_header, cmd_status), v); 17249ab747fSPaolo Bonzini } 17349ab747fSPaolo Bonzini 17416578c6fSPaolo Bonzini static void megasas_frame_set_scsi_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, scsi_status), v); 17949ab747fSPaolo Bonzini } 18049ab747fSPaolo Bonzini 181ee760ac8SThomas Huth static inline const char *mfi_frame_desc(unsigned int cmd) 182ee760ac8SThomas Huth { 183ee760ac8SThomas Huth static const char *mfi_frame_descs[] = { 184ee760ac8SThomas Huth "MFI init", "LD Read", "LD Write", "LD SCSI", "PD SCSI", 185ee760ac8SThomas Huth "MFI Doorbell", "MFI Abort", "MFI SMP", "MFI Stop" 186ee760ac8SThomas Huth }; 187ee760ac8SThomas Huth 188ee760ac8SThomas Huth if (cmd < ARRAY_SIZE(mfi_frame_descs)) { 189ee760ac8SThomas Huth return mfi_frame_descs[cmd]; 190ee760ac8SThomas Huth } 191ee760ac8SThomas Huth 192ee760ac8SThomas Huth return "Unknown"; 193ee760ac8SThomas Huth } 194ee760ac8SThomas Huth 19549ab747fSPaolo Bonzini /* 19649ab747fSPaolo Bonzini * Context is considered opaque, but the HBA firmware is running 19749ab747fSPaolo Bonzini * in little endian mode. So convert it to little endian, too. 19849ab747fSPaolo Bonzini */ 19916578c6fSPaolo Bonzini static uint64_t megasas_frame_get_context(MegasasState *s, 20016578c6fSPaolo Bonzini unsigned long frame) 20149ab747fSPaolo Bonzini { 20216578c6fSPaolo Bonzini PCIDevice *pci = &s->parent_obj; 20316578c6fSPaolo Bonzini return ldq_le_pci_dma(pci, frame + offsetof(struct mfi_frame_header, context)); 20449ab747fSPaolo Bonzini } 20549ab747fSPaolo Bonzini 20649ab747fSPaolo Bonzini static bool megasas_frame_is_ieee_sgl(MegasasCmd *cmd) 20749ab747fSPaolo Bonzini { 20849ab747fSPaolo Bonzini return cmd->flags & MFI_FRAME_IEEE_SGL; 20949ab747fSPaolo Bonzini } 21049ab747fSPaolo Bonzini 21149ab747fSPaolo Bonzini static bool megasas_frame_is_sgl64(MegasasCmd *cmd) 21249ab747fSPaolo Bonzini { 21349ab747fSPaolo Bonzini return cmd->flags & MFI_FRAME_SGL64; 21449ab747fSPaolo Bonzini } 21549ab747fSPaolo Bonzini 21649ab747fSPaolo Bonzini static bool megasas_frame_is_sense64(MegasasCmd *cmd) 21749ab747fSPaolo Bonzini { 21849ab747fSPaolo Bonzini return cmd->flags & MFI_FRAME_SENSE64; 21949ab747fSPaolo Bonzini } 22049ab747fSPaolo Bonzini 22149ab747fSPaolo Bonzini static uint64_t megasas_sgl_get_addr(MegasasCmd *cmd, 22249ab747fSPaolo Bonzini union mfi_sgl *sgl) 22349ab747fSPaolo Bonzini { 22449ab747fSPaolo Bonzini uint64_t addr; 22549ab747fSPaolo Bonzini 22649ab747fSPaolo Bonzini if (megasas_frame_is_ieee_sgl(cmd)) { 22749ab747fSPaolo Bonzini addr = le64_to_cpu(sgl->sg_skinny->addr); 22849ab747fSPaolo Bonzini } else if (megasas_frame_is_sgl64(cmd)) { 22949ab747fSPaolo Bonzini addr = le64_to_cpu(sgl->sg64->addr); 23049ab747fSPaolo Bonzini } else { 23149ab747fSPaolo Bonzini addr = le32_to_cpu(sgl->sg32->addr); 23249ab747fSPaolo Bonzini } 23349ab747fSPaolo Bonzini return addr; 23449ab747fSPaolo Bonzini } 23549ab747fSPaolo Bonzini 23649ab747fSPaolo Bonzini static uint32_t megasas_sgl_get_len(MegasasCmd *cmd, 23749ab747fSPaolo Bonzini union mfi_sgl *sgl) 23849ab747fSPaolo Bonzini { 23949ab747fSPaolo Bonzini uint32_t len; 24049ab747fSPaolo Bonzini 24149ab747fSPaolo Bonzini if (megasas_frame_is_ieee_sgl(cmd)) { 24249ab747fSPaolo Bonzini len = le32_to_cpu(sgl->sg_skinny->len); 24349ab747fSPaolo Bonzini } else if (megasas_frame_is_sgl64(cmd)) { 24449ab747fSPaolo Bonzini len = le32_to_cpu(sgl->sg64->len); 24549ab747fSPaolo Bonzini } else { 24649ab747fSPaolo Bonzini len = le32_to_cpu(sgl->sg32->len); 24749ab747fSPaolo Bonzini } 24849ab747fSPaolo Bonzini return len; 24949ab747fSPaolo Bonzini } 25049ab747fSPaolo Bonzini 25149ab747fSPaolo Bonzini static union mfi_sgl *megasas_sgl_next(MegasasCmd *cmd, 25249ab747fSPaolo Bonzini union mfi_sgl *sgl) 25349ab747fSPaolo Bonzini { 25449ab747fSPaolo Bonzini uint8_t *next = (uint8_t *)sgl; 25549ab747fSPaolo Bonzini 25649ab747fSPaolo Bonzini if (megasas_frame_is_ieee_sgl(cmd)) { 25749ab747fSPaolo Bonzini next += sizeof(struct mfi_sg_skinny); 25849ab747fSPaolo Bonzini } else if (megasas_frame_is_sgl64(cmd)) { 25949ab747fSPaolo Bonzini next += sizeof(struct mfi_sg64); 26049ab747fSPaolo Bonzini } else { 26149ab747fSPaolo Bonzini next += sizeof(struct mfi_sg32); 26249ab747fSPaolo Bonzini } 26349ab747fSPaolo Bonzini 26449ab747fSPaolo Bonzini if (next >= (uint8_t *)cmd->frame + cmd->pa_size) { 26549ab747fSPaolo Bonzini return NULL; 26649ab747fSPaolo Bonzini } 26749ab747fSPaolo Bonzini return (union mfi_sgl *)next; 26849ab747fSPaolo Bonzini } 26949ab747fSPaolo Bonzini 27049ab747fSPaolo Bonzini static void megasas_soft_reset(MegasasState *s); 27149ab747fSPaolo Bonzini 27249ab747fSPaolo Bonzini static int megasas_map_sgl(MegasasState *s, MegasasCmd *cmd, union mfi_sgl *sgl) 27349ab747fSPaolo Bonzini { 27449ab747fSPaolo Bonzini int i; 27549ab747fSPaolo Bonzini int iov_count = 0; 27649ab747fSPaolo Bonzini size_t iov_size = 0; 27749ab747fSPaolo Bonzini 27849ab747fSPaolo Bonzini cmd->flags = le16_to_cpu(cmd->frame->header.flags); 27949ab747fSPaolo Bonzini iov_count = cmd->frame->header.sge_count; 28049ab747fSPaolo Bonzini if (iov_count > MEGASAS_MAX_SGE) { 28149ab747fSPaolo Bonzini trace_megasas_iovec_sgl_overflow(cmd->index, iov_count, 28249ab747fSPaolo Bonzini MEGASAS_MAX_SGE); 28349ab747fSPaolo Bonzini return iov_count; 28449ab747fSPaolo Bonzini } 28552190c1eSAndreas Färber pci_dma_sglist_init(&cmd->qsg, PCI_DEVICE(s), iov_count); 28649ab747fSPaolo Bonzini for (i = 0; i < iov_count; i++) { 28749ab747fSPaolo Bonzini dma_addr_t iov_pa, iov_size_p; 28849ab747fSPaolo Bonzini 28949ab747fSPaolo Bonzini if (!sgl) { 29049ab747fSPaolo Bonzini trace_megasas_iovec_sgl_underflow(cmd->index, i); 29149ab747fSPaolo Bonzini goto unmap; 29249ab747fSPaolo Bonzini } 29349ab747fSPaolo Bonzini iov_pa = megasas_sgl_get_addr(cmd, sgl); 29449ab747fSPaolo Bonzini iov_size_p = megasas_sgl_get_len(cmd, sgl); 29549ab747fSPaolo Bonzini if (!iov_pa || !iov_size_p) { 29649ab747fSPaolo Bonzini trace_megasas_iovec_sgl_invalid(cmd->index, i, 29749ab747fSPaolo Bonzini iov_pa, iov_size_p); 29849ab747fSPaolo Bonzini goto unmap; 29949ab747fSPaolo Bonzini } 30049ab747fSPaolo Bonzini qemu_sglist_add(&cmd->qsg, iov_pa, iov_size_p); 30149ab747fSPaolo Bonzini sgl = megasas_sgl_next(cmd, sgl); 30249ab747fSPaolo Bonzini iov_size += (size_t)iov_size_p; 30349ab747fSPaolo Bonzini } 30449ab747fSPaolo Bonzini if (cmd->iov_size > iov_size) { 30549ab747fSPaolo Bonzini trace_megasas_iovec_overflow(cmd->index, iov_size, cmd->iov_size); 30649ab747fSPaolo Bonzini } else if (cmd->iov_size < iov_size) { 307d17e7448SEric Blake trace_megasas_iovec_underflow(cmd->index, iov_size, cmd->iov_size); 30849ab747fSPaolo Bonzini } 30949ab747fSPaolo Bonzini cmd->iov_offset = 0; 31049ab747fSPaolo Bonzini return 0; 31149ab747fSPaolo Bonzini unmap: 31249ab747fSPaolo Bonzini qemu_sglist_destroy(&cmd->qsg); 31349ab747fSPaolo Bonzini return iov_count - i; 31449ab747fSPaolo Bonzini } 31549ab747fSPaolo Bonzini 31649ab747fSPaolo Bonzini /* 31749ab747fSPaolo Bonzini * passthrough sense and io sense are at the same offset 31849ab747fSPaolo Bonzini */ 31949ab747fSPaolo Bonzini static int megasas_build_sense(MegasasCmd *cmd, uint8_t *sense_ptr, 32049ab747fSPaolo Bonzini uint8_t sense_len) 32149ab747fSPaolo Bonzini { 3221016b239SPaolo Bonzini PCIDevice *pcid = PCI_DEVICE(cmd->state); 32349ab747fSPaolo Bonzini uint32_t pa_hi = 0, pa_lo; 32449ab747fSPaolo Bonzini hwaddr pa; 325134550bfSPaolo Bonzini int frame_sense_len; 32649ab747fSPaolo Bonzini 327134550bfSPaolo Bonzini frame_sense_len = cmd->frame->header.sense_len; 328134550bfSPaolo Bonzini if (sense_len > frame_sense_len) { 329134550bfSPaolo Bonzini sense_len = frame_sense_len; 33049ab747fSPaolo Bonzini } 33149ab747fSPaolo Bonzini if (sense_len) { 33249ab747fSPaolo Bonzini pa_lo = le32_to_cpu(cmd->frame->pass.sense_addr_lo); 33349ab747fSPaolo Bonzini if (megasas_frame_is_sense64(cmd)) { 33449ab747fSPaolo Bonzini pa_hi = le32_to_cpu(cmd->frame->pass.sense_addr_hi); 33549ab747fSPaolo Bonzini } 33649ab747fSPaolo Bonzini pa = ((uint64_t) pa_hi << 32) | pa_lo; 3371016b239SPaolo Bonzini pci_dma_write(pcid, pa, sense_ptr, sense_len); 33849ab747fSPaolo Bonzini cmd->frame->header.sense_len = sense_len; 33949ab747fSPaolo Bonzini } 34049ab747fSPaolo Bonzini return sense_len; 34149ab747fSPaolo Bonzini } 34249ab747fSPaolo Bonzini 34349ab747fSPaolo Bonzini static void megasas_write_sense(MegasasCmd *cmd, SCSISense sense) 34449ab747fSPaolo Bonzini { 34549ab747fSPaolo Bonzini uint8_t sense_buf[SCSI_SENSE_BUF_SIZE]; 34649ab747fSPaolo Bonzini uint8_t sense_len = 18; 34749ab747fSPaolo Bonzini 34849ab747fSPaolo Bonzini memset(sense_buf, 0, sense_len); 34949ab747fSPaolo Bonzini sense_buf[0] = 0xf0; 35049ab747fSPaolo Bonzini sense_buf[2] = sense.key; 35149ab747fSPaolo Bonzini sense_buf[7] = 10; 35249ab747fSPaolo Bonzini sense_buf[12] = sense.asc; 35349ab747fSPaolo Bonzini sense_buf[13] = sense.ascq; 35449ab747fSPaolo Bonzini megasas_build_sense(cmd, sense_buf, sense_len); 35549ab747fSPaolo Bonzini } 35649ab747fSPaolo Bonzini 35749ab747fSPaolo Bonzini static void megasas_copy_sense(MegasasCmd *cmd) 35849ab747fSPaolo Bonzini { 35949ab747fSPaolo Bonzini uint8_t sense_buf[SCSI_SENSE_BUF_SIZE]; 36049ab747fSPaolo Bonzini uint8_t sense_len; 36149ab747fSPaolo Bonzini 36249ab747fSPaolo Bonzini sense_len = scsi_req_get_sense(cmd->req, sense_buf, 36349ab747fSPaolo Bonzini SCSI_SENSE_BUF_SIZE); 36449ab747fSPaolo Bonzini megasas_build_sense(cmd, sense_buf, sense_len); 36549ab747fSPaolo Bonzini } 36649ab747fSPaolo Bonzini 36749ab747fSPaolo Bonzini /* 36849ab747fSPaolo Bonzini * Format an INQUIRY CDB 36949ab747fSPaolo Bonzini */ 37049ab747fSPaolo Bonzini static int megasas_setup_inquiry(uint8_t *cdb, int pg, int len) 37149ab747fSPaolo Bonzini { 37249ab747fSPaolo Bonzini memset(cdb, 0, 6); 37349ab747fSPaolo Bonzini cdb[0] = INQUIRY; 37449ab747fSPaolo Bonzini if (pg > 0) { 37549ab747fSPaolo Bonzini cdb[1] = 0x1; 37649ab747fSPaolo Bonzini cdb[2] = pg; 37749ab747fSPaolo Bonzini } 37849ab747fSPaolo Bonzini cdb[3] = (len >> 8) & 0xff; 37949ab747fSPaolo Bonzini cdb[4] = (len & 0xff); 38049ab747fSPaolo Bonzini return len; 38149ab747fSPaolo Bonzini } 38249ab747fSPaolo Bonzini 38349ab747fSPaolo Bonzini /* 38449ab747fSPaolo Bonzini * Encode lba and len into a READ_16/WRITE_16 CDB 38549ab747fSPaolo Bonzini */ 38649ab747fSPaolo Bonzini static void megasas_encode_lba(uint8_t *cdb, uint64_t lba, 38749ab747fSPaolo Bonzini uint32_t len, bool is_write) 38849ab747fSPaolo Bonzini { 38949ab747fSPaolo Bonzini memset(cdb, 0x0, 16); 39049ab747fSPaolo Bonzini if (is_write) { 39149ab747fSPaolo Bonzini cdb[0] = WRITE_16; 39249ab747fSPaolo Bonzini } else { 39349ab747fSPaolo Bonzini cdb[0] = READ_16; 39449ab747fSPaolo Bonzini } 39549ab747fSPaolo Bonzini cdb[2] = (lba >> 56) & 0xff; 39649ab747fSPaolo Bonzini cdb[3] = (lba >> 48) & 0xff; 39749ab747fSPaolo Bonzini cdb[4] = (lba >> 40) & 0xff; 39849ab747fSPaolo Bonzini cdb[5] = (lba >> 32) & 0xff; 39949ab747fSPaolo Bonzini cdb[6] = (lba >> 24) & 0xff; 40049ab747fSPaolo Bonzini cdb[7] = (lba >> 16) & 0xff; 40149ab747fSPaolo Bonzini cdb[8] = (lba >> 8) & 0xff; 40249ab747fSPaolo Bonzini cdb[9] = (lba) & 0xff; 40349ab747fSPaolo Bonzini cdb[10] = (len >> 24) & 0xff; 40449ab747fSPaolo Bonzini cdb[11] = (len >> 16) & 0xff; 40549ab747fSPaolo Bonzini cdb[12] = (len >> 8) & 0xff; 40649ab747fSPaolo Bonzini cdb[13] = (len) & 0xff; 40749ab747fSPaolo Bonzini } 40849ab747fSPaolo Bonzini 40949ab747fSPaolo Bonzini /* 41049ab747fSPaolo Bonzini * Utility functions 41149ab747fSPaolo Bonzini */ 41249ab747fSPaolo Bonzini static uint64_t megasas_fw_time(void) 41349ab747fSPaolo Bonzini { 41449ab747fSPaolo Bonzini struct tm curtime; 41549ab747fSPaolo Bonzini 41649ab747fSPaolo Bonzini qemu_get_timedate(&curtime, 0); 4179be38598SEduardo Habkost return ((uint64_t)curtime.tm_sec & 0xff) << 48 | 41849ab747fSPaolo Bonzini ((uint64_t)curtime.tm_min & 0xff) << 40 | 41949ab747fSPaolo Bonzini ((uint64_t)curtime.tm_hour & 0xff) << 32 | 42049ab747fSPaolo Bonzini ((uint64_t)curtime.tm_mday & 0xff) << 24 | 42149ab747fSPaolo Bonzini ((uint64_t)curtime.tm_mon & 0xff) << 16 | 42249ab747fSPaolo Bonzini ((uint64_t)(curtime.tm_year + 1900) & 0xffff); 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); 4348ef2eb8dSPaolo Bonzini return addr | ((uint64_t)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 457f50ab86aSPrasad J Pandit while (num < s->fw_cmds && index < MEGASAS_MAX_FRAMES) { 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 47375f19f8cSPaolo Bonzini if (cmd->pa_size) { 4746df5718bSHannes Reinecke pci_dma_unmap(p, cmd->frame, cmd->pa_size, 0, 0); 47575f19f8cSPaolo Bonzini } 4766df5718bSHannes Reinecke cmd->frame = NULL; 4776df5718bSHannes Reinecke cmd->pa = 0; 47875f19f8cSPaolo Bonzini cmd->pa_size = 0; 47948285ba2SMarc-André Lureau qemu_sglist_destroy(&cmd->qsg); 4806df5718bSHannes Reinecke clear_bit(cmd->index, s->frame_map); 48149ab747fSPaolo Bonzini } 48249ab747fSPaolo Bonzini 4836df5718bSHannes Reinecke /* 4846df5718bSHannes Reinecke * This absolutely needs to be locked if 4856df5718bSHannes Reinecke * qemu ever goes multithreaded. 4866df5718bSHannes Reinecke */ 48749ab747fSPaolo Bonzini static MegasasCmd *megasas_enqueue_frame(MegasasState *s, 48849ab747fSPaolo Bonzini hwaddr frame, uint64_t context, int count) 48949ab747fSPaolo Bonzini { 4901016b239SPaolo Bonzini PCIDevice *pcid = PCI_DEVICE(s); 49149ab747fSPaolo Bonzini MegasasCmd *cmd = NULL; 4922e56fbc8SPeter Lieven int frame_size = MEGASAS_MAX_SGE * sizeof(union mfi_sgl); 49349ab747fSPaolo Bonzini hwaddr frame_size_p = frame_size; 4946df5718bSHannes Reinecke unsigned long index; 49549ab747fSPaolo Bonzini 4966df5718bSHannes Reinecke index = 0; 4976df5718bSHannes Reinecke while (index < s->fw_cmds) { 4986df5718bSHannes Reinecke index = find_next_zero_bit(s->frame_map, s->fw_cmds, index); 4996df5718bSHannes Reinecke if (!s->frames[index].pa) 5006df5718bSHannes Reinecke break; 5016df5718bSHannes Reinecke /* Busy frame found */ 5026df5718bSHannes Reinecke trace_megasas_qf_mapped(index); 5036df5718bSHannes Reinecke } 5046df5718bSHannes Reinecke if (index >= s->fw_cmds) { 50549ab747fSPaolo Bonzini /* All frames busy */ 5066df5718bSHannes Reinecke trace_megasas_qf_busy(frame); 50749ab747fSPaolo Bonzini return NULL; 50849ab747fSPaolo Bonzini } 5096df5718bSHannes Reinecke cmd = &s->frames[index]; 5106df5718bSHannes Reinecke set_bit(index, s->frame_map); 5116df5718bSHannes Reinecke trace_megasas_qf_new(index, frame); 5126df5718bSHannes Reinecke 51349ab747fSPaolo Bonzini cmd->pa = frame; 51449ab747fSPaolo Bonzini /* Map all possible frames */ 5151016b239SPaolo Bonzini cmd->frame = pci_dma_map(pcid, frame, &frame_size_p, 0); 516fd691855SPrasad J Pandit if (!cmd->frame || frame_size_p != frame_size) { 51749ab747fSPaolo Bonzini trace_megasas_qf_map_failed(cmd->index, (unsigned long)frame); 51849ab747fSPaolo Bonzini if (cmd->frame) { 5196df5718bSHannes Reinecke megasas_unmap_frame(s, cmd); 52049ab747fSPaolo Bonzini } 52149ab747fSPaolo Bonzini s->event_count++; 52249ab747fSPaolo Bonzini return NULL; 52349ab747fSPaolo Bonzini } 52449ab747fSPaolo Bonzini cmd->pa_size = frame_size_p; 52549ab747fSPaolo Bonzini cmd->context = context; 52649ab747fSPaolo Bonzini if (!megasas_use_queue64(s)) { 52749ab747fSPaolo Bonzini cmd->context &= (uint64_t)0xFFFFFFFF; 52849ab747fSPaolo Bonzini } 52949ab747fSPaolo Bonzini cmd->count = count; 5305104fac8SPaolo Bonzini cmd->dcmd_opcode = -1; 53149ab747fSPaolo Bonzini s->busy++; 53249ab747fSPaolo Bonzini 533aaf2a859SHannes Reinecke if (s->consumer_pa) { 53416578c6fSPaolo Bonzini s->reply_queue_tail = ldl_le_pci_dma(pcid, s->consumer_pa); 535aaf2a859SHannes Reinecke } 53649ab747fSPaolo Bonzini trace_megasas_qf_enqueue(cmd->index, cmd->count, cmd->context, 537aaf2a859SHannes Reinecke s->reply_queue_head, s->reply_queue_tail, s->busy); 53849ab747fSPaolo Bonzini 53949ab747fSPaolo Bonzini return cmd; 54049ab747fSPaolo Bonzini } 54149ab747fSPaolo Bonzini 54249ab747fSPaolo Bonzini static void megasas_complete_frame(MegasasState *s, uint64_t context) 54349ab747fSPaolo Bonzini { 54452190c1eSAndreas Färber PCIDevice *pci_dev = PCI_DEVICE(s); 54549ab747fSPaolo Bonzini int tail, queue_offset; 54649ab747fSPaolo Bonzini 54749ab747fSPaolo Bonzini /* Decrement busy count */ 54849ab747fSPaolo Bonzini s->busy--; 54949ab747fSPaolo Bonzini if (s->reply_queue_pa) { 55049ab747fSPaolo Bonzini /* 55149ab747fSPaolo Bonzini * Put command on the reply queue. 55249ab747fSPaolo Bonzini * Context is opaque, but emulation is running in 55349ab747fSPaolo Bonzini * little endian. So convert it. 55449ab747fSPaolo Bonzini */ 55549ab747fSPaolo Bonzini if (megasas_use_queue64(s)) { 5567957ee71SHannes Reinecke queue_offset = s->reply_queue_head * sizeof(uint64_t); 55716578c6fSPaolo Bonzini stq_le_pci_dma(pci_dev, s->reply_queue_pa + queue_offset, context); 55849ab747fSPaolo Bonzini } else { 5597957ee71SHannes Reinecke queue_offset = s->reply_queue_head * sizeof(uint32_t); 56016578c6fSPaolo Bonzini stl_le_pci_dma(pci_dev, s->reply_queue_pa + queue_offset, context); 56149ab747fSPaolo Bonzini } 56216578c6fSPaolo Bonzini s->reply_queue_tail = ldl_le_pci_dma(pci_dev, s->consumer_pa); 563aaf2a859SHannes Reinecke trace_megasas_qf_complete(context, s->reply_queue_head, 5647957ee71SHannes Reinecke s->reply_queue_tail, s->busy); 56549ab747fSPaolo Bonzini } 56649ab747fSPaolo Bonzini 56749ab747fSPaolo Bonzini if (megasas_intr_enabled(s)) { 5687957ee71SHannes Reinecke /* Update reply queue pointer */ 56916578c6fSPaolo Bonzini s->reply_queue_tail = ldl_le_pci_dma(pci_dev, s->consumer_pa); 5707957ee71SHannes Reinecke tail = s->reply_queue_head; 5717957ee71SHannes Reinecke s->reply_queue_head = megasas_next_index(s, tail, s->fw_cmds); 5727957ee71SHannes Reinecke trace_megasas_qf_update(s->reply_queue_head, s->reply_queue_tail, 5737957ee71SHannes Reinecke s->busy); 57416578c6fSPaolo Bonzini stl_le_pci_dma(pci_dev, s->producer_pa, s->reply_queue_head); 57549ab747fSPaolo Bonzini /* Notify HBA */ 57652190c1eSAndreas Färber if (msix_enabled(pci_dev)) { 57749ab747fSPaolo Bonzini trace_megasas_msix_raise(0); 57852190c1eSAndreas Färber msix_notify(pci_dev, 0); 5794522b69cSHannes Reinecke } else if (msi_enabled(pci_dev)) { 5804522b69cSHannes Reinecke trace_megasas_msi_raise(0); 5814522b69cSHannes Reinecke msi_notify(pci_dev, 0); 58249ab747fSPaolo Bonzini } else { 5837957ee71SHannes Reinecke s->doorbell++; 5847957ee71SHannes Reinecke if (s->doorbell == 1) { 58549ab747fSPaolo Bonzini trace_megasas_irq_raise(); 5869e64f8a3SMarcel Apfelbaum pci_irq_assert(pci_dev); 58749ab747fSPaolo Bonzini } 58849ab747fSPaolo Bonzini } 58949ab747fSPaolo Bonzini } else { 59049ab747fSPaolo Bonzini trace_megasas_qf_complete_noirq(context); 59149ab747fSPaolo Bonzini } 59249ab747fSPaolo Bonzini } 59349ab747fSPaolo Bonzini 5949e55d588SPaolo Bonzini static void megasas_complete_command(MegasasCmd *cmd) 5959e55d588SPaolo Bonzini { 5969e55d588SPaolo Bonzini cmd->iov_size = 0; 5979e55d588SPaolo Bonzini cmd->iov_offset = 0; 5989e55d588SPaolo Bonzini 5999e55d588SPaolo Bonzini cmd->req->hba_private = NULL; 6009e55d588SPaolo Bonzini scsi_req_unref(cmd->req); 6019e55d588SPaolo Bonzini cmd->req = NULL; 6029e55d588SPaolo Bonzini 6039e55d588SPaolo Bonzini megasas_unmap_frame(cmd->state, cmd); 6049e55d588SPaolo Bonzini megasas_complete_frame(cmd->state, cmd->context); 6059e55d588SPaolo Bonzini } 6069e55d588SPaolo Bonzini 60749ab747fSPaolo Bonzini static void megasas_reset_frames(MegasasState *s) 60849ab747fSPaolo Bonzini { 60949ab747fSPaolo Bonzini int i; 61049ab747fSPaolo Bonzini MegasasCmd *cmd; 61149ab747fSPaolo Bonzini 61249ab747fSPaolo Bonzini for (i = 0; i < s->fw_cmds; i++) { 61349ab747fSPaolo Bonzini cmd = &s->frames[i]; 61449ab747fSPaolo Bonzini if (cmd->pa) { 6156df5718bSHannes Reinecke megasas_unmap_frame(s, cmd); 61649ab747fSPaolo Bonzini } 61749ab747fSPaolo Bonzini } 6186df5718bSHannes Reinecke bitmap_zero(s->frame_map, MEGASAS_MAX_FRAMES); 61949ab747fSPaolo Bonzini } 62049ab747fSPaolo Bonzini 62149ab747fSPaolo Bonzini static void megasas_abort_command(MegasasCmd *cmd) 62249ab747fSPaolo Bonzini { 6239e55d588SPaolo Bonzini /* Never abort internal commands. */ 62487e459a8SPaolo Bonzini if (cmd->dcmd_opcode != -1) { 62587e459a8SPaolo Bonzini return; 62687e459a8SPaolo Bonzini } 6279e55d588SPaolo Bonzini if (cmd->req != NULL) { 62849ab747fSPaolo Bonzini scsi_req_cancel(cmd->req); 62949ab747fSPaolo Bonzini } 63049ab747fSPaolo Bonzini } 63149ab747fSPaolo Bonzini 63249ab747fSPaolo Bonzini static int megasas_init_firmware(MegasasState *s, MegasasCmd *cmd) 63349ab747fSPaolo Bonzini { 6341016b239SPaolo Bonzini PCIDevice *pcid = PCI_DEVICE(s); 63549ab747fSPaolo Bonzini uint32_t pa_hi, pa_lo; 63696f8f23aSHannes Reinecke hwaddr iq_pa, initq_size = sizeof(struct mfi_init_qinfo); 63796f8f23aSHannes Reinecke struct mfi_init_qinfo *initq = NULL; 63849ab747fSPaolo Bonzini uint32_t flags; 63949ab747fSPaolo Bonzini int ret = MFI_STAT_OK; 64049ab747fSPaolo Bonzini 64196f8f23aSHannes Reinecke if (s->reply_queue_pa) { 64296f8f23aSHannes Reinecke trace_megasas_initq_mapped(s->reply_queue_pa); 64396f8f23aSHannes Reinecke goto out; 64496f8f23aSHannes Reinecke } 64549ab747fSPaolo Bonzini pa_lo = le32_to_cpu(cmd->frame->init.qinfo_new_addr_lo); 64649ab747fSPaolo Bonzini pa_hi = le32_to_cpu(cmd->frame->init.qinfo_new_addr_hi); 64749ab747fSPaolo Bonzini iq_pa = (((uint64_t) pa_hi << 32) | pa_lo); 64849ab747fSPaolo Bonzini trace_megasas_init_firmware((uint64_t)iq_pa); 6491016b239SPaolo Bonzini initq = pci_dma_map(pcid, iq_pa, &initq_size, 0); 65049ab747fSPaolo Bonzini if (!initq || initq_size != sizeof(*initq)) { 65149ab747fSPaolo Bonzini trace_megasas_initq_map_failed(cmd->index); 65249ab747fSPaolo Bonzini s->event_count++; 65349ab747fSPaolo Bonzini ret = MFI_STAT_MEMORY_NOT_AVAILABLE; 65449ab747fSPaolo Bonzini goto out; 65549ab747fSPaolo Bonzini } 65649ab747fSPaolo Bonzini s->reply_queue_len = le32_to_cpu(initq->rq_entries) & 0xFFFF; 65749ab747fSPaolo Bonzini if (s->reply_queue_len > s->fw_cmds) { 65849ab747fSPaolo Bonzini trace_megasas_initq_mismatch(s->reply_queue_len, s->fw_cmds); 65949ab747fSPaolo Bonzini s->event_count++; 66049ab747fSPaolo Bonzini ret = MFI_STAT_INVALID_PARAMETER; 66149ab747fSPaolo Bonzini goto out; 66249ab747fSPaolo Bonzini } 66349ab747fSPaolo Bonzini pa_lo = le32_to_cpu(initq->rq_addr_lo); 66449ab747fSPaolo Bonzini pa_hi = le32_to_cpu(initq->rq_addr_hi); 66549ab747fSPaolo Bonzini s->reply_queue_pa = ((uint64_t) pa_hi << 32) | pa_lo; 66649ab747fSPaolo Bonzini pa_lo = le32_to_cpu(initq->ci_addr_lo); 66749ab747fSPaolo Bonzini pa_hi = le32_to_cpu(initq->ci_addr_hi); 66849ab747fSPaolo Bonzini s->consumer_pa = ((uint64_t) pa_hi << 32) | pa_lo; 66949ab747fSPaolo Bonzini pa_lo = le32_to_cpu(initq->pi_addr_lo); 67049ab747fSPaolo Bonzini pa_hi = le32_to_cpu(initq->pi_addr_hi); 67149ab747fSPaolo Bonzini s->producer_pa = ((uint64_t) pa_hi << 32) | pa_lo; 67216578c6fSPaolo Bonzini s->reply_queue_head = ldl_le_pci_dma(pcid, s->producer_pa); 673b60bdd1fSPrasad J Pandit s->reply_queue_head %= MEGASAS_MAX_FRAMES; 67416578c6fSPaolo Bonzini s->reply_queue_tail = ldl_le_pci_dma(pcid, s->consumer_pa); 675b60bdd1fSPrasad J Pandit s->reply_queue_tail %= MEGASAS_MAX_FRAMES; 67649ab747fSPaolo Bonzini flags = le32_to_cpu(initq->flags); 67749ab747fSPaolo Bonzini if (flags & MFI_QUEUE_FLAG_CONTEXT64) { 67849ab747fSPaolo Bonzini s->flags |= MEGASAS_MASK_USE_QUEUE64; 67949ab747fSPaolo Bonzini } 68049ab747fSPaolo Bonzini trace_megasas_init_queue((unsigned long)s->reply_queue_pa, 68149ab747fSPaolo Bonzini s->reply_queue_len, s->reply_queue_head, 68249ab747fSPaolo Bonzini s->reply_queue_tail, flags); 68349ab747fSPaolo Bonzini megasas_reset_frames(s); 68449ab747fSPaolo Bonzini s->fw_state = MFI_FWSTATE_OPERATIONAL; 68549ab747fSPaolo Bonzini out: 68649ab747fSPaolo Bonzini if (initq) { 6871016b239SPaolo Bonzini pci_dma_unmap(pcid, initq, initq_size, 0, 0); 68849ab747fSPaolo Bonzini } 68949ab747fSPaolo Bonzini return ret; 69049ab747fSPaolo Bonzini } 69149ab747fSPaolo Bonzini 69249ab747fSPaolo Bonzini static int megasas_map_dcmd(MegasasState *s, MegasasCmd *cmd) 69349ab747fSPaolo Bonzini { 69449ab747fSPaolo Bonzini dma_addr_t iov_pa, iov_size; 69524c0c77aSPaolo Bonzini int iov_count; 69649ab747fSPaolo Bonzini 69749ab747fSPaolo Bonzini cmd->flags = le16_to_cpu(cmd->frame->header.flags); 69824c0c77aSPaolo Bonzini iov_count = cmd->frame->header.sge_count; 69924c0c77aSPaolo Bonzini if (!iov_count) { 70049ab747fSPaolo Bonzini trace_megasas_dcmd_zero_sge(cmd->index); 70149ab747fSPaolo Bonzini cmd->iov_size = 0; 70249ab747fSPaolo Bonzini return 0; 70324c0c77aSPaolo Bonzini } else if (iov_count > 1) { 70424c0c77aSPaolo Bonzini trace_megasas_dcmd_invalid_sge(cmd->index, iov_count); 70549ab747fSPaolo Bonzini cmd->iov_size = 0; 706765a7070SPaolo Bonzini return -EINVAL; 70749ab747fSPaolo Bonzini } 70849ab747fSPaolo Bonzini iov_pa = megasas_sgl_get_addr(cmd, &cmd->frame->dcmd.sgl); 70949ab747fSPaolo Bonzini iov_size = megasas_sgl_get_len(cmd, &cmd->frame->dcmd.sgl); 71052190c1eSAndreas Färber pci_dma_sglist_init(&cmd->qsg, PCI_DEVICE(s), 1); 71149ab747fSPaolo Bonzini qemu_sglist_add(&cmd->qsg, iov_pa, iov_size); 71249ab747fSPaolo Bonzini cmd->iov_size = iov_size; 713765a7070SPaolo Bonzini return 0; 71449ab747fSPaolo Bonzini } 71549ab747fSPaolo Bonzini 71649ab747fSPaolo Bonzini static void megasas_finish_dcmd(MegasasCmd *cmd, uint32_t iov_size) 71749ab747fSPaolo Bonzini { 71849ab747fSPaolo Bonzini trace_megasas_finish_dcmd(cmd->index, iov_size); 71949ab747fSPaolo Bonzini 72049ab747fSPaolo Bonzini if (iov_size > cmd->iov_size) { 72149ab747fSPaolo Bonzini if (megasas_frame_is_ieee_sgl(cmd)) { 72249ab747fSPaolo Bonzini cmd->frame->dcmd.sgl.sg_skinny->len = cpu_to_le32(iov_size); 72349ab747fSPaolo Bonzini } else if (megasas_frame_is_sgl64(cmd)) { 72449ab747fSPaolo Bonzini cmd->frame->dcmd.sgl.sg64->len = cpu_to_le32(iov_size); 72549ab747fSPaolo Bonzini } else { 72649ab747fSPaolo Bonzini cmd->frame->dcmd.sgl.sg32->len = cpu_to_le32(iov_size); 72749ab747fSPaolo Bonzini } 72849ab747fSPaolo Bonzini } 72949ab747fSPaolo Bonzini } 73049ab747fSPaolo Bonzini 73149ab747fSPaolo Bonzini static int megasas_ctrl_get_info(MegasasState *s, MegasasCmd *cmd) 73249ab747fSPaolo Bonzini { 73352190c1eSAndreas Färber PCIDevice *pci_dev = PCI_DEVICE(s); 734e23d0498SHannes Reinecke PCIDeviceClass *pci_class = PCI_DEVICE_GET_CLASS(pci_dev); 7352e0aec15SEduardo Habkost MegasasBaseClass *base_class = MEGASAS_GET_CLASS(s); 73649ab747fSPaolo Bonzini struct mfi_ctrl_info info; 73749ab747fSPaolo Bonzini size_t dcmd_size = sizeof(info); 73849ab747fSPaolo Bonzini BusChild *kid; 7393f2cd4ddSHannes Reinecke int num_pd_disks = 0; 74049ab747fSPaolo Bonzini 74136fef36bSP J P memset(&info, 0x0, dcmd_size); 74249ab747fSPaolo Bonzini if (cmd->iov_size < dcmd_size) { 74349ab747fSPaolo Bonzini trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size, 74449ab747fSPaolo Bonzini dcmd_size); 74549ab747fSPaolo Bonzini return MFI_STAT_INVALID_PARAMETER; 74649ab747fSPaolo Bonzini } 74749ab747fSPaolo Bonzini 748e23d0498SHannes Reinecke info.pci.vendor = cpu_to_le16(pci_class->vendor_id); 749e23d0498SHannes Reinecke info.pci.device = cpu_to_le16(pci_class->device_id); 750e23d0498SHannes Reinecke info.pci.subvendor = cpu_to_le16(pci_class->subsystem_vendor_id); 751e23d0498SHannes Reinecke info.pci.subdevice = cpu_to_le16(pci_class->subsystem_id); 75249ab747fSPaolo Bonzini 75349ab747fSPaolo Bonzini /* 75449ab747fSPaolo Bonzini * For some reason the firmware supports 75549ab747fSPaolo Bonzini * only up to 8 device ports. 75649ab747fSPaolo Bonzini * Despite supporting a far larger number 75749ab747fSPaolo Bonzini * of devices for the physical devices. 75849ab747fSPaolo Bonzini * So just display the first 8 devices 75949ab747fSPaolo Bonzini * in the device port list, independent 76049ab747fSPaolo Bonzini * of how many logical devices are actually 76149ab747fSPaolo Bonzini * present. 76249ab747fSPaolo Bonzini */ 76349ab747fSPaolo Bonzini info.host.type = MFI_INFO_HOST_PCIE; 76449ab747fSPaolo Bonzini info.device.type = MFI_INFO_DEV_SAS3G; 76549ab747fSPaolo Bonzini info.device.port_count = 8; 76649ab747fSPaolo Bonzini QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) { 767e1dc6815SCao jin SCSIDevice *sdev = SCSI_DEVICE(kid->child); 7683f2cd4ddSHannes Reinecke uint16_t pd_id; 76949ab747fSPaolo Bonzini 7703f2cd4ddSHannes Reinecke if (num_pd_disks < 8) { 7713f2cd4ddSHannes Reinecke pd_id = ((sdev->id & 0xFF) << 8) | (sdev->lun & 0xFF); 7723f2cd4ddSHannes Reinecke info.device.port_addr[num_pd_disks] = 7733f2cd4ddSHannes Reinecke cpu_to_le64(megasas_get_sata_addr(pd_id)); 77449ab747fSPaolo Bonzini } 7753f2cd4ddSHannes Reinecke num_pd_disks++; 77649ab747fSPaolo Bonzini } 77749ab747fSPaolo Bonzini 778e23d0498SHannes Reinecke memcpy(info.product_name, base_class->product_name, 24); 77949ab747fSPaolo Bonzini snprintf(info.serial_number, 32, "%s", s->hba_serial); 78069fbd0eaSEduardo Habkost snprintf(info.package_version, 0x60, "%s-QEMU", qemu_hw_version()); 78149ab747fSPaolo Bonzini memcpy(info.image_component[0].name, "APP", 3); 782e23d0498SHannes Reinecke snprintf(info.image_component[0].version, 10, "%s-QEMU", 783e23d0498SHannes Reinecke base_class->product_version); 7845a7733b0SOlaf Hering memcpy(info.image_component[0].build_date, "Apr 1 2014", 11); 7855a7733b0SOlaf Hering memcpy(info.image_component[0].build_time, "12:34:56", 8); 78649ab747fSPaolo Bonzini info.image_component_count = 1; 78752190c1eSAndreas Färber if (pci_dev->has_rom) { 78849ab747fSPaolo Bonzini uint8_t biosver[32]; 78949ab747fSPaolo Bonzini uint8_t *ptr; 79049ab747fSPaolo Bonzini 79152190c1eSAndreas Färber ptr = memory_region_get_ram_ptr(&pci_dev->rom); 79249ab747fSPaolo Bonzini memcpy(biosver, ptr + 0x41, 31); 793844864fbSPrasad J Pandit biosver[31] = 0; 79449ab747fSPaolo Bonzini memcpy(info.image_component[1].name, "BIOS", 4); 79549ab747fSPaolo Bonzini memcpy(info.image_component[1].version, biosver, 79649ab747fSPaolo Bonzini strlen((const char *)biosver)); 79749ab747fSPaolo Bonzini info.image_component_count++; 79849ab747fSPaolo Bonzini } 79949ab747fSPaolo Bonzini info.current_fw_time = cpu_to_le32(megasas_fw_time()); 80049ab747fSPaolo Bonzini info.max_arms = 32; 80149ab747fSPaolo Bonzini info.max_spans = 8; 80249ab747fSPaolo Bonzini info.max_arrays = MEGASAS_MAX_ARRAYS; 8033f2cd4ddSHannes Reinecke info.max_lds = MFI_MAX_LD; 80449ab747fSPaolo Bonzini info.max_cmds = cpu_to_le16(s->fw_cmds); 80549ab747fSPaolo Bonzini info.max_sg_elements = cpu_to_le16(s->fw_sge); 80649ab747fSPaolo Bonzini info.max_request_size = cpu_to_le32(MEGASAS_MAX_SECTORS); 8073f2cd4ddSHannes Reinecke if (!megasas_is_jbod(s)) 8083f2cd4ddSHannes Reinecke info.lds_present = cpu_to_le16(num_pd_disks); 8093f2cd4ddSHannes Reinecke info.pd_present = cpu_to_le16(num_pd_disks); 8103f2cd4ddSHannes Reinecke info.pd_disks_present = cpu_to_le16(num_pd_disks); 81149ab747fSPaolo Bonzini info.hw_present = cpu_to_le32(MFI_INFO_HW_NVRAM | 81249ab747fSPaolo Bonzini MFI_INFO_HW_MEM | 81349ab747fSPaolo Bonzini MFI_INFO_HW_FLASH); 81449ab747fSPaolo Bonzini info.memory_size = cpu_to_le16(512); 81549ab747fSPaolo Bonzini info.nvram_size = cpu_to_le16(32); 81649ab747fSPaolo Bonzini info.flash_size = cpu_to_le16(16); 81749ab747fSPaolo Bonzini info.raid_levels = cpu_to_le32(MFI_INFO_RAID_0); 81849ab747fSPaolo Bonzini info.adapter_ops = cpu_to_le32(MFI_INFO_AOPS_RBLD_RATE | 81949ab747fSPaolo Bonzini MFI_INFO_AOPS_SELF_DIAGNOSTIC | 82049ab747fSPaolo Bonzini MFI_INFO_AOPS_MIXED_ARRAY); 82149ab747fSPaolo Bonzini info.ld_ops = cpu_to_le32(MFI_INFO_LDOPS_DISK_CACHE_POLICY | 82249ab747fSPaolo Bonzini MFI_INFO_LDOPS_ACCESS_POLICY | 82349ab747fSPaolo Bonzini MFI_INFO_LDOPS_IO_POLICY | 82449ab747fSPaolo Bonzini MFI_INFO_LDOPS_WRITE_POLICY | 82549ab747fSPaolo Bonzini MFI_INFO_LDOPS_READ_POLICY); 82649ab747fSPaolo Bonzini info.max_strips_per_io = cpu_to_le16(s->fw_sge); 82749ab747fSPaolo Bonzini info.stripe_sz_ops.min = 3; 828786a4ea8SStefan Hajnoczi info.stripe_sz_ops.max = ctz32(MEGASAS_MAX_SECTORS + 1); 82949ab747fSPaolo Bonzini info.properties.pred_fail_poll_interval = cpu_to_le16(300); 83049ab747fSPaolo Bonzini info.properties.intr_throttle_cnt = cpu_to_le16(16); 83149ab747fSPaolo Bonzini info.properties.intr_throttle_timeout = cpu_to_le16(50); 83249ab747fSPaolo Bonzini info.properties.rebuild_rate = 30; 83349ab747fSPaolo Bonzini info.properties.patrol_read_rate = 30; 83449ab747fSPaolo Bonzini info.properties.bgi_rate = 30; 83549ab747fSPaolo Bonzini info.properties.cc_rate = 30; 83649ab747fSPaolo Bonzini info.properties.recon_rate = 30; 83749ab747fSPaolo Bonzini info.properties.cache_flush_interval = 4; 83849ab747fSPaolo Bonzini info.properties.spinup_drv_cnt = 2; 83949ab747fSPaolo Bonzini info.properties.spinup_delay = 6; 84049ab747fSPaolo Bonzini info.properties.ecc_bucket_size = 15; 84149ab747fSPaolo Bonzini info.properties.ecc_bucket_leak_rate = cpu_to_le16(1440); 84249ab747fSPaolo Bonzini info.properties.expose_encl_devices = 1; 84349ab747fSPaolo Bonzini info.properties.OnOffProperties = cpu_to_le32(MFI_CTRL_PROP_EnableJBOD); 84449ab747fSPaolo Bonzini info.pd_ops = cpu_to_le32(MFI_INFO_PDOPS_FORCE_ONLINE | 84549ab747fSPaolo Bonzini MFI_INFO_PDOPS_FORCE_OFFLINE); 84649ab747fSPaolo Bonzini info.pd_mix_support = cpu_to_le32(MFI_INFO_PDMIX_SAS | 84749ab747fSPaolo Bonzini MFI_INFO_PDMIX_SATA | 84849ab747fSPaolo Bonzini MFI_INFO_PDMIX_LD); 84949ab747fSPaolo Bonzini 85049ab747fSPaolo Bonzini cmd->iov_size -= dma_buf_read((uint8_t *)&info, dcmd_size, &cmd->qsg); 85149ab747fSPaolo Bonzini return MFI_STAT_OK; 85249ab747fSPaolo Bonzini } 85349ab747fSPaolo Bonzini 85449ab747fSPaolo Bonzini static int megasas_mfc_get_defaults(MegasasState *s, MegasasCmd *cmd) 85549ab747fSPaolo Bonzini { 85649ab747fSPaolo Bonzini struct mfi_defaults info; 85749ab747fSPaolo Bonzini size_t dcmd_size = sizeof(struct mfi_defaults); 85849ab747fSPaolo Bonzini 85949ab747fSPaolo Bonzini memset(&info, 0x0, dcmd_size); 86049ab747fSPaolo Bonzini if (cmd->iov_size < dcmd_size) { 86149ab747fSPaolo Bonzini trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size, 86249ab747fSPaolo Bonzini dcmd_size); 86349ab747fSPaolo Bonzini return MFI_STAT_INVALID_PARAMETER; 86449ab747fSPaolo Bonzini } 86549ab747fSPaolo Bonzini 86649ab747fSPaolo Bonzini info.sas_addr = cpu_to_le64(s->sas_addr); 86749ab747fSPaolo Bonzini info.stripe_size = 3; 86849ab747fSPaolo Bonzini info.flush_time = 4; 86949ab747fSPaolo Bonzini info.background_rate = 30; 87049ab747fSPaolo Bonzini info.allow_mix_in_enclosure = 1; 87149ab747fSPaolo Bonzini info.allow_mix_in_ld = 1; 87249ab747fSPaolo Bonzini info.direct_pd_mapping = 1; 87349ab747fSPaolo Bonzini /* Enable for BIOS support */ 87449ab747fSPaolo Bonzini info.bios_enumerate_lds = 1; 87549ab747fSPaolo Bonzini info.disable_ctrl_r = 1; 87649ab747fSPaolo Bonzini info.expose_enclosure_devices = 1; 87749ab747fSPaolo Bonzini info.disable_preboot_cli = 1; 87849ab747fSPaolo Bonzini info.cluster_disable = 1; 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_bios_info(MegasasState *s, MegasasCmd *cmd) 88549ab747fSPaolo Bonzini { 88649ab747fSPaolo Bonzini struct mfi_bios_data info; 88749ab747fSPaolo Bonzini size_t dcmd_size = sizeof(info); 88849ab747fSPaolo Bonzini 88949ab747fSPaolo Bonzini memset(&info, 0x0, dcmd_size); 89049ab747fSPaolo Bonzini if (cmd->iov_size < dcmd_size) { 89149ab747fSPaolo Bonzini trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size, 89249ab747fSPaolo Bonzini dcmd_size); 89349ab747fSPaolo Bonzini return MFI_STAT_INVALID_PARAMETER; 89449ab747fSPaolo Bonzini } 89549ab747fSPaolo Bonzini info.continue_on_error = 1; 89649ab747fSPaolo Bonzini info.verbose = 1; 89749ab747fSPaolo Bonzini if (megasas_is_jbod(s)) { 89849ab747fSPaolo Bonzini info.expose_all_drives = 1; 89949ab747fSPaolo Bonzini } 90049ab747fSPaolo Bonzini 90149ab747fSPaolo Bonzini cmd->iov_size -= dma_buf_read((uint8_t *)&info, dcmd_size, &cmd->qsg); 90249ab747fSPaolo Bonzini return MFI_STAT_OK; 90349ab747fSPaolo Bonzini } 90449ab747fSPaolo Bonzini 90549ab747fSPaolo Bonzini static int megasas_dcmd_get_fw_time(MegasasState *s, MegasasCmd *cmd) 90649ab747fSPaolo Bonzini { 90749ab747fSPaolo Bonzini uint64_t fw_time; 90849ab747fSPaolo Bonzini size_t dcmd_size = sizeof(fw_time); 90949ab747fSPaolo Bonzini 91049ab747fSPaolo Bonzini fw_time = cpu_to_le64(megasas_fw_time()); 91149ab747fSPaolo Bonzini 91249ab747fSPaolo Bonzini cmd->iov_size -= dma_buf_read((uint8_t *)&fw_time, dcmd_size, &cmd->qsg); 91349ab747fSPaolo Bonzini return MFI_STAT_OK; 91449ab747fSPaolo Bonzini } 91549ab747fSPaolo Bonzini 91649ab747fSPaolo Bonzini static int megasas_dcmd_set_fw_time(MegasasState *s, MegasasCmd *cmd) 91749ab747fSPaolo Bonzini { 91849ab747fSPaolo Bonzini uint64_t fw_time; 91949ab747fSPaolo Bonzini 92049ab747fSPaolo Bonzini /* This is a dummy; setting of firmware time is not allowed */ 92149ab747fSPaolo Bonzini memcpy(&fw_time, cmd->frame->dcmd.mbox, sizeof(fw_time)); 92249ab747fSPaolo Bonzini 92349ab747fSPaolo Bonzini trace_megasas_dcmd_set_fw_time(cmd->index, fw_time); 92449ab747fSPaolo Bonzini fw_time = cpu_to_le64(megasas_fw_time()); 92549ab747fSPaolo Bonzini return MFI_STAT_OK; 92649ab747fSPaolo Bonzini } 92749ab747fSPaolo Bonzini 92849ab747fSPaolo Bonzini static int megasas_event_info(MegasasState *s, MegasasCmd *cmd) 92949ab747fSPaolo Bonzini { 93049ab747fSPaolo Bonzini struct mfi_evt_log_state info; 93149ab747fSPaolo Bonzini size_t dcmd_size = sizeof(info); 93249ab747fSPaolo Bonzini 93349ab747fSPaolo Bonzini memset(&info, 0, dcmd_size); 93449ab747fSPaolo Bonzini 93549ab747fSPaolo Bonzini info.newest_seq_num = cpu_to_le32(s->event_count); 93649ab747fSPaolo Bonzini info.shutdown_seq_num = cpu_to_le32(s->shutdown_event); 93749ab747fSPaolo Bonzini info.boot_seq_num = cpu_to_le32(s->boot_event); 93849ab747fSPaolo Bonzini 93949ab747fSPaolo Bonzini cmd->iov_size -= dma_buf_read((uint8_t *)&info, dcmd_size, &cmd->qsg); 94049ab747fSPaolo Bonzini return MFI_STAT_OK; 94149ab747fSPaolo Bonzini } 94249ab747fSPaolo Bonzini 94349ab747fSPaolo Bonzini static int megasas_event_wait(MegasasState *s, MegasasCmd *cmd) 94449ab747fSPaolo Bonzini { 94549ab747fSPaolo Bonzini union mfi_evt event; 94649ab747fSPaolo Bonzini 94749ab747fSPaolo Bonzini if (cmd->iov_size < sizeof(struct mfi_evt_detail)) { 94849ab747fSPaolo Bonzini trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size, 94949ab747fSPaolo Bonzini sizeof(struct mfi_evt_detail)); 95049ab747fSPaolo Bonzini return MFI_STAT_INVALID_PARAMETER; 95149ab747fSPaolo Bonzini } 95249ab747fSPaolo Bonzini s->event_count = cpu_to_le32(cmd->frame->dcmd.mbox[0]); 95349ab747fSPaolo Bonzini event.word = cpu_to_le32(cmd->frame->dcmd.mbox[4]); 95449ab747fSPaolo Bonzini s->event_locale = event.members.locale; 95549ab747fSPaolo Bonzini s->event_class = event.members.class; 95649ab747fSPaolo Bonzini s->event_cmd = cmd; 95749ab747fSPaolo Bonzini /* Decrease busy count; event frame doesn't count here */ 95849ab747fSPaolo Bonzini s->busy--; 95949ab747fSPaolo Bonzini cmd->iov_size = sizeof(struct mfi_evt_detail); 96049ab747fSPaolo Bonzini return MFI_STAT_INVALID_STATUS; 96149ab747fSPaolo Bonzini } 96249ab747fSPaolo Bonzini 96349ab747fSPaolo Bonzini static int megasas_dcmd_pd_get_list(MegasasState *s, MegasasCmd *cmd) 96449ab747fSPaolo Bonzini { 96549ab747fSPaolo Bonzini struct mfi_pd_list info; 96649ab747fSPaolo Bonzini size_t dcmd_size = sizeof(info); 96749ab747fSPaolo Bonzini BusChild *kid; 96849ab747fSPaolo Bonzini uint32_t offset, dcmd_limit, num_pd_disks = 0, max_pd_disks; 96949ab747fSPaolo Bonzini 97049ab747fSPaolo Bonzini memset(&info, 0, dcmd_size); 97149ab747fSPaolo Bonzini offset = 8; 97249ab747fSPaolo Bonzini dcmd_limit = offset + sizeof(struct mfi_pd_address); 97349ab747fSPaolo Bonzini if (cmd->iov_size < dcmd_limit) { 97449ab747fSPaolo Bonzini trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size, 97549ab747fSPaolo Bonzini dcmd_limit); 97649ab747fSPaolo Bonzini return MFI_STAT_INVALID_PARAMETER; 97749ab747fSPaolo Bonzini } 97849ab747fSPaolo Bonzini 97949ab747fSPaolo Bonzini max_pd_disks = (cmd->iov_size - offset) / sizeof(struct mfi_pd_address); 9803f2cd4ddSHannes Reinecke if (max_pd_disks > MFI_MAX_SYS_PDS) { 9813f2cd4ddSHannes Reinecke max_pd_disks = MFI_MAX_SYS_PDS; 98249ab747fSPaolo Bonzini } 98349ab747fSPaolo Bonzini QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) { 984e1dc6815SCao jin SCSIDevice *sdev = SCSI_DEVICE(kid->child); 9853f2cd4ddSHannes Reinecke uint16_t pd_id; 98649ab747fSPaolo Bonzini 9873f2cd4ddSHannes Reinecke if (num_pd_disks >= max_pd_disks) 9883f2cd4ddSHannes Reinecke break; 9893f2cd4ddSHannes Reinecke 9903f2cd4ddSHannes Reinecke pd_id = ((sdev->id & 0xFF) << 8) | (sdev->lun & 0xFF); 9913f2cd4ddSHannes Reinecke info.addr[num_pd_disks].device_id = cpu_to_le16(pd_id); 99249ab747fSPaolo Bonzini info.addr[num_pd_disks].encl_device_id = 0xFFFF; 99349ab747fSPaolo Bonzini info.addr[num_pd_disks].encl_index = 0; 9943f2cd4ddSHannes Reinecke info.addr[num_pd_disks].slot_number = sdev->id & 0xFF; 99549ab747fSPaolo Bonzini info.addr[num_pd_disks].scsi_dev_type = sdev->type; 99649ab747fSPaolo Bonzini info.addr[num_pd_disks].connect_port_bitmap = 0x1; 99749ab747fSPaolo Bonzini info.addr[num_pd_disks].sas_addr[0] = 9983f2cd4ddSHannes Reinecke cpu_to_le64(megasas_get_sata_addr(pd_id)); 99949ab747fSPaolo Bonzini num_pd_disks++; 100049ab747fSPaolo Bonzini offset += sizeof(struct mfi_pd_address); 100149ab747fSPaolo Bonzini } 100249ab747fSPaolo Bonzini trace_megasas_dcmd_pd_get_list(cmd->index, num_pd_disks, 100349ab747fSPaolo Bonzini max_pd_disks, offset); 100449ab747fSPaolo Bonzini 100549ab747fSPaolo Bonzini info.size = cpu_to_le32(offset); 100649ab747fSPaolo Bonzini info.count = cpu_to_le32(num_pd_disks); 100749ab747fSPaolo Bonzini 100849ab747fSPaolo Bonzini cmd->iov_size -= dma_buf_read((uint8_t *)&info, offset, &cmd->qsg); 100949ab747fSPaolo Bonzini return MFI_STAT_OK; 101049ab747fSPaolo Bonzini } 101149ab747fSPaolo Bonzini 101249ab747fSPaolo Bonzini static int megasas_dcmd_pd_list_query(MegasasState *s, MegasasCmd *cmd) 101349ab747fSPaolo Bonzini { 101449ab747fSPaolo Bonzini uint16_t flags; 101549ab747fSPaolo Bonzini 101649ab747fSPaolo Bonzini /* mbox0 contains flags */ 101749ab747fSPaolo Bonzini flags = le16_to_cpu(cmd->frame->dcmd.mbox[0]); 101849ab747fSPaolo Bonzini trace_megasas_dcmd_pd_list_query(cmd->index, flags); 101949ab747fSPaolo Bonzini if (flags == MR_PD_QUERY_TYPE_ALL || 102049ab747fSPaolo Bonzini megasas_is_jbod(s)) { 102149ab747fSPaolo Bonzini return megasas_dcmd_pd_get_list(s, cmd); 102249ab747fSPaolo Bonzini } 102349ab747fSPaolo Bonzini 102449ab747fSPaolo Bonzini return MFI_STAT_OK; 102549ab747fSPaolo Bonzini } 102649ab747fSPaolo Bonzini 102749ab747fSPaolo Bonzini static int megasas_pd_get_info_submit(SCSIDevice *sdev, int lun, 102849ab747fSPaolo Bonzini MegasasCmd *cmd) 102949ab747fSPaolo Bonzini { 103049ab747fSPaolo Bonzini struct mfi_pd_info *info = cmd->iov_buf; 103149ab747fSPaolo Bonzini size_t dcmd_size = sizeof(struct mfi_pd_info); 103249ab747fSPaolo Bonzini uint64_t pd_size; 10333f2cd4ddSHannes Reinecke uint16_t pd_id = ((sdev->id & 0xFF) << 8) | (lun & 0xFF); 103449ab747fSPaolo Bonzini uint8_t cmdbuf[6]; 103549ab747fSPaolo Bonzini size_t len, resid; 103649ab747fSPaolo Bonzini 103749ab747fSPaolo Bonzini if (!cmd->iov_buf) { 10380bd0adbeSMarkus Armbruster cmd->iov_buf = g_malloc0(dcmd_size); 103949ab747fSPaolo Bonzini info = cmd->iov_buf; 104049ab747fSPaolo Bonzini info->inquiry_data[0] = 0x7f; /* Force PQual 0x3, PType 0x1f */ 104149ab747fSPaolo Bonzini info->vpd_page83[0] = 0x7f; 104249ab747fSPaolo Bonzini megasas_setup_inquiry(cmdbuf, 0, sizeof(info->inquiry_data)); 104387e459a8SPaolo Bonzini cmd->req = scsi_req_new(sdev, cmd->index, lun, cmdbuf, cmd); 104487e459a8SPaolo Bonzini if (!cmd->req) { 104549ab747fSPaolo Bonzini trace_megasas_dcmd_req_alloc_failed(cmd->index, 104649ab747fSPaolo Bonzini "PD get info std inquiry"); 104749ab747fSPaolo Bonzini g_free(cmd->iov_buf); 104849ab747fSPaolo Bonzini cmd->iov_buf = NULL; 104949ab747fSPaolo Bonzini return MFI_STAT_FLASH_ALLOC_FAIL; 105049ab747fSPaolo Bonzini } 105149ab747fSPaolo Bonzini trace_megasas_dcmd_internal_submit(cmd->index, 105249ab747fSPaolo Bonzini "PD get info std inquiry", lun); 105387e459a8SPaolo Bonzini len = scsi_req_enqueue(cmd->req); 105449ab747fSPaolo Bonzini if (len > 0) { 105549ab747fSPaolo Bonzini cmd->iov_size = len; 105687e459a8SPaolo Bonzini scsi_req_continue(cmd->req); 105749ab747fSPaolo Bonzini } 105849ab747fSPaolo Bonzini return MFI_STAT_INVALID_STATUS; 105949ab747fSPaolo Bonzini } else if (info->inquiry_data[0] != 0x7f && info->vpd_page83[0] == 0x7f) { 106049ab747fSPaolo Bonzini megasas_setup_inquiry(cmdbuf, 0x83, sizeof(info->vpd_page83)); 106187e459a8SPaolo Bonzini cmd->req = scsi_req_new(sdev, cmd->index, lun, cmdbuf, cmd); 106287e459a8SPaolo Bonzini if (!cmd->req) { 106349ab747fSPaolo Bonzini trace_megasas_dcmd_req_alloc_failed(cmd->index, 106449ab747fSPaolo Bonzini "PD get info vpd inquiry"); 106549ab747fSPaolo Bonzini return MFI_STAT_FLASH_ALLOC_FAIL; 106649ab747fSPaolo Bonzini } 106749ab747fSPaolo Bonzini trace_megasas_dcmd_internal_submit(cmd->index, 106849ab747fSPaolo Bonzini "PD get info vpd inquiry", lun); 106987e459a8SPaolo Bonzini len = scsi_req_enqueue(cmd->req); 107049ab747fSPaolo Bonzini if (len > 0) { 107149ab747fSPaolo Bonzini cmd->iov_size = len; 107287e459a8SPaolo Bonzini scsi_req_continue(cmd->req); 107349ab747fSPaolo Bonzini } 107449ab747fSPaolo Bonzini return MFI_STAT_INVALID_STATUS; 107549ab747fSPaolo Bonzini } 107649ab747fSPaolo Bonzini /* Finished, set FW state */ 107749ab747fSPaolo Bonzini if ((info->inquiry_data[0] >> 5) == 0) { 107849ab747fSPaolo Bonzini if (megasas_is_jbod(cmd->state)) { 107949ab747fSPaolo Bonzini info->fw_state = cpu_to_le16(MFI_PD_STATE_SYSTEM); 108049ab747fSPaolo Bonzini } else { 108149ab747fSPaolo Bonzini info->fw_state = cpu_to_le16(MFI_PD_STATE_ONLINE); 108249ab747fSPaolo Bonzini } 108349ab747fSPaolo Bonzini } else { 108449ab747fSPaolo Bonzini info->fw_state = cpu_to_le16(MFI_PD_STATE_OFFLINE); 108549ab747fSPaolo Bonzini } 108649ab747fSPaolo Bonzini 10873f2cd4ddSHannes Reinecke info->ref.v.device_id = cpu_to_le16(pd_id); 108849ab747fSPaolo Bonzini info->state.ddf.pd_type = cpu_to_le16(MFI_PD_DDF_TYPE_IN_VD| 108949ab747fSPaolo Bonzini MFI_PD_DDF_TYPE_INTF_SAS); 10904be74634SMarkus Armbruster blk_get_geometry(sdev->conf.blk, &pd_size); 109149ab747fSPaolo Bonzini info->raw_size = cpu_to_le64(pd_size); 109249ab747fSPaolo Bonzini info->non_coerced_size = cpu_to_le64(pd_size); 109349ab747fSPaolo Bonzini info->coerced_size = cpu_to_le64(pd_size); 109449ab747fSPaolo Bonzini info->encl_device_id = 0xFFFF; 109549ab747fSPaolo Bonzini info->slot_number = (sdev->id & 0xFF); 109649ab747fSPaolo Bonzini info->path_info.count = 1; 109749ab747fSPaolo Bonzini info->path_info.sas_addr[0] = 10983f2cd4ddSHannes Reinecke cpu_to_le64(megasas_get_sata_addr(pd_id)); 109949ab747fSPaolo Bonzini info->connected_port_bitmap = 0x1; 110049ab747fSPaolo Bonzini info->device_speed = 1; 110149ab747fSPaolo Bonzini info->link_speed = 1; 110249ab747fSPaolo Bonzini resid = dma_buf_read(cmd->iov_buf, dcmd_size, &cmd->qsg); 110349ab747fSPaolo Bonzini g_free(cmd->iov_buf); 110449ab747fSPaolo Bonzini cmd->iov_size = dcmd_size - resid; 110549ab747fSPaolo Bonzini cmd->iov_buf = NULL; 110649ab747fSPaolo Bonzini return MFI_STAT_OK; 110749ab747fSPaolo Bonzini } 110849ab747fSPaolo Bonzini 110949ab747fSPaolo Bonzini static int megasas_dcmd_pd_get_info(MegasasState *s, MegasasCmd *cmd) 111049ab747fSPaolo Bonzini { 111149ab747fSPaolo Bonzini size_t dcmd_size = sizeof(struct mfi_pd_info); 111249ab747fSPaolo Bonzini uint16_t pd_id; 11133f2cd4ddSHannes Reinecke uint8_t target_id, lun_id; 111449ab747fSPaolo Bonzini SCSIDevice *sdev = NULL; 111549ab747fSPaolo Bonzini int retval = MFI_STAT_DEVICE_NOT_FOUND; 111649ab747fSPaolo Bonzini 111749ab747fSPaolo Bonzini if (cmd->iov_size < dcmd_size) { 111849ab747fSPaolo Bonzini return MFI_STAT_INVALID_PARAMETER; 111949ab747fSPaolo Bonzini } 112049ab747fSPaolo Bonzini 112149ab747fSPaolo Bonzini /* mbox0 has the ID */ 112249ab747fSPaolo Bonzini pd_id = le16_to_cpu(cmd->frame->dcmd.mbox[0]); 11233f2cd4ddSHannes Reinecke target_id = (pd_id >> 8) & 0xFF; 11243f2cd4ddSHannes Reinecke lun_id = pd_id & 0xFF; 11253f2cd4ddSHannes Reinecke sdev = scsi_device_find(&s->bus, 0, target_id, lun_id); 112649ab747fSPaolo Bonzini trace_megasas_dcmd_pd_get_info(cmd->index, pd_id); 112749ab747fSPaolo Bonzini 112849ab747fSPaolo Bonzini if (sdev) { 112949ab747fSPaolo Bonzini /* Submit inquiry */ 113049ab747fSPaolo Bonzini retval = megasas_pd_get_info_submit(sdev, pd_id, cmd); 113149ab747fSPaolo Bonzini } 113249ab747fSPaolo Bonzini 113349ab747fSPaolo Bonzini return retval; 113449ab747fSPaolo Bonzini } 113549ab747fSPaolo Bonzini 113649ab747fSPaolo Bonzini static int megasas_dcmd_ld_get_list(MegasasState *s, MegasasCmd *cmd) 113749ab747fSPaolo Bonzini { 113849ab747fSPaolo Bonzini struct mfi_ld_list info; 113949ab747fSPaolo Bonzini size_t dcmd_size = sizeof(info), resid; 11403f2cd4ddSHannes Reinecke uint32_t num_ld_disks = 0, max_ld_disks; 114149ab747fSPaolo Bonzini uint64_t ld_size; 114249ab747fSPaolo Bonzini BusChild *kid; 114349ab747fSPaolo Bonzini 114449ab747fSPaolo Bonzini memset(&info, 0, dcmd_size); 1145e74a4315SHannes Reinecke if (cmd->iov_size > dcmd_size) { 114649ab747fSPaolo Bonzini trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size, 114749ab747fSPaolo Bonzini dcmd_size); 114849ab747fSPaolo Bonzini return MFI_STAT_INVALID_PARAMETER; 114949ab747fSPaolo Bonzini } 115049ab747fSPaolo Bonzini 11513f2cd4ddSHannes Reinecke max_ld_disks = (cmd->iov_size - 8) / 16; 115249ab747fSPaolo Bonzini if (megasas_is_jbod(s)) { 115349ab747fSPaolo Bonzini max_ld_disks = 0; 115449ab747fSPaolo Bonzini } 11553f2cd4ddSHannes Reinecke if (max_ld_disks > MFI_MAX_LD) { 11563f2cd4ddSHannes Reinecke max_ld_disks = MFI_MAX_LD; 11573f2cd4ddSHannes Reinecke } 115849ab747fSPaolo Bonzini QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) { 1159e1dc6815SCao jin SCSIDevice *sdev = SCSI_DEVICE(kid->child); 116049ab747fSPaolo Bonzini 116149ab747fSPaolo Bonzini if (num_ld_disks >= max_ld_disks) { 116249ab747fSPaolo Bonzini break; 116349ab747fSPaolo Bonzini } 116449ab747fSPaolo Bonzini /* Logical device size is in blocks */ 11654be74634SMarkus Armbruster blk_get_geometry(sdev->conf.blk, &ld_size); 116649ab747fSPaolo Bonzini info.ld_list[num_ld_disks].ld.v.target_id = sdev->id; 116749ab747fSPaolo Bonzini info.ld_list[num_ld_disks].state = MFI_LD_STATE_OPTIMAL; 116849ab747fSPaolo Bonzini info.ld_list[num_ld_disks].size = cpu_to_le64(ld_size); 116949ab747fSPaolo Bonzini num_ld_disks++; 117049ab747fSPaolo Bonzini } 117149ab747fSPaolo Bonzini info.ld_count = cpu_to_le32(num_ld_disks); 117249ab747fSPaolo Bonzini trace_megasas_dcmd_ld_get_list(cmd->index, num_ld_disks, max_ld_disks); 117349ab747fSPaolo Bonzini 117449ab747fSPaolo Bonzini resid = dma_buf_read((uint8_t *)&info, dcmd_size, &cmd->qsg); 117549ab747fSPaolo Bonzini cmd->iov_size = dcmd_size - resid; 117649ab747fSPaolo Bonzini return MFI_STAT_OK; 117749ab747fSPaolo Bonzini } 117849ab747fSPaolo Bonzini 117934bb4d02SHannes Reinecke static int megasas_dcmd_ld_list_query(MegasasState *s, MegasasCmd *cmd) 118034bb4d02SHannes Reinecke { 118134bb4d02SHannes Reinecke uint16_t flags; 1182d97ae368SHannes Reinecke struct mfi_ld_targetid_list info; 1183d97ae368SHannes Reinecke size_t dcmd_size = sizeof(info), resid; 1184d97ae368SHannes Reinecke uint32_t num_ld_disks = 0, max_ld_disks = s->fw_luns; 1185d97ae368SHannes Reinecke BusChild *kid; 118634bb4d02SHannes Reinecke 118734bb4d02SHannes Reinecke /* mbox0 contains flags */ 118834bb4d02SHannes Reinecke flags = le16_to_cpu(cmd->frame->dcmd.mbox[0]); 118934bb4d02SHannes Reinecke trace_megasas_dcmd_ld_list_query(cmd->index, flags); 1190d97ae368SHannes Reinecke if (flags != MR_LD_QUERY_TYPE_ALL && 1191d97ae368SHannes Reinecke flags != MR_LD_QUERY_TYPE_EXPOSED_TO_HOST) { 1192d97ae368SHannes Reinecke max_ld_disks = 0; 119334bb4d02SHannes Reinecke } 119434bb4d02SHannes Reinecke 1195d97ae368SHannes Reinecke memset(&info, 0, dcmd_size); 1196d97ae368SHannes Reinecke if (cmd->iov_size < 12) { 1197d97ae368SHannes Reinecke trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size, 1198d97ae368SHannes Reinecke dcmd_size); 1199d97ae368SHannes Reinecke return MFI_STAT_INVALID_PARAMETER; 1200d97ae368SHannes Reinecke } 1201d97ae368SHannes Reinecke dcmd_size = sizeof(uint32_t) * 2 + 3; 12023f2cd4ddSHannes Reinecke max_ld_disks = cmd->iov_size - dcmd_size; 1203d97ae368SHannes Reinecke if (megasas_is_jbod(s)) { 1204d97ae368SHannes Reinecke max_ld_disks = 0; 1205d97ae368SHannes Reinecke } 12063f2cd4ddSHannes Reinecke if (max_ld_disks > MFI_MAX_LD) { 12073f2cd4ddSHannes Reinecke max_ld_disks = MFI_MAX_LD; 12083f2cd4ddSHannes Reinecke } 1209d97ae368SHannes Reinecke QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) { 1210e1dc6815SCao jin SCSIDevice *sdev = SCSI_DEVICE(kid->child); 1211d97ae368SHannes Reinecke 1212d97ae368SHannes Reinecke if (num_ld_disks >= max_ld_disks) { 1213d97ae368SHannes Reinecke break; 1214d97ae368SHannes Reinecke } 1215d97ae368SHannes Reinecke info.targetid[num_ld_disks] = sdev->lun; 1216d97ae368SHannes Reinecke num_ld_disks++; 1217d97ae368SHannes Reinecke dcmd_size++; 1218d97ae368SHannes Reinecke } 1219d97ae368SHannes Reinecke info.ld_count = cpu_to_le32(num_ld_disks); 1220d97ae368SHannes Reinecke info.size = dcmd_size; 1221d97ae368SHannes Reinecke trace_megasas_dcmd_ld_get_list(cmd->index, num_ld_disks, max_ld_disks); 1222d97ae368SHannes Reinecke 1223d97ae368SHannes Reinecke resid = dma_buf_read((uint8_t *)&info, dcmd_size, &cmd->qsg); 1224d97ae368SHannes Reinecke cmd->iov_size = dcmd_size - resid; 122534bb4d02SHannes Reinecke return MFI_STAT_OK; 122634bb4d02SHannes Reinecke } 122734bb4d02SHannes Reinecke 122849ab747fSPaolo Bonzini static int megasas_ld_get_info_submit(SCSIDevice *sdev, int lun, 122949ab747fSPaolo Bonzini MegasasCmd *cmd) 123049ab747fSPaolo Bonzini { 123149ab747fSPaolo Bonzini struct mfi_ld_info *info = cmd->iov_buf; 123249ab747fSPaolo Bonzini size_t dcmd_size = sizeof(struct mfi_ld_info); 123349ab747fSPaolo Bonzini uint8_t cdb[6]; 123449ab747fSPaolo Bonzini ssize_t len, resid; 12353f2cd4ddSHannes Reinecke uint16_t sdev_id = ((sdev->id & 0xFF) << 8) | (lun & 0xFF); 123649ab747fSPaolo Bonzini uint64_t ld_size; 123749ab747fSPaolo Bonzini 123849ab747fSPaolo Bonzini if (!cmd->iov_buf) { 12390bd0adbeSMarkus Armbruster cmd->iov_buf = g_malloc0(dcmd_size); 124049ab747fSPaolo Bonzini info = cmd->iov_buf; 124149ab747fSPaolo Bonzini megasas_setup_inquiry(cdb, 0x83, sizeof(info->vpd_page83)); 124287e459a8SPaolo Bonzini cmd->req = scsi_req_new(sdev, cmd->index, lun, cdb, cmd); 124387e459a8SPaolo Bonzini if (!cmd->req) { 124449ab747fSPaolo Bonzini trace_megasas_dcmd_req_alloc_failed(cmd->index, 124549ab747fSPaolo Bonzini "LD get info vpd inquiry"); 124649ab747fSPaolo Bonzini g_free(cmd->iov_buf); 124749ab747fSPaolo Bonzini cmd->iov_buf = NULL; 124849ab747fSPaolo Bonzini return MFI_STAT_FLASH_ALLOC_FAIL; 124949ab747fSPaolo Bonzini } 125049ab747fSPaolo Bonzini trace_megasas_dcmd_internal_submit(cmd->index, 125149ab747fSPaolo Bonzini "LD get info vpd inquiry", lun); 125287e459a8SPaolo Bonzini len = scsi_req_enqueue(cmd->req); 125349ab747fSPaolo Bonzini if (len > 0) { 125449ab747fSPaolo Bonzini cmd->iov_size = len; 125587e459a8SPaolo Bonzini scsi_req_continue(cmd->req); 125649ab747fSPaolo Bonzini } 125749ab747fSPaolo Bonzini return MFI_STAT_INVALID_STATUS; 125849ab747fSPaolo Bonzini } 125949ab747fSPaolo Bonzini 126049ab747fSPaolo Bonzini info->ld_config.params.state = MFI_LD_STATE_OPTIMAL; 126149ab747fSPaolo Bonzini info->ld_config.properties.ld.v.target_id = lun; 126249ab747fSPaolo Bonzini info->ld_config.params.stripe_size = 3; 126349ab747fSPaolo Bonzini info->ld_config.params.num_drives = 1; 126449ab747fSPaolo Bonzini info->ld_config.params.is_consistent = 1; 126549ab747fSPaolo Bonzini /* Logical device size is in blocks */ 12664be74634SMarkus Armbruster blk_get_geometry(sdev->conf.blk, &ld_size); 126749ab747fSPaolo Bonzini info->size = cpu_to_le64(ld_size); 126849ab747fSPaolo Bonzini memset(info->ld_config.span, 0, sizeof(info->ld_config.span)); 126949ab747fSPaolo Bonzini info->ld_config.span[0].start_block = 0; 127049ab747fSPaolo Bonzini info->ld_config.span[0].num_blocks = info->size; 127149ab747fSPaolo Bonzini info->ld_config.span[0].array_ref = cpu_to_le16(sdev_id); 127249ab747fSPaolo Bonzini 127349ab747fSPaolo Bonzini resid = dma_buf_read(cmd->iov_buf, dcmd_size, &cmd->qsg); 127449ab747fSPaolo Bonzini g_free(cmd->iov_buf); 127549ab747fSPaolo Bonzini cmd->iov_size = dcmd_size - resid; 127649ab747fSPaolo Bonzini cmd->iov_buf = NULL; 127749ab747fSPaolo Bonzini return MFI_STAT_OK; 127849ab747fSPaolo Bonzini } 127949ab747fSPaolo Bonzini 128049ab747fSPaolo Bonzini static int megasas_dcmd_ld_get_info(MegasasState *s, MegasasCmd *cmd) 128149ab747fSPaolo Bonzini { 128249ab747fSPaolo Bonzini struct mfi_ld_info info; 128349ab747fSPaolo Bonzini size_t dcmd_size = sizeof(info); 128449ab747fSPaolo Bonzini uint16_t ld_id; 128549ab747fSPaolo Bonzini uint32_t max_ld_disks = s->fw_luns; 128649ab747fSPaolo Bonzini SCSIDevice *sdev = NULL; 128749ab747fSPaolo Bonzini int retval = MFI_STAT_DEVICE_NOT_FOUND; 128849ab747fSPaolo Bonzini 128949ab747fSPaolo Bonzini if (cmd->iov_size < dcmd_size) { 129049ab747fSPaolo Bonzini return MFI_STAT_INVALID_PARAMETER; 129149ab747fSPaolo Bonzini } 129249ab747fSPaolo Bonzini 129349ab747fSPaolo Bonzini /* mbox0 has the ID */ 129449ab747fSPaolo Bonzini ld_id = le16_to_cpu(cmd->frame->dcmd.mbox[0]); 129549ab747fSPaolo Bonzini trace_megasas_dcmd_ld_get_info(cmd->index, ld_id); 129649ab747fSPaolo Bonzini 129749ab747fSPaolo Bonzini if (megasas_is_jbod(s)) { 129849ab747fSPaolo Bonzini return MFI_STAT_DEVICE_NOT_FOUND; 129949ab747fSPaolo Bonzini } 130049ab747fSPaolo Bonzini 130149ab747fSPaolo Bonzini if (ld_id < max_ld_disks) { 130249ab747fSPaolo Bonzini sdev = scsi_device_find(&s->bus, 0, ld_id, 0); 130349ab747fSPaolo Bonzini } 130449ab747fSPaolo Bonzini 130549ab747fSPaolo Bonzini if (sdev) { 130649ab747fSPaolo Bonzini retval = megasas_ld_get_info_submit(sdev, ld_id, cmd); 130749ab747fSPaolo Bonzini } 130849ab747fSPaolo Bonzini 130949ab747fSPaolo Bonzini return retval; 131049ab747fSPaolo Bonzini } 131149ab747fSPaolo Bonzini 131249ab747fSPaolo Bonzini static int megasas_dcmd_cfg_read(MegasasState *s, MegasasCmd *cmd) 131349ab747fSPaolo Bonzini { 1314d37af740SPrasad J Pandit uint8_t data[4096] = { 0 }; 131549ab747fSPaolo Bonzini struct mfi_config_data *info; 131649ab747fSPaolo Bonzini int num_pd_disks = 0, array_offset, ld_offset; 131749ab747fSPaolo Bonzini BusChild *kid; 131849ab747fSPaolo Bonzini 131949ab747fSPaolo Bonzini if (cmd->iov_size > 4096) { 132049ab747fSPaolo Bonzini return MFI_STAT_INVALID_PARAMETER; 132149ab747fSPaolo Bonzini } 132249ab747fSPaolo Bonzini 132349ab747fSPaolo Bonzini QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) { 132449ab747fSPaolo Bonzini num_pd_disks++; 132549ab747fSPaolo Bonzini } 132649ab747fSPaolo Bonzini info = (struct mfi_config_data *)&data; 132749ab747fSPaolo Bonzini /* 132849ab747fSPaolo Bonzini * Array mapping: 132949ab747fSPaolo Bonzini * - One array per SCSI device 133049ab747fSPaolo Bonzini * - One logical drive per SCSI device 133149ab747fSPaolo Bonzini * spanning the entire device 133249ab747fSPaolo Bonzini */ 133349ab747fSPaolo Bonzini info->array_count = num_pd_disks; 133449ab747fSPaolo Bonzini info->array_size = sizeof(struct mfi_array) * num_pd_disks; 133549ab747fSPaolo Bonzini info->log_drv_count = num_pd_disks; 133649ab747fSPaolo Bonzini info->log_drv_size = sizeof(struct mfi_ld_config) * num_pd_disks; 133749ab747fSPaolo Bonzini info->spares_count = 0; 133849ab747fSPaolo Bonzini info->spares_size = sizeof(struct mfi_spare); 133949ab747fSPaolo Bonzini info->size = sizeof(struct mfi_config_data) + info->array_size + 134049ab747fSPaolo Bonzini info->log_drv_size; 134149ab747fSPaolo Bonzini if (info->size > 4096) { 134249ab747fSPaolo Bonzini return MFI_STAT_INVALID_PARAMETER; 134349ab747fSPaolo Bonzini } 134449ab747fSPaolo Bonzini 134549ab747fSPaolo Bonzini array_offset = sizeof(struct mfi_config_data); 134649ab747fSPaolo Bonzini ld_offset = array_offset + sizeof(struct mfi_array) * num_pd_disks; 134749ab747fSPaolo Bonzini 134849ab747fSPaolo Bonzini QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) { 1349e1dc6815SCao jin SCSIDevice *sdev = SCSI_DEVICE(kid->child); 13503f2cd4ddSHannes Reinecke uint16_t sdev_id = ((sdev->id & 0xFF) << 8) | (sdev->lun & 0xFF); 135149ab747fSPaolo Bonzini struct mfi_array *array; 135249ab747fSPaolo Bonzini struct mfi_ld_config *ld; 135349ab747fSPaolo Bonzini uint64_t pd_size; 135449ab747fSPaolo Bonzini int i; 135549ab747fSPaolo Bonzini 135649ab747fSPaolo Bonzini array = (struct mfi_array *)(data + array_offset); 13574be74634SMarkus Armbruster blk_get_geometry(sdev->conf.blk, &pd_size); 135849ab747fSPaolo Bonzini array->size = cpu_to_le64(pd_size); 135949ab747fSPaolo Bonzini array->num_drives = 1; 136049ab747fSPaolo Bonzini array->array_ref = cpu_to_le16(sdev_id); 136149ab747fSPaolo Bonzini array->pd[0].ref.v.device_id = cpu_to_le16(sdev_id); 136249ab747fSPaolo Bonzini array->pd[0].ref.v.seq_num = 0; 136349ab747fSPaolo Bonzini array->pd[0].fw_state = MFI_PD_STATE_ONLINE; 136449ab747fSPaolo Bonzini array->pd[0].encl.pd = 0xFF; 136549ab747fSPaolo Bonzini array->pd[0].encl.slot = (sdev->id & 0xFF); 136649ab747fSPaolo Bonzini for (i = 1; i < MFI_MAX_ROW_SIZE; i++) { 136749ab747fSPaolo Bonzini array->pd[i].ref.v.device_id = 0xFFFF; 136849ab747fSPaolo Bonzini array->pd[i].ref.v.seq_num = 0; 136949ab747fSPaolo Bonzini array->pd[i].fw_state = MFI_PD_STATE_UNCONFIGURED_GOOD; 137049ab747fSPaolo Bonzini array->pd[i].encl.pd = 0xFF; 137149ab747fSPaolo Bonzini array->pd[i].encl.slot = 0xFF; 137249ab747fSPaolo Bonzini } 137349ab747fSPaolo Bonzini array_offset += sizeof(struct mfi_array); 137449ab747fSPaolo Bonzini ld = (struct mfi_ld_config *)(data + ld_offset); 137549ab747fSPaolo Bonzini memset(ld, 0, sizeof(struct mfi_ld_config)); 13763f2cd4ddSHannes Reinecke ld->properties.ld.v.target_id = sdev->id; 137749ab747fSPaolo Bonzini ld->properties.default_cache_policy = MR_LD_CACHE_READ_AHEAD | 137849ab747fSPaolo Bonzini MR_LD_CACHE_READ_ADAPTIVE; 137949ab747fSPaolo Bonzini ld->properties.current_cache_policy = MR_LD_CACHE_READ_AHEAD | 138049ab747fSPaolo Bonzini MR_LD_CACHE_READ_ADAPTIVE; 138149ab747fSPaolo Bonzini ld->params.state = MFI_LD_STATE_OPTIMAL; 138249ab747fSPaolo Bonzini ld->params.stripe_size = 3; 138349ab747fSPaolo Bonzini ld->params.num_drives = 1; 138449ab747fSPaolo Bonzini ld->params.span_depth = 1; 138549ab747fSPaolo Bonzini ld->params.is_consistent = 1; 138649ab747fSPaolo Bonzini ld->span[0].start_block = 0; 138749ab747fSPaolo Bonzini ld->span[0].num_blocks = cpu_to_le64(pd_size); 138849ab747fSPaolo Bonzini ld->span[0].array_ref = cpu_to_le16(sdev_id); 138949ab747fSPaolo Bonzini ld_offset += sizeof(struct mfi_ld_config); 139049ab747fSPaolo Bonzini } 139149ab747fSPaolo Bonzini 139249ab747fSPaolo Bonzini cmd->iov_size -= dma_buf_read((uint8_t *)data, info->size, &cmd->qsg); 139349ab747fSPaolo Bonzini return MFI_STAT_OK; 139449ab747fSPaolo Bonzini } 139549ab747fSPaolo Bonzini 139649ab747fSPaolo Bonzini static int megasas_dcmd_get_properties(MegasasState *s, MegasasCmd *cmd) 139749ab747fSPaolo Bonzini { 139849ab747fSPaolo Bonzini struct mfi_ctrl_props info; 139949ab747fSPaolo Bonzini size_t dcmd_size = sizeof(info); 140049ab747fSPaolo Bonzini 140149ab747fSPaolo Bonzini memset(&info, 0x0, dcmd_size); 140249ab747fSPaolo Bonzini if (cmd->iov_size < dcmd_size) { 140349ab747fSPaolo Bonzini trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size, 140449ab747fSPaolo Bonzini dcmd_size); 140549ab747fSPaolo Bonzini return MFI_STAT_INVALID_PARAMETER; 140649ab747fSPaolo Bonzini } 140749ab747fSPaolo Bonzini info.pred_fail_poll_interval = cpu_to_le16(300); 140849ab747fSPaolo Bonzini info.intr_throttle_cnt = cpu_to_le16(16); 140949ab747fSPaolo Bonzini info.intr_throttle_timeout = cpu_to_le16(50); 141049ab747fSPaolo Bonzini info.rebuild_rate = 30; 141149ab747fSPaolo Bonzini info.patrol_read_rate = 30; 141249ab747fSPaolo Bonzini info.bgi_rate = 30; 141349ab747fSPaolo Bonzini info.cc_rate = 30; 141449ab747fSPaolo Bonzini info.recon_rate = 30; 141549ab747fSPaolo Bonzini info.cache_flush_interval = 4; 141649ab747fSPaolo Bonzini info.spinup_drv_cnt = 2; 141749ab747fSPaolo Bonzini info.spinup_delay = 6; 141849ab747fSPaolo Bonzini info.ecc_bucket_size = 15; 141949ab747fSPaolo Bonzini info.ecc_bucket_leak_rate = cpu_to_le16(1440); 142049ab747fSPaolo Bonzini info.expose_encl_devices = 1; 142149ab747fSPaolo Bonzini 142249ab747fSPaolo Bonzini cmd->iov_size -= dma_buf_read((uint8_t *)&info, dcmd_size, &cmd->qsg); 142349ab747fSPaolo Bonzini return MFI_STAT_OK; 142449ab747fSPaolo Bonzini } 142549ab747fSPaolo Bonzini 142649ab747fSPaolo Bonzini static int megasas_cache_flush(MegasasState *s, MegasasCmd *cmd) 142749ab747fSPaolo Bonzini { 14284be74634SMarkus Armbruster blk_drain_all(); 142949ab747fSPaolo Bonzini return MFI_STAT_OK; 143049ab747fSPaolo Bonzini } 143149ab747fSPaolo Bonzini 143249ab747fSPaolo Bonzini static int megasas_ctrl_shutdown(MegasasState *s, MegasasCmd *cmd) 143349ab747fSPaolo Bonzini { 143449ab747fSPaolo Bonzini s->fw_state = MFI_FWSTATE_READY; 143549ab747fSPaolo Bonzini return MFI_STAT_OK; 143649ab747fSPaolo Bonzini } 143749ab747fSPaolo Bonzini 1438200b6966SHannes Reinecke /* Some implementations use CLUSTER RESET LD to simulate a device reset */ 143949ab747fSPaolo Bonzini static int megasas_cluster_reset_ld(MegasasState *s, MegasasCmd *cmd) 144049ab747fSPaolo Bonzini { 1441200b6966SHannes Reinecke uint16_t target_id; 1442200b6966SHannes Reinecke int i; 1443200b6966SHannes Reinecke 1444200b6966SHannes Reinecke /* mbox0 contains the device index */ 1445200b6966SHannes Reinecke target_id = le16_to_cpu(cmd->frame->dcmd.mbox[0]); 1446200b6966SHannes Reinecke trace_megasas_dcmd_reset_ld(cmd->index, target_id); 1447200b6966SHannes Reinecke for (i = 0; i < s->fw_cmds; i++) { 1448200b6966SHannes Reinecke MegasasCmd *tmp_cmd = &s->frames[i]; 1449200b6966SHannes Reinecke if (tmp_cmd->req && tmp_cmd->req->dev->id == target_id) { 1450200b6966SHannes Reinecke SCSIDevice *d = tmp_cmd->req->dev; 1451200b6966SHannes Reinecke qdev_reset_all(&d->qdev); 1452200b6966SHannes Reinecke } 1453200b6966SHannes Reinecke } 1454200b6966SHannes Reinecke return MFI_STAT_OK; 145549ab747fSPaolo Bonzini } 145649ab747fSPaolo Bonzini 145749ab747fSPaolo Bonzini static int megasas_dcmd_set_properties(MegasasState *s, MegasasCmd *cmd) 145849ab747fSPaolo Bonzini { 145949ab747fSPaolo Bonzini struct mfi_ctrl_props info; 146049ab747fSPaolo Bonzini size_t dcmd_size = sizeof(info); 146149ab747fSPaolo Bonzini 146249ab747fSPaolo Bonzini if (cmd->iov_size < dcmd_size) { 146349ab747fSPaolo Bonzini trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size, 146449ab747fSPaolo Bonzini dcmd_size); 146549ab747fSPaolo Bonzini return MFI_STAT_INVALID_PARAMETER; 146649ab747fSPaolo Bonzini } 14671b858980SPrasad J Pandit dma_buf_write((uint8_t *)&info, dcmd_size, &cmd->qsg); 146849ab747fSPaolo Bonzini trace_megasas_dcmd_unsupported(cmd->index, cmd->iov_size); 146949ab747fSPaolo Bonzini return MFI_STAT_OK; 147049ab747fSPaolo Bonzini } 147149ab747fSPaolo Bonzini 147249ab747fSPaolo Bonzini static int megasas_dcmd_dummy(MegasasState *s, MegasasCmd *cmd) 147349ab747fSPaolo Bonzini { 147449ab747fSPaolo Bonzini trace_megasas_dcmd_dummy(cmd->index, cmd->iov_size); 147549ab747fSPaolo Bonzini return MFI_STAT_OK; 147649ab747fSPaolo Bonzini } 147749ab747fSPaolo Bonzini 147849ab747fSPaolo Bonzini static const struct dcmd_cmd_tbl_t { 147949ab747fSPaolo Bonzini int opcode; 148049ab747fSPaolo Bonzini const char *desc; 148149ab747fSPaolo Bonzini int (*func)(MegasasState *s, MegasasCmd *cmd); 148249ab747fSPaolo Bonzini } dcmd_cmd_tbl[] = { 148349ab747fSPaolo Bonzini { MFI_DCMD_CTRL_MFI_HOST_MEM_ALLOC, "CTRL_HOST_MEM_ALLOC", 148449ab747fSPaolo Bonzini megasas_dcmd_dummy }, 148549ab747fSPaolo Bonzini { MFI_DCMD_CTRL_GET_INFO, "CTRL_GET_INFO", 148649ab747fSPaolo Bonzini megasas_ctrl_get_info }, 148749ab747fSPaolo Bonzini { MFI_DCMD_CTRL_GET_PROPERTIES, "CTRL_GET_PROPERTIES", 148849ab747fSPaolo Bonzini megasas_dcmd_get_properties }, 148949ab747fSPaolo Bonzini { MFI_DCMD_CTRL_SET_PROPERTIES, "CTRL_SET_PROPERTIES", 149049ab747fSPaolo Bonzini megasas_dcmd_set_properties }, 149149ab747fSPaolo Bonzini { MFI_DCMD_CTRL_ALARM_GET, "CTRL_ALARM_GET", 149249ab747fSPaolo Bonzini megasas_dcmd_dummy }, 149349ab747fSPaolo Bonzini { MFI_DCMD_CTRL_ALARM_ENABLE, "CTRL_ALARM_ENABLE", 149449ab747fSPaolo Bonzini megasas_dcmd_dummy }, 149549ab747fSPaolo Bonzini { MFI_DCMD_CTRL_ALARM_DISABLE, "CTRL_ALARM_DISABLE", 149649ab747fSPaolo Bonzini megasas_dcmd_dummy }, 149749ab747fSPaolo Bonzini { MFI_DCMD_CTRL_ALARM_SILENCE, "CTRL_ALARM_SILENCE", 149849ab747fSPaolo Bonzini megasas_dcmd_dummy }, 149949ab747fSPaolo Bonzini { MFI_DCMD_CTRL_ALARM_TEST, "CTRL_ALARM_TEST", 150049ab747fSPaolo Bonzini megasas_dcmd_dummy }, 150149ab747fSPaolo Bonzini { MFI_DCMD_CTRL_EVENT_GETINFO, "CTRL_EVENT_GETINFO", 150249ab747fSPaolo Bonzini megasas_event_info }, 150349ab747fSPaolo Bonzini { MFI_DCMD_CTRL_EVENT_GET, "CTRL_EVENT_GET", 150449ab747fSPaolo Bonzini megasas_dcmd_dummy }, 150549ab747fSPaolo Bonzini { MFI_DCMD_CTRL_EVENT_WAIT, "CTRL_EVENT_WAIT", 150649ab747fSPaolo Bonzini megasas_event_wait }, 150749ab747fSPaolo Bonzini { MFI_DCMD_CTRL_SHUTDOWN, "CTRL_SHUTDOWN", 150849ab747fSPaolo Bonzini megasas_ctrl_shutdown }, 150949ab747fSPaolo Bonzini { MFI_DCMD_HIBERNATE_STANDBY, "CTRL_STANDBY", 151049ab747fSPaolo Bonzini megasas_dcmd_dummy }, 151149ab747fSPaolo Bonzini { MFI_DCMD_CTRL_GET_TIME, "CTRL_GET_TIME", 151249ab747fSPaolo Bonzini megasas_dcmd_get_fw_time }, 151349ab747fSPaolo Bonzini { MFI_DCMD_CTRL_SET_TIME, "CTRL_SET_TIME", 151449ab747fSPaolo Bonzini megasas_dcmd_set_fw_time }, 151549ab747fSPaolo Bonzini { MFI_DCMD_CTRL_BIOS_DATA_GET, "CTRL_BIOS_DATA_GET", 151649ab747fSPaolo Bonzini megasas_dcmd_get_bios_info }, 151749ab747fSPaolo Bonzini { MFI_DCMD_CTRL_FACTORY_DEFAULTS, "CTRL_FACTORY_DEFAULTS", 151849ab747fSPaolo Bonzini megasas_dcmd_dummy }, 151949ab747fSPaolo Bonzini { MFI_DCMD_CTRL_MFC_DEFAULTS_GET, "CTRL_MFC_DEFAULTS_GET", 152049ab747fSPaolo Bonzini megasas_mfc_get_defaults }, 152149ab747fSPaolo Bonzini { MFI_DCMD_CTRL_MFC_DEFAULTS_SET, "CTRL_MFC_DEFAULTS_SET", 152249ab747fSPaolo Bonzini megasas_dcmd_dummy }, 152349ab747fSPaolo Bonzini { MFI_DCMD_CTRL_CACHE_FLUSH, "CTRL_CACHE_FLUSH", 152449ab747fSPaolo Bonzini megasas_cache_flush }, 152549ab747fSPaolo Bonzini { MFI_DCMD_PD_GET_LIST, "PD_GET_LIST", 152649ab747fSPaolo Bonzini megasas_dcmd_pd_get_list }, 152749ab747fSPaolo Bonzini { MFI_DCMD_PD_LIST_QUERY, "PD_LIST_QUERY", 152849ab747fSPaolo Bonzini megasas_dcmd_pd_list_query }, 152949ab747fSPaolo Bonzini { MFI_DCMD_PD_GET_INFO, "PD_GET_INFO", 153049ab747fSPaolo Bonzini megasas_dcmd_pd_get_info }, 153149ab747fSPaolo Bonzini { MFI_DCMD_PD_STATE_SET, "PD_STATE_SET", 153249ab747fSPaolo Bonzini megasas_dcmd_dummy }, 153349ab747fSPaolo Bonzini { MFI_DCMD_PD_REBUILD, "PD_REBUILD", 153449ab747fSPaolo Bonzini megasas_dcmd_dummy }, 153549ab747fSPaolo Bonzini { MFI_DCMD_PD_BLINK, "PD_BLINK", 153649ab747fSPaolo Bonzini megasas_dcmd_dummy }, 153749ab747fSPaolo Bonzini { MFI_DCMD_PD_UNBLINK, "PD_UNBLINK", 153849ab747fSPaolo Bonzini megasas_dcmd_dummy }, 153949ab747fSPaolo Bonzini { MFI_DCMD_LD_GET_LIST, "LD_GET_LIST", 154049ab747fSPaolo Bonzini megasas_dcmd_ld_get_list}, 154134bb4d02SHannes Reinecke { MFI_DCMD_LD_LIST_QUERY, "LD_LIST_QUERY", 154234bb4d02SHannes Reinecke megasas_dcmd_ld_list_query }, 154349ab747fSPaolo Bonzini { MFI_DCMD_LD_GET_INFO, "LD_GET_INFO", 154449ab747fSPaolo Bonzini megasas_dcmd_ld_get_info }, 154549ab747fSPaolo Bonzini { MFI_DCMD_LD_GET_PROP, "LD_GET_PROP", 154649ab747fSPaolo Bonzini megasas_dcmd_dummy }, 154749ab747fSPaolo Bonzini { MFI_DCMD_LD_SET_PROP, "LD_SET_PROP", 154849ab747fSPaolo Bonzini megasas_dcmd_dummy }, 154949ab747fSPaolo Bonzini { MFI_DCMD_LD_DELETE, "LD_DELETE", 155049ab747fSPaolo Bonzini megasas_dcmd_dummy }, 155149ab747fSPaolo Bonzini { MFI_DCMD_CFG_READ, "CFG_READ", 155249ab747fSPaolo Bonzini megasas_dcmd_cfg_read }, 155349ab747fSPaolo Bonzini { MFI_DCMD_CFG_ADD, "CFG_ADD", 155449ab747fSPaolo Bonzini megasas_dcmd_dummy }, 155549ab747fSPaolo Bonzini { MFI_DCMD_CFG_CLEAR, "CFG_CLEAR", 155649ab747fSPaolo Bonzini megasas_dcmd_dummy }, 155749ab747fSPaolo Bonzini { MFI_DCMD_CFG_FOREIGN_READ, "CFG_FOREIGN_READ", 155849ab747fSPaolo Bonzini megasas_dcmd_dummy }, 155949ab747fSPaolo Bonzini { MFI_DCMD_CFG_FOREIGN_IMPORT, "CFG_FOREIGN_IMPORT", 156049ab747fSPaolo Bonzini megasas_dcmd_dummy }, 156149ab747fSPaolo Bonzini { MFI_DCMD_BBU_STATUS, "BBU_STATUS", 156249ab747fSPaolo Bonzini megasas_dcmd_dummy }, 156349ab747fSPaolo Bonzini { MFI_DCMD_BBU_CAPACITY_INFO, "BBU_CAPACITY_INFO", 156449ab747fSPaolo Bonzini megasas_dcmd_dummy }, 156549ab747fSPaolo Bonzini { MFI_DCMD_BBU_DESIGN_INFO, "BBU_DESIGN_INFO", 156649ab747fSPaolo Bonzini megasas_dcmd_dummy }, 156749ab747fSPaolo Bonzini { MFI_DCMD_BBU_PROP_GET, "BBU_PROP_GET", 156849ab747fSPaolo Bonzini megasas_dcmd_dummy }, 156949ab747fSPaolo Bonzini { MFI_DCMD_CLUSTER, "CLUSTER", 157049ab747fSPaolo Bonzini megasas_dcmd_dummy }, 157149ab747fSPaolo Bonzini { MFI_DCMD_CLUSTER_RESET_ALL, "CLUSTER_RESET_ALL", 157249ab747fSPaolo Bonzini megasas_dcmd_dummy }, 157349ab747fSPaolo Bonzini { MFI_DCMD_CLUSTER_RESET_LD, "CLUSTER_RESET_LD", 157449ab747fSPaolo Bonzini megasas_cluster_reset_ld }, 157549ab747fSPaolo Bonzini { -1, NULL, NULL } 157649ab747fSPaolo Bonzini }; 157749ab747fSPaolo Bonzini 157849ab747fSPaolo Bonzini static int megasas_handle_dcmd(MegasasState *s, MegasasCmd *cmd) 157949ab747fSPaolo Bonzini { 158049ab747fSPaolo Bonzini int retval = 0; 1581765a7070SPaolo Bonzini size_t len; 158249ab747fSPaolo Bonzini const struct dcmd_cmd_tbl_t *cmdptr = dcmd_cmd_tbl; 158349ab747fSPaolo Bonzini 15845104fac8SPaolo Bonzini cmd->dcmd_opcode = le32_to_cpu(cmd->frame->dcmd.opcode); 15855104fac8SPaolo Bonzini trace_megasas_handle_dcmd(cmd->index, cmd->dcmd_opcode); 1586765a7070SPaolo Bonzini if (megasas_map_dcmd(s, cmd) < 0) { 158749ab747fSPaolo Bonzini return MFI_STAT_MEMORY_NOT_AVAILABLE; 158849ab747fSPaolo Bonzini } 15895104fac8SPaolo Bonzini while (cmdptr->opcode != -1 && cmdptr->opcode != cmd->dcmd_opcode) { 159049ab747fSPaolo Bonzini cmdptr++; 159149ab747fSPaolo Bonzini } 1592765a7070SPaolo Bonzini len = cmd->iov_size; 159349ab747fSPaolo Bonzini if (cmdptr->opcode == -1) { 15945104fac8SPaolo Bonzini trace_megasas_dcmd_unhandled(cmd->index, cmd->dcmd_opcode, len); 159549ab747fSPaolo Bonzini retval = megasas_dcmd_dummy(s, cmd); 159649ab747fSPaolo Bonzini } else { 159749ab747fSPaolo Bonzini trace_megasas_dcmd_enter(cmd->index, cmdptr->desc, len); 159849ab747fSPaolo Bonzini retval = cmdptr->func(s, cmd); 159949ab747fSPaolo Bonzini } 160049ab747fSPaolo Bonzini if (retval != MFI_STAT_INVALID_STATUS) { 160149ab747fSPaolo Bonzini megasas_finish_dcmd(cmd, len); 160249ab747fSPaolo Bonzini } 160349ab747fSPaolo Bonzini return retval; 160449ab747fSPaolo Bonzini } 160549ab747fSPaolo Bonzini 160649ab747fSPaolo Bonzini static int megasas_finish_internal_dcmd(MegasasCmd *cmd, 160736c327a6SPaolo Bonzini SCSIRequest *req, size_t resid) 160849ab747fSPaolo Bonzini { 160949ab747fSPaolo Bonzini int retval = MFI_STAT_OK; 161049ab747fSPaolo Bonzini int lun = req->lun; 161149ab747fSPaolo Bonzini 16125104fac8SPaolo Bonzini trace_megasas_dcmd_internal_finish(cmd->index, cmd->dcmd_opcode, lun); 161336c327a6SPaolo Bonzini cmd->iov_size -= resid; 16145104fac8SPaolo Bonzini switch (cmd->dcmd_opcode) { 161549ab747fSPaolo Bonzini case MFI_DCMD_PD_GET_INFO: 161649ab747fSPaolo Bonzini retval = megasas_pd_get_info_submit(req->dev, lun, cmd); 161749ab747fSPaolo Bonzini break; 161849ab747fSPaolo Bonzini case MFI_DCMD_LD_GET_INFO: 161949ab747fSPaolo Bonzini retval = megasas_ld_get_info_submit(req->dev, lun, cmd); 162049ab747fSPaolo Bonzini break; 162149ab747fSPaolo Bonzini default: 16225104fac8SPaolo Bonzini trace_megasas_dcmd_internal_invalid(cmd->index, cmd->dcmd_opcode); 162349ab747fSPaolo Bonzini retval = MFI_STAT_INVALID_DCMD; 162449ab747fSPaolo Bonzini break; 162549ab747fSPaolo Bonzini } 162649ab747fSPaolo Bonzini if (retval != MFI_STAT_INVALID_STATUS) { 162749ab747fSPaolo Bonzini megasas_finish_dcmd(cmd, cmd->iov_size); 162849ab747fSPaolo Bonzini } 162949ab747fSPaolo Bonzini return retval; 163049ab747fSPaolo Bonzini } 163149ab747fSPaolo Bonzini 163249ab747fSPaolo Bonzini static int megasas_enqueue_req(MegasasCmd *cmd, bool is_write) 163349ab747fSPaolo Bonzini { 163449ab747fSPaolo Bonzini int len; 163549ab747fSPaolo Bonzini 163649ab747fSPaolo Bonzini len = scsi_req_enqueue(cmd->req); 163749ab747fSPaolo Bonzini if (len < 0) { 163849ab747fSPaolo Bonzini len = -len; 163949ab747fSPaolo Bonzini } 164049ab747fSPaolo Bonzini if (len > 0) { 164149ab747fSPaolo Bonzini if (len > cmd->iov_size) { 164249ab747fSPaolo Bonzini if (is_write) { 164349ab747fSPaolo Bonzini trace_megasas_iov_write_overflow(cmd->index, len, 164449ab747fSPaolo Bonzini cmd->iov_size); 164549ab747fSPaolo Bonzini } else { 164649ab747fSPaolo Bonzini trace_megasas_iov_read_overflow(cmd->index, len, 164749ab747fSPaolo Bonzini cmd->iov_size); 164849ab747fSPaolo Bonzini } 164949ab747fSPaolo Bonzini } 165049ab747fSPaolo Bonzini if (len < cmd->iov_size) { 165149ab747fSPaolo Bonzini if (is_write) { 165249ab747fSPaolo Bonzini trace_megasas_iov_write_underflow(cmd->index, len, 165349ab747fSPaolo Bonzini cmd->iov_size); 165449ab747fSPaolo Bonzini } else { 165549ab747fSPaolo Bonzini trace_megasas_iov_read_underflow(cmd->index, len, 165649ab747fSPaolo Bonzini cmd->iov_size); 165749ab747fSPaolo Bonzini } 165849ab747fSPaolo Bonzini cmd->iov_size = len; 165949ab747fSPaolo Bonzini } 166049ab747fSPaolo Bonzini scsi_req_continue(cmd->req); 166149ab747fSPaolo Bonzini } 166249ab747fSPaolo Bonzini return len; 166349ab747fSPaolo Bonzini } 166449ab747fSPaolo Bonzini 166549ab747fSPaolo Bonzini static int megasas_handle_scsi(MegasasState *s, MegasasCmd *cmd, 166636c327a6SPaolo Bonzini int frame_cmd) 166749ab747fSPaolo Bonzini { 166849ab747fSPaolo Bonzini uint8_t *cdb; 1669b356807fSPaolo Bonzini int target_id, lun_id, cdb_len; 167049ab747fSPaolo Bonzini bool is_write; 167149ab747fSPaolo Bonzini struct SCSIDevice *sdev = NULL; 167236c327a6SPaolo Bonzini bool is_logical = (frame_cmd == MFI_CMD_LD_SCSI_IO); 167349ab747fSPaolo Bonzini 167449ab747fSPaolo Bonzini cdb = cmd->frame->pass.cdb; 1675b356807fSPaolo Bonzini target_id = cmd->frame->header.target_id; 1676b356807fSPaolo Bonzini lun_id = cmd->frame->header.lun_id; 1677b356807fSPaolo Bonzini cdb_len = cmd->frame->header.cdb_len; 167849ab747fSPaolo Bonzini 16793f2cd4ddSHannes Reinecke if (is_logical) { 1680b356807fSPaolo Bonzini if (target_id >= MFI_MAX_LD || lun_id != 0) { 16813f2cd4ddSHannes Reinecke trace_megasas_scsi_target_not_present( 1682ee760ac8SThomas Huth mfi_frame_desc(frame_cmd), is_logical, target_id, lun_id); 16833f2cd4ddSHannes Reinecke return MFI_STAT_DEVICE_NOT_FOUND; 16843f2cd4ddSHannes Reinecke } 16853f2cd4ddSHannes Reinecke } 1686b356807fSPaolo Bonzini sdev = scsi_device_find(&s->bus, 0, target_id, lun_id); 16873f2cd4ddSHannes Reinecke 168849ab747fSPaolo Bonzini cmd->iov_size = le32_to_cpu(cmd->frame->header.data_len); 1689ee760ac8SThomas Huth trace_megasas_handle_scsi(mfi_frame_desc(frame_cmd), is_logical, 1690b356807fSPaolo Bonzini target_id, lun_id, sdev, cmd->iov_size); 169149ab747fSPaolo Bonzini 169249ab747fSPaolo Bonzini if (!sdev || (megasas_is_jbod(s) && is_logical)) { 169349ab747fSPaolo Bonzini trace_megasas_scsi_target_not_present( 1694ee760ac8SThomas Huth mfi_frame_desc(frame_cmd), is_logical, target_id, lun_id); 169549ab747fSPaolo Bonzini return MFI_STAT_DEVICE_NOT_FOUND; 169649ab747fSPaolo Bonzini } 169749ab747fSPaolo Bonzini 1698b356807fSPaolo Bonzini if (cdb_len > 16) { 169949ab747fSPaolo Bonzini trace_megasas_scsi_invalid_cdb_len( 1700ee760ac8SThomas Huth mfi_frame_desc(frame_cmd), is_logical, 1701b356807fSPaolo Bonzini target_id, lun_id, cdb_len); 170249ab747fSPaolo Bonzini megasas_write_sense(cmd, SENSE_CODE(INVALID_OPCODE)); 170349ab747fSPaolo Bonzini cmd->frame->header.scsi_status = CHECK_CONDITION; 170449ab747fSPaolo Bonzini s->event_count++; 170549ab747fSPaolo Bonzini return MFI_STAT_SCSI_DONE_WITH_ERROR; 170649ab747fSPaolo Bonzini } 170749ab747fSPaolo Bonzini 170849ab747fSPaolo Bonzini if (megasas_map_sgl(s, cmd, &cmd->frame->pass.sgl)) { 170949ab747fSPaolo Bonzini megasas_write_sense(cmd, SENSE_CODE(TARGET_FAILURE)); 171049ab747fSPaolo Bonzini cmd->frame->header.scsi_status = CHECK_CONDITION; 171149ab747fSPaolo Bonzini s->event_count++; 171249ab747fSPaolo Bonzini return MFI_STAT_SCSI_DONE_WITH_ERROR; 171349ab747fSPaolo Bonzini } 171449ab747fSPaolo Bonzini 1715b356807fSPaolo Bonzini cmd->req = scsi_req_new(sdev, cmd->index, lun_id, cdb, cmd); 171649ab747fSPaolo Bonzini if (!cmd->req) { 171749ab747fSPaolo Bonzini trace_megasas_scsi_req_alloc_failed( 1718ee760ac8SThomas Huth mfi_frame_desc(frame_cmd), target_id, lun_id); 171949ab747fSPaolo Bonzini megasas_write_sense(cmd, SENSE_CODE(NO_SENSE)); 172049ab747fSPaolo Bonzini cmd->frame->header.scsi_status = BUSY; 172149ab747fSPaolo Bonzini s->event_count++; 172249ab747fSPaolo Bonzini return MFI_STAT_SCSI_DONE_WITH_ERROR; 172349ab747fSPaolo Bonzini } 172449ab747fSPaolo Bonzini 172549ab747fSPaolo Bonzini is_write = (cmd->req->cmd.mode == SCSI_XFER_TO_DEV); 1726aaf2a859SHannes Reinecke if (cmd->iov_size) { 172749ab747fSPaolo Bonzini if (is_write) { 1728aaf2a859SHannes Reinecke trace_megasas_scsi_write_start(cmd->index, cmd->iov_size); 172949ab747fSPaolo Bonzini } else { 1730aaf2a859SHannes Reinecke trace_megasas_scsi_read_start(cmd->index, cmd->iov_size); 173149ab747fSPaolo Bonzini } 173249ab747fSPaolo Bonzini } else { 173349ab747fSPaolo Bonzini trace_megasas_scsi_nodata(cmd->index); 173449ab747fSPaolo Bonzini } 1735aaf2a859SHannes Reinecke megasas_enqueue_req(cmd, is_write); 173649ab747fSPaolo Bonzini return MFI_STAT_INVALID_STATUS; 173749ab747fSPaolo Bonzini } 173849ab747fSPaolo Bonzini 173936c327a6SPaolo Bonzini static int megasas_handle_io(MegasasState *s, MegasasCmd *cmd, int frame_cmd) 174049ab747fSPaolo Bonzini { 174149ab747fSPaolo Bonzini uint32_t lba_count, lba_start_hi, lba_start_lo; 174249ab747fSPaolo Bonzini uint64_t lba_start; 174336c327a6SPaolo Bonzini bool is_write = (frame_cmd == MFI_CMD_LD_WRITE); 174449ab747fSPaolo Bonzini uint8_t cdb[16]; 174549ab747fSPaolo Bonzini int len; 174649ab747fSPaolo Bonzini struct SCSIDevice *sdev = NULL; 1747b356807fSPaolo Bonzini int target_id, lun_id, cdb_len; 174849ab747fSPaolo Bonzini 174949ab747fSPaolo Bonzini lba_count = le32_to_cpu(cmd->frame->io.header.data_len); 175049ab747fSPaolo Bonzini lba_start_lo = le32_to_cpu(cmd->frame->io.lba_lo); 175149ab747fSPaolo Bonzini lba_start_hi = le32_to_cpu(cmd->frame->io.lba_hi); 175249ab747fSPaolo Bonzini lba_start = ((uint64_t)lba_start_hi << 32) | lba_start_lo; 175349ab747fSPaolo Bonzini 1754b356807fSPaolo Bonzini target_id = cmd->frame->header.target_id; 1755b356807fSPaolo Bonzini lun_id = cmd->frame->header.lun_id; 1756b356807fSPaolo Bonzini cdb_len = cmd->frame->header.cdb_len; 1757b356807fSPaolo Bonzini 1758b356807fSPaolo Bonzini if (target_id < MFI_MAX_LD && lun_id == 0) { 1759b356807fSPaolo Bonzini sdev = scsi_device_find(&s->bus, 0, target_id, lun_id); 176049ab747fSPaolo Bonzini } 176149ab747fSPaolo Bonzini 176249ab747fSPaolo Bonzini trace_megasas_handle_io(cmd->index, 1763ee760ac8SThomas Huth mfi_frame_desc(frame_cmd), target_id, lun_id, 176449ab747fSPaolo Bonzini (unsigned long)lba_start, (unsigned long)lba_count); 176549ab747fSPaolo Bonzini if (!sdev) { 176649ab747fSPaolo Bonzini trace_megasas_io_target_not_present(cmd->index, 1767ee760ac8SThomas Huth mfi_frame_desc(frame_cmd), target_id, lun_id); 176849ab747fSPaolo Bonzini return MFI_STAT_DEVICE_NOT_FOUND; 176949ab747fSPaolo Bonzini } 177049ab747fSPaolo Bonzini 1771b356807fSPaolo Bonzini if (cdb_len > 16) { 177249ab747fSPaolo Bonzini trace_megasas_scsi_invalid_cdb_len( 1773ee760ac8SThomas Huth mfi_frame_desc(frame_cmd), 1, target_id, lun_id, cdb_len); 177449ab747fSPaolo Bonzini megasas_write_sense(cmd, SENSE_CODE(INVALID_OPCODE)); 177549ab747fSPaolo Bonzini cmd->frame->header.scsi_status = CHECK_CONDITION; 177649ab747fSPaolo Bonzini s->event_count++; 177749ab747fSPaolo Bonzini return MFI_STAT_SCSI_DONE_WITH_ERROR; 177849ab747fSPaolo Bonzini } 177949ab747fSPaolo Bonzini 178049ab747fSPaolo Bonzini cmd->iov_size = lba_count * sdev->blocksize; 178149ab747fSPaolo Bonzini if (megasas_map_sgl(s, cmd, &cmd->frame->io.sgl)) { 178249ab747fSPaolo Bonzini megasas_write_sense(cmd, SENSE_CODE(TARGET_FAILURE)); 178349ab747fSPaolo Bonzini cmd->frame->header.scsi_status = CHECK_CONDITION; 178449ab747fSPaolo Bonzini s->event_count++; 178549ab747fSPaolo Bonzini return MFI_STAT_SCSI_DONE_WITH_ERROR; 178649ab747fSPaolo Bonzini } 178749ab747fSPaolo Bonzini 178849ab747fSPaolo Bonzini megasas_encode_lba(cdb, lba_start, lba_count, is_write); 178949ab747fSPaolo Bonzini cmd->req = scsi_req_new(sdev, cmd->index, 1790b356807fSPaolo Bonzini lun_id, cdb, cmd); 179149ab747fSPaolo Bonzini if (!cmd->req) { 179249ab747fSPaolo Bonzini trace_megasas_scsi_req_alloc_failed( 1793ee760ac8SThomas Huth mfi_frame_desc(frame_cmd), target_id, lun_id); 179449ab747fSPaolo Bonzini megasas_write_sense(cmd, SENSE_CODE(NO_SENSE)); 179549ab747fSPaolo Bonzini cmd->frame->header.scsi_status = BUSY; 179649ab747fSPaolo Bonzini s->event_count++; 179749ab747fSPaolo Bonzini return MFI_STAT_SCSI_DONE_WITH_ERROR; 179849ab747fSPaolo Bonzini } 179949ab747fSPaolo Bonzini len = megasas_enqueue_req(cmd, is_write); 180049ab747fSPaolo Bonzini if (len > 0) { 180149ab747fSPaolo Bonzini if (is_write) { 180249ab747fSPaolo Bonzini trace_megasas_io_write_start(cmd->index, lba_start, lba_count, len); 180349ab747fSPaolo Bonzini } else { 180449ab747fSPaolo Bonzini trace_megasas_io_read_start(cmd->index, lba_start, lba_count, len); 180549ab747fSPaolo Bonzini } 180649ab747fSPaolo Bonzini } 180749ab747fSPaolo Bonzini return MFI_STAT_INVALID_STATUS; 180849ab747fSPaolo Bonzini } 180949ab747fSPaolo Bonzini 181049ab747fSPaolo Bonzini static QEMUSGList *megasas_get_sg_list(SCSIRequest *req) 181149ab747fSPaolo Bonzini { 181249ab747fSPaolo Bonzini MegasasCmd *cmd = req->hba_private; 181349ab747fSPaolo Bonzini 181436c327a6SPaolo Bonzini if (cmd->dcmd_opcode != -1) { 181549ab747fSPaolo Bonzini return NULL; 181649ab747fSPaolo Bonzini } else { 181749ab747fSPaolo Bonzini return &cmd->qsg; 181849ab747fSPaolo Bonzini } 181949ab747fSPaolo Bonzini } 182049ab747fSPaolo Bonzini 182149ab747fSPaolo Bonzini static void megasas_xfer_complete(SCSIRequest *req, uint32_t len) 182249ab747fSPaolo Bonzini { 182349ab747fSPaolo Bonzini MegasasCmd *cmd = req->hba_private; 182449ab747fSPaolo Bonzini uint8_t *buf; 182549ab747fSPaolo Bonzini 182649ab747fSPaolo Bonzini trace_megasas_io_complete(cmd->index, len); 182749ab747fSPaolo Bonzini 182836c327a6SPaolo Bonzini if (cmd->dcmd_opcode != -1) { 182949ab747fSPaolo Bonzini scsi_req_continue(req); 183049ab747fSPaolo Bonzini return; 183149ab747fSPaolo Bonzini } 183249ab747fSPaolo Bonzini 183349ab747fSPaolo Bonzini buf = scsi_req_get_buf(req); 18345104fac8SPaolo Bonzini if (cmd->dcmd_opcode == MFI_DCMD_PD_GET_INFO && cmd->iov_buf) { 183549ab747fSPaolo Bonzini struct mfi_pd_info *info = cmd->iov_buf; 183649ab747fSPaolo Bonzini 183749ab747fSPaolo Bonzini if (info->inquiry_data[0] == 0x7f) { 183849ab747fSPaolo Bonzini memset(info->inquiry_data, 0, sizeof(info->inquiry_data)); 183949ab747fSPaolo Bonzini memcpy(info->inquiry_data, buf, len); 184049ab747fSPaolo Bonzini } else if (info->vpd_page83[0] == 0x7f) { 184149ab747fSPaolo Bonzini memset(info->vpd_page83, 0, sizeof(info->vpd_page83)); 184249ab747fSPaolo Bonzini memcpy(info->vpd_page83, buf, len); 184349ab747fSPaolo Bonzini } 184449ab747fSPaolo Bonzini scsi_req_continue(req); 18455104fac8SPaolo Bonzini } else if (cmd->dcmd_opcode == MFI_DCMD_LD_GET_INFO) { 184649ab747fSPaolo Bonzini struct mfi_ld_info *info = cmd->iov_buf; 184749ab747fSPaolo Bonzini 184849ab747fSPaolo Bonzini if (cmd->iov_buf) { 184949ab747fSPaolo Bonzini memcpy(info->vpd_page83, buf, sizeof(info->vpd_page83)); 185049ab747fSPaolo Bonzini scsi_req_continue(req); 185149ab747fSPaolo Bonzini } 185249ab747fSPaolo Bonzini } 185349ab747fSPaolo Bonzini } 185449ab747fSPaolo Bonzini 185549ab747fSPaolo Bonzini static void megasas_command_complete(SCSIRequest *req, uint32_t status, 185649ab747fSPaolo Bonzini size_t resid) 185749ab747fSPaolo Bonzini { 185849ab747fSPaolo Bonzini MegasasCmd *cmd = req->hba_private; 185949ab747fSPaolo Bonzini uint8_t cmd_status = MFI_STAT_OK; 186049ab747fSPaolo Bonzini 186149ab747fSPaolo Bonzini trace_megasas_command_complete(cmd->index, status, resid); 186249ab747fSPaolo Bonzini 18639e55d588SPaolo Bonzini if (req->io_canceled) { 18649e55d588SPaolo Bonzini return; 18659e55d588SPaolo Bonzini } 18669e55d588SPaolo Bonzini 186787e459a8SPaolo Bonzini if (cmd->dcmd_opcode != -1) { 186849ab747fSPaolo Bonzini /* 186949ab747fSPaolo Bonzini * Internal command complete 187049ab747fSPaolo Bonzini */ 187136c327a6SPaolo Bonzini cmd_status = megasas_finish_internal_dcmd(cmd, req, resid); 187249ab747fSPaolo Bonzini if (cmd_status == MFI_STAT_INVALID_STATUS) { 187349ab747fSPaolo Bonzini return; 187449ab747fSPaolo Bonzini } 187549ab747fSPaolo Bonzini } else { 187649ab747fSPaolo Bonzini req->status = status; 187749ab747fSPaolo Bonzini trace_megasas_scsi_complete(cmd->index, req->status, 187849ab747fSPaolo Bonzini cmd->iov_size, req->cmd.xfer); 187949ab747fSPaolo Bonzini if (req->status != GOOD) { 188049ab747fSPaolo Bonzini cmd_status = MFI_STAT_SCSI_DONE_WITH_ERROR; 188149ab747fSPaolo Bonzini } 188249ab747fSPaolo Bonzini if (req->status == CHECK_CONDITION) { 188349ab747fSPaolo Bonzini megasas_copy_sense(cmd); 188449ab747fSPaolo Bonzini } 188549ab747fSPaolo Bonzini 188649ab747fSPaolo Bonzini cmd->frame->header.scsi_status = req->status; 188749ab747fSPaolo Bonzini } 188849ab747fSPaolo Bonzini cmd->frame->header.cmd_status = cmd_status; 18899e55d588SPaolo Bonzini megasas_complete_command(cmd); 189049ab747fSPaolo Bonzini } 189149ab747fSPaolo Bonzini 18929e55d588SPaolo Bonzini static void megasas_command_cancelled(SCSIRequest *req) 189349ab747fSPaolo Bonzini { 189449ab747fSPaolo Bonzini MegasasCmd *cmd = req->hba_private; 189549ab747fSPaolo Bonzini 18969e55d588SPaolo Bonzini if (!cmd) { 18979e55d588SPaolo Bonzini return; 189849ab747fSPaolo Bonzini } 18999e55d588SPaolo Bonzini cmd->frame->header.cmd_status = MFI_STAT_SCSI_IO_FAILED; 19009e55d588SPaolo Bonzini megasas_complete_command(cmd); 190149ab747fSPaolo Bonzini } 190249ab747fSPaolo Bonzini 190349ab747fSPaolo Bonzini static int megasas_handle_abort(MegasasState *s, MegasasCmd *cmd) 190449ab747fSPaolo Bonzini { 190549ab747fSPaolo Bonzini uint64_t abort_ctx = le64_to_cpu(cmd->frame->abort.abort_context); 190649ab747fSPaolo Bonzini hwaddr abort_addr, addr_hi, addr_lo; 190749ab747fSPaolo Bonzini MegasasCmd *abort_cmd; 190849ab747fSPaolo Bonzini 190949ab747fSPaolo Bonzini addr_hi = le32_to_cpu(cmd->frame->abort.abort_mfi_addr_hi); 191049ab747fSPaolo Bonzini addr_lo = le32_to_cpu(cmd->frame->abort.abort_mfi_addr_lo); 191149ab747fSPaolo Bonzini abort_addr = ((uint64_t)addr_hi << 32) | addr_lo; 191249ab747fSPaolo Bonzini 191349ab747fSPaolo Bonzini abort_cmd = megasas_lookup_frame(s, abort_addr); 191449ab747fSPaolo Bonzini if (!abort_cmd) { 191549ab747fSPaolo Bonzini trace_megasas_abort_no_cmd(cmd->index, abort_ctx); 191649ab747fSPaolo Bonzini s->event_count++; 191749ab747fSPaolo Bonzini return MFI_STAT_OK; 191849ab747fSPaolo Bonzini } 191949ab747fSPaolo Bonzini if (!megasas_use_queue64(s)) { 192049ab747fSPaolo Bonzini abort_ctx &= (uint64_t)0xFFFFFFFF; 192149ab747fSPaolo Bonzini } 192249ab747fSPaolo Bonzini if (abort_cmd->context != abort_ctx) { 1923d17e7448SEric Blake trace_megasas_abort_invalid_context(cmd->index, abort_cmd->context, 1924d17e7448SEric Blake abort_cmd->index); 192549ab747fSPaolo Bonzini s->event_count++; 192649ab747fSPaolo Bonzini return MFI_STAT_ABORT_NOT_POSSIBLE; 192749ab747fSPaolo Bonzini } 192849ab747fSPaolo Bonzini trace_megasas_abort_frame(cmd->index, abort_cmd->index); 192949ab747fSPaolo Bonzini megasas_abort_command(abort_cmd); 193049ab747fSPaolo Bonzini if (!s->event_cmd || abort_cmd != s->event_cmd) { 193149ab747fSPaolo Bonzini s->event_cmd = NULL; 193249ab747fSPaolo Bonzini } 193349ab747fSPaolo Bonzini s->event_count++; 193449ab747fSPaolo Bonzini return MFI_STAT_OK; 193549ab747fSPaolo Bonzini } 193649ab747fSPaolo Bonzini 193749ab747fSPaolo Bonzini static void megasas_handle_frame(MegasasState *s, uint64_t frame_addr, 193849ab747fSPaolo Bonzini uint32_t frame_count) 193949ab747fSPaolo Bonzini { 194049ab747fSPaolo Bonzini uint8_t frame_status = MFI_STAT_INVALID_CMD; 194149ab747fSPaolo Bonzini uint64_t frame_context; 194236c327a6SPaolo Bonzini int frame_cmd; 194349ab747fSPaolo Bonzini MegasasCmd *cmd; 194449ab747fSPaolo Bonzini 194549ab747fSPaolo Bonzini /* 194649ab747fSPaolo Bonzini * Always read 64bit context, top bits will be 194749ab747fSPaolo Bonzini * masked out if required in megasas_enqueue_frame() 194849ab747fSPaolo Bonzini */ 194916578c6fSPaolo Bonzini frame_context = megasas_frame_get_context(s, frame_addr); 195049ab747fSPaolo Bonzini 195149ab747fSPaolo Bonzini cmd = megasas_enqueue_frame(s, frame_addr, frame_context, frame_count); 195249ab747fSPaolo Bonzini if (!cmd) { 195349ab747fSPaolo Bonzini /* reply queue full */ 195449ab747fSPaolo Bonzini trace_megasas_frame_busy(frame_addr); 195516578c6fSPaolo Bonzini megasas_frame_set_scsi_status(s, frame_addr, BUSY); 195616578c6fSPaolo Bonzini megasas_frame_set_cmd_status(s, frame_addr, MFI_STAT_SCSI_DONE_WITH_ERROR); 195749ab747fSPaolo Bonzini megasas_complete_frame(s, frame_context); 195849ab747fSPaolo Bonzini s->event_count++; 195949ab747fSPaolo Bonzini return; 196049ab747fSPaolo Bonzini } 196136c327a6SPaolo Bonzini frame_cmd = cmd->frame->header.frame_cmd; 196236c327a6SPaolo Bonzini switch (frame_cmd) { 196349ab747fSPaolo Bonzini case MFI_CMD_INIT: 196449ab747fSPaolo Bonzini frame_status = megasas_init_firmware(s, cmd); 196549ab747fSPaolo Bonzini break; 196649ab747fSPaolo Bonzini case MFI_CMD_DCMD: 196749ab747fSPaolo Bonzini frame_status = megasas_handle_dcmd(s, cmd); 196849ab747fSPaolo Bonzini break; 196949ab747fSPaolo Bonzini case MFI_CMD_ABORT: 197049ab747fSPaolo Bonzini frame_status = megasas_handle_abort(s, cmd); 197149ab747fSPaolo Bonzini break; 197249ab747fSPaolo Bonzini case MFI_CMD_PD_SCSI_IO: 197349ab747fSPaolo Bonzini case MFI_CMD_LD_SCSI_IO: 197436c327a6SPaolo Bonzini frame_status = megasas_handle_scsi(s, cmd, frame_cmd); 197549ab747fSPaolo Bonzini break; 197649ab747fSPaolo Bonzini case MFI_CMD_LD_READ: 197749ab747fSPaolo Bonzini case MFI_CMD_LD_WRITE: 197836c327a6SPaolo Bonzini frame_status = megasas_handle_io(s, cmd, frame_cmd); 197949ab747fSPaolo Bonzini break; 198049ab747fSPaolo Bonzini default: 198136c327a6SPaolo Bonzini trace_megasas_unhandled_frame_cmd(cmd->index, frame_cmd); 198249ab747fSPaolo Bonzini s->event_count++; 198349ab747fSPaolo Bonzini break; 198449ab747fSPaolo Bonzini } 198549ab747fSPaolo Bonzini if (frame_status != MFI_STAT_INVALID_STATUS) { 1986421cc3e7SPaolo Bonzini if (cmd->frame) { 198749ab747fSPaolo Bonzini cmd->frame->header.cmd_status = frame_status; 1988421cc3e7SPaolo Bonzini } else { 1989421cc3e7SPaolo Bonzini megasas_frame_set_cmd_status(s, frame_addr, frame_status); 1990421cc3e7SPaolo Bonzini } 19916df5718bSHannes Reinecke megasas_unmap_frame(s, cmd); 199249ab747fSPaolo Bonzini megasas_complete_frame(s, cmd->context); 199349ab747fSPaolo Bonzini } 199449ab747fSPaolo Bonzini } 199549ab747fSPaolo Bonzini 199649ab747fSPaolo Bonzini static uint64_t megasas_mmio_read(void *opaque, hwaddr addr, 199749ab747fSPaolo Bonzini unsigned size) 199849ab747fSPaolo Bonzini { 199949ab747fSPaolo Bonzini MegasasState *s = opaque; 2000e23d0498SHannes Reinecke PCIDevice *pci_dev = PCI_DEVICE(s); 20012e0aec15SEduardo Habkost MegasasBaseClass *base_class = MEGASAS_GET_CLASS(s); 200249ab747fSPaolo Bonzini uint32_t retval = 0; 200349ab747fSPaolo Bonzini 200449ab747fSPaolo Bonzini switch (addr) { 200549ab747fSPaolo Bonzini case MFI_IDB: 200649ab747fSPaolo Bonzini retval = 0; 200777bb6b17SHannes Reinecke trace_megasas_mmio_readl("MFI_IDB", retval); 200849ab747fSPaolo Bonzini break; 200949ab747fSPaolo Bonzini case MFI_OMSG0: 201049ab747fSPaolo Bonzini case MFI_OSP0: 2011e23d0498SHannes Reinecke retval = (msix_present(pci_dev) ? MFI_FWSTATE_MSIX_SUPPORTED : 0) | 201249ab747fSPaolo Bonzini (s->fw_state & MFI_FWSTATE_MASK) | 201349ab747fSPaolo Bonzini ((s->fw_sge & 0xff) << 16) | 201449ab747fSPaolo Bonzini (s->fw_cmds & 0xFFFF); 201577bb6b17SHannes Reinecke trace_megasas_mmio_readl(addr == MFI_OMSG0 ? "MFI_OMSG0" : "MFI_OSP0", 201677bb6b17SHannes Reinecke retval); 201749ab747fSPaolo Bonzini break; 201849ab747fSPaolo Bonzini case MFI_OSTS: 201949ab747fSPaolo Bonzini if (megasas_intr_enabled(s) && s->doorbell) { 2020e23d0498SHannes Reinecke retval = base_class->osts; 202149ab747fSPaolo Bonzini } 202277bb6b17SHannes Reinecke trace_megasas_mmio_readl("MFI_OSTS", retval); 202349ab747fSPaolo Bonzini break; 202449ab747fSPaolo Bonzini case MFI_OMSK: 202549ab747fSPaolo Bonzini retval = s->intr_mask; 202677bb6b17SHannes Reinecke trace_megasas_mmio_readl("MFI_OMSK", retval); 202749ab747fSPaolo Bonzini break; 202849ab747fSPaolo Bonzini case MFI_ODCR0: 20297957ee71SHannes Reinecke retval = s->doorbell ? 1 : 0; 203077bb6b17SHannes Reinecke trace_megasas_mmio_readl("MFI_ODCR0", retval); 203149ab747fSPaolo Bonzini break; 2032e23d0498SHannes Reinecke case MFI_DIAG: 2033e23d0498SHannes Reinecke retval = s->diag; 203477bb6b17SHannes Reinecke trace_megasas_mmio_readl("MFI_DIAG", retval); 2035e23d0498SHannes Reinecke break; 2036e23d0498SHannes Reinecke case MFI_OSP1: 2037e23d0498SHannes Reinecke retval = 15; 203877bb6b17SHannes Reinecke trace_megasas_mmio_readl("MFI_OSP1", retval); 2039e23d0498SHannes Reinecke break; 204049ab747fSPaolo Bonzini default: 204149ab747fSPaolo Bonzini trace_megasas_mmio_invalid_readl(addr); 204249ab747fSPaolo Bonzini break; 204349ab747fSPaolo Bonzini } 204449ab747fSPaolo Bonzini return retval; 204549ab747fSPaolo Bonzini } 204649ab747fSPaolo Bonzini 2047e23d0498SHannes Reinecke static int adp_reset_seq[] = {0x00, 0x04, 0x0b, 0x02, 0x07, 0x0d}; 2048e23d0498SHannes Reinecke 204949ab747fSPaolo Bonzini static void megasas_mmio_write(void *opaque, hwaddr addr, 205049ab747fSPaolo Bonzini uint64_t val, unsigned size) 205149ab747fSPaolo Bonzini { 205249ab747fSPaolo Bonzini MegasasState *s = opaque; 205352190c1eSAndreas Färber PCIDevice *pci_dev = PCI_DEVICE(s); 205449ab747fSPaolo Bonzini uint64_t frame_addr; 205549ab747fSPaolo Bonzini uint32_t frame_count; 205649ab747fSPaolo Bonzini int i; 205749ab747fSPaolo Bonzini 205849ab747fSPaolo Bonzini switch (addr) { 205949ab747fSPaolo Bonzini case MFI_IDB: 206077bb6b17SHannes Reinecke trace_megasas_mmio_writel("MFI_IDB", val); 206149ab747fSPaolo Bonzini if (val & MFI_FWINIT_ABORT) { 206249ab747fSPaolo Bonzini /* Abort all pending cmds */ 206349ab747fSPaolo Bonzini for (i = 0; i < s->fw_cmds; i++) { 206449ab747fSPaolo Bonzini megasas_abort_command(&s->frames[i]); 206549ab747fSPaolo Bonzini } 206649ab747fSPaolo Bonzini } 206749ab747fSPaolo Bonzini if (val & MFI_FWINIT_READY) { 206849ab747fSPaolo Bonzini /* move to FW READY */ 206949ab747fSPaolo Bonzini megasas_soft_reset(s); 207049ab747fSPaolo Bonzini } 207149ab747fSPaolo Bonzini if (val & MFI_FWINIT_MFIMODE) { 207249ab747fSPaolo Bonzini /* discard MFIs */ 207349ab747fSPaolo Bonzini } 2074e23d0498SHannes Reinecke if (val & MFI_FWINIT_STOP_ADP) { 2075e23d0498SHannes Reinecke /* Terminal error, stop processing */ 2076e23d0498SHannes Reinecke s->fw_state = MFI_FWSTATE_FAULT; 2077e23d0498SHannes Reinecke } 207849ab747fSPaolo Bonzini break; 207949ab747fSPaolo Bonzini case MFI_OMSK: 208077bb6b17SHannes Reinecke trace_megasas_mmio_writel("MFI_OMSK", val); 208149ab747fSPaolo Bonzini s->intr_mask = val; 20824522b69cSHannes Reinecke if (!megasas_intr_enabled(s) && 20834522b69cSHannes Reinecke !msi_enabled(pci_dev) && 20844522b69cSHannes Reinecke !msix_enabled(pci_dev)) { 208549ab747fSPaolo Bonzini trace_megasas_irq_lower(); 20869e64f8a3SMarcel Apfelbaum pci_irq_deassert(pci_dev); 208749ab747fSPaolo Bonzini } 208849ab747fSPaolo Bonzini if (megasas_intr_enabled(s)) { 20894522b69cSHannes Reinecke if (msix_enabled(pci_dev)) { 20904522b69cSHannes Reinecke trace_megasas_msix_enabled(0); 20914522b69cSHannes Reinecke } else if (msi_enabled(pci_dev)) { 20924522b69cSHannes Reinecke trace_megasas_msi_enabled(0); 20934522b69cSHannes Reinecke } else { 209449ab747fSPaolo Bonzini trace_megasas_intr_enabled(); 20954522b69cSHannes Reinecke } 209649ab747fSPaolo Bonzini } else { 209749ab747fSPaolo Bonzini trace_megasas_intr_disabled(); 2098e23d0498SHannes Reinecke megasas_soft_reset(s); 209949ab747fSPaolo Bonzini } 210049ab747fSPaolo Bonzini break; 210149ab747fSPaolo Bonzini case MFI_ODCR0: 210277bb6b17SHannes Reinecke trace_megasas_mmio_writel("MFI_ODCR0", val); 210349ab747fSPaolo Bonzini s->doorbell = 0; 21047957ee71SHannes Reinecke if (megasas_intr_enabled(s)) { 21057957ee71SHannes Reinecke if (!msix_enabled(pci_dev) && !msi_enabled(pci_dev)) { 210649ab747fSPaolo Bonzini trace_megasas_irq_lower(); 21079e64f8a3SMarcel Apfelbaum pci_irq_deassert(pci_dev); 210849ab747fSPaolo Bonzini } 210949ab747fSPaolo Bonzini } 211049ab747fSPaolo Bonzini break; 211149ab747fSPaolo Bonzini case MFI_IQPH: 211277bb6b17SHannes Reinecke trace_megasas_mmio_writel("MFI_IQPH", val); 211349ab747fSPaolo Bonzini /* Received high 32 bits of a 64 bit MFI frame address */ 211449ab747fSPaolo Bonzini s->frame_hi = val; 211549ab747fSPaolo Bonzini break; 211649ab747fSPaolo Bonzini case MFI_IQPL: 211777bb6b17SHannes Reinecke trace_megasas_mmio_writel("MFI_IQPL", val); 211849ab747fSPaolo Bonzini /* Received low 32 bits of a 64 bit MFI frame address */ 2119e23d0498SHannes Reinecke /* Fallthrough */ 212049ab747fSPaolo Bonzini case MFI_IQP: 212177bb6b17SHannes Reinecke if (addr == MFI_IQP) { 212277bb6b17SHannes Reinecke trace_megasas_mmio_writel("MFI_IQP", val); 2123e23d0498SHannes Reinecke /* Received 64 bit MFI frame address */ 212477bb6b17SHannes Reinecke s->frame_hi = 0; 212577bb6b17SHannes Reinecke } 212649ab747fSPaolo Bonzini frame_addr = (val & ~0x1F); 212749ab747fSPaolo Bonzini /* Add possible 64 bit offset */ 212849ab747fSPaolo Bonzini frame_addr |= ((uint64_t)s->frame_hi << 32); 212949ab747fSPaolo Bonzini s->frame_hi = 0; 213049ab747fSPaolo Bonzini frame_count = (val >> 1) & 0xF; 213149ab747fSPaolo Bonzini megasas_handle_frame(s, frame_addr, frame_count); 213249ab747fSPaolo Bonzini break; 2133e23d0498SHannes Reinecke case MFI_SEQ: 213477bb6b17SHannes Reinecke trace_megasas_mmio_writel("MFI_SEQ", val); 2135e23d0498SHannes Reinecke /* Magic sequence to start ADP reset */ 213624dfa9faSPrasad J Pandit if (adp_reset_seq[s->adp_reset++] == val) { 213724dfa9faSPrasad J Pandit if (s->adp_reset == 6) { 213824dfa9faSPrasad J Pandit s->adp_reset = 0; 213924dfa9faSPrasad J Pandit s->diag = MFI_DIAG_WRITE_ENABLE; 214024dfa9faSPrasad J Pandit } 2141e23d0498SHannes Reinecke } else { 2142e23d0498SHannes Reinecke s->adp_reset = 0; 2143e23d0498SHannes Reinecke s->diag = 0; 2144e23d0498SHannes Reinecke } 2145e23d0498SHannes Reinecke break; 2146e23d0498SHannes Reinecke case MFI_DIAG: 214777bb6b17SHannes Reinecke trace_megasas_mmio_writel("MFI_DIAG", val); 2148e23d0498SHannes Reinecke /* ADP reset */ 2149e23d0498SHannes Reinecke if ((s->diag & MFI_DIAG_WRITE_ENABLE) && 2150e23d0498SHannes Reinecke (val & MFI_DIAG_RESET_ADP)) { 2151e23d0498SHannes Reinecke s->diag |= MFI_DIAG_RESET_ADP; 2152e23d0498SHannes Reinecke megasas_soft_reset(s); 2153e23d0498SHannes Reinecke s->adp_reset = 0; 2154e23d0498SHannes Reinecke s->diag = 0; 2155e23d0498SHannes Reinecke } 2156e23d0498SHannes Reinecke break; 215749ab747fSPaolo Bonzini default: 215849ab747fSPaolo Bonzini trace_megasas_mmio_invalid_writel(addr, val); 215949ab747fSPaolo Bonzini break; 216049ab747fSPaolo Bonzini } 216149ab747fSPaolo Bonzini } 216249ab747fSPaolo Bonzini 216349ab747fSPaolo Bonzini static const MemoryRegionOps megasas_mmio_ops = { 216449ab747fSPaolo Bonzini .read = megasas_mmio_read, 216549ab747fSPaolo Bonzini .write = megasas_mmio_write, 216649ab747fSPaolo Bonzini .endianness = DEVICE_LITTLE_ENDIAN, 216749ab747fSPaolo Bonzini .impl = { 216849ab747fSPaolo Bonzini .min_access_size = 8, 216949ab747fSPaolo Bonzini .max_access_size = 8, 217049ab747fSPaolo Bonzini } 217149ab747fSPaolo Bonzini }; 217249ab747fSPaolo Bonzini 217349ab747fSPaolo Bonzini static uint64_t megasas_port_read(void *opaque, hwaddr addr, 217449ab747fSPaolo Bonzini unsigned size) 217549ab747fSPaolo Bonzini { 217649ab747fSPaolo Bonzini return megasas_mmio_read(opaque, addr & 0xff, size); 217749ab747fSPaolo Bonzini } 217849ab747fSPaolo Bonzini 217949ab747fSPaolo Bonzini static void megasas_port_write(void *opaque, hwaddr addr, 218049ab747fSPaolo Bonzini uint64_t val, unsigned size) 218149ab747fSPaolo Bonzini { 218249ab747fSPaolo Bonzini megasas_mmio_write(opaque, addr & 0xff, val, size); 218349ab747fSPaolo Bonzini } 218449ab747fSPaolo Bonzini 218549ab747fSPaolo Bonzini static const MemoryRegionOps megasas_port_ops = { 218649ab747fSPaolo Bonzini .read = megasas_port_read, 218749ab747fSPaolo Bonzini .write = megasas_port_write, 218849ab747fSPaolo Bonzini .endianness = DEVICE_LITTLE_ENDIAN, 218949ab747fSPaolo Bonzini .impl = { 219049ab747fSPaolo Bonzini .min_access_size = 4, 219149ab747fSPaolo Bonzini .max_access_size = 4, 219249ab747fSPaolo Bonzini } 219349ab747fSPaolo Bonzini }; 219449ab747fSPaolo Bonzini 219549ab747fSPaolo Bonzini static uint64_t megasas_queue_read(void *opaque, hwaddr addr, 219649ab747fSPaolo Bonzini unsigned size) 219749ab747fSPaolo Bonzini { 219849ab747fSPaolo Bonzini return 0; 219949ab747fSPaolo Bonzini } 220049ab747fSPaolo Bonzini 220155875fc4SSalva Peiró static void megasas_queue_write(void *opaque, hwaddr addr, 220255875fc4SSalva Peiró uint64_t val, unsigned size) 220355875fc4SSalva Peiró { 220455875fc4SSalva Peiró return; 220555875fc4SSalva Peiró } 220655875fc4SSalva Peiró 220749ab747fSPaolo Bonzini static const MemoryRegionOps megasas_queue_ops = { 220849ab747fSPaolo Bonzini .read = megasas_queue_read, 220955875fc4SSalva Peiró .write = megasas_queue_write, 221049ab747fSPaolo Bonzini .endianness = DEVICE_LITTLE_ENDIAN, 221149ab747fSPaolo Bonzini .impl = { 221249ab747fSPaolo Bonzini .min_access_size = 8, 221349ab747fSPaolo Bonzini .max_access_size = 8, 221449ab747fSPaolo Bonzini } 221549ab747fSPaolo Bonzini }; 221649ab747fSPaolo Bonzini 221749ab747fSPaolo Bonzini static void megasas_soft_reset(MegasasState *s) 221849ab747fSPaolo Bonzini { 221949ab747fSPaolo Bonzini int i; 222049ab747fSPaolo Bonzini MegasasCmd *cmd; 222149ab747fSPaolo Bonzini 22228d72db68SHannes Reinecke trace_megasas_reset(s->fw_state); 222349ab747fSPaolo Bonzini for (i = 0; i < s->fw_cmds; i++) { 222449ab747fSPaolo Bonzini cmd = &s->frames[i]; 222549ab747fSPaolo Bonzini megasas_abort_command(cmd); 222649ab747fSPaolo Bonzini } 22278d72db68SHannes Reinecke if (s->fw_state == MFI_FWSTATE_READY) { 22288d72db68SHannes Reinecke BusChild *kid; 22298d72db68SHannes Reinecke 22308d72db68SHannes Reinecke /* 22318d72db68SHannes Reinecke * The EFI firmware doesn't handle UA, 22328d72db68SHannes Reinecke * so we need to clear the Power On/Reset UA 22338d72db68SHannes Reinecke * after the initial reset. 22348d72db68SHannes Reinecke */ 22358d72db68SHannes Reinecke QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) { 2236e1dc6815SCao jin SCSIDevice *sdev = SCSI_DEVICE(kid->child); 22378d72db68SHannes Reinecke 22388d72db68SHannes Reinecke sdev->unit_attention = SENSE_CODE(NO_SENSE); 22398d72db68SHannes Reinecke scsi_device_unit_attention_reported(sdev); 22408d72db68SHannes Reinecke } 22418d72db68SHannes Reinecke } 224249ab747fSPaolo Bonzini megasas_reset_frames(s); 224349ab747fSPaolo Bonzini s->reply_queue_len = s->fw_cmds; 224449ab747fSPaolo Bonzini s->reply_queue_pa = 0; 224549ab747fSPaolo Bonzini s->consumer_pa = 0; 224649ab747fSPaolo Bonzini s->producer_pa = 0; 224749ab747fSPaolo Bonzini s->fw_state = MFI_FWSTATE_READY; 224849ab747fSPaolo Bonzini s->doorbell = 0; 224949ab747fSPaolo Bonzini s->intr_mask = MEGASAS_INTR_DISABLED_MASK; 225049ab747fSPaolo Bonzini s->frame_hi = 0; 225149ab747fSPaolo Bonzini s->flags &= ~MEGASAS_MASK_USE_QUEUE64; 225249ab747fSPaolo Bonzini s->event_count++; 225349ab747fSPaolo Bonzini s->boot_event = s->event_count; 225449ab747fSPaolo Bonzini } 225549ab747fSPaolo Bonzini 225649ab747fSPaolo Bonzini static void megasas_scsi_reset(DeviceState *dev) 225749ab747fSPaolo Bonzini { 2258c79e16aeSPeter Crosthwaite MegasasState *s = MEGASAS(dev); 225949ab747fSPaolo Bonzini 226049ab747fSPaolo Bonzini megasas_soft_reset(s); 226149ab747fSPaolo Bonzini } 226249ab747fSPaolo Bonzini 2263e23d0498SHannes Reinecke static const VMStateDescription vmstate_megasas_gen1 = { 226449ab747fSPaolo Bonzini .name = "megasas", 226549ab747fSPaolo Bonzini .version_id = 0, 226649ab747fSPaolo Bonzini .minimum_version_id = 0, 226749ab747fSPaolo Bonzini .fields = (VMStateField[]) { 226852190c1eSAndreas Färber VMSTATE_PCI_DEVICE(parent_obj, MegasasState), 226923335f62SHannes Reinecke VMSTATE_MSIX(parent_obj, MegasasState), 227049ab747fSPaolo Bonzini 22712b151297SPrasad J Pandit VMSTATE_UINT32(fw_state, MegasasState), 22722b151297SPrasad J Pandit VMSTATE_UINT32(intr_mask, MegasasState), 22732b151297SPrasad J Pandit VMSTATE_UINT32(doorbell, MegasasState), 227449ab747fSPaolo Bonzini VMSTATE_UINT64(reply_queue_pa, MegasasState), 227549ab747fSPaolo Bonzini VMSTATE_UINT64(consumer_pa, MegasasState), 227649ab747fSPaolo Bonzini VMSTATE_UINT64(producer_pa, MegasasState), 227749ab747fSPaolo Bonzini VMSTATE_END_OF_LIST() 227849ab747fSPaolo Bonzini } 227949ab747fSPaolo Bonzini }; 228049ab747fSPaolo Bonzini 2281e23d0498SHannes Reinecke static const VMStateDescription vmstate_megasas_gen2 = { 2282e23d0498SHannes Reinecke .name = "megasas-gen2", 2283e23d0498SHannes Reinecke .version_id = 0, 2284e23d0498SHannes Reinecke .minimum_version_id = 0, 2285e23d0498SHannes Reinecke .minimum_version_id_old = 0, 2286e23d0498SHannes Reinecke .fields = (VMStateField[]) { 228720daa90aSDr. David Alan Gilbert VMSTATE_PCI_DEVICE(parent_obj, MegasasState), 2288e23d0498SHannes Reinecke VMSTATE_MSIX(parent_obj, MegasasState), 2289e23d0498SHannes Reinecke 22902b151297SPrasad J Pandit VMSTATE_UINT32(fw_state, MegasasState), 22912b151297SPrasad J Pandit VMSTATE_UINT32(intr_mask, MegasasState), 22922b151297SPrasad J Pandit VMSTATE_UINT32(doorbell, MegasasState), 2293e23d0498SHannes Reinecke VMSTATE_UINT64(reply_queue_pa, MegasasState), 2294e23d0498SHannes Reinecke VMSTATE_UINT64(consumer_pa, MegasasState), 2295e23d0498SHannes Reinecke VMSTATE_UINT64(producer_pa, MegasasState), 2296e23d0498SHannes Reinecke VMSTATE_END_OF_LIST() 2297e23d0498SHannes Reinecke } 2298e23d0498SHannes Reinecke }; 2299e23d0498SHannes Reinecke 230049ab747fSPaolo Bonzini static void megasas_scsi_uninit(PCIDevice *d) 230149ab747fSPaolo Bonzini { 2302c79e16aeSPeter Crosthwaite MegasasState *s = MEGASAS(d); 230349ab747fSPaolo Bonzini 23044522b69cSHannes Reinecke if (megasas_use_msix(s)) { 230523335f62SHannes Reinecke msix_uninit(d, &s->mmio_io, &s->mmio_io); 23064522b69cSHannes Reinecke } 23074522b69cSHannes Reinecke msi_uninit(d); 23084522b69cSHannes Reinecke } 230949ab747fSPaolo Bonzini 231049ab747fSPaolo Bonzini static const struct SCSIBusInfo megasas_scsi_info = { 231149ab747fSPaolo Bonzini .tcq = true, 231249ab747fSPaolo Bonzini .max_target = MFI_MAX_LD, 231349ab747fSPaolo Bonzini .max_lun = 255, 231449ab747fSPaolo Bonzini 231549ab747fSPaolo Bonzini .transfer_data = megasas_xfer_complete, 231649ab747fSPaolo Bonzini .get_sg_list = megasas_get_sg_list, 231749ab747fSPaolo Bonzini .complete = megasas_command_complete, 23189e55d588SPaolo Bonzini .cancel = megasas_command_cancelled, 231949ab747fSPaolo Bonzini }; 232049ab747fSPaolo Bonzini 2321ae071cc8SMarkus Armbruster static void megasas_scsi_realize(PCIDevice *dev, Error **errp) 232249ab747fSPaolo Bonzini { 2323c79e16aeSPeter Crosthwaite MegasasState *s = MEGASAS(dev); 23242e0aec15SEduardo Habkost MegasasBaseClass *b = MEGASAS_GET_CLASS(s); 232549ab747fSPaolo Bonzini uint8_t *pci_conf; 232649ab747fSPaolo Bonzini int i, bar_type; 23271108b2f8SCao jin Error *err = NULL; 23281108b2f8SCao jin int ret; 232949ab747fSPaolo Bonzini 233052190c1eSAndreas Färber pci_conf = dev->config; 233149ab747fSPaolo Bonzini 233249ab747fSPaolo Bonzini /* PCI latency timer = 0 */ 233349ab747fSPaolo Bonzini pci_conf[PCI_LATENCY_TIMER] = 0; 233449ab747fSPaolo Bonzini /* Interrupt pin 1 */ 233549ab747fSPaolo Bonzini pci_conf[PCI_INTERRUPT_PIN] = 0x01; 233649ab747fSPaolo Bonzini 2337afea4e14SCao jin if (s->msi != ON_OFF_AUTO_OFF) { 23381108b2f8SCao jin ret = msi_init(dev, 0x50, 1, true, false, &err); 23391108b2f8SCao jin /* Any error other than -ENOTSUP(board's MSI support is broken) 23401108b2f8SCao jin * is a programming error */ 23411108b2f8SCao jin assert(!ret || ret == -ENOTSUP); 23421108b2f8SCao jin if (ret && s->msi == ON_OFF_AUTO_ON) { 23431108b2f8SCao jin /* Can't satisfy user's explicit msi=on request, fail */ 23441108b2f8SCao jin error_append_hint(&err, "You have to use msi=auto (default) or " 23451108b2f8SCao jin "msi=off with this machine type.\n"); 23461108b2f8SCao jin error_propagate(errp, err); 23471108b2f8SCao jin return; 23481108b2f8SCao jin } else if (ret) { 23491108b2f8SCao jin /* With msi=auto, we fall back to MSI off silently */ 23501108b2f8SCao jin s->msi = ON_OFF_AUTO_OFF; 23511108b2f8SCao jin error_free(err); 23521108b2f8SCao jin } 23531108b2f8SCao jin } 23541108b2f8SCao jin 235529776739SPaolo Bonzini memory_region_init_io(&s->mmio_io, OBJECT(s), &megasas_mmio_ops, s, 235649ab747fSPaolo Bonzini "megasas-mmio", 0x4000); 235729776739SPaolo Bonzini memory_region_init_io(&s->port_io, OBJECT(s), &megasas_port_ops, s, 235849ab747fSPaolo Bonzini "megasas-io", 256); 235929776739SPaolo Bonzini memory_region_init_io(&s->queue_io, OBJECT(s), &megasas_queue_ops, s, 236049ab747fSPaolo Bonzini "megasas-queue", 0x40000); 236149ab747fSPaolo Bonzini 236249ab747fSPaolo Bonzini if (megasas_use_msix(s) && 2363e23d0498SHannes Reinecke msix_init(dev, 15, &s->mmio_io, b->mmio_bar, 0x2000, 2364ee640c62SCao jin &s->mmio_io, b->mmio_bar, 0x3800, 0x68, NULL)) { 2365ee640c62SCao jin /* TODO: check msix_init's error, and should fail on msix=on */ 2366b4b4a57fSCao jin s->msix = ON_OFF_AUTO_OFF; 236749ab747fSPaolo Bonzini } 2368ee640c62SCao jin 2369e23d0498SHannes Reinecke if (pci_is_express(dev)) { 2370e23d0498SHannes Reinecke pcie_endpoint_cap_init(dev, 0xa0); 2371e23d0498SHannes Reinecke } 237249ab747fSPaolo Bonzini 237349ab747fSPaolo Bonzini bar_type = PCI_BASE_ADDRESS_SPACE_MEMORY | PCI_BASE_ADDRESS_MEM_TYPE_64; 2374e23d0498SHannes Reinecke pci_register_bar(dev, b->ioport_bar, 2375e23d0498SHannes Reinecke PCI_BASE_ADDRESS_SPACE_IO, &s->port_io); 2376e23d0498SHannes Reinecke pci_register_bar(dev, b->mmio_bar, bar_type, &s->mmio_io); 237752190c1eSAndreas Färber pci_register_bar(dev, 3, bar_type, &s->queue_io); 237849ab747fSPaolo Bonzini 237949ab747fSPaolo Bonzini if (megasas_use_msix(s)) { 238052190c1eSAndreas Färber msix_vector_use(dev, 0); 238149ab747fSPaolo Bonzini } 238249ab747fSPaolo Bonzini 23838d72db68SHannes Reinecke s->fw_state = MFI_FWSTATE_READY; 238449ab747fSPaolo Bonzini if (!s->sas_addr) { 238549ab747fSPaolo Bonzini s->sas_addr = ((NAA_LOCALLY_ASSIGNED_ID << 24) | 238649ab747fSPaolo Bonzini IEEE_COMPANY_LOCALLY_ASSIGNED) << 36; 2387cdc57472SDavid Gibson s->sas_addr |= (pci_dev_bus_num(dev) << 16); 238849ab747fSPaolo Bonzini s->sas_addr |= (PCI_SLOT(dev->devfn) << 8); 238949ab747fSPaolo Bonzini s->sas_addr |= PCI_FUNC(dev->devfn); 239049ab747fSPaolo Bonzini } 239149ab747fSPaolo Bonzini if (!s->hba_serial) { 239249ab747fSPaolo Bonzini s->hba_serial = g_strdup(MEGASAS_HBA_SERIAL); 239349ab747fSPaolo Bonzini } 239449ab747fSPaolo Bonzini if (s->fw_sge >= MEGASAS_MAX_SGE - MFI_PASS_FRAME_SIZE) { 239549ab747fSPaolo Bonzini s->fw_sge = MEGASAS_MAX_SGE - MFI_PASS_FRAME_SIZE; 239649ab747fSPaolo Bonzini } else if (s->fw_sge >= 128 - MFI_PASS_FRAME_SIZE) { 239749ab747fSPaolo Bonzini s->fw_sge = 128 - MFI_PASS_FRAME_SIZE; 239849ab747fSPaolo Bonzini } else { 239949ab747fSPaolo Bonzini s->fw_sge = 64 - MFI_PASS_FRAME_SIZE; 240049ab747fSPaolo Bonzini } 240149ab747fSPaolo Bonzini if (s->fw_cmds > MEGASAS_MAX_FRAMES) { 240249ab747fSPaolo Bonzini s->fw_cmds = MEGASAS_MAX_FRAMES; 240349ab747fSPaolo Bonzini } 240449ab747fSPaolo Bonzini trace_megasas_init(s->fw_sge, s->fw_cmds, 240549ab747fSPaolo Bonzini megasas_is_jbod(s) ? "jbod" : "raid"); 24063f2cd4ddSHannes Reinecke 24073f2cd4ddSHannes Reinecke if (megasas_is_jbod(s)) { 24083f2cd4ddSHannes Reinecke s->fw_luns = MFI_MAX_SYS_PDS; 24093f2cd4ddSHannes Reinecke } else { 24103f2cd4ddSHannes Reinecke s->fw_luns = MFI_MAX_LD; 24113f2cd4ddSHannes Reinecke } 241249ab747fSPaolo Bonzini s->producer_pa = 0; 241349ab747fSPaolo Bonzini s->consumer_pa = 0; 241449ab747fSPaolo Bonzini for (i = 0; i < s->fw_cmds; i++) { 241549ab747fSPaolo Bonzini s->frames[i].index = i; 241649ab747fSPaolo Bonzini s->frames[i].context = -1; 241749ab747fSPaolo Bonzini s->frames[i].pa = 0; 241849ab747fSPaolo Bonzini s->frames[i].state = s; 241949ab747fSPaolo Bonzini } 242049ab747fSPaolo Bonzini 2421b1187b51SAndreas Färber scsi_bus_new(&s->bus, sizeof(s->bus), DEVICE(dev), 2422b1187b51SAndreas Färber &megasas_scsi_info, NULL); 242322d6aa03SAndreas Färber } 242449ab747fSPaolo Bonzini 2425e23d0498SHannes Reinecke static Property megasas_properties_gen1[] = { 242649ab747fSPaolo Bonzini DEFINE_PROP_UINT32("max_sge", MegasasState, fw_sge, 242749ab747fSPaolo Bonzini MEGASAS_DEFAULT_SGE), 242849ab747fSPaolo Bonzini DEFINE_PROP_UINT32("max_cmds", MegasasState, fw_cmds, 242949ab747fSPaolo Bonzini MEGASAS_DEFAULT_FRAMES), 243049ab747fSPaolo Bonzini DEFINE_PROP_STRING("hba_serial", MegasasState, hba_serial), 2431c7bcc85dSPaolo Bonzini DEFINE_PROP_UINT64("sas_address", MegasasState, sas_addr, 0), 2432b4b4a57fSCao jin DEFINE_PROP_ON_OFF_AUTO("msi", MegasasState, msi, ON_OFF_AUTO_AUTO), 2433b4b4a57fSCao jin DEFINE_PROP_ON_OFF_AUTO("msix", MegasasState, msix, ON_OFF_AUTO_AUTO), 243449ab747fSPaolo Bonzini DEFINE_PROP_BIT("use_jbod", MegasasState, flags, 243549ab747fSPaolo Bonzini MEGASAS_FLAG_USE_JBOD, false), 243649ab747fSPaolo Bonzini DEFINE_PROP_END_OF_LIST(), 243749ab747fSPaolo Bonzini }; 243849ab747fSPaolo Bonzini 2439e23d0498SHannes Reinecke static Property megasas_properties_gen2[] = { 2440e23d0498SHannes Reinecke DEFINE_PROP_UINT32("max_sge", MegasasState, fw_sge, 2441e23d0498SHannes Reinecke MEGASAS_DEFAULT_SGE), 2442e23d0498SHannes Reinecke DEFINE_PROP_UINT32("max_cmds", MegasasState, fw_cmds, 2443e23d0498SHannes Reinecke MEGASAS_GEN2_DEFAULT_FRAMES), 2444e23d0498SHannes Reinecke DEFINE_PROP_STRING("hba_serial", MegasasState, hba_serial), 2445e23d0498SHannes Reinecke DEFINE_PROP_UINT64("sas_address", MegasasState, sas_addr, 0), 2446b4b4a57fSCao jin DEFINE_PROP_ON_OFF_AUTO("msi", MegasasState, msi, ON_OFF_AUTO_AUTO), 2447b4b4a57fSCao jin DEFINE_PROP_ON_OFF_AUTO("msix", MegasasState, msix, ON_OFF_AUTO_AUTO), 2448e23d0498SHannes Reinecke DEFINE_PROP_BIT("use_jbod", MegasasState, flags, 2449e23d0498SHannes Reinecke MEGASAS_FLAG_USE_JBOD, false), 2450e23d0498SHannes Reinecke DEFINE_PROP_END_OF_LIST(), 2451e23d0498SHannes Reinecke }; 2452e23d0498SHannes Reinecke 2453e23d0498SHannes Reinecke typedef struct MegasasInfo { 2454e23d0498SHannes Reinecke const char *name; 2455e23d0498SHannes Reinecke const char *desc; 2456e23d0498SHannes Reinecke const char *product_name; 2457e23d0498SHannes Reinecke const char *product_version; 2458e23d0498SHannes Reinecke uint16_t device_id; 2459e23d0498SHannes Reinecke uint16_t subsystem_id; 2460e23d0498SHannes Reinecke int ioport_bar; 2461e23d0498SHannes Reinecke int mmio_bar; 2462e23d0498SHannes Reinecke int osts; 2463e23d0498SHannes Reinecke const VMStateDescription *vmsd; 2464e23d0498SHannes Reinecke Property *props; 246571d78767SEduardo Habkost InterfaceInfo *interfaces; 2466e23d0498SHannes Reinecke } MegasasInfo; 2467e23d0498SHannes Reinecke 2468e23d0498SHannes Reinecke static struct MegasasInfo megasas_devices[] = { 2469e23d0498SHannes Reinecke { 2470e23d0498SHannes Reinecke .name = TYPE_MEGASAS_GEN1, 2471e23d0498SHannes Reinecke .desc = "LSI MegaRAID SAS 1078", 2472e23d0498SHannes Reinecke .product_name = "LSI MegaRAID SAS 8708EM2", 2473e23d0498SHannes Reinecke .product_version = MEGASAS_VERSION_GEN1, 2474e23d0498SHannes Reinecke .device_id = PCI_DEVICE_ID_LSI_SAS1078, 2475e23d0498SHannes Reinecke .subsystem_id = 0x1013, 2476e23d0498SHannes Reinecke .ioport_bar = 2, 2477e23d0498SHannes Reinecke .mmio_bar = 0, 2478e23d0498SHannes Reinecke .osts = MFI_1078_RM | 1, 2479e23d0498SHannes Reinecke .vmsd = &vmstate_megasas_gen1, 2480e23d0498SHannes Reinecke .props = megasas_properties_gen1, 2481fd3b02c8SEduardo Habkost .interfaces = (InterfaceInfo[]) { 2482fd3b02c8SEduardo Habkost { INTERFACE_CONVENTIONAL_PCI_DEVICE }, 2483fd3b02c8SEduardo Habkost { }, 2484fd3b02c8SEduardo Habkost }, 2485e23d0498SHannes Reinecke },{ 2486e23d0498SHannes Reinecke .name = TYPE_MEGASAS_GEN2, 2487e23d0498SHannes Reinecke .desc = "LSI MegaRAID SAS 2108", 2488e23d0498SHannes Reinecke .product_name = "LSI MegaRAID SAS 9260-8i", 2489e23d0498SHannes Reinecke .product_version = MEGASAS_VERSION_GEN2, 2490e23d0498SHannes Reinecke .device_id = PCI_DEVICE_ID_LSI_SAS0079, 2491e23d0498SHannes Reinecke .subsystem_id = 0x9261, 2492e23d0498SHannes Reinecke .ioport_bar = 0, 2493e23d0498SHannes Reinecke .mmio_bar = 1, 2494e23d0498SHannes Reinecke .osts = MFI_GEN2_RM, 2495e23d0498SHannes Reinecke .vmsd = &vmstate_megasas_gen2, 2496e23d0498SHannes Reinecke .props = megasas_properties_gen2, 249771d78767SEduardo Habkost .interfaces = (InterfaceInfo[]) { 249871d78767SEduardo Habkost { INTERFACE_PCIE_DEVICE }, 249971d78767SEduardo Habkost { } 250071d78767SEduardo Habkost }, 2501e23d0498SHannes Reinecke } 2502e23d0498SHannes Reinecke }; 2503e23d0498SHannes Reinecke 250449ab747fSPaolo Bonzini static void megasas_class_init(ObjectClass *oc, void *data) 250549ab747fSPaolo Bonzini { 250649ab747fSPaolo Bonzini DeviceClass *dc = DEVICE_CLASS(oc); 250749ab747fSPaolo Bonzini PCIDeviceClass *pc = PCI_DEVICE_CLASS(oc); 25082e0aec15SEduardo Habkost MegasasBaseClass *e = MEGASAS_CLASS(oc); 2509e23d0498SHannes Reinecke const MegasasInfo *info = data; 251049ab747fSPaolo Bonzini 2511ae071cc8SMarkus Armbruster pc->realize = megasas_scsi_realize; 251249ab747fSPaolo Bonzini pc->exit = megasas_scsi_uninit; 251349ab747fSPaolo Bonzini pc->vendor_id = PCI_VENDOR_ID_LSI_LOGIC; 2514e23d0498SHannes Reinecke pc->device_id = info->device_id; 251549ab747fSPaolo Bonzini pc->subsystem_vendor_id = PCI_VENDOR_ID_LSI_LOGIC; 2516e23d0498SHannes Reinecke pc->subsystem_id = info->subsystem_id; 251749ab747fSPaolo Bonzini pc->class_id = PCI_CLASS_STORAGE_RAID; 2518e23d0498SHannes Reinecke e->mmio_bar = info->mmio_bar; 2519e23d0498SHannes Reinecke e->ioport_bar = info->ioport_bar; 2520e23d0498SHannes Reinecke e->osts = info->osts; 2521e23d0498SHannes Reinecke e->product_name = info->product_name; 2522e23d0498SHannes Reinecke e->product_version = info->product_version; 25234f67d30bSMarc-André Lureau device_class_set_props(dc, info->props); 252449ab747fSPaolo Bonzini dc->reset = megasas_scsi_reset; 2525e23d0498SHannes Reinecke dc->vmsd = info->vmsd; 2526125ee0edSMarcel Apfelbaum set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); 2527e23d0498SHannes Reinecke dc->desc = info->desc; 252849ab747fSPaolo Bonzini } 252949ab747fSPaolo Bonzini 253049ab747fSPaolo Bonzini static const TypeInfo megasas_info = { 2531e23d0498SHannes Reinecke .name = TYPE_MEGASAS_BASE, 253249ab747fSPaolo Bonzini .parent = TYPE_PCI_DEVICE, 253349ab747fSPaolo Bonzini .instance_size = sizeof(MegasasState), 2534e23d0498SHannes Reinecke .class_size = sizeof(MegasasBaseClass), 2535e23d0498SHannes Reinecke .abstract = true, 253649ab747fSPaolo Bonzini }; 253749ab747fSPaolo Bonzini 253849ab747fSPaolo Bonzini static void megasas_register_types(void) 253949ab747fSPaolo Bonzini { 2540e23d0498SHannes Reinecke int i; 2541e23d0498SHannes Reinecke 254249ab747fSPaolo Bonzini type_register_static(&megasas_info); 2543e23d0498SHannes Reinecke for (i = 0; i < ARRAY_SIZE(megasas_devices); i++) { 2544e23d0498SHannes Reinecke const MegasasInfo *info = &megasas_devices[i]; 2545e23d0498SHannes Reinecke TypeInfo type_info = {}; 2546e23d0498SHannes Reinecke 2547e23d0498SHannes Reinecke type_info.name = info->name; 2548e23d0498SHannes Reinecke type_info.parent = TYPE_MEGASAS_BASE; 2549e23d0498SHannes Reinecke type_info.class_data = (void *)info; 2550e23d0498SHannes Reinecke type_info.class_init = megasas_class_init; 255171d78767SEduardo Habkost type_info.interfaces = info->interfaces; 2552e23d0498SHannes Reinecke 2553e23d0498SHannes Reinecke type_register(&type_info); 2554e23d0498SHannes Reinecke } 255549ab747fSPaolo Bonzini } 255649ab747fSPaolo Bonzini 255749ab747fSPaolo Bonzini type_init(megasas_register_types) 2558